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 16 struct panel_drv_data { 17 struct omap_dss_device dssdev; 18 struct omap_dss_device *in; 19 20 struct device *dev; 21 22 struct omap_video_timings timings; 23 24 bool invert_polarity; 25 }; 26 27 static const struct omap_video_timings tvc_pal_timings = { 28 .x_res = 720, 29 .y_res = 574, 30 .pixelclock = 13500000, 31 .hsw = 64, 32 .hfp = 12, 33 .hbp = 68, 34 .vsw = 5, 35 .vfp = 5, 36 .vbp = 41, 37 38 .interlace = true, 39 }; 40 41 static const struct of_device_id tvc_of_match[]; 42 43 #define to_panel_data(x) container_of(x, struct panel_drv_data, dssdev) 44 45 static int tvc_connect(struct omap_dss_device *dssdev) 46 { 47 struct panel_drv_data *ddata = to_panel_data(dssdev); 48 struct omap_dss_device *in = ddata->in; 49 50 dev_dbg(ddata->dev, "connect\n"); 51 52 if (omapdss_device_is_connected(dssdev)) 53 return 0; 54 55 return in->ops.atv->connect(in, dssdev); 56 } 57 58 static void tvc_disconnect(struct omap_dss_device *dssdev) 59 { 60 struct panel_drv_data *ddata = to_panel_data(dssdev); 61 struct omap_dss_device *in = ddata->in; 62 63 dev_dbg(ddata->dev, "disconnect\n"); 64 65 if (!omapdss_device_is_connected(dssdev)) 66 return; 67 68 in->ops.atv->disconnect(in, dssdev); 69 } 70 71 static int tvc_enable(struct omap_dss_device *dssdev) 72 { 73 struct panel_drv_data *ddata = to_panel_data(dssdev); 74 struct omap_dss_device *in = ddata->in; 75 int r; 76 77 dev_dbg(ddata->dev, "enable\n"); 78 79 if (!omapdss_device_is_connected(dssdev)) 80 return -ENODEV; 81 82 if (omapdss_device_is_enabled(dssdev)) 83 return 0; 84 85 in->ops.atv->set_timings(in, &ddata->timings); 86 87 if (!ddata->dev->of_node) { 88 in->ops.atv->set_type(in, OMAP_DSS_VENC_TYPE_COMPOSITE); 89 90 in->ops.atv->invert_vid_out_polarity(in, 91 ddata->invert_polarity); 92 } 93 94 r = in->ops.atv->enable(in); 95 if (r) 96 return r; 97 98 dssdev->state = OMAP_DSS_DISPLAY_ACTIVE; 99 100 return r; 101 } 102 103 static void tvc_disable(struct omap_dss_device *dssdev) 104 { 105 struct panel_drv_data *ddata = to_panel_data(dssdev); 106 struct omap_dss_device *in = ddata->in; 107 108 dev_dbg(ddata->dev, "disable\n"); 109 110 if (!omapdss_device_is_enabled(dssdev)) 111 return; 112 113 in->ops.atv->disable(in); 114 115 dssdev->state = OMAP_DSS_DISPLAY_DISABLED; 116 } 117 118 static void tvc_set_timings(struct omap_dss_device *dssdev, 119 struct omap_video_timings *timings) 120 { 121 struct panel_drv_data *ddata = to_panel_data(dssdev); 122 struct omap_dss_device *in = ddata->in; 123 124 ddata->timings = *timings; 125 dssdev->panel.timings = *timings; 126 127 in->ops.atv->set_timings(in, timings); 128 } 129 130 static void tvc_get_timings(struct omap_dss_device *dssdev, 131 struct omap_video_timings *timings) 132 { 133 struct panel_drv_data *ddata = to_panel_data(dssdev); 134 135 *timings = ddata->timings; 136 } 137 138 static int tvc_check_timings(struct omap_dss_device *dssdev, 139 struct omap_video_timings *timings) 140 { 141 struct panel_drv_data *ddata = to_panel_data(dssdev); 142 struct omap_dss_device *in = ddata->in; 143 144 return in->ops.atv->check_timings(in, timings); 145 } 146 147 static u32 tvc_get_wss(struct omap_dss_device *dssdev) 148 { 149 struct panel_drv_data *ddata = to_panel_data(dssdev); 150 struct omap_dss_device *in = ddata->in; 151 152 return in->ops.atv->get_wss(in); 153 } 154 155 static int tvc_set_wss(struct omap_dss_device *dssdev, u32 wss) 156 { 157 struct panel_drv_data *ddata = to_panel_data(dssdev); 158 struct omap_dss_device *in = ddata->in; 159 160 return in->ops.atv->set_wss(in, wss); 161 } 162 163 static struct omap_dss_driver tvc_driver = { 164 .connect = tvc_connect, 165 .disconnect = tvc_disconnect, 166 167 .enable = tvc_enable, 168 .disable = tvc_disable, 169 170 .set_timings = tvc_set_timings, 171 .get_timings = tvc_get_timings, 172 .check_timings = tvc_check_timings, 173 174 .get_resolution = omapdss_default_get_resolution, 175 176 .get_wss = tvc_get_wss, 177 .set_wss = tvc_set_wss, 178 }; 179 180 static int tvc_probe(struct platform_device *pdev) 181 { 182 struct panel_drv_data *ddata; 183 struct omap_dss_device *dssdev; 184 int r; 185 186 if (!pdev->dev.of_node) 187 return -ENODEV; 188 189 ddata = devm_kzalloc(&pdev->dev, sizeof(*ddata), GFP_KERNEL); 190 if (!ddata) 191 return -ENOMEM; 192 193 platform_set_drvdata(pdev, ddata); 194 ddata->dev = &pdev->dev; 195 196 ddata->in = omapdss_of_find_source_for_first_ep(pdev->dev.of_node); 197 r = PTR_ERR_OR_ZERO(ddata->in); 198 if (r) { 199 dev_err(&pdev->dev, "failed to find video source\n"); 200 return r; 201 } 202 203 ddata->timings = tvc_pal_timings; 204 205 dssdev = &ddata->dssdev; 206 dssdev->driver = &tvc_driver; 207 dssdev->dev = &pdev->dev; 208 dssdev->type = OMAP_DISPLAY_TYPE_VENC; 209 dssdev->owner = THIS_MODULE; 210 dssdev->panel.timings = tvc_pal_timings; 211 212 r = omapdss_register_display(dssdev); 213 if (r) { 214 dev_err(&pdev->dev, "Failed to register panel\n"); 215 goto err_reg; 216 } 217 218 return 0; 219 err_reg: 220 omap_dss_put_device(ddata->in); 221 return r; 222 } 223 224 static void tvc_remove(struct platform_device *pdev) 225 { 226 struct panel_drv_data *ddata = platform_get_drvdata(pdev); 227 struct omap_dss_device *dssdev = &ddata->dssdev; 228 struct omap_dss_device *in = ddata->in; 229 230 omapdss_unregister_display(&ddata->dssdev); 231 232 tvc_disable(dssdev); 233 tvc_disconnect(dssdev); 234 235 omap_dss_put_device(in); 236 } 237 238 static const struct of_device_id tvc_of_match[] = { 239 { .compatible = "omapdss,svideo-connector", }, 240 { .compatible = "omapdss,composite-video-connector", }, 241 {}, 242 }; 243 244 MODULE_DEVICE_TABLE(of, tvc_of_match); 245 246 static struct platform_driver tvc_connector_driver = { 247 .probe = tvc_probe, 248 .remove_new = tvc_remove, 249 .driver = { 250 .name = "connector-analog-tv", 251 .of_match_table = tvc_of_match, 252 }, 253 }; 254 255 module_platform_driver(tvc_connector_driver); 256 257 MODULE_AUTHOR("Tomi Valkeinen <tomi.valkeinen@ti.com>"); 258 MODULE_DESCRIPTION("Analog TV Connector driver"); 259 MODULE_LICENSE("GPL"); 260