1
2
3
4
5
6#include <linux/module.h>
7#include <linux/platform_device.h>
8#include <linux/component.h>
9#include <linux/mfd/syscon.h>
10#include <linux/mfd/syscon/imx6q-iomuxc-gpr.h>
11#include <drm/bridge/dw_hdmi.h>
12#include <video/imx-ipu-v3.h>
13#include <linux/regmap.h>
14#include <drm/drm_of.h>
15#include <drm/drmP.h>
16#include <drm/drm_atomic_helper.h>
17#include <drm/drm_edid.h>
18#include <drm/drm_encoder_slave.h>
19
20#include "imx-drm.h"
21
22struct imx_hdmi {
23 struct device *dev;
24 struct drm_encoder encoder;
25 struct dw_hdmi *hdmi;
26 struct regmap *regmap;
27};
28
29static inline struct imx_hdmi *enc_to_imx_hdmi(struct drm_encoder *e)
30{
31 return container_of(e, struct imx_hdmi, encoder);
32}
33
34static const struct dw_hdmi_mpll_config imx_mpll_cfg[] = {
35 {
36 45250000, {
37 { 0x01e0, 0x0000 },
38 { 0x21e1, 0x0000 },
39 { 0x41e2, 0x0000 }
40 },
41 }, {
42 92500000, {
43 { 0x0140, 0x0005 },
44 { 0x2141, 0x0005 },
45 { 0x4142, 0x0005 },
46 },
47 }, {
48 148500000, {
49 { 0x00a0, 0x000a },
50 { 0x20a1, 0x000a },
51 { 0x40a2, 0x000a },
52 },
53 }, {
54 216000000, {
55 { 0x00a0, 0x000a },
56 { 0x2001, 0x000f },
57 { 0x4002, 0x000f },
58 },
59 }, {
60 ~0UL, {
61 { 0x0000, 0x0000 },
62 { 0x0000, 0x0000 },
63 { 0x0000, 0x0000 },
64 },
65 }
66};
67
68static const struct dw_hdmi_curr_ctrl imx_cur_ctr[] = {
69
70 {
71 54000000, { 0x091c, 0x091c, 0x06dc },
72 }, {
73 58400000, { 0x091c, 0x06dc, 0x06dc },
74 }, {
75 72000000, { 0x06dc, 0x06dc, 0x091c },
76 }, {
77 74250000, { 0x06dc, 0x0b5c, 0x091c },
78 }, {
79 118800000, { 0x091c, 0x091c, 0x06dc },
80 }, {
81 216000000, { 0x06dc, 0x0b5c, 0x091c },
82 }, {
83 ~0UL, { 0x0000, 0x0000, 0x0000 },
84 },
85};
86
87
88
89
90
91
92static const struct dw_hdmi_phy_config imx_phy_config[] = {
93
94 { 216000000, 0x800d, 0x0005, 0x01ad},
95 { ~0UL, 0x0000, 0x0000, 0x0000}
96};
97
98static int dw_hdmi_imx_parse_dt(struct imx_hdmi *hdmi)
99{
100 struct device_node *np = hdmi->dev->of_node;
101
102 hdmi->regmap = syscon_regmap_lookup_by_phandle(np, "gpr");
103 if (IS_ERR(hdmi->regmap)) {
104 dev_err(hdmi->dev, "Unable to get gpr\n");
105 return PTR_ERR(hdmi->regmap);
106 }
107
108 return 0;
109}
110
111static void dw_hdmi_imx_encoder_disable(struct drm_encoder *encoder)
112{
113}
114
115static void dw_hdmi_imx_encoder_enable(struct drm_encoder *encoder)
116{
117 struct imx_hdmi *hdmi = enc_to_imx_hdmi(encoder);
118 int mux = drm_of_encoder_active_port_id(hdmi->dev->of_node, encoder);
119
120 regmap_update_bits(hdmi->regmap, IOMUXC_GPR3,
121 IMX6Q_GPR3_HDMI_MUX_CTL_MASK,
122 mux << IMX6Q_GPR3_HDMI_MUX_CTL_SHIFT);
123}
124
125static int dw_hdmi_imx_atomic_check(struct drm_encoder *encoder,
126 struct drm_crtc_state *crtc_state,
127 struct drm_connector_state *conn_state)
128{
129 struct imx_crtc_state *imx_crtc_state = to_imx_crtc_state(crtc_state);
130
131 imx_crtc_state->bus_format = MEDIA_BUS_FMT_RGB888_1X24;
132 imx_crtc_state->di_hsync_pin = 2;
133 imx_crtc_state->di_vsync_pin = 3;
134
135 return 0;
136}
137
138static const struct drm_encoder_helper_funcs dw_hdmi_imx_encoder_helper_funcs = {
139 .enable = dw_hdmi_imx_encoder_enable,
140 .disable = dw_hdmi_imx_encoder_disable,
141 .atomic_check = dw_hdmi_imx_atomic_check,
142};
143
144static const struct drm_encoder_funcs dw_hdmi_imx_encoder_funcs = {
145 .destroy = drm_encoder_cleanup,
146};
147
148static enum drm_mode_status
149imx6q_hdmi_mode_valid(struct drm_connector *con,
150 const struct drm_display_mode *mode)
151{
152 if (mode->clock < 13500)
153 return MODE_CLOCK_LOW;
154
155 if (mode->clock > 216000)
156 return MODE_CLOCK_HIGH;
157
158 return MODE_OK;
159}
160
161static enum drm_mode_status
162imx6dl_hdmi_mode_valid(struct drm_connector *con,
163 const struct drm_display_mode *mode)
164{
165 if (mode->clock < 13500)
166 return MODE_CLOCK_LOW;
167
168 if (mode->clock > 216000)
169 return MODE_CLOCK_HIGH;
170
171 return MODE_OK;
172}
173
174static struct dw_hdmi_plat_data imx6q_hdmi_drv_data = {
175 .mpll_cfg = imx_mpll_cfg,
176 .cur_ctr = imx_cur_ctr,
177 .phy_config = imx_phy_config,
178 .mode_valid = imx6q_hdmi_mode_valid,
179};
180
181static struct dw_hdmi_plat_data imx6dl_hdmi_drv_data = {
182 .mpll_cfg = imx_mpll_cfg,
183 .cur_ctr = imx_cur_ctr,
184 .phy_config = imx_phy_config,
185 .mode_valid = imx6dl_hdmi_mode_valid,
186};
187
188static const struct of_device_id dw_hdmi_imx_dt_ids[] = {
189 { .compatible = "fsl,imx6q-hdmi",
190 .data = &imx6q_hdmi_drv_data
191 }, {
192 .compatible = "fsl,imx6dl-hdmi",
193 .data = &imx6dl_hdmi_drv_data
194 },
195 {},
196};
197MODULE_DEVICE_TABLE(of, dw_hdmi_imx_dt_ids);
198
199static int dw_hdmi_imx_bind(struct device *dev, struct device *master,
200 void *data)
201{
202 struct platform_device *pdev = to_platform_device(dev);
203 const struct dw_hdmi_plat_data *plat_data;
204 const struct of_device_id *match;
205 struct drm_device *drm = data;
206 struct drm_encoder *encoder;
207 struct imx_hdmi *hdmi;
208 int ret;
209
210 if (!pdev->dev.of_node)
211 return -ENODEV;
212
213 hdmi = devm_kzalloc(&pdev->dev, sizeof(*hdmi), GFP_KERNEL);
214 if (!hdmi)
215 return -ENOMEM;
216
217 match = of_match_node(dw_hdmi_imx_dt_ids, pdev->dev.of_node);
218 plat_data = match->data;
219 hdmi->dev = &pdev->dev;
220 encoder = &hdmi->encoder;
221
222 encoder->possible_crtcs = drm_of_find_possible_crtcs(drm, dev->of_node);
223
224
225
226
227
228
229 if (encoder->possible_crtcs == 0)
230 return -EPROBE_DEFER;
231
232 ret = dw_hdmi_imx_parse_dt(hdmi);
233 if (ret < 0)
234 return ret;
235
236 drm_encoder_helper_add(encoder, &dw_hdmi_imx_encoder_helper_funcs);
237 drm_encoder_init(drm, encoder, &dw_hdmi_imx_encoder_funcs,
238 DRM_MODE_ENCODER_TMDS, NULL);
239
240 platform_set_drvdata(pdev, hdmi);
241
242 hdmi->hdmi = dw_hdmi_bind(pdev, encoder, plat_data);
243
244
245
246
247
248 if (IS_ERR(hdmi->hdmi)) {
249 ret = PTR_ERR(hdmi->hdmi);
250 drm_encoder_cleanup(encoder);
251 }
252
253 return ret;
254}
255
256static void dw_hdmi_imx_unbind(struct device *dev, struct device *master,
257 void *data)
258{
259 struct imx_hdmi *hdmi = dev_get_drvdata(dev);
260
261 dw_hdmi_unbind(hdmi->hdmi);
262}
263
264static const struct component_ops dw_hdmi_imx_ops = {
265 .bind = dw_hdmi_imx_bind,
266 .unbind = dw_hdmi_imx_unbind,
267};
268
269static int dw_hdmi_imx_probe(struct platform_device *pdev)
270{
271 return component_add(&pdev->dev, &dw_hdmi_imx_ops);
272}
273
274static int dw_hdmi_imx_remove(struct platform_device *pdev)
275{
276 component_del(&pdev->dev, &dw_hdmi_imx_ops);
277
278 return 0;
279}
280
281static struct platform_driver dw_hdmi_imx_platform_driver = {
282 .probe = dw_hdmi_imx_probe,
283 .remove = dw_hdmi_imx_remove,
284 .driver = {
285 .name = "dwhdmi-imx",
286 .of_match_table = dw_hdmi_imx_dt_ids,
287 },
288};
289
290module_platform_driver(dw_hdmi_imx_platform_driver);
291
292MODULE_AUTHOR("Andy Yan <andy.yan@rock-chips.com>");
293MODULE_AUTHOR("Yakir Yang <ykk@rock-chips.com>");
294MODULE_DESCRIPTION("IMX6 Specific DW-HDMI Driver Extension");
295MODULE_LICENSE("GPL");
296MODULE_ALIAS("platform:dwhdmi-imx");
297
