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_fb_helper.h>
20 #include <drm/drm_crtc_helper.h>
21 #include <drm/drm_panel.h>
22 #include <linux/videodev2.h>
23 #include <video/of_display_timing.h>
27 #define con_to_imxpd(x) container_of(x, struct imx_parallel_display, connector)
28 #define enc_to_imxpd(x) container_of(x, struct imx_parallel_display, encoder)
30 struct imx_parallel_display
{
31 struct drm_connector connector
;
32 struct drm_encoder encoder
;
36 u32 interface_pix_fmt
;
38 struct drm_display_mode mode
;
39 struct drm_panel
*panel
;
42 static enum drm_connector_status
imx_pd_connector_detect(
43 struct drm_connector
*connector
, bool force
)
45 return connector_status_connected
;
48 static int imx_pd_connector_get_modes(struct drm_connector
*connector
)
50 struct imx_parallel_display
*imxpd
= con_to_imxpd(connector
);
51 struct device_node
*np
= imxpd
->dev
->of_node
;
54 if (imxpd
->panel
&& imxpd
->panel
->funcs
&&
55 imxpd
->panel
->funcs
->get_modes
) {
56 num_modes
= imxpd
->panel
->funcs
->get_modes(imxpd
->panel
);
62 drm_mode_connector_update_edid_property(connector
, imxpd
->edid
);
63 num_modes
= drm_add_edid_modes(connector
, imxpd
->edid
);
66 if (imxpd
->mode_valid
) {
67 struct drm_display_mode
*mode
= drm_mode_create(connector
->dev
);
71 drm_mode_copy(mode
, &imxpd
->mode
);
72 mode
->type
|= DRM_MODE_TYPE_DRIVER
| DRM_MODE_TYPE_PREFERRED
,
73 drm_mode_probed_add(connector
, mode
);
78 struct drm_display_mode
*mode
= drm_mode_create(connector
->dev
);
82 of_get_drm_display_mode(np
, &imxpd
->mode
, OF_USE_NATIVE_MODE
);
83 drm_mode_copy(mode
, &imxpd
->mode
);
84 mode
->type
|= DRM_MODE_TYPE_DRIVER
| DRM_MODE_TYPE_PREFERRED
,
85 drm_mode_probed_add(connector
, mode
);
92 static struct drm_encoder
*imx_pd_connector_best_encoder(
93 struct drm_connector
*connector
)
95 struct imx_parallel_display
*imxpd
= con_to_imxpd(connector
);
97 return &imxpd
->encoder
;
100 static void imx_pd_encoder_dpms(struct drm_encoder
*encoder
, int mode
)
102 struct imx_parallel_display
*imxpd
= enc_to_imxpd(encoder
);
104 if (mode
!= DRM_MODE_DPMS_ON
)
105 drm_panel_disable(imxpd
->panel
);
107 drm_panel_enable(imxpd
->panel
);
110 static bool imx_pd_encoder_mode_fixup(struct drm_encoder
*encoder
,
111 const struct drm_display_mode
*mode
,
112 struct drm_display_mode
*adjusted_mode
)
117 static void imx_pd_encoder_prepare(struct drm_encoder
*encoder
)
119 struct imx_parallel_display
*imxpd
= enc_to_imxpd(encoder
);
121 imx_drm_panel_format(encoder
, imxpd
->interface_pix_fmt
);
124 static void imx_pd_encoder_commit(struct drm_encoder
*encoder
)
126 struct imx_parallel_display
*imxpd
= enc_to_imxpd(encoder
);
128 drm_panel_prepare(imxpd
->panel
);
129 drm_panel_enable(imxpd
->panel
);
132 static void imx_pd_encoder_mode_set(struct drm_encoder
*encoder
,
133 struct drm_display_mode
*orig_mode
,
134 struct drm_display_mode
*mode
)
138 static void imx_pd_encoder_disable(struct drm_encoder
*encoder
)
140 struct imx_parallel_display
*imxpd
= enc_to_imxpd(encoder
);
142 drm_panel_disable(imxpd
->panel
);
143 drm_panel_unprepare(imxpd
->panel
);
146 static struct drm_connector_funcs imx_pd_connector_funcs
= {
147 .dpms
= drm_helper_connector_dpms
,
148 .fill_modes
= drm_helper_probe_single_connector_modes
,
149 .detect
= imx_pd_connector_detect
,
150 .destroy
= imx_drm_connector_destroy
,
153 static struct drm_connector_helper_funcs imx_pd_connector_helper_funcs
= {
154 .get_modes
= imx_pd_connector_get_modes
,
155 .best_encoder
= imx_pd_connector_best_encoder
,
158 static struct drm_encoder_funcs imx_pd_encoder_funcs
= {
159 .destroy
= imx_drm_encoder_destroy
,
162 static struct drm_encoder_helper_funcs imx_pd_encoder_helper_funcs
= {
163 .dpms
= imx_pd_encoder_dpms
,
164 .mode_fixup
= imx_pd_encoder_mode_fixup
,
165 .prepare
= imx_pd_encoder_prepare
,
166 .commit
= imx_pd_encoder_commit
,
167 .mode_set
= imx_pd_encoder_mode_set
,
168 .disable
= imx_pd_encoder_disable
,
171 static int imx_pd_register(struct drm_device
*drm
,
172 struct imx_parallel_display
*imxpd
)
176 ret
= imx_drm_encoder_parse_of(drm
, &imxpd
->encoder
,
177 imxpd
->dev
->of_node
);
181 /* set the connector's dpms to OFF so that
182 * drm_helper_connector_dpms() won't return
183 * immediately since the current state is ON
186 imxpd
->connector
.dpms
= DRM_MODE_DPMS_OFF
;
188 drm_encoder_helper_add(&imxpd
->encoder
, &imx_pd_encoder_helper_funcs
);
189 drm_encoder_init(drm
, &imxpd
->encoder
, &imx_pd_encoder_funcs
,
190 DRM_MODE_ENCODER_NONE
);
192 drm_connector_helper_add(&imxpd
->connector
,
193 &imx_pd_connector_helper_funcs
);
194 drm_connector_init(drm
, &imxpd
->connector
, &imx_pd_connector_funcs
,
195 DRM_MODE_CONNECTOR_VGA
);
198 drm_panel_attach(imxpd
->panel
, &imxpd
->connector
);
200 drm_mode_connector_attach_encoder(&imxpd
->connector
, &imxpd
->encoder
);
202 imxpd
->connector
.encoder
= &imxpd
->encoder
;
207 static int imx_pd_bind(struct device
*dev
, struct device
*master
, void *data
)
209 struct drm_device
*drm
= data
;
210 struct device_node
*np
= dev
->of_node
;
211 struct device_node
*panel_node
;
213 struct imx_parallel_display
*imxpd
;
217 imxpd
= devm_kzalloc(dev
, sizeof(*imxpd
), GFP_KERNEL
);
221 edidp
= of_get_property(np
, "edid", &imxpd
->edid_len
);
223 imxpd
->edid
= kmemdup(edidp
, imxpd
->edid_len
, GFP_KERNEL
);
225 ret
= of_property_read_string(np
, "interface-pix-fmt", &fmt
);
227 if (!strcmp(fmt
, "rgb24"))
228 imxpd
->interface_pix_fmt
= V4L2_PIX_FMT_RGB24
;
229 else if (!strcmp(fmt
, "rgb565"))
230 imxpd
->interface_pix_fmt
= V4L2_PIX_FMT_RGB565
;
231 else if (!strcmp(fmt
, "bgr666"))
232 imxpd
->interface_pix_fmt
= V4L2_PIX_FMT_BGR666
;
233 else if (!strcmp(fmt
, "lvds666"))
234 imxpd
->interface_pix_fmt
=
235 v4l2_fourcc('L', 'V', 'D', '6');
238 panel_node
= of_parse_phandle(np
, "fsl,panel", 0);
240 imxpd
->panel
= of_drm_find_panel(panel_node
);
244 ret
= imx_pd_register(drm
, imxpd
);
248 dev_set_drvdata(dev
, imxpd
);
253 static void imx_pd_unbind(struct device
*dev
, struct device
*master
,
256 struct imx_parallel_display
*imxpd
= dev_get_drvdata(dev
);
258 imxpd
->encoder
.funcs
->destroy(&imxpd
->encoder
);
259 imxpd
->connector
.funcs
->destroy(&imxpd
->connector
);
264 static const struct component_ops imx_pd_ops
= {
266 .unbind
= imx_pd_unbind
,
269 static int imx_pd_probe(struct platform_device
*pdev
)
271 return component_add(&pdev
->dev
, &imx_pd_ops
);
274 static int imx_pd_remove(struct platform_device
*pdev
)
276 component_del(&pdev
->dev
, &imx_pd_ops
);
281 static const struct of_device_id imx_pd_dt_ids
[] = {
282 { .compatible
= "fsl,imx-parallel-display", },
285 MODULE_DEVICE_TABLE(of
, imx_pd_dt_ids
);
287 static struct platform_driver imx_pd_driver
= {
288 .probe
= imx_pd_probe
,
289 .remove
= imx_pd_remove
,
291 .of_match_table
= imx_pd_dt_ids
,
292 .name
= "imx-parallel-display",
296 module_platform_driver(imx_pd_driver
);
298 MODULE_DESCRIPTION("i.MX parallel display driver");
299 MODULE_AUTHOR("Sascha Hauer, Pengutronix");
300 MODULE_LICENSE("GPL");
301 MODULE_ALIAS("platform:imx-parallel-display");