|  | /* | 
|  | * 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> | 
|  | * | 
|  | * This program is free software; you can redistribute  it and/or modify it | 
|  | * under  the terms of  the GNU General  Public License as published by the | 
|  | * Free Software Foundation;  either version 2 of the  License, or (at your | 
|  | * option) any later version. | 
|  | */ | 
|  |  | 
|  | #include <drm/drmP.h> | 
|  | #include <drm/drm_crtc_helper.h> | 
|  |  | 
|  | #include <drm/exynos_drm.h> | 
|  | #include "exynos_drm_drv.h" | 
|  | #include "exynos_drm_encoder.h" | 
|  |  | 
|  | #define to_exynos_connector(x)	container_of(x, struct exynos_drm_connector,\ | 
|  | drm_connector) | 
|  |  | 
|  | struct exynos_drm_connector { | 
|  | struct drm_connector	drm_connector; | 
|  | uint32_t		encoder_id; | 
|  | struct exynos_drm_manager *manager; | 
|  | uint32_t		dpms; | 
|  | }; | 
|  |  | 
|  | /* convert exynos_video_timings to drm_display_mode */ | 
|  | static inline void | 
|  | convert_to_display_mode(struct drm_display_mode *mode, | 
|  | struct exynos_drm_panel_info *panel) | 
|  | { | 
|  | struct fb_videomode *timing = &panel->timing; | 
|  | DRM_DEBUG_KMS("%s\n", __FILE__); | 
|  |  | 
|  | mode->clock = timing->pixclock / 1000; | 
|  | mode->vrefresh = timing->refresh; | 
|  |  | 
|  | mode->hdisplay = timing->xres; | 
|  | mode->hsync_start = mode->hdisplay + timing->right_margin; | 
|  | mode->hsync_end = mode->hsync_start + timing->hsync_len; | 
|  | mode->htotal = mode->hsync_end + timing->left_margin; | 
|  |  | 
|  | mode->vdisplay = timing->yres; | 
|  | mode->vsync_start = mode->vdisplay + timing->lower_margin; | 
|  | mode->vsync_end = mode->vsync_start + timing->vsync_len; | 
|  | mode->vtotal = mode->vsync_end + timing->upper_margin; | 
|  | mode->width_mm = panel->width_mm; | 
|  | mode->height_mm = panel->height_mm; | 
|  |  | 
|  | if (timing->vmode & FB_VMODE_INTERLACED) | 
|  | mode->flags |= DRM_MODE_FLAG_INTERLACE; | 
|  |  | 
|  | if (timing->vmode & FB_VMODE_DOUBLE) | 
|  | mode->flags |= DRM_MODE_FLAG_DBLSCAN; | 
|  | } | 
|  |  | 
|  | /* 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 = drm_mode_vrefresh(mode); | 
|  |  | 
|  | timing->xres = mode->hdisplay; | 
|  | timing->right_margin = mode->hsync_start - mode->hdisplay; | 
|  | timing->hsync_len = mode->hsync_end - mode->hsync_start; | 
|  | timing->left_margin = mode->htotal - mode->hsync_end; | 
|  |  | 
|  | timing->yres = mode->vdisplay; | 
|  | timing->lower_margin = mode->vsync_start - mode->vdisplay; | 
|  | timing->vsync_len = mode->vsync_end - mode->vsync_start; | 
|  | timing->upper_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_connector *exynos_connector = | 
|  | to_exynos_connector(connector); | 
|  | struct exynos_drm_manager *manager = exynos_connector->manager; | 
|  | struct exynos_drm_display_ops *display_ops = manager->display_ops; | 
|  | struct edid *edid = NULL; | 
|  | unsigned int count = 0; | 
|  | int ret; | 
|  |  | 
|  | DRM_DEBUG_KMS("%s\n", __FILE__); | 
|  |  | 
|  | if (!display_ops) { | 
|  | DRM_DEBUG_KMS("display_ops 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_ops->get_edid) { | 
|  | edid = display_ops->get_edid(manager->dev, connector); | 
|  | if (IS_ERR_OR_NULL(edid)) { | 
|  | ret = PTR_ERR(edid); | 
|  | edid = NULL; | 
|  | DRM_ERROR("Panel operation get_edid failed %d\n", ret); | 
|  | goto out; | 
|  | } | 
|  |  | 
|  | count = drm_add_edid_modes(connector, edid); | 
|  | if (!count) { | 
|  | DRM_ERROR("Add edid modes failed %d\n", count); | 
|  | goto out; | 
|  | } | 
|  |  | 
|  | drm_mode_connector_update_edid_property(connector, edid); | 
|  | } else { | 
|  | struct exynos_drm_panel_info *panel; | 
|  | struct drm_display_mode *mode = drm_mode_create(connector->dev); | 
|  | if (!mode) { | 
|  | DRM_ERROR("failed to create a new display mode.\n"); | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | if (display_ops->get_panel) | 
|  | panel = display_ops->get_panel(manager->dev); | 
|  | else { | 
|  | drm_mode_destroy(connector->dev, mode); | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | convert_to_display_mode(mode, panel); | 
|  | connector->display_info.width_mm = mode->width_mm; | 
|  | connector->display_info.height_mm = mode->height_mm; | 
|  |  | 
|  | mode->type = DRM_MODE_TYPE_DRIVER | DRM_MODE_TYPE_PREFERRED; | 
|  | drm_mode_set_name(mode); | 
|  | drm_mode_probed_add(connector, mode); | 
|  |  | 
|  | count = 1; | 
|  | } | 
|  |  | 
|  | out: | 
|  | kfree(edid); | 
|  | return count; | 
|  | } | 
|  |  | 
|  | static int exynos_drm_connector_mode_valid(struct drm_connector *connector, | 
|  | struct drm_display_mode *mode) | 
|  | { | 
|  | struct exynos_drm_connector *exynos_connector = | 
|  | to_exynos_connector(connector); | 
|  | struct exynos_drm_manager *manager = exynos_connector->manager; | 
|  | struct exynos_drm_display_ops *display_ops = manager->display_ops; | 
|  | struct fb_videomode timing; | 
|  | int ret = MODE_BAD; | 
|  |  | 
|  | DRM_DEBUG_KMS("%s\n", __FILE__); | 
|  |  | 
|  | convert_to_video_timing(&timing, mode); | 
|  |  | 
|  | if (display_ops && display_ops->check_timing) | 
|  | if (!display_ops->check_timing(manager->dev, (void *)&timing)) | 
|  | ret = MODE_OK; | 
|  |  | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | struct drm_encoder *exynos_drm_best_encoder(struct drm_connector *connector) | 
|  | { | 
|  | struct drm_device *dev = connector->dev; | 
|  | struct exynos_drm_connector *exynos_connector = | 
|  | to_exynos_connector(connector); | 
|  | struct drm_mode_object *obj; | 
|  | struct drm_encoder *encoder; | 
|  |  | 
|  | DRM_DEBUG_KMS("%s\n", __FILE__); | 
|  |  | 
|  | obj = drm_mode_object_find(dev, exynos_connector->encoder_id, | 
|  | DRM_MODE_OBJECT_ENCODER); | 
|  | if (!obj) { | 
|  | DRM_DEBUG_KMS("Unknown ENCODER ID %d\n", | 
|  | exynos_connector->encoder_id); | 
|  | return NULL; | 
|  | } | 
|  |  | 
|  | encoder = obj_to_encoder(obj); | 
|  |  | 
|  | return 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, | 
|  | }; | 
|  |  | 
|  | void exynos_drm_display_power(struct drm_connector *connector, int mode) | 
|  | { | 
|  | struct drm_encoder *encoder = exynos_drm_best_encoder(connector); | 
|  | struct exynos_drm_connector *exynos_connector; | 
|  | struct exynos_drm_manager *manager = exynos_drm_get_manager(encoder); | 
|  | struct exynos_drm_display_ops *display_ops = manager->display_ops; | 
|  |  | 
|  | exynos_connector = to_exynos_connector(connector); | 
|  |  | 
|  | if (exynos_connector->dpms == mode) { | 
|  | DRM_DEBUG_KMS("desired dpms mode is same as previous one.\n"); | 
|  | return; | 
|  | } | 
|  |  | 
|  | if (display_ops && display_ops->power_on) | 
|  | display_ops->power_on(manager->dev, mode); | 
|  |  | 
|  | exynos_connector->dpms = mode; | 
|  | } | 
|  |  | 
|  | static void exynos_drm_connector_dpms(struct drm_connector *connector, | 
|  | int mode) | 
|  | { | 
|  | DRM_DEBUG_KMS("%s\n", __FILE__); | 
|  |  | 
|  | /* | 
|  | * in case that drm_crtc_helper_set_mode() is called, | 
|  | * encoder/crtc->funcs->dpms() will be just returned | 
|  | * because they already were DRM_MODE_DPMS_ON so only | 
|  | * exynos_drm_display_power() will be called. | 
|  | */ | 
|  | drm_helper_connector_dpms(connector, mode); | 
|  |  | 
|  | exynos_drm_display_power(connector, mode); | 
|  |  | 
|  | } | 
|  |  | 
|  | static int exynos_drm_connector_fill_modes(struct drm_connector *connector, | 
|  | unsigned int max_width, unsigned int max_height) | 
|  | { | 
|  | struct exynos_drm_connector *exynos_connector = | 
|  | to_exynos_connector(connector); | 
|  | struct exynos_drm_manager *manager = exynos_connector->manager; | 
|  | struct exynos_drm_manager_ops *ops = manager->ops; | 
|  | unsigned int width, height; | 
|  |  | 
|  | width = max_width; | 
|  | height = max_height; | 
|  |  | 
|  | /* | 
|  | * if specific driver want to find desired_mode using maxmum | 
|  | * resolution then get max width and height from that driver. | 
|  | */ | 
|  | if (ops && ops->get_max_resol) | 
|  | ops->get_max_resol(manager->dev, &width, &height); | 
|  |  | 
|  | return drm_helper_probe_single_connector_modes(connector, width, | 
|  | height); | 
|  | } | 
|  |  | 
|  | /* get detection status of display device. */ | 
|  | static enum drm_connector_status | 
|  | exynos_drm_connector_detect(struct drm_connector *connector, bool force) | 
|  | { | 
|  | struct exynos_drm_connector *exynos_connector = | 
|  | to_exynos_connector(connector); | 
|  | struct exynos_drm_manager *manager = exynos_connector->manager; | 
|  | struct exynos_drm_display_ops *display_ops = | 
|  | manager->display_ops; | 
|  | enum drm_connector_status status = connector_status_disconnected; | 
|  |  | 
|  | DRM_DEBUG_KMS("%s\n", __FILE__); | 
|  |  | 
|  | if (display_ops && display_ops->is_connected) { | 
|  | if (display_ops->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		= exynos_drm_connector_dpms, | 
|  | .fill_modes	= exynos_drm_connector_fill_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_ops->type) { | 
|  | case EXYNOS_DISPLAY_TYPE_HDMI: | 
|  | type = DRM_MODE_CONNECTOR_HDMIA; | 
|  | connector->interlace_allowed = true; | 
|  | connector->polled = DRM_CONNECTOR_POLL_HPD; | 
|  | break; | 
|  | case EXYNOS_DISPLAY_TYPE_VIDI: | 
|  | type = DRM_MODE_CONNECTOR_VIRTUAL; | 
|  | connector->polled = DRM_CONNECTOR_POLL_HPD; | 
|  | 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; | 
|  |  | 
|  | exynos_connector->encoder_id = encoder->base.id; | 
|  | exynos_connector->manager = manager; | 
|  | exynos_connector->dpms = DRM_MODE_DPMS_OFF; | 
|  | connector->dpms = DRM_MODE_DPMS_OFF; | 
|  | 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; | 
|  | } |