Merge branch 'for-linus' of git://git.kernel.org/pub/scm/linux/kernel/git/dtor/input
[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / staging / 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/usb.h>
22
23 #include "tm6000.h"
24 #include "tm6000-regs.h"
25
26 #include "zl10353.h"
27
28 #include <media/tuner.h>
29
30 #include "tuner-xc2028.h"
31
32 static void inline print_err_status (struct tm6000_core *dev,
33 int packet, int status)
34 {
35 char *errmsg = "Unknown";
36
37 switch(status) {
38 case -ENOENT:
39 errmsg = "unlinked synchronuously";
40 break;
41 case -ECONNRESET:
42 errmsg = "unlinked asynchronuously";
43 break;
44 case -ENOSR:
45 errmsg = "Buffer error (overrun)";
46 break;
47 case -EPIPE:
48 errmsg = "Stalled (device not responding)";
49 break;
50 case -EOVERFLOW:
51 errmsg = "Babble (bad cable?)";
52 break;
53 case -EPROTO:
54 errmsg = "Bit-stuff error (bad cable?)";
55 break;
56 case -EILSEQ:
57 errmsg = "CRC/Timeout (could be anything)";
58 break;
59 case -ETIME:
60 errmsg = "Device does not respond";
61 break;
62 }
63 if (packet<0) {
64 dprintk(dev, 1, "URB status %d [%s].\n",
65 status, errmsg);
66 } else {
67 dprintk(dev, 1, "URB packet %d, status %d [%s].\n",
68 packet, status, errmsg);
69 }
70 }
71
72 static void tm6000_urb_received(struct urb *urb)
73 {
74 int ret;
75 struct tm6000_core* dev = urb->context;
76
77 if(urb->status != 0) {
78 print_err_status (dev,0,urb->status);
79 }
80 else if(urb->actual_length>0){
81 dvb_dmx_swfilter(&dev->dvb->demux, urb->transfer_buffer,
82 urb->actual_length);
83 }
84
85 if(dev->dvb->streams > 0) {
86 ret = usb_submit_urb(urb, GFP_ATOMIC);
87 if(ret < 0) {
88 printk(KERN_ERR "tm6000: error %s\n", __FUNCTION__);
89 kfree(urb->transfer_buffer);
90 usb_free_urb(urb);
91 }
92 }
93 }
94
95 int tm6000_start_stream(struct tm6000_core *dev)
96 {
97 int ret;
98 unsigned int pipe, size;
99 struct tm6000_dvb *dvb = dev->dvb;
100
101 printk(KERN_INFO "tm6000: got start stream request %s\n",__FUNCTION__);
102
103 tm6000_init_digital_mode(dev);
104
105 dvb->bulk_urb = usb_alloc_urb(0, GFP_KERNEL);
106 if(dvb->bulk_urb == NULL) {
107 printk(KERN_ERR "tm6000: couldn't allocate urb\n");
108 return -ENOMEM;
109 }
110
111 pipe = usb_rcvbulkpipe(dev->udev, dev->bulk_in.endp->desc.bEndpointAddress
112 & USB_ENDPOINT_NUMBER_MASK);
113
114 size = usb_maxpacket(dev->udev, pipe, usb_pipeout(pipe));
115 size = size * 15; /* 512 x 8 or 12 or 15 */
116
117 dvb->bulk_urb->transfer_buffer = kzalloc(size, GFP_KERNEL);
118 if(dvb->bulk_urb->transfer_buffer == NULL) {
119 usb_free_urb(dvb->bulk_urb);
120 printk(KERN_ERR "tm6000: couldn't allocate transfer buffer!\n");
121 return -ENOMEM;
122 }
123
124 usb_fill_bulk_urb(dvb->bulk_urb, dev->udev, pipe,
125 dvb->bulk_urb->transfer_buffer,
126 size,
127 tm6000_urb_received, dev);
128
129 ret = usb_clear_halt(dev->udev, pipe);
130 if(ret < 0) {
131 printk(KERN_ERR "tm6000: error %i in %s during pipe reset\n",ret,__FUNCTION__);
132 return ret;
133 }
134 else {
135 printk(KERN_ERR "tm6000: pipe resetted\n");
136 }
137
138 /* mutex_lock(&tm6000_driver.open_close_mutex); */
139 ret = usb_submit_urb(dvb->bulk_urb, GFP_KERNEL);
140
141 /* mutex_unlock(&tm6000_driver.open_close_mutex); */
142 if (ret) {
143 printk(KERN_ERR "tm6000: submit of urb failed (error=%i)\n",ret);
144
145 kfree(dvb->bulk_urb->transfer_buffer);
146 usb_free_urb(dvb->bulk_urb);
147 return ret;
148 }
149
150 return 0;
151 }
152
153 void tm6000_stop_stream(struct tm6000_core *dev)
154 {
155 struct tm6000_dvb *dvb = dev->dvb;
156
157 if(dvb->bulk_urb) {
158 printk (KERN_INFO "urb killing\n");
159 usb_kill_urb(dvb->bulk_urb);
160 printk (KERN_INFO "urb buffer free\n");
161 kfree(dvb->bulk_urb->transfer_buffer);
162 usb_free_urb(dvb->bulk_urb);
163 dvb->bulk_urb = NULL;
164 }
165 }
166
167 int tm6000_start_feed(struct dvb_demux_feed *feed)
168 {
169 struct dvb_demux *demux = feed->demux;
170 struct tm6000_core *dev = demux->priv;
171 struct tm6000_dvb *dvb = dev->dvb;
172 printk(KERN_INFO "tm6000: got start feed request %s\n",__FUNCTION__);
173
174 mutex_lock(&dvb->mutex);
175 if(dvb->streams == 0) {
176 dvb->streams = 1;
177 /* mutex_init(&tm6000_dev->streming_mutex); */
178 tm6000_start_stream(dev);
179 }
180 else {
181 ++(dvb->streams);
182 }
183 mutex_unlock(&dvb->mutex);
184
185 return 0;
186 }
187
188 int tm6000_stop_feed(struct dvb_demux_feed *feed) {
189 struct dvb_demux *demux = feed->demux;
190 struct tm6000_core *dev = demux->priv;
191 struct tm6000_dvb *dvb = dev->dvb;
192
193 printk(KERN_INFO "tm6000: got stop feed request %s\n",__FUNCTION__);
194
195 mutex_lock(&dvb->mutex);
196
197 printk (KERN_INFO "stream %#x\n", dvb->streams);
198 --(dvb->streams);
199 if(dvb->streams == 0) {
200 printk (KERN_INFO "stop stream\n");
201 tm6000_stop_stream(dev);
202 /* mutex_destroy(&tm6000_dev->streaming_mutex); */
203 }
204 mutex_unlock(&dvb->mutex);
205 /* mutex_destroy(&tm6000_dev->streaming_mutex); */
206
207 return 0;
208 }
209
210 int tm6000_dvb_attach_frontend(struct tm6000_core *dev)
211 {
212 struct tm6000_dvb *dvb = dev->dvb;
213
214 if(dev->caps.has_zl10353) {
215 struct zl10353_config config =
216 {.demod_address = dev->demod_addr,
217 .no_tuner = 1,
218 .parallel_ts = 1,
219 .if2 = 45700,
220 .disable_i2c_gate_ctrl = 1,
221 };
222
223 dvb->frontend = dvb_attach(zl10353_attach, &config,
224 &dev->i2c_adap);
225 }
226 else {
227 printk(KERN_ERR "tm6000: no frontend defined for the device!\n");
228 return -1;
229 }
230
231 return (!dvb->frontend) ? -1 : 0;
232 }
233
234 DVB_DEFINE_MOD_OPT_ADAPTER_NR(adapter_nr);
235
236 int tm6000_dvb_register(struct tm6000_core *dev)
237 {
238 int ret = -1;
239 struct tm6000_dvb *dvb = dev->dvb;
240
241 mutex_init(&dvb->mutex);
242
243 dvb->streams = 0;
244
245 /* attach the frontend */
246 ret = tm6000_dvb_attach_frontend(dev);
247 if(ret < 0) {
248 printk(KERN_ERR "tm6000: couldn't attach the frontend!\n");
249 goto err;
250 }
251
252 ret = dvb_register_adapter(&dvb->adapter, "Trident TVMaster 6000 DVB-T",
253 THIS_MODULE, &dev->udev->dev, adapter_nr);
254 dvb->adapter.priv = dev;
255
256 if (dvb->frontend) {
257 struct xc2028_config cfg = {
258 .i2c_adap = &dev->i2c_adap,
259 .i2c_addr = dev->tuner_addr,
260 };
261
262 dvb->frontend->callback = tm6000_tuner_callback;
263 ret = dvb_register_frontend(&dvb->adapter, dvb->frontend);
264 if (ret < 0) {
265 printk(KERN_ERR
266 "tm6000: couldn't register frontend\n");
267 goto adapter_err;
268 }
269
270 if (!dvb_attach(xc2028_attach, dvb->frontend, &cfg)) {
271 printk(KERN_ERR "tm6000: couldn't register "
272 "frontend (xc3028)\n");
273 ret = -EINVAL;
274 goto frontend_err;
275 }
276 printk(KERN_INFO "tm6000: XC2028/3028 asked to be "
277 "attached to frontend!\n");
278 } else {
279 printk(KERN_ERR "tm6000: no frontend found\n");
280 }
281
282 dvb->demux.dmx.capabilities = DMX_TS_FILTERING | DMX_SECTION_FILTERING
283 | DMX_MEMORY_BASED_FILTERING;
284 dvb->demux.priv = dev;
285 dvb->demux.filternum = 8;
286 dvb->demux.feednum = 8;
287 dvb->demux.start_feed = tm6000_start_feed;
288 dvb->demux.stop_feed = tm6000_stop_feed;
289 dvb->demux.write_to_decoder = NULL;
290 ret = dvb_dmx_init(&dvb->demux);
291 if(ret < 0) {
292 printk("tm6000: dvb_dmx_init failed (errno = %d)\n", ret);
293 goto frontend_err;
294 }
295
296 dvb->dmxdev.filternum = dev->dvb->demux.filternum;
297 dvb->dmxdev.demux = &dev->dvb->demux.dmx;
298 dvb->dmxdev.capabilities = 0;
299
300 ret = dvb_dmxdev_init(&dvb->dmxdev, &dvb->adapter);
301 if(ret < 0) {
302 printk("tm6000: dvb_dmxdev_init failed (errno = %d)\n", ret);
303 goto dvb_dmx_err;
304 }
305
306 return 0;
307
308 dvb_dmx_err:
309 dvb_dmx_release(&dvb->demux);
310 frontend_err:
311 if(dvb->frontend) {
312 dvb_frontend_detach(dvb->frontend);
313 dvb_unregister_frontend(dvb->frontend);
314 }
315 adapter_err:
316 dvb_unregister_adapter(&dvb->adapter);
317 err:
318 return ret;
319 }
320
321 void tm6000_dvb_unregister(struct tm6000_core *dev)
322 {
323 struct tm6000_dvb *dvb = dev->dvb;
324
325 if(dvb->bulk_urb != NULL) {
326 struct urb *bulk_urb = dvb->bulk_urb;
327
328 kfree(bulk_urb->transfer_buffer);
329 bulk_urb->transfer_buffer = NULL;
330 usb_unlink_urb(bulk_urb);
331 usb_free_urb(bulk_urb);
332 }
333
334 /* mutex_lock(&tm6000_driver.open_close_mutex); */
335 if(dvb->frontend) {
336 dvb_frontend_detach(dvb->frontend);
337 dvb_unregister_frontend(dvb->frontend);
338 }
339
340 dvb_dmxdev_release(&dvb->dmxdev);
341 dvb_dmx_release(&dvb->demux);
342 dvb_unregister_adapter(&dvb->adapter);
343 mutex_destroy(&dvb->mutex);
344 /* mutex_unlock(&tm6000_driver.open_close_mutex); */
345
346 }