drivers/video/fbdev/omap2/omapfb/displays/connector-analog-tv.c

   1 // SPDX-License-Identifier: GPL-2.0-only
   2 /*
   3  * Analog TV Connector driver
   4  *
   5  * Copyright (C) 2013 Texas Instruments
   6  * Author: Tomi Valkeinen <tomi.valkeinen@ti.com>
   7  */
   8
   9 #include <linux/slab.h>
  10 #include <linux/module.h>
  11 #include <linux/platform_device.h>
  12 #include <linux/of.h>
  13
  14 #include <video/omapfb_dss.h>
  15 #include <video/omap-panel-data.h>
  16
  17 struct panel_drv_data {
  18         struct omap_dss_device dssdev;
  19         struct omap_dss_device *in;
  20
  21         struct device *dev;
  22
  23         struct omap_video_timings timings;
  24
  25         bool invert_polarity;
  26 };
  27
  28 static const struct omap_video_timings tvc_pal_timings = {
  29         .x_res          = 720,
  30         .y_res          = 574,
  31         .pixelclock     = 13500000,
  32         .hsw            = 64,
  33         .hfp            = 12,
  34         .hbp            = 68,
  35         .vsw            = 5,
  36         .vfp            = 5,
  37         .vbp            = 41,
  38
  39         .interlace      = true,
  40 };
  41
  42 static const struct of_device_id tvc_of_match[];
  43
  44 #define to_panel_data(x) container_of(x, struct panel_drv_data, dssdev)
  45
  46 static int tvc_connect(struct omap_dss_device *dssdev)
  47 {
  48         struct panel_drv_data *ddata = to_panel_data(dssdev);
  49         struct omap_dss_device *in = ddata->in;
  50         int r;
  51
  52         dev_dbg(ddata->dev, "connect\n");
  53
  54         if (omapdss_device_is_connected(dssdev))
  55                 return 0;
  56
  57         r = in->ops.atv->connect(in, dssdev);
  58         if (r)
  59                 return r;
  60
  61         return 0;
  62 }
  63
  64 static void tvc_disconnect(struct omap_dss_device *dssdev)
  65 {
  66         struct panel_drv_data *ddata = to_panel_data(dssdev);
  67         struct omap_dss_device *in = ddata->in;
  68
  69         dev_dbg(ddata->dev, "disconnect\n");
  70
  71         if (!omapdss_device_is_connected(dssdev))
  72                 return;
  73
  74         in->ops.atv->disconnect(in, dssdev);
  75 }
  76
  77 static int tvc_enable(struct omap_dss_device *dssdev)
  78 {
  79         struct panel_drv_data *ddata = to_panel_data(dssdev);
  80         struct omap_dss_device *in = ddata->in;
  81         int r;
  82
  83         dev_dbg(ddata->dev, "enable\n");
  84
  85         if (!omapdss_device_is_connected(dssdev))
  86                 return -ENODEV;
  87
  88         if (omapdss_device_is_enabled(dssdev))
  89                 return 0;
  90
  91         in->ops.atv->set_timings(in, &ddata->timings);
  92
  93         if (!ddata->dev->of_node) {
  94                 in->ops.atv->set_type(in, OMAP_DSS_VENC_TYPE_COMPOSITE);
  95
  96                 in->ops.atv->invert_vid_out_polarity(in,
  97                         ddata->invert_polarity);
  98         }
  99
 100         r = in->ops.atv->enable(in);
 101         if (r)
 102                 return r;
 103
 104         dssdev->state = OMAP_DSS_DISPLAY_ACTIVE;
 105
 106         return r;
 107 }
 108
 109 static void tvc_disable(struct omap_dss_device *dssdev)
 110 {
 111         struct panel_drv_data *ddata = to_panel_data(dssdev);
 112         struct omap_dss_device *in = ddata->in;
 113
 114         dev_dbg(ddata->dev, "disable\n");
 115
 116         if (!omapdss_device_is_enabled(dssdev))
 117                 return;
 118
 119         in->ops.atv->disable(in);
 120
 121         dssdev->state = OMAP_DSS_DISPLAY_DISABLED;
 122 }
 123
 124 static void tvc_set_timings(struct omap_dss_device *dssdev,
 125                 struct omap_video_timings *timings)
 126 {
 127         struct panel_drv_data *ddata = to_panel_data(dssdev);
 128         struct omap_dss_device *in = ddata->in;
 129
 130         ddata->timings = *timings;
 131         dssdev->panel.timings = *timings;
 132
 133         in->ops.atv->set_timings(in, timings);
 134 }
 135
 136 static void tvc_get_timings(struct omap_dss_device *dssdev,
 137                 struct omap_video_timings *timings)
 138 {
 139         struct panel_drv_data *ddata = to_panel_data(dssdev);
 140
 141         *timings = ddata->timings;
 142 }
 143
 144 static int tvc_check_timings(struct omap_dss_device *dssdev,
 145                 struct omap_video_timings *timings)
 146 {
 147         struct panel_drv_data *ddata = to_panel_data(dssdev);
 148         struct omap_dss_device *in = ddata->in;
 149
 150         return in->ops.atv->check_timings(in, timings);
 151 }
 152
 153 static u32 tvc_get_wss(struct omap_dss_device *dssdev)
 154 {
 155         struct panel_drv_data *ddata = to_panel_data(dssdev);
 156         struct omap_dss_device *in = ddata->in;
 157
 158         return in->ops.atv->get_wss(in);
 159 }
 160
 161 static int tvc_set_wss(struct omap_dss_device *dssdev, u32 wss)
 162 {
 163         struct panel_drv_data *ddata = to_panel_data(dssdev);
 164         struct omap_dss_device *in = ddata->in;
 165
 166         return in->ops.atv->set_wss(in, wss);
 167 }
 168
 169 static struct omap_dss_driver tvc_driver = {
 170         .connect                = tvc_connect,
 171         .disconnect             = tvc_disconnect,
 172
 173         .enable                 = tvc_enable,
 174         .disable                = tvc_disable,
 175
 176         .set_timings            = tvc_set_timings,
 177         .get_timings            = tvc_get_timings,
 178         .check_timings          = tvc_check_timings,
 179
 180         .get_resolution         = omapdss_default_get_resolution,
 181
 182         .get_wss                = tvc_get_wss,
 183         .set_wss                = tvc_set_wss,
 184 };
 185
 186 static int tvc_probe_pdata(struct platform_device *pdev)
 187 {
 188         struct panel_drv_data *ddata = platform_get_drvdata(pdev);
 189         struct connector_atv_platform_data *pdata;
 190         struct omap_dss_device *in, *dssdev;
 191
 192         pdata = dev_get_platdata(&pdev->dev);
 193
 194         in = omap_dss_find_output(pdata->source);
 195         if (in == NULL) {
 196                 dev_err(&pdev->dev, "Failed to find video source\n");
 197                 return -EPROBE_DEFER;
 198         }
 199
 200         ddata->in = in;
 201
 202         ddata->invert_polarity = pdata->invert_polarity;
 203
 204         dssdev = &ddata->dssdev;
 205         dssdev->name = pdata->name;
 206
 207         return 0;
 208 }
 209
 210 static int tvc_probe_of(struct platform_device *pdev)
 211 {
 212         struct panel_drv_data *ddata = platform_get_drvdata(pdev);
 213         struct device_node *node = pdev->dev.of_node;
 214         struct omap_dss_device *in;
 215
 216         in = omapdss_of_find_source_for_first_ep(node);
 217         if (IS_ERR(in)) {
 218                 dev_err(&pdev->dev, "failed to find video source\n");
 219                 return PTR_ERR(in);
 220         }
 221
 222         ddata->in = in;
 223
 224         return 0;
 225 }
 226
 227 static int tvc_probe(struct platform_device *pdev)
 228 {
 229         struct panel_drv_data *ddata;
 230         struct omap_dss_device *dssdev;
 231         int r;
 232
 233         ddata = devm_kzalloc(&pdev->dev, sizeof(*ddata), GFP_KERNEL);
 234         if (!ddata)
 235                 return -ENOMEM;
 236
 237         platform_set_drvdata(pdev, ddata);
 238         ddata->dev = &pdev->dev;
 239
 240         if (dev_get_platdata(&pdev->dev)) {
 241                 r = tvc_probe_pdata(pdev);
 242                 if (r)
 243                         return r;
 244         } else if (pdev->dev.of_node) {
 245                 r = tvc_probe_of(pdev);
 246                 if (r)
 247                         return r;
 248         } else {
 249                 return -ENODEV;
 250         }
 251
 252         ddata->timings = tvc_pal_timings;
 253
 254         dssdev = &ddata->dssdev;
 255         dssdev->driver = &tvc_driver;
 256         dssdev->dev = &pdev->dev;
 257         dssdev->type = OMAP_DISPLAY_TYPE_VENC;
 258         dssdev->owner = THIS_MODULE;
 259         dssdev->panel.timings = tvc_pal_timings;
 260
 261         r = omapdss_register_display(dssdev);
 262         if (r) {
 263                 dev_err(&pdev->dev, "Failed to register panel\n");
 264                 goto err_reg;
 265         }
 266
 267         return 0;
 268 err_reg:
 269         omap_dss_put_device(ddata->in);
 270         return r;
 271 }
 272
 273 static int __exit tvc_remove(struct platform_device *pdev)
 274 {
 275         struct panel_drv_data *ddata = platform_get_drvdata(pdev);
 276         struct omap_dss_device *dssdev = &ddata->dssdev;
 277         struct omap_dss_device *in = ddata->in;
 278
 279         omapdss_unregister_display(&ddata->dssdev);
 280
 281         tvc_disable(dssdev);
 282         tvc_disconnect(dssdev);
 283
 284         omap_dss_put_device(in);
 285
 286         return 0;
 287 }
 288
 289 static const struct of_device_id tvc_of_match[] = {
 290         { .compatible = "omapdss,svideo-connector", },
 291         { .compatible = "omapdss,composite-video-connector", },
 292         {},
 293 };
 294
 295 MODULE_DEVICE_TABLE(of, tvc_of_match);
 296
 297 static struct platform_driver tvc_connector_driver = {
 298         .probe  = tvc_probe,
 299         .remove = __exit_p(tvc_remove),
 300         .driver = {
 301                 .name   = "connector-analog-tv",
 302                 .of_match_table = tvc_of_match,
 303                 .suppress_bind_attrs = true,
 304         },
 305 };
 306
 307 module_platform_driver(tvc_connector_driver);
 308
 309 MODULE_AUTHOR("Tomi Valkeinen <tomi.valkeinen@ti.com>");
 310 MODULE_DESCRIPTION("Analog TV Connector driver");
 311 MODULE_LICENSE("GPL");