328 lines
		
	
	
		
			7.5 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			328 lines
		
	
	
		
			7.5 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
// SPDX-License-Identifier: GPL-2.0-only
 | 
						|
/*
 | 
						|
 * linux/drivers/video/omap2/dss/display.c
 | 
						|
 *
 | 
						|
 * Copyright (C) 2009 Nokia Corporation
 | 
						|
 * Author: Tomi Valkeinen <tomi.valkeinen@nokia.com>
 | 
						|
 *
 | 
						|
 * Some code and ideas taken from drivers/video/omap/ driver
 | 
						|
 * by Imre Deak.
 | 
						|
 */
 | 
						|
 | 
						|
#define DSS_SUBSYS_NAME "DISPLAY"
 | 
						|
 | 
						|
#include <linux/kernel.h>
 | 
						|
#include <linux/module.h>
 | 
						|
#include <linux/jiffies.h>
 | 
						|
#include <linux/platform_device.h>
 | 
						|
#include <linux/of.h>
 | 
						|
 | 
						|
#include <video/omapfb_dss.h>
 | 
						|
#include "dss.h"
 | 
						|
#include "dss_features.h"
 | 
						|
 | 
						|
void omapdss_default_get_resolution(struct omap_dss_device *dssdev,
 | 
						|
			u16 *xres, u16 *yres)
 | 
						|
{
 | 
						|
	*xres = dssdev->panel.timings.x_res;
 | 
						|
	*yres = dssdev->panel.timings.y_res;
 | 
						|
}
 | 
						|
EXPORT_SYMBOL(omapdss_default_get_resolution);
 | 
						|
 | 
						|
int omapdss_default_get_recommended_bpp(struct omap_dss_device *dssdev)
 | 
						|
{
 | 
						|
	switch (dssdev->type) {
 | 
						|
	case OMAP_DISPLAY_TYPE_DPI:
 | 
						|
		if (dssdev->phy.dpi.data_lines == 24)
 | 
						|
			return 24;
 | 
						|
		else
 | 
						|
			return 16;
 | 
						|
 | 
						|
	case OMAP_DISPLAY_TYPE_DBI:
 | 
						|
		if (dssdev->ctrl.pixel_size == 24)
 | 
						|
			return 24;
 | 
						|
		else
 | 
						|
			return 16;
 | 
						|
	case OMAP_DISPLAY_TYPE_DSI:
 | 
						|
		if (dsi_get_pixel_size(dssdev->panel.dsi_pix_fmt) > 16)
 | 
						|
			return 24;
 | 
						|
		else
 | 
						|
			return 16;
 | 
						|
	case OMAP_DISPLAY_TYPE_VENC:
 | 
						|
	case OMAP_DISPLAY_TYPE_SDI:
 | 
						|
	case OMAP_DISPLAY_TYPE_HDMI:
 | 
						|
	case OMAP_DISPLAY_TYPE_DVI:
 | 
						|
		return 24;
 | 
						|
	default:
 | 
						|
		BUG();
 | 
						|
		return 0;
 | 
						|
	}
 | 
						|
}
 | 
						|
EXPORT_SYMBOL(omapdss_default_get_recommended_bpp);
 | 
						|
 | 
						|
void omapdss_default_get_timings(struct omap_dss_device *dssdev,
 | 
						|
		struct omap_video_timings *timings)
 | 
						|
{
 | 
						|
	*timings = dssdev->panel.timings;
 | 
						|
}
 | 
						|
EXPORT_SYMBOL(omapdss_default_get_timings);
 | 
						|
 | 
						|
