OSDN Git Service

Merge "cnss2: Add support for genoa sdio"
[sagit-ice-cold/kernel_xiaomi_msm8998.git] / drivers / media / usb / tm6000 / tm6000-dvb.c
1 /*
2  *  tm6000-dvb.c - dvb-t support for TM5600/TM6000/TM6010 USB video capture devices
3  *
4  *  Copyright (C) 2007 Michel Ludwig <michel.ludwig@gmail.com>
5  *
6  *  This program is free software; you can redistribute it and/or modify
7  *  it under the terms of the GNU General Public License as published by
8  *  the Free Software Foundation version 2
9  *
10  *  This program is distributed in the hope that it will be useful,
11  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
12  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
13  *  GNU General Public License for more details.
14  *
15  *  You should have received a copy of the GNU General Public License
16  *  along with this program; if not, write to the Free Software
17  *  Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
18  */
19
20 #include <linux/kernel.h>
21 #include <linux/slab.h>
22 #include <linux/usb.h>
23
24 #include "tm6000.h"
25 #include "tm6000-regs.h"
26
27 #include "zl10353.h"
28
29 #include <media/tuner.h>
30
31 #include "tuner-xc2028.h"
32 #include "xc5000.h"
33
34 MODULE_DESCRIPTION("DVB driver extension module for tm5600/6000/6010 based TV cards");
35 MODULE_AUTHOR("Mauro Carvalho Chehab");
36 MODULE_LICENSE("GPL");
37
38 MODULE_SUPPORTED_DEVICE("{{Trident, tm5600},"
39                         "{{Trident, tm6000},"
40                         "{{Trident, tm6010}");
41
42 static int debug;
43
44 module_param(debug, int, 0644);
45 MODULE_PARM_DESC(debug, "enable debug message");
46
47 static inline void print_err_status(struct tm6000_core *dev,
48                                     int packet, int status)
49 {
50         char *errmsg = "Unknown";
51
52         switch (status) {
53         case -ENOENT:
54                 errmsg = "unlinked synchronuously";
55                 break;
56         case -ECONNRESET:
57                 errmsg = "unlinked asynchronuously";
58                 break;
59         case -ENOSR:
60                 errmsg = "Buffer error (overrun)";
61                 break;
62         case -EPIPE:
63                 errmsg = "Stalled (device not responding)";
64                 break;
65         case -EOVERFLOW:
66                 errmsg = "Babble (bad cable?)";
67                 break;
68         case -EPROTO:
69                 errmsg = "Bit-stuff error (bad cable?)";
70                 break;
71         case -EILSEQ:
72                 errmsg = "CRC/Timeout (could be anything)";
73                 break;
74         case -ETIME:
75                 errmsg = "Device does not respond";
76                 break;
77         }
78         if (packet < 0) {
79                 dprintk(dev, 1, "URB status %d [%s].\n",
80                         status, errmsg);
81         } else {
82                 dprintk(dev, 1, "URB packet %d, status %d [%s].\n",
83                         packet, status, errmsg);
84         }
85 }
86
87 static void tm6000_urb_received(struct urb *urb)
88 {
89         int ret;
90         struct tm6000_core *dev = urb->context;
91
92         switch (urb->status) {
93         case 0:
94         case -ETIMEDOUT:
95                 break;
96         case -ENOENT:
97         case -ECONNRESET:
98         case -ESHUTDOWN:
99                 return;
100         default:
101                 print_err_status(dev, 0, urb->status);
102         }
103
104         if (urb->actual_length > 0)
105                 dvb_dmx_swfilter(&dev->dvb->demux, urb->transfer_buffer,
106                                                    urb->actual_length);
107
108         if (dev->dvb->streams > 0) {
109                 ret = usb_submit_urb(urb, GFP_ATOMIC);
110                 if (ret < 0) {
111                         printk(KERN_ERR "tm6000:  error %s\n", __func__);
112                         kfree(urb->transfer_buffer);
113                         usb_free_urb(urb);
114                         dev->dvb->bulk_urb = NULL;
115                 }
116         }
117 }
118
119 static int tm6000_start_stream(struct tm6000_core *dev)
120 {
121         int ret;
122         unsigned int pipe, size;
123         struct tm6000_dvb *dvb = dev->dvb;
124
125         printk(KERN_INFO "tm6000: got start stream request %s\n", __func__);
126
127         if (dev->mode != TM6000_MODE_DIGITAL) {
128                 tm6000_init_digital_mode(dev);
129                 dev->mode = TM6000_MODE_DIGITAL;
130         }
131
132         dvb->bulk_urb = usb_alloc_urb(0, GFP_KERNEL);
133         if (dvb->bulk_urb == NULL) {
134                 printk(KERN_ERR "tm6000: couldn't allocate urb\n");
135                 return -ENOMEM;
136         }
137
138         pipe = usb_rcvbulkpipe(dev->udev, dev->bulk_in.endp->desc.bEndpointAddress
139                                                           & USB_ENDPOINT_NUMBER_MASK);
140
141         size = usb_maxpacket(dev->udev, pipe, usb_pipeout(pipe));
142         size = size * 15; /* 512 x 8 or 12 or 15 */
143
144         dvb->bulk_urb->transfer_buffer = kzalloc(size, GFP_KERNEL);
145         if (dvb->bulk_urb->transfer_buffer == NULL) {
146                 usb_free_urb(dvb->bulk_urb);
147                 dvb->bulk_urb = NULL;
148                 printk(KERN_ERR "tm6000: couldn't allocate transfer buffer!\n");
149                 return -ENOMEM;
150         }
151
152         usb_fill_bulk_urb(dvb->bulk_urb, dev->udev, pipe,
153                                                  dvb->bulk_urb->transfer_buffer,
154                                                  size,
155                                                  tm6000_urb_received, dev);
156
157         ret = usb_clear_halt(dev->udev, pipe);
158         if (ret < 0) {
159                 printk(KERN_ERR "tm6000: error %i in %s during pipe reset\n",
160                                                         ret, __func__);
161                 return ret;
162         } else
163                 printk(KERN_ERR "tm6000: pipe resetted\n");
164
165 /*      mutex_lock(&tm6000_driver.open_close_mutex); */
166         ret = usb_submit_urb(dvb->bulk_urb, GFP_ATOMIC);
167
168 /*      mutex_unlock(&tm6000_driver.open_close_mutex); */
169         if (ret) {
170                 printk(KERN_ERR "tm6000: submit of urb failed (error=%i)\n",
171                                                                         ret);
172
173                 kfree(dvb->bulk_urb->transfer_buffer);
174                 usb_free_urb(dvb->bulk_urb);
175                 dvb->bulk_urb = NULL;
176                 return ret;
177         }
178
179         return 0;
180 }
181
182 static void tm6000_stop_stream(struct tm6000_core *dev)
183 {
184         struct tm6000_dvb *dvb = dev->dvb;
185
186         if (dvb->bulk_urb) {
187                 printk(KERN_INFO "urb killing\n");
188                 usb_kill_urb(dvb->bulk_urb);
189                 printk(KERN_INFO "urb buffer free\n");
190                 kfree(dvb->bulk_urb->transfer_buffer);
191                 usb_free_urb(dvb->bulk_urb);
192                 dvb->bulk_urb = NULL;
193         }
194 }
195
196 static int tm6000_start_feed(struct dvb_demux_feed *feed)
197 {
198         struct dvb_demux *demux = feed->demux;
199         struct tm6000_core *dev = demux->priv;
200         struct tm6000_dvb *dvb = dev->dvb;
201         printk(KERN_INFO "tm6000: got start feed request %s\n", __func__);
202
203         mutex_lock(&dvb->mutex);
204         if (dvb->streams == 0) {
205                 dvb->streams = 1;
206 /*              mutex_init(&tm6000_dev->streming_mutex); */
207                 tm6000_start_stream(dev);
208         } else
209                 ++(dvb->streams);
210         mutex_unlock(&dvb->mutex);
211
212         return 0;
213 }
214
215 static int tm6000_stop_feed(struct dvb_demux_feed *feed)
216 {
217         struct dvb_demux *demux = feed->demux;
218         struct tm6000_core *dev = demux->priv;
219         struct tm6000_dvb *dvb = dev->dvb;
220
221         printk(KERN_INFO "tm6000: got stop feed request %s\n", __func__);
222
223         mutex_lock(&dvb->mutex);
224
225         printk(KERN_INFO "stream %#x\n", dvb->streams);
226         --(dvb->streams);
227         if (dvb->streams == 0) {
228                 printk(KERN_INFO "stop stream\n");
229                 tm6000_stop_stream(dev);
230 /*              mutex_destroy(&tm6000_dev->streaming_mutex); */
231         }
232         mutex_unlock(&dvb->mutex);
233 /*      mutex_destroy(&tm6000_dev->streaming_mutex); */
234
235         return 0;
236 }
237
238 static int tm6000_dvb_attach_frontend(struct tm6000_core *dev)
239 {
240         struct tm6000_dvb *dvb = dev->dvb;
241
242         if (dev->caps.has_zl10353) {
243                 struct zl10353_config config = {
244                                      .demod_address = dev->demod_addr,
245                                      .no_tuner = 1,
246                                      .parallel_ts = 1,
247                                      .if2 = 45700,
248                                      .disable_i2c_gate_ctrl = 1,
249                                     };
250
251                 dvb->frontend = dvb_attach(zl10353_attach, &config,
252                                                            &dev->i2c_adap);
253         } else {
254                 printk(KERN_ERR "tm6000: no frontend defined for the device!\n");
255                 return -1;
256         }
257
258         return (!dvb->frontend) ? -1 : 0;
259 }
260
261 DVB_DEFINE_MOD_OPT_ADAPTER_NR(adapter_nr);
262
263 static int register_dvb(struct tm6000_core *dev)
264 {
265         int ret = -1;
266         struct tm6000_dvb *dvb = dev->dvb;
267
268         mutex_init(&dvb->mutex);
269
270         dvb->streams = 0;
271
272         /* attach the frontend */
273         ret = tm6000_dvb_attach_frontend(dev);
274         if (ret < 0) {
275                 printk(KERN_ERR "tm6000: couldn't attach the frontend!\n");
276                 goto err;
277         }
278
279         ret = dvb_register_adapter(&dvb->adapter, "Trident TVMaster 6000 DVB-T",
280                                         THIS_MODULE, &dev->udev->dev, adapter_nr);
281         if (ret < 0) {
282                 pr_err("tm6000: couldn't register the adapter!\n");
283                 goto err;
284         }
285
286         dvb->adapter.priv = dev;
287
288         if (dvb->frontend) {
289                 switch (dev->tuner_type) {
290                 case TUNER_XC2028: {
291                         struct xc2028_config cfg = {
292                                 .i2c_adap = &dev->i2c_adap,
293                                 .i2c_addr = dev->tuner_addr,
294                         };
295
296                         dvb->frontend->callback = tm6000_tuner_callback;
297                         ret = dvb_register_frontend(&dvb->adapter, dvb->frontend);
298                         if (ret < 0) {
299                                 printk(KERN_ERR
300                                         "tm6000: couldn't register frontend\n");
301                                 goto adapter_err;
302                         }
303
304                         if (!dvb_attach(xc2028_attach, dvb->frontend, &cfg)) {
305                                 printk(KERN_ERR "tm6000: couldn't register "
306                                                 "frontend (xc3028)\n");
307                                 ret = -EINVAL;
308                                 goto frontend_err;
309                         }
310                         printk(KERN_INFO "tm6000: XC2028/3028 asked to be "
311                                          "attached to frontend!\n");
312                         break;
313                         }
314                 case TUNER_XC5000: {
315                         struct xc5000_config cfg = {
316                                 .i2c_address = dev->tuner_addr,
317                         };
318
319                         dvb->frontend->callback = tm6000_xc5000_callback;
320                         ret = dvb_register_frontend(&dvb->adapter, dvb->frontend);
321                         if (ret < 0) {
322                                 printk(KERN_ERR
323                                         "tm6000: couldn't register frontend\n");
324                                 goto adapter_err;
325                         }
326
327                         if (!dvb_attach(xc5000_attach, dvb->frontend, &dev->i2c_adap, &cfg)) {
328                                 printk(KERN_ERR "tm6000: couldn't register "
329                                                 "frontend (xc5000)\n");
330                                 ret = -EINVAL;
331                                 goto frontend_err;
332                         }
333                         printk(KERN_INFO "tm6000: XC5000 asked to be "
334                                          "attached to frontend!\n");
335                         break;
336                         }
337                 }
338         } else
339                 printk(KERN_ERR "tm6000: no frontend found\n");
340
341         dvb->demux.dmx.capabilities = DMX_TS_FILTERING | DMX_SECTION_FILTERING
342                                                             | DMX_MEMORY_BASED_FILTERING;
343         dvb->demux.priv = dev;
344         dvb->demux.filternum = 8;
345         dvb->demux.feednum = 8;
346         dvb->demux.start_feed = tm6000_start_feed;
347         dvb->demux.stop_feed = tm6000_stop_feed;
348         dvb->demux.write_to_decoder = NULL;
349         ret = dvb_dmx_init(&dvb->demux);
350         if (ret < 0) {
351                 printk(KERN_ERR "tm6000: dvb_dmx_init failed (errno = %d)\n", ret);
352                 goto frontend_err;
353         }
354
355         dvb->dmxdev.filternum = dev->dvb->demux.filternum;
356         dvb->dmxdev.demux = &dev->dvb->demux.dmx;
357         dvb->dmxdev.capabilities = 0;
358
359         ret =  dvb_dmxdev_init(&dvb->dmxdev, &dvb->adapter);
360         if (ret < 0) {
361                 printk(KERN_ERR "tm6000: dvb_dmxdev_init failed (errno = %d)\n", ret);
362                 goto dvb_dmx_err;
363         }
364
365         return 0;
366
367 dvb_dmx_err:
368         dvb_dmx_release(&dvb->demux);
369 frontend_err:
370         if (dvb->frontend) {
371                 dvb_unregister_frontend(dvb->frontend);
372                 dvb_frontend_detach(dvb->frontend);
373         }
374 adapter_err:
375         dvb_unregister_adapter(&dvb->adapter);
376 err:
377         return ret;
378 }
379
380 static void unregister_dvb(struct tm6000_core *dev)
381 {
382         struct tm6000_dvb *dvb = dev->dvb;
383
384         if (dvb->bulk_urb != NULL) {
385                 struct urb *bulk_urb = dvb->bulk_urb;
386
387                 kfree(bulk_urb->transfer_buffer);
388                 bulk_urb->transfer_buffer = NULL;
389                 usb_unlink_urb(bulk_urb);
390                 usb_free_urb(bulk_urb);
391         }
392
393 /*      mutex_lock(&tm6000_driver.open_close_mutex); */
394         if (dvb->frontend) {
395                 dvb_unregister_frontend(dvb->frontend);
396                 dvb_frontend_detach(dvb->frontend);
397         }
398
399         dvb_dmxdev_release(&dvb->dmxdev);
400         dvb_dmx_release(&dvb->demux);
401         dvb_unregister_adapter(&dvb->adapter);
402         mutex_destroy(&dvb->mutex);
403 /*      mutex_unlock(&tm6000_driver.open_close_mutex); */
404 }
405
406 static int dvb_init(struct tm6000_core *dev)
407 {
408         struct tm6000_dvb *dvb;
409         int rc;
410
411         if (!dev)
412                 return 0;
413
414         if (!dev->caps.has_dvb)
415                 return 0;
416
417         if (dev->udev->speed == USB_SPEED_FULL) {
418                 printk(KERN_INFO "This USB2.0 device cannot be run on a USB1.1 port. (it lacks a hardware PID filter)\n");
419                 return 0;
420         }
421
422         dvb = kzalloc(sizeof(struct tm6000_dvb), GFP_KERNEL);
423         if (!dvb) {
424                 printk(KERN_INFO "Cannot allocate memory\n");
425                 return -ENOMEM;
426         }
427
428         dev->dvb = dvb;
429
430         rc = register_dvb(dev);
431         if (rc < 0) {
432                 kfree(dvb);
433                 dev->dvb = NULL;
434                 return 0;
435         }
436
437         return 0;
438 }
439
440 static int dvb_fini(struct tm6000_core *dev)
441 {
442         if (!dev)
443                 return 0;
444
445         if (!dev->caps.has_dvb)
446                 return 0;
447
448         if (dev->dvb) {
449                 unregister_dvb(dev);
450                 kfree(dev->dvb);
451                 dev->dvb = NULL;
452         }
453
454         return 0;
455 }
456
457 static struct tm6000_ops dvb_ops = {
458         .type   = TM6000_DVB,
459         .name   = "TM6000 dvb Extension",
460         .init   = dvb_init,
461         .fini   = dvb_fini,
462 };
463
464 static int __init tm6000_dvb_register(void)
465 {
466         return tm6000_register_extension(&dvb_ops);
467 }
468
469 static void __exit tm6000_dvb_unregister(void)
470 {
471         tm6000_unregister_extension(&dvb_ops);
472 }
473
474 module_init(tm6000_dvb_register);
475 module_exit(tm6000_dvb_unregister);