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_atomic_helper.h>
16 #include <drm/drm_crtc.h>
17 #include <drm/drm_crtc_helper.h>
18 
19 #include <video/display_timing.h>
20 #include <video/of_display_timing.h>
21 #include <video/videomode.h>
22 
23 #include "rcar_du_drv.h"
24 #include "rcar_du_encoder.h"
25 #include "rcar_du_kms.h"
26 #include "rcar_du_lvdscon.h"
27 
28 struct rcar_du_lvds_connector {
29 	struct rcar_du_connector connector;
30 
31 	struct {
32 		unsigned int width_mm;		/* Panel width in mm */
33 		unsigned int height_mm;		/* Panel height in mm */
34 		struct videomode mode;
35 	} panel;
36 };
37 
38 #define to_rcar_lvds_connector(c) \
39 	container_of(c, struct rcar_du_lvds_connector, connector.connector)
40 
rcar_du_lvds_connector_get_modes(struct drm_connector * connector)41 static int rcar_du_lvds_connector_get_modes(struct drm_connector *connector)
42 {
43 	struct rcar_du_lvds_connector *lvdscon =
44 		to_rcar_lvds_connector(connector);
45 	struct drm_display_mode *mode;
46 
47 	mode = drm_mode_create(connector->dev);
48 	if (mode == NULL)
49 		return 0;
50 
51 	mode->type = DRM_MODE_TYPE_PREFERRED | DRM_MODE_TYPE_DRIVER;
52 
53 	drm_display_mode_from_videomode(&lvdscon->panel.mode, mode);
54 
55 	drm_mode_probed_add(connector, mode);
56 
57 	return 1;
58 }
59 
60 static const struct drm_connector_helper_funcs connector_helper_funcs = {
61 	.get_modes = rcar_du_lvds_connector_get_modes,
62 	.best_encoder = rcar_du_connector_best_encoder,
63 };
64 
rcar_du_lvds_connector_destroy(struct drm_connector * connector)65 static void rcar_du_lvds_connector_destroy(struct drm_connector *connector)
66 {
67 	drm_connector_unregister(connector);
68 	drm_connector_cleanup(connector);
69 }
70 
71 static enum drm_connector_status
rcar_du_lvds_connector_detect(struct drm_connector * connector,bool force)72 rcar_du_lvds_connector_detect(struct drm_connector *connector, bool force)
73 {
74 	return connector_status_connected;
75 }
76 
77 static const struct drm_connector_funcs connector_funcs = {
78 	.dpms = drm_atomic_helper_connector_dpms,
79 	.reset = drm_atomic_helper_connector_reset,
80 	.detect = rcar_du_lvds_connector_detect,
81 	.fill_modes = drm_helper_probe_single_connector_modes,
82 	.destroy = rcar_du_lvds_connector_destroy,
83 	.atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,
84 	.atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
85 };
86 
rcar_du_lvds_connector_init(struct rcar_du_device * rcdu,struct rcar_du_encoder * renc,struct device_node * np)87 int rcar_du_lvds_connector_init(struct rcar_du_device *rcdu,
88 				struct rcar_du_encoder *renc,
89 				/* TODO const */ struct device_node *np)
90 {
91 	struct drm_encoder *encoder = rcar_encoder_to_drm_encoder(renc);
92 	struct rcar_du_lvds_connector *lvdscon;
93 	struct drm_connector *connector;
94 	struct display_timing timing;
95 	int ret;
96 
97 	lvdscon = devm_kzalloc(rcdu->dev, sizeof(*lvdscon), GFP_KERNEL);
98 	if (lvdscon == NULL)
99 		return -ENOMEM;
100 
101 	ret = of_get_display_timing(np, "panel-timing", &timing);
102 	if (ret < 0)
103 		return ret;
104 
105 	videomode_from_timing(&timing, &lvdscon->panel.mode);
106 
107 	of_property_read_u32(np, "width-mm", &lvdscon->panel.width_mm);
108 	of_property_read_u32(np, "height-mm", &lvdscon->panel.height_mm);
109 
110 	connector = &lvdscon->connector.connector;
111 	connector->display_info.width_mm = lvdscon->panel.width_mm;
112 	connector->display_info.height_mm = lvdscon->panel.height_mm;
113 
114 	ret = drm_connector_init(rcdu->ddev, connector, &connector_funcs,
115 				 DRM_MODE_CONNECTOR_LVDS);
116 	if (ret < 0)
117 		return ret;
118 
119 	drm_connector_helper_add(connector, &connector_helper_funcs);
120 	ret = drm_connector_register(connector);
121 	if (ret < 0)
122 		return ret;
123 
124 	connector->dpms = DRM_MODE_DPMS_OFF;
125 	drm_object_property_set_value(&connector->base,
126 		rcdu->ddev->mode_config.dpms_property, DRM_MODE_DPMS_OFF);
127 
128 	ret = drm_mode_connector_attach_encoder(connector, encoder);
129 	if (ret < 0)
130 		return ret;
131 
132 	lvdscon->connector.encoder = renc;
133 
134 	return 0;
135 }
136