int dss_suspend_all_devices(void)
 | 
						|
{
 | 
						|
	struct omap_dss_device *dssdev = NULL;
 | 
						|
 | 
						|
	for_each_dss_dev(dssdev) {
 | 
						|
		if (!dssdev->driver)
 | 
						|
			continue;
 | 
						|
 | 
						|
		if (dssdev->state == OMAP_DSS_DISPLAY_ACTIVE) {
 | 
						|
			dssdev->driver->disable(dssdev);
 | 
						|
			dssdev->activate_after_resume = true;
 | 
						|
		} else {
 | 
						|
			dssdev->activate_after_resume = false;
 | 
						|
		}
 | 
						|
	}
 | 
						|
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
int dss_resume_all_devices(void)
 | 
						|
{
 | 
						|
	struct omap_dss_device *dssdev = NULL;
 | 
						|
 | 
						|
	for_each_dss_dev(dssdev) {
 | 
						|
		if (!dssdev->driver)
 | 
						|
			continue;
 | 
						|
 | 
						|
		if (dssdev->activate_after_resume) {
 | 
						|
			dssdev->driver->enable(dssdev);
 | 
						|
			dssdev->activate_after_resume = false;
 | 
						|
		}
 | 
						|
	}
 | 
						|
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
void dss_disable_all_devices(void)
 | 
						|
{
 | 
						|
	struct omap_dss_device *dssdev = NULL;
 | 
						|
 | 
						|
	for_each_dss_dev(dssdev) {
 | 
						|
		if (!dssdev->driver)
 | 
						|
			continue;
 | 
						|
 | 
						|
		if (dssdev->state == OMAP_DSS_DISPLAY_ACTIVE)
 | 
						|
			dssdev->driver->disable(dssdev);
 | 
						|
	}
 | 
						|
}
 | 
						|
 | 
						|
static LIST_HEAD(panel_list);
 | 
						|
static DEFINE_MUTEX(panel_list_mutex);
 | 
						|
static int disp_num_counter;
 | 
						|
 | 
						|
int omapdss_register_display(struct omap_dss_device *dssdev)
 | 
						|
{
 | 
						|
	struct omap_dss_driver *drv = dssdev->driver;
 | 
						|
	int id;
 | 
						|
 | 
						|
	/*
 | 
						|
	 * Note: this presumes all the displays are either using DT or non-DT,
 | 
						|
	 * which normally should be the case. This also presumes that all
 | 
						|
	 * displays either have an DT alias, or none has.
 | 
						|
	 */
 | 
						|
 | 
						|
	if (dssdev->dev->of_node) {
 | 
						|
		id = of_alias_get_id(dssdev->dev->of_node, "display");
 | 
						|
 | 
						|
		if (id < 0)
 | 
						|
			id = disp_num_counter++;
 | 
						|
	} else {
 | 
						|
		id = disp_num_counter++;
 | 
						|
	}
 | 
						|
 | 
						|
	snprintf(dssdev->alias, sizeof(dssdev->alias), "display%d", id);
 | 
						|
 | 
						|
	/* Use 'label' property for name, if it exists */
 | 
						|
	if (dssdev->dev->of_node)
 | 
						|
		of_property_read_string(dssdev->dev->of_node, "label",
 | 
						|
			&dssdev->name);
 | 
						|
 | 
						|
	if (dssdev->name == NULL)
 | 
						|
		dssdev->name = dssdev->alias;
 | 
						|
 | 
						|
	if (drv && drv->get_resolution == NULL)
 | 
						|
		drv->get_resolution = omapdss_default_get_resolution;
 | 
						|
	if (drv && drv->get_recommended_bpp == NULL)
 | 
						|
		drv->get_recommended_bpp = omapdss_default_get_recommended_bpp;
 | 
						|
	if (drv && drv->get_timings == NULL)
 | 
						|
		drv->get_timings = omapdss_default_get_timings;
 | 
						|
 | 
						|
	mutex_lock(&panel_list_mutex);
 | 
						|
	list_add_tail(&dssdev->panel_list, &panel_list);
 | 
						|
	mutex_unlock(&panel_list_mutex);
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
EXPORT_SYMBOL(omapdss_register_display);
 | 
						|
 | 
						|
void omapdss_unregister_display(struct omap_dss_device *dssdev)
 | 
						|
{
 | 
						|
	mutex_lock(&panel_list_mutex);
 | 
						|
	list_del(&dssdev->panel_list);
 | 
						|
	mutex_unlock(&panel_list_mutex);
 | 
						|
}
 | 
						|
EXPORT_SYMBOL(omapdss_unregister_display);
 | 
						|
 | 
						|
struct omap_dss_device *omap_dss_get_device(struct omap_dss_device *dssdev)
 | 
						|
{
 | 
						|
	if (!try_module_get(dssdev->owner))
 | 
						|
		return NULL;
 | 
						|
 | 
						|
	if (get_device(dssdev->dev) == NULL) {
 | 
						|
		module_put(dssdev->owner);
 | 
						|
		return NULL;
 | 
						|
	}
 | 
						|
 | 
						|
	return dssdev;
 | 
						|
}
 | 
						|
EXPORT_SYMBOL(omap_dss_get_device);
 | 
						|
 | 
						|
void omap_dss_put_device(struct omap_dss_device *dssdev)
 | 
						|
{
 | 
						|
	put_device(dssdev->dev);
 | 
						|
	module_put(dssdev->owner);
 | 
						|
}
 | 
						|
EXPORT_SYMBOL(omap_dss_put_device);
 | 
						|
 | 
						|
/*
 | 
						|
 * ref count of the found device is incremented.
 | 
						|
 * ref count of from-device is decremented.
 | 
						|
 */
 | 
						|
struct omap_dss_device *omap_dss_get_next_device(struct omap_dss_device *from)
 | 
						|
{
 | 
						|
	struct list_head *l;
 | 
						|
	struct omap_dss_device *dssdev;
 | 
						|
 | 
						|
	mutex_lock(&panel_list_mutex);
 | 
						|
 | 
						|
	if (list_empty(&panel_list)) {
 | 
						|
		dssdev = NULL;
 | 
						|
		goto out;
 | 
						|
	}
 | 
						|
 | 
						|
	if (from == NULL) {
 | 
						|
		dssdev = list_first_entry(&panel_list, struct omap_dss_device,
 | 
						|
				panel_list);
 | 
						|
		omap_dss_get_device(dssdev);
 | 
						|
		goto out;
 | 
						|
	}
 | 
						|
 | 
						|
	omap_dss_put_device(from);
 | 
						|
 | 
						|
	list_for_each(l, &panel_list) {
 | 
						|
		dssdev = list_entry(l, struct omap_dss_device, panel_list);
 | 
						|
		if (dssdev == from) {
 | 
						|
			if (list_is_last(l, &panel_list)) {
 | 
						|
				dssdev = NULL;
 | 
						|
				goto out;
 | 
						|
			}
 | 
						|
 | 
						|
			dssdev = list_entry(l->next, struct omap_dss_device,
 | 
						|
					panel_list);
 | 
						|
			omap_dss_get_device(dssdev);
 | 
						|
			goto out;
 | 
						|
		}
 | 
						|
	}
 | 
						|
 | 
						|
	WARN(1, "'from' dssdev not found\n");
 | 
						|
 | 
						|
	dssdev = NULL;
 | 
						|
out:
 | 
						|
	mutex_unlock(&panel_list_mutex);
 | 
						|
	return dssdev;
 | 
						|
}
 | 
						|
EXPORT_SYMBOL(omap_dss_get_next_device);
 | 
						|
 | 
						|
struct omap_dss_device *omap_dss_find_device(void *data,
 | 
						|
		int (*match)(struct omap_dss_device *dssdev, void *data))
 | 
						|
{
 | 
						|
	struct omap_dss_device *dssdev = NULL;
 | 
						|
 | 
						|
	while ((dssdev = omap_dss_get_next_device(dssdev)) != NULL) {
 | 
						|
		if (match(dssdev, data))
 | 
						|
			return dssdev;
 | 
						|
	}
 | 
						|
 | 
						|
	return NULL;
 | 
						|
}
 | 
						|
EXPORT_SYMBOL(omap_dss_find_device);
 | 
						|
 | 
						|
void videomode_to_omap_video_timings(const struct videomode *vm,
 | 
						|
		struct omap_video_timings *ovt)
 | 
						|
{
 | 
						|
	memset(ovt, 0, sizeof(*ovt));
 | 
						|
 | 
						|
	ovt->pixelclock = vm->pixelclock;
 | 
						|
	ovt->x_res = vm->hactive;
 | 
						|
	ovt->hbp = vm->hback_porch;
 | 
						|
	ovt->hfp = vm->hfront_porch;
 | 
						|
	ovt->hsw = vm->hsync_len;
 | 
						|
	ovt->y_res = vm->vactive;
 | 
						|
	ovt->vbp = vm->vback_porch;
 | 
						|
	ovt->vfp = vm->vfront_porch;
 | 
						|
	ovt->vsw = vm->vsync_len;
 | 
						|
 | 
						|
	ovt->vsync_level = vm->flags & DISPLAY_FLAGS_VSYNC_HIGH ?
 | 
						|
		OMAPDSS_SIG_ACTIVE_HIGH :
 | 
						|
		OMAPDSS_SIG_ACTIVE_LOW;
 | 
						|
	ovt->hsync_level = vm->flags & DISPLAY_FLAGS_HSYNC_HIGH ?
 | 
						|
		OMAPDSS_SIG_ACTIVE_HIGH :
 | 
						|
		OMAPDSS_SIG_ACTIVE_LOW;
 | 
						|
	ovt->de_level = vm->flags & DISPLAY_FLAGS_DE_HIGH ?
 | 
						|
		OMAPDSS_SIG_ACTIVE_HIGH :
 | 
						|
		OMAPDSS_SIG_ACTIVE_LOW;
 | 
						|
	ovt->data_pclk_edge = vm->flags & DISPLAY_FLAGS_PIXDATA_POSEDGE ?
 | 
						|
		OMAPDSS_DRIVE_SIG_RISING_EDGE :
 | 
						|
		OMAPDSS_DRIVE_SIG_FALLING_EDGE;
 | 
						|
 | 
						|
	ovt->sync_pclk_edge = ovt->data_pclk_edge;
 | 
						|
}
 | 
						|
EXPORT_SYMBOL(videomode_to_omap_video_timings);
 | 
						|
 | 
						|
void omap_video_timings_to_videomode(const struct omap_video_timings *ovt,
 | 
						|
		struct videomode *vm)
 | 
						|
{
 | 
						|
	memset(vm, 0, sizeof(*vm));
 | 
						|
 | 
						|
	vm->pixelclock = ovt->pixelclock;
 | 
						|
 | 
						|
	vm->hactive = ovt->x_res;
 | 
						|
	vm->hback_porch = ovt->hbp;
 | 
						|
	vm->hfront_porch = ovt->hfp;
 | 
						|
	vm->hsync_len = ovt->hsw;
 | 
						|
	vm->vactive = ovt->y_res;
 | 
						|
	vm->vback_porch = ovt->vbp;
 | 
						|
	vm->vfront_porch = ovt->vfp;
 | 
						|
	vm->vsync_len = ovt->vsw;
 | 
						|
 | 
						|
	if (ovt->hsync_level == OMAPDSS_SIG_ACTIVE_HIGH)
 | 
						|
		vm->flags |= DISPLAY_FLAGS_HSYNC_HIGH;
 | 
						|
	else
 | 
						|
		vm->flags |= DISPLAY_FLAGS_HSYNC_LOW;
 | 
						|
 | 
						|
	if (ovt->vsync_level == OMAPDSS_SIG_ACTIVE_HIGH)
 | 
						|
		vm->flags |= DISPLAY_FLAGS_VSYNC_HIGH;
 | 
						|
	else
 | 
						|
		vm->flags |= DISPLAY_FLAGS_VSYNC_LOW;
 | 
						|
 | 
						|
	if (ovt->de_level == OMAPDSS_SIG_ACTIVE_HIGH)
 | 
						|
		vm->flags |= DISPLAY_FLAGS_DE_HIGH;
 | 
						|
	else
 | 
						|
		vm->flags |= DISPLAY_FLAGS_DE_LOW;
 | 
						|
 | 
						|
	if (ovt->data_pclk_edge == OMAPDSS_DRIVE_SIG_RISING_EDGE)
 | 
						|
		vm->flags |= DISPLAY_FLAGS_PIXDATA_POSEDGE;
 | 
						|
	else
 | 
						|
		vm->flags |= DISPLAY_FLAGS_PIXDATA_NEGEDGE;
 | 
						|
}
 | 
						|
EXPORT_SYMBOL(omap_video_timings_to_videomode);
 |