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

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