]> asedeno.scripts.mit.edu Git - linux.git/blob - drivers/gpu/drm/imx/imx-tve.c
drm/imx: drop use of drmP.h
[linux.git] / drivers / gpu / drm / imx / imx-tve.c
1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3  * i.MX drm driver - Television Encoder (TVEv2)
4  *
5  * Copyright (C) 2013 Philipp Zabel, Pengutronix
6  */
7
8 #include <linux/clk-provider.h>
9 #include <linux/clk.h>
10 #include <linux/component.h>
11 #include <linux/i2c.h>
12 #include <linux/module.h>
13 #include <linux/platform_device.h>
14 #include <linux/regmap.h>
15 #include <linux/regulator/consumer.h>
16 #include <linux/spinlock.h>
17 #include <linux/videodev2.h>
18
19 #include <video/imx-ipu-v3.h>
20
21 #include <drm/drm_atomic_helper.h>
22 #include <drm/drm_fb_helper.h>
23 #include <drm/drm_probe_helper.h>
24
25 #include "imx-drm.h"
26
27 #define TVE_COM_CONF_REG        0x00
28 #define TVE_TVDAC0_CONT_REG     0x28
29 #define TVE_TVDAC1_CONT_REG     0x2c
30 #define TVE_TVDAC2_CONT_REG     0x30
31 #define TVE_CD_CONT_REG         0x34
32 #define TVE_INT_CONT_REG        0x64
33 #define TVE_STAT_REG            0x68
34 #define TVE_TST_MODE_REG        0x6c
35 #define TVE_MV_CONT_REG         0xdc
36
37 /* TVE_COM_CONF_REG */
38 #define TVE_SYNC_CH_2_EN        BIT(22)
39 #define TVE_SYNC_CH_1_EN        BIT(21)
40 #define TVE_SYNC_CH_0_EN        BIT(20)
41 #define TVE_TV_OUT_MODE_MASK    (0x7 << 12)
42 #define TVE_TV_OUT_DISABLE      (0x0 << 12)
43 #define TVE_TV_OUT_CVBS_0       (0x1 << 12)
44 #define TVE_TV_OUT_CVBS_2       (0x2 << 12)
45 #define TVE_TV_OUT_CVBS_0_2     (0x3 << 12)
46 #define TVE_TV_OUT_SVIDEO_0_1   (0x4 << 12)
47 #define TVE_TV_OUT_SVIDEO_0_1_CVBS2_2   (0x5 << 12)
48 #define TVE_TV_OUT_YPBPR        (0x6 << 12)
49 #define TVE_TV_OUT_RGB          (0x7 << 12)
50 #define TVE_TV_STAND_MASK       (0xf << 8)
51 #define TVE_TV_STAND_HD_1080P30 (0xc << 8)
52 #define TVE_P2I_CONV_EN         BIT(7)
53 #define TVE_INP_VIDEO_FORM      BIT(6)
54 #define TVE_INP_YCBCR_422       (0x0 << 6)
55 #define TVE_INP_YCBCR_444       (0x1 << 6)
56 #define TVE_DATA_SOURCE_MASK    (0x3 << 4)
57 #define TVE_DATA_SOURCE_BUS1    (0x0 << 4)
58 #define TVE_DATA_SOURCE_BUS2    (0x1 << 4)
59 #define TVE_DATA_SOURCE_EXT     (0x2 << 4)
60 #define TVE_DATA_SOURCE_TESTGEN (0x3 << 4)
61 #define TVE_IPU_CLK_EN_OFS      3
62 #define TVE_IPU_CLK_EN          BIT(3)
63 #define TVE_DAC_SAMP_RATE_OFS   1
64 #define TVE_DAC_SAMP_RATE_WIDTH 2
65 #define TVE_DAC_SAMP_RATE_MASK  (0x3 << 1)
66 #define TVE_DAC_FULL_RATE       (0x0 << 1)
67 #define TVE_DAC_DIV2_RATE       (0x1 << 1)
68 #define TVE_DAC_DIV4_RATE       (0x2 << 1)
69 #define TVE_EN                  BIT(0)
70
71 /* TVE_TVDACx_CONT_REG */
72 #define TVE_TVDAC_GAIN_MASK     (0x3f << 0)
73
74 /* TVE_CD_CONT_REG */
75 #define TVE_CD_CH_2_SM_EN       BIT(22)
76 #define TVE_CD_CH_1_SM_EN       BIT(21)
77 #define TVE_CD_CH_0_SM_EN       BIT(20)
78 #define TVE_CD_CH_2_LM_EN       BIT(18)
79 #define TVE_CD_CH_1_LM_EN       BIT(17)
80 #define TVE_CD_CH_0_LM_EN       BIT(16)
81 #define TVE_CD_CH_2_REF_LVL     BIT(10)
82 #define TVE_CD_CH_1_REF_LVL     BIT(9)
83 #define TVE_CD_CH_0_REF_LVL     BIT(8)
84 #define TVE_CD_EN               BIT(0)
85
86 /* TVE_INT_CONT_REG */
87 #define TVE_FRAME_END_IEN       BIT(13)
88 #define TVE_CD_MON_END_IEN      BIT(2)
89 #define TVE_CD_SM_IEN           BIT(1)
90 #define TVE_CD_LM_IEN           BIT(0)
91
92 /* TVE_TST_MODE_REG */
93 #define TVE_TVDAC_TEST_MODE_MASK        (0x7 << 0)
94
95 #define IMX_TVE_DAC_VOLTAGE     2750000
96
97 enum {
98         TVE_MODE_TVOUT,
99         TVE_MODE_VGA,
100 };
101
102 struct imx_tve {
103         struct drm_connector connector;
104         struct drm_encoder encoder;
105         struct device *dev;
106         spinlock_t lock;        /* register lock */
107         bool enabled;
108         int mode;
109         int di_hsync_pin;
110         int di_vsync_pin;
111
112         struct regmap *regmap;
113         struct regulator *dac_reg;
114         struct i2c_adapter *ddc;
115         struct clk *clk;
116         struct clk *di_sel_clk;
117         struct clk_hw clk_hw_di;
118         struct clk *di_clk;
119 };
120
121 static inline struct imx_tve *con_to_tve(struct drm_connector *c)
122 {
123         return container_of(c, struct imx_tve, connector);
124 }
125
126 static inline struct imx_tve *enc_to_tve(struct drm_encoder *e)
127 {
128         return container_of(e, struct imx_tve, encoder);
129 }
130
131 static void tve_lock(void *__tve)
132 __acquires(&tve->lock)
133 {
134         struct imx_tve *tve = __tve;
135
136         spin_lock(&tve->lock);
137 }
138
139 static void tve_unlock(void *__tve)
140 __releases(&tve->lock)
141 {
142         struct imx_tve *tve = __tve;
143
144         spin_unlock(&tve->lock);
145 }
146
147 static void tve_enable(struct imx_tve *tve)
148 {
149         if (!tve->enabled) {
150                 tve->enabled = true;
151                 clk_prepare_enable(tve->clk);
152                 regmap_update_bits(tve->regmap, TVE_COM_CONF_REG,
153                                    TVE_EN, TVE_EN);
154         }
155
156         /* clear interrupt status register */
157         regmap_write(tve->regmap, TVE_STAT_REG, 0xffffffff);
158
159         /* cable detection irq disabled in VGA mode, enabled in TVOUT mode */
160         if (tve->mode == TVE_MODE_VGA)
161                 regmap_write(tve->regmap, TVE_INT_CONT_REG, 0);
162         else
163                 regmap_write(tve->regmap, TVE_INT_CONT_REG,
164                              TVE_CD_SM_IEN |
165                              TVE_CD_LM_IEN |
166                              TVE_CD_MON_END_IEN);
167 }
168
169 static void tve_disable(struct imx_tve *tve)
170 {
171         if (tve->enabled) {
172                 tve->enabled = false;
173                 regmap_update_bits(tve->regmap, TVE_COM_CONF_REG, TVE_EN, 0);
174                 clk_disable_unprepare(tve->clk);
175         }
176 }
177
178 static int tve_setup_tvout(struct imx_tve *tve)
179 {
180         return -ENOTSUPP;
181 }
182
183 static int tve_setup_vga(struct imx_tve *tve)
184 {
185         unsigned int mask;
186         unsigned int val;
187         int ret;
188
189         /* set gain to (1 + 10/128) to provide 0.7V peak-to-peak amplitude */
190         ret = regmap_update_bits(tve->regmap, TVE_TVDAC0_CONT_REG,
191                                  TVE_TVDAC_GAIN_MASK, 0x0a);
192         if (ret)
193                 return ret;
194
195         ret = regmap_update_bits(tve->regmap, TVE_TVDAC1_CONT_REG,
196                                  TVE_TVDAC_GAIN_MASK, 0x0a);
197         if (ret)
198                 return ret;
199
200         ret = regmap_update_bits(tve->regmap, TVE_TVDAC2_CONT_REG,
201                                  TVE_TVDAC_GAIN_MASK, 0x0a);
202         if (ret)
203                 return ret;
204
205         /* set configuration register */
206         mask = TVE_DATA_SOURCE_MASK | TVE_INP_VIDEO_FORM;
207         val  = TVE_DATA_SOURCE_BUS2 | TVE_INP_YCBCR_444;
208         mask |= TVE_TV_STAND_MASK       | TVE_P2I_CONV_EN;
209         val  |= TVE_TV_STAND_HD_1080P30 | 0;
210         mask |= TVE_TV_OUT_MODE_MASK | TVE_SYNC_CH_0_EN;
211         val  |= TVE_TV_OUT_RGB       | TVE_SYNC_CH_0_EN;
212         ret = regmap_update_bits(tve->regmap, TVE_COM_CONF_REG, mask, val);
213         if (ret)
214                 return ret;
215
216         /* set test mode (as documented) */
217         return regmap_update_bits(tve->regmap, TVE_TST_MODE_REG,
218                                  TVE_TVDAC_TEST_MODE_MASK, 1);
219 }
220
221 static int imx_tve_connector_get_modes(struct drm_connector *connector)
222 {
223         struct imx_tve *tve = con_to_tve(connector);
224         struct edid *edid;
225         int ret = 0;
226
227         if (!tve->ddc)
228                 return 0;
229
230         edid = drm_get_edid(connector, tve->ddc);
231         if (edid) {
232                 drm_connector_update_edid_property(connector, edid);
233                 ret = drm_add_edid_modes(connector, edid);
234                 kfree(edid);
235         }
236
237         return ret;
238 }
239
240 static int imx_tve_connector_mode_valid(struct drm_connector *connector,
241                                         struct drm_display_mode *mode)
242 {
243         struct imx_tve *tve = con_to_tve(connector);
244         unsigned long rate;
245
246         /* pixel clock with 2x oversampling */
247         rate = clk_round_rate(tve->clk, 2000UL * mode->clock) / 2000;
248         if (rate == mode->clock)
249                 return MODE_OK;
250
251         /* pixel clock without oversampling */
252         rate = clk_round_rate(tve->clk, 1000UL * mode->clock) / 1000;
253         if (rate == mode->clock)
254                 return MODE_OK;
255
256         dev_warn(tve->dev, "ignoring mode %dx%d\n",
257                  mode->hdisplay, mode->vdisplay);
258
259         return MODE_BAD;
260 }
261
262 static struct drm_encoder *imx_tve_connector_best_encoder(
263                 struct drm_connector *connector)
264 {
265         struct imx_tve *tve = con_to_tve(connector);
266
267         return &tve->encoder;
268 }
269
270 static void imx_tve_encoder_mode_set(struct drm_encoder *encoder,
271                                      struct drm_display_mode *orig_mode,
272                                      struct drm_display_mode *mode)
273 {
274         struct imx_tve *tve = enc_to_tve(encoder);
275         unsigned long rounded_rate;
276         unsigned long rate;
277         int div = 1;
278         int ret;
279
280         /*
281          * FIXME
282          * we should try 4k * mode->clock first,
283          * and enable 4x oversampling for lower resolutions
284          */
285         rate = 2000UL * mode->clock;
286         clk_set_rate(tve->clk, rate);
287         rounded_rate = clk_get_rate(tve->clk);
288         if (rounded_rate >= rate)
289                 div = 2;
290         clk_set_rate(tve->di_clk, rounded_rate / div);
291
292         ret = clk_set_parent(tve->di_sel_clk, tve->di_clk);
293         if (ret < 0) {
294                 dev_err(tve->dev, "failed to set di_sel parent to tve_di: %d\n",
295                         ret);
296         }
297
298         regmap_update_bits(tve->regmap, TVE_COM_CONF_REG,
299                            TVE_IPU_CLK_EN, TVE_IPU_CLK_EN);
300
301         if (tve->mode == TVE_MODE_VGA)
302                 ret = tve_setup_vga(tve);
303         else
304                 ret = tve_setup_tvout(tve);
305         if (ret)
306                 dev_err(tve->dev, "failed to set configuration: %d\n", ret);
307 }
308
309 static void imx_tve_encoder_enable(struct drm_encoder *encoder)
310 {
311         struct imx_tve *tve = enc_to_tve(encoder);
312
313         tve_enable(tve);
314 }
315
316 static void imx_tve_encoder_disable(struct drm_encoder *encoder)
317 {
318         struct imx_tve *tve = enc_to_tve(encoder);
319
320         tve_disable(tve);
321 }
322
323 static int imx_tve_atomic_check(struct drm_encoder *encoder,
324                                 struct drm_crtc_state *crtc_state,
325                                 struct drm_connector_state *conn_state)
326 {
327         struct imx_crtc_state *imx_crtc_state = to_imx_crtc_state(crtc_state);
328         struct imx_tve *tve = enc_to_tve(encoder);
329
330         imx_crtc_state->bus_format = MEDIA_BUS_FMT_GBR888_1X24;
331         imx_crtc_state->di_hsync_pin = tve->di_hsync_pin;
332         imx_crtc_state->di_vsync_pin = tve->di_vsync_pin;
333
334         return 0;
335 }
336
337 static const struct drm_connector_funcs imx_tve_connector_funcs = {
338         .fill_modes = drm_helper_probe_single_connector_modes,
339         .destroy = imx_drm_connector_destroy,
340         .reset = drm_atomic_helper_connector_reset,
341         .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,
342         .atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
343 };
344
345 static const struct drm_connector_helper_funcs imx_tve_connector_helper_funcs = {
346         .get_modes = imx_tve_connector_get_modes,
347         .best_encoder = imx_tve_connector_best_encoder,
348         .mode_valid = imx_tve_connector_mode_valid,
349 };
350
351 static const struct drm_encoder_funcs imx_tve_encoder_funcs = {
352         .destroy = imx_drm_encoder_destroy,
353 };
354
355 static const struct drm_encoder_helper_funcs imx_tve_encoder_helper_funcs = {
356         .mode_set = imx_tve_encoder_mode_set,
357         .enable = imx_tve_encoder_enable,
358         .disable = imx_tve_encoder_disable,
359         .atomic_check = imx_tve_atomic_check,
360 };
361
362 static irqreturn_t imx_tve_irq_handler(int irq, void *data)
363 {
364         struct imx_tve *tve = data;
365         unsigned int val;
366
367         regmap_read(tve->regmap, TVE_STAT_REG, &val);
368
369         /* clear interrupt status register */
370         regmap_write(tve->regmap, TVE_STAT_REG, 0xffffffff);
371
372         return IRQ_HANDLED;
373 }
374
375 static unsigned long clk_tve_di_recalc_rate(struct clk_hw *hw,
376                                             unsigned long parent_rate)
377 {
378         struct imx_tve *tve = container_of(hw, struct imx_tve, clk_hw_di);
379         unsigned int val;
380         int ret;
381
382         ret = regmap_read(tve->regmap, TVE_COM_CONF_REG, &val);
383         if (ret < 0)
384                 return 0;
385
386         switch (val & TVE_DAC_SAMP_RATE_MASK) {
387         case TVE_DAC_DIV4_RATE:
388                 return parent_rate / 4;
389         case TVE_DAC_DIV2_RATE:
390                 return parent_rate / 2;
391         case TVE_DAC_FULL_RATE:
392         default:
393                 return parent_rate;
394         }
395
396         return 0;
397 }
398
399 static long clk_tve_di_round_rate(struct clk_hw *hw, unsigned long rate,
400                                   unsigned long *prate)
401 {
402         unsigned long div;
403
404         div = *prate / rate;
405         if (div >= 4)
406                 return *prate / 4;
407         else if (div >= 2)
408                 return *prate / 2;
409         return *prate;
410 }
411
412 static int clk_tve_di_set_rate(struct clk_hw *hw, unsigned long rate,
413                                unsigned long parent_rate)
414 {
415         struct imx_tve *tve = container_of(hw, struct imx_tve, clk_hw_di);
416         unsigned long div;
417         u32 val;
418         int ret;
419
420         div = parent_rate / rate;
421         if (div >= 4)
422                 val = TVE_DAC_DIV4_RATE;
423         else if (div >= 2)
424                 val = TVE_DAC_DIV2_RATE;
425         else
426                 val = TVE_DAC_FULL_RATE;
427
428         ret = regmap_update_bits(tve->regmap, TVE_COM_CONF_REG,
429                                  TVE_DAC_SAMP_RATE_MASK, val);
430
431         if (ret < 0) {
432                 dev_err(tve->dev, "failed to set divider: %d\n", ret);
433                 return ret;
434         }
435
436         return 0;
437 }
438
439 static const struct clk_ops clk_tve_di_ops = {
440         .round_rate = clk_tve_di_round_rate,
441         .set_rate = clk_tve_di_set_rate,
442         .recalc_rate = clk_tve_di_recalc_rate,
443 };
444
445 static int tve_clk_init(struct imx_tve *tve, void __iomem *base)
446 {
447         const char *tve_di_parent[1];
448         struct clk_init_data init = {
449                 .name = "tve_di",
450                 .ops = &clk_tve_di_ops,
451                 .num_parents = 1,
452                 .flags = 0,
453         };
454
455         tve_di_parent[0] = __clk_get_name(tve->clk);
456         init.parent_names = (const char **)&tve_di_parent;
457
458         tve->clk_hw_di.init = &init;
459         tve->di_clk = clk_register(tve->dev, &tve->clk_hw_di);
460         if (IS_ERR(tve->di_clk)) {
461                 dev_err(tve->dev, "failed to register TVE output clock: %ld\n",
462                         PTR_ERR(tve->di_clk));
463                 return PTR_ERR(tve->di_clk);
464         }
465
466         return 0;
467 }
468
469 static int imx_tve_register(struct drm_device *drm, struct imx_tve *tve)
470 {
471         int encoder_type;
472         int ret;
473
474         encoder_type = tve->mode == TVE_MODE_VGA ?
475                                 DRM_MODE_ENCODER_DAC : DRM_MODE_ENCODER_TVDAC;
476
477         ret = imx_drm_encoder_parse_of(drm, &tve->encoder, tve->dev->of_node);
478         if (ret)
479                 return ret;
480
481         drm_encoder_helper_add(&tve->encoder, &imx_tve_encoder_helper_funcs);
482         drm_encoder_init(drm, &tve->encoder, &imx_tve_encoder_funcs,
483                          encoder_type, NULL);
484
485         drm_connector_helper_add(&tve->connector,
486                         &imx_tve_connector_helper_funcs);
487         drm_connector_init(drm, &tve->connector, &imx_tve_connector_funcs,
488                            DRM_MODE_CONNECTOR_VGA);
489
490         drm_connector_attach_encoder(&tve->connector, &tve->encoder);
491
492         return 0;
493 }
494
495 static bool imx_tve_readable_reg(struct device *dev, unsigned int reg)
496 {
497         return (reg % 4 == 0) && (reg <= 0xdc);
498 }
499
500 static struct regmap_config tve_regmap_config = {
501         .reg_bits = 32,
502         .val_bits = 32,
503         .reg_stride = 4,
504
505         .readable_reg = imx_tve_readable_reg,
506
507         .lock = tve_lock,
508         .unlock = tve_unlock,
509
510         .max_register = 0xdc,
511 };
512
513 static const char * const imx_tve_modes[] = {
514         [TVE_MODE_TVOUT]  = "tvout",
515         [TVE_MODE_VGA] = "vga",
516 };
517
518 static const int of_get_tve_mode(struct device_node *np)
519 {
520         const char *bm;
521         int ret, i;
522
523         ret = of_property_read_string(np, "fsl,tve-mode", &bm);
524         if (ret < 0)
525                 return ret;
526
527         for (i = 0; i < ARRAY_SIZE(imx_tve_modes); i++)
528                 if (!strcasecmp(bm, imx_tve_modes[i]))
529                         return i;
530
531         return -EINVAL;
532 }
533
534 static int imx_tve_bind(struct device *dev, struct device *master, void *data)
535 {
536         struct platform_device *pdev = to_platform_device(dev);
537         struct drm_device *drm = data;
538         struct device_node *np = dev->of_node;
539         struct device_node *ddc_node;
540         struct imx_tve *tve;
541         struct resource *res;
542         void __iomem *base;
543         unsigned int val;
544         int irq;
545         int ret;
546
547         tve = devm_kzalloc(dev, sizeof(*tve), GFP_KERNEL);
548         if (!tve)
549                 return -ENOMEM;
550
551         tve->dev = dev;
552         spin_lock_init(&tve->lock);
553
554         ddc_node = of_parse_phandle(np, "ddc-i2c-bus", 0);
555         if (ddc_node) {
556                 tve->ddc = of_find_i2c_adapter_by_node(ddc_node);
557                 of_node_put(ddc_node);
558         }
559
560         tve->mode = of_get_tve_mode(np);
561         if (tve->mode != TVE_MODE_VGA) {
562                 dev_err(dev, "only VGA mode supported, currently\n");
563                 return -EINVAL;
564         }
565
566         if (tve->mode == TVE_MODE_VGA) {
567                 ret = of_property_read_u32(np, "fsl,hsync-pin",
568                                            &tve->di_hsync_pin);
569
570                 if (ret < 0) {
571                         dev_err(dev, "failed to get hsync pin\n");
572                         return ret;
573                 }
574
575                 ret = of_property_read_u32(np, "fsl,vsync-pin",
576                                            &tve->di_vsync_pin);
577
578                 if (ret < 0) {
579                         dev_err(dev, "failed to get vsync pin\n");
580                         return ret;
581                 }
582         }
583
584         res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
585         base = devm_ioremap_resource(dev, res);
586         if (IS_ERR(base))
587                 return PTR_ERR(base);
588
589         tve_regmap_config.lock_arg = tve;
590         tve->regmap = devm_regmap_init_mmio_clk(dev, "tve", base,
591                                                 &tve_regmap_config);
592         if (IS_ERR(tve->regmap)) {
593                 dev_err(dev, "failed to init regmap: %ld\n",
594                         PTR_ERR(tve->regmap));
595                 return PTR_ERR(tve->regmap);
596         }
597
598         irq = platform_get_irq(pdev, 0);
599         if (irq < 0) {
600                 dev_err(dev, "failed to get irq\n");
601                 return irq;
602         }
603
604         ret = devm_request_threaded_irq(dev, irq, NULL,
605                                         imx_tve_irq_handler, IRQF_ONESHOT,
606                                         "imx-tve", tve);
607         if (ret < 0) {
608                 dev_err(dev, "failed to request irq: %d\n", ret);
609                 return ret;
610         }
611
612         tve->dac_reg = devm_regulator_get(dev, "dac");
613         if (!IS_ERR(tve->dac_reg)) {
614                 if (regulator_get_voltage(tve->dac_reg) != IMX_TVE_DAC_VOLTAGE)
615                         dev_warn(dev, "dac voltage is not %d uV\n", IMX_TVE_DAC_VOLTAGE);
616                 ret = regulator_enable(tve->dac_reg);
617                 if (ret)
618                         return ret;
619         }
620
621         tve->clk = devm_clk_get(dev, "tve");
622         if (IS_ERR(tve->clk)) {
623                 dev_err(dev, "failed to get high speed tve clock: %ld\n",
624                         PTR_ERR(tve->clk));
625                 return PTR_ERR(tve->clk);
626         }
627
628         /* this is the IPU DI clock input selector, can be parented to tve_di */
629         tve->di_sel_clk = devm_clk_get(dev, "di_sel");
630         if (IS_ERR(tve->di_sel_clk)) {
631                 dev_err(dev, "failed to get ipu di mux clock: %ld\n",
632                         PTR_ERR(tve->di_sel_clk));
633                 return PTR_ERR(tve->di_sel_clk);
634         }
635
636         ret = tve_clk_init(tve, base);
637         if (ret < 0)
638                 return ret;
639
640         ret = regmap_read(tve->regmap, TVE_COM_CONF_REG, &val);
641         if (ret < 0) {
642                 dev_err(dev, "failed to read configuration register: %d\n",
643                         ret);
644                 return ret;
645         }
646         if (val != 0x00100000) {
647                 dev_err(dev, "configuration register default value indicates this is not a TVEv2\n");
648                 return -ENODEV;
649         }
650
651         /* disable cable detection for VGA mode */
652         ret = regmap_write(tve->regmap, TVE_CD_CONT_REG, 0);
653         if (ret)
654                 return ret;
655
656         ret = imx_tve_register(drm, tve);
657         if (ret)
658                 return ret;
659
660         dev_set_drvdata(dev, tve);
661
662         return 0;
663 }
664
665 static void imx_tve_unbind(struct device *dev, struct device *master,
666         void *data)
667 {
668         struct imx_tve *tve = dev_get_drvdata(dev);
669
670         if (!IS_ERR(tve->dac_reg))
671                 regulator_disable(tve->dac_reg);
672 }
673
674 static const struct component_ops imx_tve_ops = {
675         .bind   = imx_tve_bind,
676         .unbind = imx_tve_unbind,
677 };
678
679 static int imx_tve_probe(struct platform_device *pdev)
680 {
681         return component_add(&pdev->dev, &imx_tve_ops);
682 }
683
684 static int imx_tve_remove(struct platform_device *pdev)
685 {
686         component_del(&pdev->dev, &imx_tve_ops);
687         return 0;
688 }
689
690 static const struct of_device_id imx_tve_dt_ids[] = {
691         { .compatible = "fsl,imx53-tve", },
692         { /* sentinel */ }
693 };
694 MODULE_DEVICE_TABLE(of, imx_tve_dt_ids);
695
696 static struct platform_driver imx_tve_driver = {
697         .probe          = imx_tve_probe,
698         .remove         = imx_tve_remove,
699         .driver         = {
700                 .of_match_table = imx_tve_dt_ids,
701                 .name   = "imx-tve",
702         },
703 };
704
705 module_platform_driver(imx_tve_driver);
706
707 MODULE_DESCRIPTION("i.MX Television Encoder driver");
708 MODULE_AUTHOR("Philipp Zabel, Pengutronix");
709 MODULE_LICENSE("GPL");
710 MODULE_ALIAS("platform:imx-tve");