1 /*
2 * rcar_du_lvdscon.c -- R-Car Display Unit LVDS Connector
3 *
4 * Copyright (C) 2013-2014 Renesas Electronics Corporation
5 *
6 * Contact: Laurent Pinchart (laurent.pinchart@ideasonboard.com)
7 *
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; either version 2 of the License, or
11 * (at your option) any later version.
12 */
13
14 #include <drm/drmP.h>
15 #include <drm/drm_crtc.h>
16 #include <drm/drm_crtc_helper.h>
17
18 #include <video/display_timing.h>
19 #include <video/of_display_timing.h>
20 #include <video/videomode.h>
21
22 #include "rcar_du_drv.h"
23 #include "rcar_du_encoder.h"
24 #include "rcar_du_kms.h"
25 #include "rcar_du_lvdscon.h"
26
27 struct rcar_du_lvds_connector {
28 struct rcar_du_connector connector;
29
30 struct rcar_du_panel_data panel;
31 };
32
33 #define to_rcar_lvds_connector(c) \
34 container_of(c, struct rcar_du_lvds_connector, connector.connector)
35
rcar_du_lvds_connector_get_modes(struct drm_connector * connector)36 static int rcar_du_lvds_connector_get_modes(struct drm_connector *connector)
37 {
38 struct rcar_du_lvds_connector *lvdscon =
39 to_rcar_lvds_connector(connector);
40 struct drm_display_mode *mode;
41
42 mode = drm_mode_create(connector->dev);
43 if (mode == NULL)
44 return 0;
45
46 mode->type = DRM_MODE_TYPE_PREFERRED | DRM_MODE_TYPE_DRIVER;
47
48 drm_display_mode_from_videomode(&lvdscon->panel.mode, mode);
49
50 drm_mode_probed_add(connector, mode);
51
52 return 1;
53 }
54
55 static const struct drm_connector_helper_funcs connector_helper_funcs = {
56 .get_modes = rcar_du_lvds_connector_get_modes,
57 .best_encoder = rcar_du_connector_best_encoder,
58 };
59
rcar_du_lvds_connector_destroy(struct drm_connector * connector)60 static void rcar_du_lvds_connector_destroy(struct drm_connector *connector)
61 {
62 drm_connector_unregister(connector);
63 drm_connector_cleanup(connector);
64 }
65
66 static enum drm_connector_status
rcar_du_lvds_connector_detect(struct drm_connector * connector,bool force)67 rcar_du_lvds_connector_detect(struct drm_connector *connector, bool force)
68 {
69 return connector_status_connected;
70 }
71
72 static const struct drm_connector_funcs connector_funcs = {
73 .dpms = drm_helper_connector_dpms,
74 .detect = rcar_du_lvds_connector_detect,
75 .fill_modes = drm_helper_probe_single_connector_modes,
76 .destroy = rcar_du_lvds_connector_destroy,
77 };
78
rcar_du_lvds_connector_init(struct rcar_du_device * rcdu,struct rcar_du_encoder * renc,const struct rcar_du_panel_data * panel,struct device_node * np)79 int rcar_du_lvds_connector_init(struct rcar_du_device *rcdu,
80 struct rcar_du_encoder *renc,
81 const struct rcar_du_panel_data *panel,
82 /* TODO const */ struct device_node *np)
83 {
84 struct rcar_du_lvds_connector *lvdscon;
85 struct drm_connector *connector;
86 int ret;
87
88 lvdscon = devm_kzalloc(rcdu->dev, sizeof(*lvdscon), GFP_KERNEL);
89 if (lvdscon == NULL)
90 return -ENOMEM;
91
92 if (panel) {
93 lvdscon->panel = *panel;
94 } else {
95 struct display_timing timing;
96
97 ret = of_get_display_timing(np, "panel-timing", &timing);
98 if (ret < 0)
99 return ret;
100
101 videomode_from_timing(&timing, &lvdscon->panel.mode);
102
103 of_property_read_u32(np, "width-mm", &lvdscon->panel.width_mm);
104 of_property_read_u32(np, "height-mm", &lvdscon->panel.height_mm);
105 }
106
107 connector = &lvdscon->connector.connector;
108 connector->display_info.width_mm = lvdscon->panel.width_mm;
109 connector->display_info.height_mm = lvdscon->panel.height_mm;
110
111 ret = drm_connector_init(rcdu->ddev, connector, &connector_funcs,
112 DRM_MODE_CONNECTOR_LVDS);
113 if (ret < 0)
114 return ret;
115
116 drm_connector_helper_add(connector, &connector_helper_funcs);
117 ret = drm_connector_register(connector);
118 if (ret < 0)
119 return ret;
120
121 drm_helper_connector_dpms(connector, DRM_MODE_DPMS_OFF);
122 drm_object_property_set_value(&connector->base,
123 rcdu->ddev->mode_config.dpms_property, DRM_MODE_DPMS_OFF);
124
125 ret = drm_mode_connector_attach_encoder(connector, &renc->encoder);
126 if (ret < 0)
127 return ret;
128
129 connector->encoder = &renc->encoder;
130 lvdscon->connector.encoder = renc;
131
132 return 0;
133 }
134