1
2
3
4
5
6
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
17struct 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
28static 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
42static const struct of_device_id tvc_of_match[];
43
44#define to_panel_data(x) container_of(x, struct panel_drv_data, dssdev)
45
46static 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
64static 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
77static 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
109static 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
124static 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
136static 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
144static 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
153static 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
161static 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
169static 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
186static 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
210static 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
227static 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;
268err_reg:
269 omap_dss_put_device(ddata->in);
270 return r;
271}
272
273static 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
289static const struct of_device_id tvc_of_match[] = {
290 { .compatible = "omapdss,svideo-connector", },
291 { .compatible = "omapdss,composite-video-connector", },
292 {},
293};
294
295MODULE_DEVICE_TABLE(of, tvc_of_match);
296
297static 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
307module_platform_driver(tvc_connector_driver);
308
309MODULE_AUTHOR("Tomi Valkeinen <tomi.valkeinen@ti.com>");
310MODULE_DESCRIPTION("Analog TV Connector driver");
311MODULE_LICENSE("GPL");
312
