drivers/gpu/drm/exynos/exynos_drm_connector.c - maze/linux - Git at Google

 /*
  * Copyright (c) 2011 Samsung Electronics Co., Ltd.
  * Authors:
  *	Inki Dae <inki.dae@samsung.com>
  *	Joonyoung Shim <jy0922.shim@samsung.com>
  *	Seung-Woo Kim <sw0312.kim@samsung.com>
  *
  * Permission is hereby granted, free of charge, to any person obtaining a
  * copy of this software and associated documentation files (the "Software"),
  * to deal in the Software without restriction, including without limitation
  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
  * and/or sell copies of the Software, and to permit persons to whom the
  * Software is furnished to do so, subject to the following conditions:
  *
  * The above copyright notice and this permission notice (including the next
  * paragraph) shall be included in all copies or substantial portions of the
  * Software.
  *
  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
  * VA LINUX SYSTEMS AND/OR ITS SUPPLIERS BE LIABLE FOR ANY CLAIM, DAMAGES OR
  * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
  * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
  * OTHER DEALINGS IN THE SOFTWARE.
  */

 #include "drmP.h"
 #include "drm_crtc_helper.h"

 #include "exynos_drm_drv.h"
 #include "exynos_drm_encoder.h"

 #define MAX_EDID 256
 #define to_exynos_connector(x)	container_of(x, struct exynos_drm_connector,\
 				drm_connector)

 struct exynos_drm_connector {
 	struct drm_connector	drm_connector;
 };

 /* convert exynos_video_timings to drm_display_mode */
 static inline void
 convert_to_display_mode(struct drm_display_mode *mode,
 			struct fb_videomode *timing)
 {
 	DRM_DEBUG_KMS("%s\n", __FILE__);

 	mode->clock = timing->pixclock / 1000;

 	mode->hdisplay = timing->xres;
 	mode->hsync_start = mode->hdisplay + timing->left_margin;
 	mode->hsync_end = mode->hsync_start + timing->hsync_len;
 	mode->htotal = mode->hsync_end + timing->right_margin;

 	mode->vdisplay = timing->yres;
 	mode->vsync_start = mode->vdisplay + timing->upper_margin;
 	mode->vsync_end = mode->vsync_start + timing->vsync_len;
 	mode->vtotal = mode->vsync_end + timing->lower_margin;
 }

 /* convert drm_display_mode to exynos_video_timings */
 static inline void
 convert_to_video_timing(struct fb_videomode *timing,
 			struct drm_display_mode *mode)
 {
 	DRM_DEBUG_KMS("%s\n", __FILE__);

 	memset(timing, 0, sizeof(*timing));

 	timing->pixclock = mode->clock * 1000;
 	timing->refresh = mode->vrefresh;

 	timing->xres = mode->hdisplay;
 	timing->left_margin = mode->hsync_start - mode->hdisplay;
 	timing->hsync_len = mode->hsync_end - mode->hsync_start;
 	timing->right_margin = mode->htotal - mode->hsync_end;

 	timing->yres = mode->vdisplay;
 	timing->upper_margin = mode->vsync_start - mode->vdisplay;
 	timing->vsync_len = mode->vsync_end - mode->vsync_start;
 	timing->lower_margin = mode->vtotal - mode->vsync_end;

 	if (mode->flags & DRM_MODE_FLAG_INTERLACE)
 		timing->vmode = FB_VMODE_INTERLACED;
 	else
 		timing->vmode = FB_VMODE_NONINTERLACED;

 	if (mode->flags & DRM_MODE_FLAG_DBLSCAN)
 		timing->vmode |= FB_VMODE_DOUBLE;
 }

 static int exynos_drm_connector_get_modes(struct drm_connector *connector)
 {
 	struct exynos_drm_manager *manager =
 				exynos_drm_get_manager(connector->encoder);
 	struct exynos_drm_display *display = manager->display;
 	unsigned int count;

 	DRM_DEBUG_KMS("%s\n", __FILE__);

 	if (!display) {
 		DRM_DEBUG_KMS("display is null.\n");
 		return 0;
 	}

 	/*
 	 * if get_edid() exists then get_edid() callback of hdmi side
 	 * is called to get edid data through i2c interface else
 	 * get timing from the FIMD driver(display controller).
 	 *
 	 * P.S. in case of lcd panel, count is always 1 if success
 	 * because lcd panel has only one mode.
 	 */
 	if (display->get_edid) {
 		int ret;
 		void *edid;

 		edid = kzalloc(MAX_EDID, GFP_KERNEL);
 		if (!edid) {
 			DRM_ERROR("failed to allocate edid\n");
 			return 0;
 		}

 		ret = display->get_edid(manager->dev, connector,
 						edid, MAX_EDID);
 		if (ret < 0) {
 			DRM_ERROR("failed to get edid data.\n");
 			kfree(edid);
 			edid = NULL;
 			return 0;
 		}

 		drm_mode_connector_update_edid_property(connector, edid);
 		count = drm_add_edid_modes(connector, edid);

 		kfree(connector->display_info.raw_edid);
 		connector->display_info.raw_edid = edid;
 	} else {
 		struct drm_display_mode *mode = drm_mode_create(connector->dev);
 		struct fb_videomode *timing;

 		if (display->get_timing)
 			timing = display->get_timing(manager->dev);
 		else {
 			drm_mode_destroy(connector->dev, mode);
 			return 0;
 		}

 		convert_to_display_mode(mode, timing);

 		mode->type = DRM_MODE_TYPE_DRIVER | DRM_MODE_TYPE_PREFERRED;
 		drm_mode_set_name(mode);
 		drm_mode_probed_add(connector, mode);

 		count = 1;
 	}

 	return count;
 }

 static int exynos_drm_connector_mode_valid(struct drm_connector *connector,
 					    struct drm_display_mode *mode)
 {
 	struct exynos_drm_manager *manager =
 				exynos_drm_get_manager(connector->encoder);
 	struct exynos_drm_display *display = manager->display;
 	struct fb_videomode timing;
 	int ret = MODE_BAD;

 	DRM_DEBUG_KMS("%s\n", __FILE__);

 	convert_to_video_timing(&timing, mode);

 	if (display && display->check_timing)
 		if (!display->check_timing(manager->dev, (void *)&timing))
 			ret = MODE_OK;

 	return ret;
 }

 struct drm_encoder *exynos_drm_best_encoder(struct drm_connector *connector)
 {
 	DRM_DEBUG_KMS("%s\n", __FILE__);

 	return connector->encoder;
 }

 static struct drm_connector_helper_funcs exynos_connector_helper_funcs = {
 	.get_modes	= exynos_drm_connector_get_modes,
 	.mode_valid	= exynos_drm_connector_mode_valid,
 	.best_encoder	= exynos_drm_best_encoder,
 };

 /* get detection status of display device. */
 static enum drm_connector_status
 exynos_drm_connector_detect(struct drm_connector *connector, bool force)
 {
 	struct exynos_drm_manager *manager =
 				exynos_drm_get_manager(connector->encoder);
 	struct exynos_drm_display *display = manager->display;
 	enum drm_connector_status status = connector_status_disconnected;

 	DRM_DEBUG_KMS("%s\n", __FILE__);

 	if (display && display->is_connected) {
 		if (display->is_connected(manager->dev))
 			status = connector_status_connected;
 		else
 			status = connector_status_disconnected;
 	}

 	return status;
 }

 static void exynos_drm_connector_destroy(struct drm_connector *connector)
 {
 	struct exynos_drm_connector *exynos_connector =
 		to_exynos_connector(connector);

 	DRM_DEBUG_KMS("%s\n", __FILE__);

 	drm_sysfs_connector_remove(connector);
 	drm_connector_cleanup(connector);
 	kfree(exynos_connector);
 }

 static struct drm_connector_funcs exynos_connector_funcs = {
 	.dpms		= drm_helper_connector_dpms,
 	.fill_modes	= drm_helper_probe_single_connector_modes,
 	.detect		= exynos_drm_connector_detect,
 	.destroy	= exynos_drm_connector_destroy,
 };

 struct drm_connector *exynos_drm_connector_create(struct drm_device *dev,
 						   struct drm_encoder *encoder)
 {
 	struct exynos_drm_connector *exynos_connector;
 	struct exynos_drm_manager *manager = exynos_drm_get_manager(encoder);
 	struct drm_connector *connector;
 	int type;
 	int err;

 	DRM_DEBUG_KMS("%s\n", __FILE__);

 	exynos_connector = kzalloc(sizeof(*exynos_connector), GFP_KERNEL);
 	if (!exynos_connector) {
 		DRM_ERROR("failed to allocate connector\n");
 		return NULL;
 	}

 	connector = &exynos_connector->drm_connector;

 	switch (manager->display->type) {
 	case EXYNOS_DISPLAY_TYPE_HDMI:
 		type = DRM_MODE_CONNECTOR_HDMIA;
 		break;
 	default:
 		type = DRM_MODE_CONNECTOR_Unknown;
 		break;
 	}

 	drm_connector_init(dev, connector, &exynos_connector_funcs, type);
 	drm_connector_helper_add(connector, &exynos_connector_helper_funcs);

 	err = drm_sysfs_connector_add(connector);
 	if (err)
 		goto err_connector;

 	connector->encoder = encoder;
 	err = drm_mode_connector_attach_encoder(connector, encoder);
 	if (err) {
 		DRM_ERROR("failed to attach a connector to a encoder\n");
 		goto err_sysfs;
 	}

 	DRM_DEBUG_KMS("connector has been created\n");

 	return connector;

 err_sysfs:
 	drm_sysfs_connector_remove(connector);
 err_connector:
 	drm_connector_cleanup(connector);
 	kfree(exynos_connector);
 	return NULL;
 }

 MODULE_AUTHOR("Inki Dae <inki.dae@samsung.com>");
 MODULE_AUTHOR("Joonyoung Shim <jy0922.shim@samsung.com>");
 MODULE_AUTHOR("Seung-Woo Kim <sw0312.kim@samsung.com>");
 MODULE_DESCRIPTION("Samsung SoC DRM Connector Driver");
 MODULE_LICENSE("GPL");
	/*
	* Copyright (c) 2011 Samsung Electronics Co., Ltd.
	* Authors:
	* Inki Dae <inki.dae@samsung.com>
	* Joonyoung Shim <jy0922.shim@samsung.com>
	* Seung-Woo Kim <sw0312.kim@samsung.com>
	*
	* Permission is hereby granted, free of charge, to any person obtaining a
	* copy of this software and associated documentation files (the "Software"),
	* to deal in the Software without restriction, including without limitation
	* the rights to use, copy, modify, merge, publish, distribute, sublicense,
	* and/or sell copies of the Software, and to permit persons to whom the
	* Software is furnished to do so, subject to the following conditions:
	*
	* The above copyright notice and this permission notice (including the next
	* paragraph) shall be included in all copies or substantial portions of the
	* Software.
	*
	* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
	* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
	* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
	* VA LINUX SYSTEMS AND/OR ITS SUPPLIERS BE LIABLE FOR ANY CLAIM, DAMAGES OR
	* OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
	* ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
	* OTHER DEALINGS IN THE SOFTWARE.
	*/

	#include "drmP.h"
	#include "drm_crtc_helper.h"

	#include "exynos_drm_drv.h"
	#include "exynos_drm_encoder.h"

	#define MAX_EDID 256
	#define to_exynos_connector(x) container_of(x, struct exynos_drm_connector,\
	drm_connector)

	struct exynos_drm_connector {
	struct drm_connector drm_connector;
	};

	/* convert exynos_video_timings to drm_display_mode */
	static inline void
	convert_to_display_mode(struct drm_display_mode *mode,
	struct fb_videomode *timing)
	{
	DRM_DEBUG_KMS("%s\n", __FILE__);

	mode->clock = timing->pixclock / 1000;

	mode->hdisplay = timing->xres;
	mode->hsync_start = mode->hdisplay + timing->left_margin;
	mode->hsync_end = mode->hsync_start + timing->hsync_len;
	mode->htotal = mode->hsync_end + timing->right_margin;

	mode->vdisplay = timing->yres;
	mode->vsync_start = mode->vdisplay + timing->upper_margin;
	mode->vsync_end = mode->vsync_start + timing->vsync_len;
	mode->vtotal = mode->vsync_end + timing->lower_margin;
	}

	/* convert drm_display_mode to exynos_video_timings */
	static inline void
	convert_to_video_timing(struct fb_videomode *timing,
	struct drm_display_mode *mode)
	{
	DRM_DEBUG_KMS("%s\n", __FILE__);

	memset(timing, 0, sizeof(*timing));

	timing->pixclock = mode->clock * 1000;
	timing->refresh = mode->vrefresh;

	timing->xres = mode->hdisplay;
	timing->left_margin = mode->hsync_start - mode->hdisplay;
	timing->hsync_len = mode->hsync_end - mode->hsync_start;
	timing->right_margin = mode->htotal - mode->hsync_end;

	timing->yres = mode->vdisplay;
	timing->upper_margin = mode->vsync_start - mode->vdisplay;
	timing->vsync_len = mode->vsync_end - mode->vsync_start;
	timing->lower_margin = mode->vtotal - mode->vsync_end;

	if (mode->flags & DRM_MODE_FLAG_INTERLACE)
	timing->vmode = FB_VMODE_INTERLACED;
	else
	timing->vmode = FB_VMODE_NONINTERLACED;

	if (mode->flags & DRM_MODE_FLAG_DBLSCAN)
	timing->vmode \|= FB_VMODE_DOUBLE;
	}

	static int exynos_drm_connector_get_modes(struct drm_connector *connector)
	{
	struct exynos_drm_manager *manager =
	exynos_drm_get_manager(connector->encoder);
	struct exynos_drm_display *display = manager->display;
	unsigned int count;

	DRM_DEBUG_KMS("%s\n", __FILE__);

	if (!display) {
	DRM_DEBUG_KMS("display is null.\n");
	return 0;
	}

	/*
	* if get_edid() exists then get_edid() callback of hdmi side
	* is called to get edid data through i2c interface else
	* get timing from the FIMD driver(display controller).
	*
	* P.S. in case of lcd panel, count is always 1 if success
	* because lcd panel has only one mode.
	*/
	if (display->get_edid) {
	int ret;
	void *edid;

	edid = kzalloc(MAX_EDID, GFP_KERNEL);
	if (!edid) {
	DRM_ERROR("failed to allocate edid\n");
	return 0;
	}

	ret = display->get_edid(manager->dev, connector,
	edid, MAX_EDID);
	if (ret < 0) {
	DRM_ERROR("failed to get edid data.\n");
	kfree(edid);
	edid = NULL;
	return 0;
	}

	drm_mode_connector_update_edid_property(connector, edid);
	count = drm_add_edid_modes(connector, edid);

	kfree(connector->display_info.raw_edid);
	connector->display_info.raw_edid = edid;
	} else {
	struct drm_display_mode *mode = drm_mode_create(connector->dev);
	struct fb_videomode *timing;

	if (display->get_timing)
	timing = display->get_timing(manager->dev);
	else {
	drm_mode_destroy(connector->dev, mode);
	return 0;
	}

	convert_to_display_mode(mode, timing);

	mode->type = DRM_MODE_TYPE_DRIVER \| DRM_MODE_TYPE_PREFERRED;
	drm_mode_set_name(mode);
	drm_mode_probed_add(connector, mode);

	count = 1;
	}

	return count;
	}

	static int exynos_drm_connector_mode_valid(struct drm_connector *connector,
	struct drm_display_mode *mode)
	{
	struct exynos_drm_manager *manager =
	exynos_drm_get_manager(connector->encoder);
	struct exynos_drm_display *display = manager->display;
	struct fb_videomode timing;
	int ret = MODE_BAD;

	DRM_DEBUG_KMS("%s\n", __FILE__);

	convert_to_video_timing(&timing, mode);

	if (display && display->check_timing)
	if (!display->check_timing(manager->dev, (void *)&timing))
	ret = MODE_OK;

	return ret;
	}

	struct drm_encoder exynos_drm_best_encoder(struct drm_connector connector)
	{
	DRM_DEBUG_KMS("%s\n", __FILE__);

	return connector->encoder;
	}

	static struct drm_connector_helper_funcs exynos_connector_helper_funcs = {
	.get_modes = exynos_drm_connector_get_modes,
	.mode_valid = exynos_drm_connector_mode_valid,
	.best_encoder = exynos_drm_best_encoder,
	};

	/* get detection status of display device. */
	static enum drm_connector_status
	exynos_drm_connector_detect(struct drm_connector *connector, bool force)
	{
	struct exynos_drm_manager *manager =
	exynos_drm_get_manager(connector->encoder);
	struct exynos_drm_display *display = manager->display;
	enum drm_connector_status status = connector_status_disconnected;

	DRM_DEBUG_KMS("%s\n", __FILE__);

	if (display && display->is_connected) {
	if (display->is_connected(manager->dev))
	status = connector_status_connected;
	else
	status = connector_status_disconnected;
	}

	return status;
	}

	static void exynos_drm_connector_destroy(struct drm_connector *connector)
	{
	struct exynos_drm_connector *exynos_connector =
	to_exynos_connector(connector);

	DRM_DEBUG_KMS("%s\n", __FILE__);

	drm_sysfs_connector_remove(connector);
	drm_connector_cleanup(connector);
	kfree(exynos_connector);
	}

	static struct drm_connector_funcs exynos_connector_funcs = {
	.dpms = drm_helper_connector_dpms,
	.fill_modes = drm_helper_probe_single_connector_modes,
	.detect = exynos_drm_connector_detect,
	.destroy = exynos_drm_connector_destroy,
	};

	struct drm_connector exynos_drm_connector_create(struct drm_device dev,
	struct drm_encoder *encoder)
	{
	struct exynos_drm_connector *exynos_connector;
	struct exynos_drm_manager *manager = exynos_drm_get_manager(encoder);
	struct drm_connector *connector;
	int type;
	int err;

	DRM_DEBUG_KMS("%s\n", __FILE__);

	exynos_connector = kzalloc(sizeof(*exynos_connector), GFP_KERNEL);
	if (!exynos_connector) {
	DRM_ERROR("failed to allocate connector\n");
	return NULL;
	}

	connector = &exynos_connector->drm_connector;

	switch (manager->display->type) {
	case EXYNOS_DISPLAY_TYPE_HDMI:
	type = DRM_MODE_CONNECTOR_HDMIA;
	break;
	default:
	type = DRM_MODE_CONNECTOR_Unknown;
	break;
	}

	drm_connector_init(dev, connector, &exynos_connector_funcs, type);
	drm_connector_helper_add(connector, &exynos_connector_helper_funcs);

	err = drm_sysfs_connector_add(connector);
	if (err)
	goto err_connector;

	connector->encoder = encoder;
	err = drm_mode_connector_attach_encoder(connector, encoder);
	if (err) {
	DRM_ERROR("failed to attach a connector to a encoder\n");
	goto err_sysfs;
	}

	DRM_DEBUG_KMS("connector has been created\n");

	return connector;

	err_sysfs:
	drm_sysfs_connector_remove(connector);
	err_connector:
	drm_connector_cleanup(connector);
	kfree(exynos_connector);
	return NULL;
	}

	MODULE_AUTHOR("Inki Dae <inki.dae@samsung.com>");
	MODULE_AUTHOR("Joonyoung Shim <jy0922.shim@samsung.com>");
	MODULE_AUTHOR("Seung-Woo Kim <sw0312.kim@samsung.com>");
	MODULE_DESCRIPTION("Samsung SoC DRM Connector Driver");
	MODULE_LICENSE("GPL");