2 * i.MX drm driver - parallel display implementation
4 * Copyright (C) 2012 Sascha Hauer, Pengutronix
6 * This program is free software; you can redistribute it and/or
7 * modify it under the terms of the GNU General Public License
8 * as published by the Free Software Foundation; either version 2
9 * of the License, or (at your option) any later version.
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
16 #include <linux/component.h>
17 #include <linux/module.h>
19 #include <drm/drm_atomic_helper.h>
20 #include <drm/drm_fb_helper.h>
21 #include <drm/drm_crtc_helper.h>
22 #include <drm/drm_panel.h>
23 #include <linux/videodev2.h>
24 #include <video/of_display_timing.h>
25 #include <linux/of_graph.h>
29 #define con_to_imxpd(x) container_of(x, struct imx_parallel_display, connector)
30 #define enc_to_imxpd(x) container_of(x, struct imx_parallel_display, encoder)
32 struct imx_parallel_display
{
33 struct drm_connector connector
;
34 struct drm_encoder encoder
;
39 struct drm_display_mode mode
;
40 struct drm_panel
*panel
;
43 static enum drm_connector_status
imx_pd_connector_detect(
44 struct drm_connector
*connector
, bool force
)
46 return connector_status_connected
;
49 static int imx_pd_connector_get_modes(struct drm_connector
*connector
)
51 struct imx_parallel_display
*imxpd
= con_to_imxpd(connector
);
52 struct device_node
*np
= imxpd
->dev
->of_node
;
55 if (imxpd
->panel
&& imxpd
->panel
->funcs
&&
56 imxpd
->panel
->funcs
->get_modes
) {
57 struct drm_display_info
*di
= &connector
->display_info
;
59 num_modes
= imxpd
->panel
->funcs
->get_modes(imxpd
->panel
);
60 if (!imxpd
->bus_format
&& di
->num_bus_formats
)
61 imxpd
->bus_format
= di
->bus_formats
[0];
67 drm_mode_connector_update_edid_property(connector
, imxpd
->edid
);
68 num_modes
= drm_add_edid_modes(connector
, imxpd
->edid
);
72 struct drm_display_mode
*mode
= drm_mode_create(connector
->dev
);
76 of_get_drm_display_mode(np
, &imxpd
->mode
, OF_USE_NATIVE_MODE
);
77 drm_mode_copy(mode
, &imxpd
->mode
);
78 mode
->type
|= DRM_MODE_TYPE_DRIVER
| DRM_MODE_TYPE_PREFERRED
,
79 drm_mode_probed_add(connector
, mode
);
86 static struct drm_encoder
*imx_pd_connector_best_encoder(
87 struct drm_connector
*connector
)
89 struct imx_parallel_display
*imxpd
= con_to_imxpd(connector
);
91 return &imxpd
->encoder
;
94 static void imx_pd_encoder_dpms(struct drm_encoder
*encoder
, int mode
)
96 struct imx_parallel_display
*imxpd
= enc_to_imxpd(encoder
);
98 if (mode
!= DRM_MODE_DPMS_ON
)
99 drm_panel_disable(imxpd
->panel
);
101 drm_panel_enable(imxpd
->panel
);
104 static void imx_pd_encoder_prepare(struct drm_encoder
*encoder
)
106 struct imx_parallel_display
*imxpd
= enc_to_imxpd(encoder
);
107 imx_drm_set_bus_config(encoder
, imxpd
->bus_format
, 2, 3,
108 imxpd
->connector
.display_info
.bus_flags
);
111 static void imx_pd_encoder_commit(struct drm_encoder
*encoder
)
113 struct imx_parallel_display
*imxpd
= enc_to_imxpd(encoder
);
115 drm_panel_prepare(imxpd
->panel
);
116 drm_panel_enable(imxpd
->panel
);
119 static void imx_pd_encoder_mode_set(struct drm_encoder
*encoder
,
120 struct drm_display_mode
*orig_mode
,
121 struct drm_display_mode
*mode
)
125 static void imx_pd_encoder_disable(struct drm_encoder
*encoder
)
127 struct imx_parallel_display
*imxpd
= enc_to_imxpd(encoder
);
129 drm_panel_disable(imxpd
->panel
);
130 drm_panel_unprepare(imxpd
->panel
);
133 static const struct drm_connector_funcs imx_pd_connector_funcs
= {
134 .dpms
= drm_helper_connector_dpms
,
135 .fill_modes
= drm_helper_probe_single_connector_modes
,
136 .detect
= imx_pd_connector_detect
,
137 .destroy
= imx_drm_connector_destroy
,
138 .reset
= drm_atomic_helper_connector_reset
,
139 .atomic_duplicate_state
= drm_atomic_helper_connector_duplicate_state
,
140 .atomic_destroy_state
= drm_atomic_helper_connector_destroy_state
,
143 static const struct drm_connector_helper_funcs imx_pd_connector_helper_funcs
= {
144 .get_modes
= imx_pd_connector_get_modes
,
145 .best_encoder
= imx_pd_connector_best_encoder
,
148 static const struct drm_encoder_funcs imx_pd_encoder_funcs
= {
149 .destroy
= imx_drm_encoder_destroy
,
152 static const struct drm_encoder_helper_funcs imx_pd_encoder_helper_funcs
= {
153 .dpms
= imx_pd_encoder_dpms
,
154 .prepare
= imx_pd_encoder_prepare
,
155 .commit
= imx_pd_encoder_commit
,
156 .mode_set
= imx_pd_encoder_mode_set
,
157 .disable
= imx_pd_encoder_disable
,
160 static int imx_pd_register(struct drm_device
*drm
,
161 struct imx_parallel_display
*imxpd
)
165 ret
= imx_drm_encoder_parse_of(drm
, &imxpd
->encoder
,
166 imxpd
->dev
->of_node
);
170 /* set the connector's dpms to OFF so that
171 * drm_helper_connector_dpms() won't return
172 * immediately since the current state is ON
175 imxpd
->connector
.dpms
= DRM_MODE_DPMS_OFF
;
177 drm_encoder_helper_add(&imxpd
->encoder
, &imx_pd_encoder_helper_funcs
);
178 drm_encoder_init(drm
, &imxpd
->encoder
, &imx_pd_encoder_funcs
,
179 DRM_MODE_ENCODER_NONE
, NULL
);
181 drm_connector_helper_add(&imxpd
->connector
,
182 &imx_pd_connector_helper_funcs
);
183 drm_connector_init(drm
, &imxpd
->connector
, &imx_pd_connector_funcs
,
184 DRM_MODE_CONNECTOR_VGA
);
187 drm_panel_attach(imxpd
->panel
, &imxpd
->connector
);
189 drm_mode_connector_attach_encoder(&imxpd
->connector
, &imxpd
->encoder
);
194 static int imx_pd_bind(struct device
*dev
, struct device
*master
, void *data
)
196 struct drm_device
*drm
= data
;
197 struct device_node
*np
= dev
->of_node
;
198 struct device_node
*ep
;
200 struct imx_parallel_display
*imxpd
;
204 imxpd
= devm_kzalloc(dev
, sizeof(*imxpd
), GFP_KERNEL
);
208 edidp
= of_get_property(np
, "edid", &imxpd
->edid_len
);
210 imxpd
->edid
= kmemdup(edidp
, imxpd
->edid_len
, GFP_KERNEL
);
212 ret
= of_property_read_string(np
, "interface-pix-fmt", &fmt
);
214 if (!strcmp(fmt
, "rgb24"))
215 imxpd
->bus_format
= MEDIA_BUS_FMT_RGB888_1X24
;
216 else if (!strcmp(fmt
, "rgb565"))
217 imxpd
->bus_format
= MEDIA_BUS_FMT_RGB565_1X16
;
218 else if (!strcmp(fmt
, "bgr666"))
219 imxpd
->bus_format
= MEDIA_BUS_FMT_RGB666_1X18
;
220 else if (!strcmp(fmt
, "lvds666"))
221 imxpd
->bus_format
= MEDIA_BUS_FMT_RGB666_1X24_CPADHI
;
224 /* port@1 is the output port */
225 ep
= of_graph_get_endpoint_by_regs(np
, 1, -1);
227 struct device_node
*remote
;
229 remote
= of_graph_get_remote_port_parent(ep
);
232 imxpd
->panel
= of_drm_find_panel(remote
);
236 return -EPROBE_DEFER
;
241 ret
= imx_pd_register(drm
, imxpd
);
245 dev_set_drvdata(dev
, imxpd
);
250 static void imx_pd_unbind(struct device
*dev
, struct device
*master
,
253 struct imx_parallel_display
*imxpd
= dev_get_drvdata(dev
);
255 imxpd
->encoder
.funcs
->destroy(&imxpd
->encoder
);
256 imxpd
->connector
.funcs
->destroy(&imxpd
->connector
);
261 static const struct component_ops imx_pd_ops
= {
263 .unbind
= imx_pd_unbind
,
266 static int imx_pd_probe(struct platform_device
*pdev
)
268 return component_add(&pdev
->dev
, &imx_pd_ops
);
271 static int imx_pd_remove(struct platform_device
*pdev
)
273 component_del(&pdev
->dev
, &imx_pd_ops
);
278 static const struct of_device_id imx_pd_dt_ids
[] = {
279 { .compatible
= "fsl,imx-parallel-display", },
282 MODULE_DEVICE_TABLE(of
, imx_pd_dt_ids
);
284 static struct platform_driver imx_pd_driver
= {
285 .probe
= imx_pd_probe
,
286 .remove
= imx_pd_remove
,
288 .of_match_table
= imx_pd_dt_ids
,
289 .name
= "imx-parallel-display",
293 module_platform_driver(imx_pd_driver
);
295 MODULE_DESCRIPTION("i.MX parallel display driver");
296 MODULE_AUTHOR("Sascha Hauer, Pengutronix");
297 MODULE_LICENSE("GPL");
298 MODULE_ALIAS("platform:imx-parallel-display");