V4L/DVB (13077): em28xx: Add support for new variant of KWorld 2800d
[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / media / video / em28xx / em28xx-dvb.c
CommitLineData
3aefb79a
MCC
1/*
2 DVB device driver for em28xx
3
4 (c) 2008 Mauro Carvalho Chehab <mchehab@infradead.org>
5
bdfbf952
DH
6 (c) 2008 Devin Heitmueller <devin.heitmueller@gmail.com>
7 - Fixes for the driver to properly work with HVR-950
4fd305b2 8 - Fixes for the driver to properly work with Pinnacle PCTV HD Pro Stick
e14b3658 9 - Fixes for the driver to properly work with AMD ATI TV Wonder HD 600
bdfbf952 10
3421b778
AT
11 (c) 2008 Aidan Thornton <makosoft@googlemail.com>
12
13 Based on cx88-dvb, saa7134-dvb and videobuf-dvb originally written by:
3aefb79a
MCC
14 (c) 2004, 2005 Chris Pascoe <c.pascoe@itee.uq.edu.au>
15 (c) 2004 Gerd Knorr <kraxel@bytesex.org> [SuSE Labs]
16
17 This program is free software; you can redistribute it and/or modify
18 it under the terms of the GNU General Public License as published by
19 the Free Software Foundation; either version 2 of the License.
20 */
21
22#include <linux/kernel.h>
23#include <linux/usb.h>
24
25#include "em28xx.h"
26#include <media/v4l2-common.h>
27#include <media/videobuf-vmalloc.h>
d7de5d8f
FM
28#include <media/tuner.h>
29#include "tuner-simple.h"
3aefb79a
MCC
30
31#include "lgdt330x.h"
7e6388a1 32#include "zl10353.h"
6e7b9ea0 33#include "s5h1409.h"
4fb202a8
DH
34#include "mt352.h"
35#include "mt352_priv.h" /* FIXME */
285eb1a4 36#include "tda1002x.h"
3aefb79a
MCC
37
38MODULE_DESCRIPTION("driver for em28xx based DVB cards");
39MODULE_AUTHOR("Mauro Carvalho Chehab <mchehab@infradead.org>");
40MODULE_LICENSE("GPL");
41
42static unsigned int debug;
43module_param(debug, int, 0644);
44MODULE_PARM_DESC(debug, "enable debug messages [dvb]");
45
46DVB_DEFINE_MOD_OPT_ADAPTER_NR(adapter_nr);
47
48#define dprintk(level, fmt, arg...) do { \
49if (debug >= level) \
3421b778 50 printk(KERN_DEBUG "%s/2-dvb: " fmt, dev->name, ## arg); \
3aefb79a
MCC
51} while (0)
52
3421b778 53#define EM28XX_DVB_NUM_BUFS 5
3421b778
AT
54#define EM28XX_DVB_MAX_PACKETS 64
55
56struct em28xx_dvb {
57 struct dvb_frontend *frontend;
58
59 /* feed count management */
60 struct mutex lock;
61 int nfeeds;
62
63 /* general boilerplate stuff */
64 struct dvb_adapter adapter;
65 struct dvb_demux demux;
66 struct dmxdev dmxdev;
67 struct dmx_frontend fe_hw;
68 struct dmx_frontend fe_mem;
69 struct dvb_net net;
70};
71
72
73static inline void print_err_status(struct em28xx *dev,
74 int packet, int status)
3aefb79a 75{
3421b778 76 char *errmsg = "Unknown";
3aefb79a 77
3421b778
AT
78 switch (status) {
79 case -ENOENT:
80 errmsg = "unlinked synchronuously";
81 break;
82 case -ECONNRESET:
83 errmsg = "unlinked asynchronuously";
84 break;
85 case -ENOSR:
86 errmsg = "Buffer error (overrun)";
87 break;
88 case -EPIPE:
89 errmsg = "Stalled (device not responding)";
90 break;
91 case -EOVERFLOW:
92 errmsg = "Babble (bad cable?)";
93 break;
94 case -EPROTO:
95 errmsg = "Bit-stuff error (bad cable?)";
96 break;
97 case -EILSEQ:
98 errmsg = "CRC/Timeout (could be anything)";
99 break;
100 case -ETIME:
101 errmsg = "Device does not respond";
102 break;
103 }
104 if (packet < 0) {
105 dprintk(1, "URB status %d [%s].\n", status, errmsg);
106 } else {
6ea54d93
DSL
107 dprintk(1, "URB packet %d, status %d [%s].\n",
108 packet, status, errmsg);
3421b778
AT
109 }
110}
3aefb79a 111
3421b778
AT
112static inline int dvb_isoc_copy(struct em28xx *dev, struct urb *urb)
113{
114 int i;
3aefb79a 115
3421b778
AT
116 if (!dev)
117 return 0;
3aefb79a 118
3421b778
AT
119 if ((dev->state & DEV_DISCONNECTED) || (dev->state & DEV_MISCONFIGURED))
120 return 0;
121
122 if (urb->status < 0) {
123 print_err_status(dev, -1, urb->status);
124 if (urb->status == -ENOENT)
125 return 0;
126 }
127
128 for (i = 0; i < urb->number_of_packets; i++) {
129 int status = urb->iso_frame_desc[i].status;
130
131 if (status < 0) {
132 print_err_status(dev, i, status);
133 if (urb->iso_frame_desc[i].status != -EPROTO)
134 continue;
135 }
136
137 dvb_dmx_swfilter(&dev->dvb->demux, urb->transfer_buffer +
138 urb->iso_frame_desc[i].offset,
139 urb->iso_frame_desc[i].actual_length);
140 }
141
142 return 0;
143}
144
6ea54d93
DSL
145static int start_streaming(struct em28xx_dvb *dvb)
146{
c67ec53f 147 int rc;
3421b778 148 struct em28xx *dev = dvb->adapter.priv;
d18e2fda 149 int max_dvb_packet_size;
3421b778
AT
150
151 usb_set_interface(dev->udev, 0, 1);
c67ec53f
MCC
152 rc = em28xx_set_mode(dev, EM28XX_DIGITAL_MODE);
153 if (rc < 0)
154 return rc;
3421b778 155
d18e2fda
DH
156 max_dvb_packet_size = em28xx_isoc_dvb_max_packetsize(dev);
157
3421b778 158 return em28xx_init_isoc(dev, EM28XX_DVB_MAX_PACKETS,
d18e2fda 159 EM28XX_DVB_NUM_BUFS, max_dvb_packet_size,
c67ec53f 160 dvb_isoc_copy);
3421b778
AT
161}
162
6ea54d93
DSL
163static int stop_streaming(struct em28xx_dvb *dvb)
164{
3421b778
AT
165 struct em28xx *dev = dvb->adapter.priv;
166
167 em28xx_uninit_isoc(dev);
c67ec53f 168
2fe3e2ee 169 em28xx_set_mode(dev, EM28XX_SUSPEND);
c67ec53f 170
3aefb79a
MCC
171 return 0;
172}
173
3421b778
AT
174static int start_feed(struct dvb_demux_feed *feed)
175{
176 struct dvb_demux *demux = feed->demux;
177 struct em28xx_dvb *dvb = demux->priv;
178 int rc, ret;
179
180 if (!demux->dmx.frontend)
181 return -EINVAL;
182
183 mutex_lock(&dvb->lock);
184 dvb->nfeeds++;
185 rc = dvb->nfeeds;
186
187 if (dvb->nfeeds == 1) {
188 ret = start_streaming(dvb);
6ea54d93
DSL
189 if (ret < 0)
190 rc = ret;
3421b778
AT
191 }
192
193 mutex_unlock(&dvb->lock);
194 return rc;
195}
196
197static int stop_feed(struct dvb_demux_feed *feed)
198{
199 struct dvb_demux *demux = feed->demux;
200 struct em28xx_dvb *dvb = demux->priv;
201 int err = 0;
202
203 mutex_lock(&dvb->lock);
204 dvb->nfeeds--;
6ea54d93
DSL
205
206 if (0 == dvb->nfeeds)
3421b778 207 err = stop_streaming(dvb);
6ea54d93 208
3421b778
AT
209 mutex_unlock(&dvb->lock);
210 return err;
211}
212
213
e3569abc
MCC
214
215/* ------------------------------------------------------------------ */
216static int em28xx_dvb_bus_ctrl(struct dvb_frontend *fe, int acquire)
217{
218 struct em28xx *dev = fe->dvb->priv;
219
220 if (acquire)
221 return em28xx_set_mode(dev, EM28XX_DIGITAL_MODE);
222 else
2fe3e2ee 223 return em28xx_set_mode(dev, EM28XX_SUSPEND);
e3569abc
MCC
224}
225
3aefb79a
MCC
226/* ------------------------------------------------------------------ */
227
227ad4ab
MCC
228static struct lgdt330x_config em2880_lgdt3303_dev = {
229 .demod_address = 0x0e,
230 .demod_chip = LGDT3303,
231};
3aefb79a 232
7e6388a1
AT
233static struct zl10353_config em28xx_zl10353_with_xc3028 = {
234 .demod_address = (0x1e >> 1),
235 .no_tuner = 1,
236 .parallel_ts = 1,
237 .if2 = 45600,
238};
239
6e7b9ea0
RK
240static struct s5h1409_config em28xx_s5h1409_with_xc3028 = {
241 .demod_address = 0x32 >> 1,
242 .output_mode = S5H1409_PARALLEL_OUTPUT,
243 .gpio = S5H1409_GPIO_OFF,
244 .inversion = S5H1409_INVERSION_OFF,
245 .status_mode = S5H1409_DEMODLOCKING,
246 .mpeg_timing = S5H1409_MPEGTIMING_CONTINOUS_NONINVERTING_CLOCK
247};
248
a84f79ae 249static struct zl10353_config em28xx_zl10353_xc3028_no_i2c_gate = {
f797608c
DH
250 .demod_address = (0x1e >> 1),
251 .no_tuner = 1,
252 .disable_i2c_gate_ctrl = 1,
253 .parallel_ts = 1,
254 .if2 = 45600,
255};
256
17d9d558
DH
257#ifdef EM28XX_DRX397XD_SUPPORT
258/* [TODO] djh - not sure yet what the device config needs to contain */
259static struct drx397xD_config em28xx_drx397xD_with_xc3028 = {
260 .demod_address = (0xe0 >> 1),
261};
262#endif
263
4fb202a8
DH
264static int mt352_terratec_xs_init(struct dvb_frontend *fe)
265{
266 /* Values extracted from a USB trace of the Terratec Windows driver */
267 static u8 clock_config[] = { CLOCK_CTL, 0x38, 0x2c };
268 static u8 reset[] = { RESET, 0x80 };
269 static u8 adc_ctl_1_cfg[] = { ADC_CTL_1, 0x40 };
270 static u8 agc_cfg[] = { AGC_TARGET, 0x28, 0xa0 };
271 static u8 input_freq_cfg[] = { INPUT_FREQ_1, 0x31, 0xb8 };
272 static u8 rs_err_cfg[] = { RS_ERR_PER_1, 0x00, 0x4d };
273 static u8 capt_range_cfg[] = { CAPT_RANGE, 0x32 };
274 static u8 trl_nom_cfg[] = { TRL_NOMINAL_RATE_1, 0x64, 0x00 };
275 static u8 tps_given_cfg[] = { TPS_GIVEN_1, 0x40, 0x80, 0x50 };
ff69786b 276 static u8 tuner_go[] = { TUNER_GO, 0x01};
4fb202a8
DH
277
278 mt352_write(fe, clock_config, sizeof(clock_config));
279 udelay(200);
280 mt352_write(fe, reset, sizeof(reset));
281 mt352_write(fe, adc_ctl_1_cfg, sizeof(adc_ctl_1_cfg));
282 mt352_write(fe, agc_cfg, sizeof(agc_cfg));
283 mt352_write(fe, input_freq_cfg, sizeof(input_freq_cfg));
284 mt352_write(fe, rs_err_cfg, sizeof(rs_err_cfg));
285 mt352_write(fe, capt_range_cfg, sizeof(capt_range_cfg));
286 mt352_write(fe, trl_nom_cfg, sizeof(trl_nom_cfg));
287 mt352_write(fe, tps_given_cfg, sizeof(tps_given_cfg));
288 mt352_write(fe, tuner_go, sizeof(tuner_go));
289 return 0;
290}
291
292static struct mt352_config terratec_xs_mt352_cfg = {
293 .demod_address = (0x1e >> 1),
294 .no_tuner = 1,
295 .if2 = 45600,
296 .demod_init = mt352_terratec_xs_init,
297};
298
285eb1a4
AP
299static struct tda10023_config em28xx_tda10023_config = {
300 .demod_address = 0x0c,
301 .invert = 1,
302};
303
3aefb79a
MCC
304/* ------------------------------------------------------------------ */
305
306static int attach_xc3028(u8 addr, struct em28xx *dev)
307{
308 struct dvb_frontend *fe;
3ca9c093
MCC
309 struct xc2028_config cfg;
310
6ea54d93 311 memset(&cfg, 0, sizeof(cfg));
3ca9c093
MCC
312 cfg.i2c_adap = &dev->i2c_adap;
313 cfg.i2c_addr = addr;
3ca9c093 314
3421b778 315 if (!dev->dvb->frontend) {
3aefb79a
MCC
316 printk(KERN_ERR "%s/2: dvb frontend not attached. "
317 "Can't attach xc3028\n",
318 dev->name);
319 return -EINVAL;
320 }
321
3421b778 322 fe = dvb_attach(xc2028_attach, dev->dvb->frontend, &cfg);
3aefb79a
MCC
323 if (!fe) {
324 printk(KERN_ERR "%s/2: xc3028 attach failed\n",
325 dev->name);
3421b778 326 dvb_frontend_detach(dev->dvb->frontend);
3421b778 327 dev->dvb->frontend = NULL;
3aefb79a
MCC
328 return -EINVAL;
329 }
330
331 printk(KERN_INFO "%s/2: xc3028 attached\n", dev->name);
332
333 return 0;
334}
335
3421b778
AT
336/* ------------------------------------------------------------------ */
337
d45b9b8a 338static int register_dvb(struct em28xx_dvb *dvb,
3421b778
AT
339 struct module *module,
340 struct em28xx *dev,
341 struct device *device)
3aefb79a 342{
3421b778 343 int result;
3aefb79a 344
3421b778 345 mutex_init(&dvb->lock);
3aefb79a 346
3421b778
AT
347 /* register adapter */
348 result = dvb_register_adapter(&dvb->adapter, dev->name, module, device,
349 adapter_nr);
350 if (result < 0) {
351 printk(KERN_WARNING "%s: dvb_register_adapter failed (errno = %d)\n",
352 dev->name, result);
353 goto fail_adapter;
354 }
e3569abc
MCC
355
356 /* Ensure all frontends negotiate bus access */
357 dvb->frontend->ops.ts_bus_ctrl = em28xx_dvb_bus_ctrl;
358
3421b778
AT
359 dvb->adapter.priv = dev;
360
361 /* register frontend */
362 result = dvb_register_frontend(&dvb->adapter, dvb->frontend);
363 if (result < 0) {
364 printk(KERN_WARNING "%s: dvb_register_frontend failed (errno = %d)\n",
365 dev->name, result);
366 goto fail_frontend;
367 }
368
369 /* register demux stuff */
370 dvb->demux.dmx.capabilities =
371 DMX_TS_FILTERING | DMX_SECTION_FILTERING |
372 DMX_MEMORY_BASED_FILTERING;
373 dvb->demux.priv = dvb;
374 dvb->demux.filternum = 256;
375 dvb->demux.feednum = 256;
376 dvb->demux.start_feed = start_feed;
377 dvb->demux.stop_feed = stop_feed;
e3569abc 378
3421b778
AT
379 result = dvb_dmx_init(&dvb->demux);
380 if (result < 0) {
381 printk(KERN_WARNING "%s: dvb_dmx_init failed (errno = %d)\n",
382 dev->name, result);
383 goto fail_dmx;
384 }
385
386 dvb->dmxdev.filternum = 256;
387 dvb->dmxdev.demux = &dvb->demux.dmx;
388 dvb->dmxdev.capabilities = 0;
389 result = dvb_dmxdev_init(&dvb->dmxdev, &dvb->adapter);
390 if (result < 0) {
391 printk(KERN_WARNING "%s: dvb_dmxdev_init failed (errno = %d)\n",
392 dev->name, result);
393 goto fail_dmxdev;
394 }
52284c3e 395
3421b778
AT
396 dvb->fe_hw.source = DMX_FRONTEND_0;
397 result = dvb->demux.dmx.add_frontend(&dvb->demux.dmx, &dvb->fe_hw);
398 if (result < 0) {
399 printk(KERN_WARNING "%s: add_frontend failed (DMX_FRONTEND_0, errno = %d)\n",
400 dev->name, result);
401 goto fail_fe_hw;
402 }
403
404 dvb->fe_mem.source = DMX_MEMORY_FE;
405 result = dvb->demux.dmx.add_frontend(&dvb->demux.dmx, &dvb->fe_mem);
406 if (result < 0) {
407 printk(KERN_WARNING "%s: add_frontend failed (DMX_MEMORY_FE, errno = %d)\n",
408 dev->name, result);
409 goto fail_fe_mem;
410 }
411
412 result = dvb->demux.dmx.connect_frontend(&dvb->demux.dmx, &dvb->fe_hw);
413 if (result < 0) {
414 printk(KERN_WARNING "%s: connect_frontend failed (errno = %d)\n",
415 dev->name, result);
416 goto fail_fe_conn;
417 }
418
419 /* register network adapter */
420 dvb_net_init(&dvb->adapter, &dvb->net, &dvb->demux.dmx);
421 return 0;
422
423fail_fe_conn:
424 dvb->demux.dmx.remove_frontend(&dvb->demux.dmx, &dvb->fe_mem);
425fail_fe_mem:
426 dvb->demux.dmx.remove_frontend(&dvb->demux.dmx, &dvb->fe_hw);
427fail_fe_hw:
428 dvb_dmxdev_release(&dvb->dmxdev);
429fail_dmxdev:
430 dvb_dmx_release(&dvb->demux);
431fail_dmx:
432 dvb_unregister_frontend(dvb->frontend);
433fail_frontend:
434 dvb_frontend_detach(dvb->frontend);
435 dvb_unregister_adapter(&dvb->adapter);
436fail_adapter:
437 return result;
438}
439
440static void unregister_dvb(struct em28xx_dvb *dvb)
441{
442 dvb_net_release(&dvb->net);
443 dvb->demux.dmx.remove_frontend(&dvb->demux.dmx, &dvb->fe_mem);
444 dvb->demux.dmx.remove_frontend(&dvb->demux.dmx, &dvb->fe_hw);
445 dvb_dmxdev_release(&dvb->dmxdev);
446 dvb_dmx_release(&dvb->demux);
447 dvb_unregister_frontend(dvb->frontend);
448 dvb_frontend_detach(dvb->frontend);
449 dvb_unregister_adapter(&dvb->adapter);
450}
451
452
453static int dvb_init(struct em28xx *dev)
454{
455 int result = 0;
456 struct em28xx_dvb *dvb;
457
505b6d0b 458 if (!dev->board.has_dvb) {
df619181
DH
459 /* This device does not support the extension */
460 return 0;
461 }
462
3421b778 463 dvb = kzalloc(sizeof(struct em28xx_dvb), GFP_KERNEL);
6ea54d93
DSL
464
465 if (dvb == NULL) {
466 printk(KERN_INFO "em28xx_dvb: memory allocation failed\n");
3421b778
AT
467 return -ENOMEM;
468 }
469 dev->dvb = dvb;
3aefb79a 470
c67ec53f 471 em28xx_set_mode(dev, EM28XX_DIGITAL_MODE);
3aefb79a
MCC
472 /* init frontend */
473 switch (dev->model) {
f89bc329 474 case EM2883_BOARD_HAUPPAUGE_WINTV_HVR_850:
10ac6603 475 case EM2883_BOARD_HAUPPAUGE_WINTV_HVR_950:
4fd305b2 476 case EM2880_BOARD_PINNACLE_PCTV_HD_PRO:
e14b3658 477 case EM2880_BOARD_AMD_ATI_TV_WONDER_HD_600:
3421b778
AT
478 dvb->frontend = dvb_attach(lgdt330x_attach,
479 &em2880_lgdt3303_dev,
480 &dev->i2c_adap);
481 if (attach_xc3028(0x61, dev) < 0) {
482 result = -EINVAL;
483 goto out_free;
484 }
227ad4ab 485 break;
46510b56 486 case EM2880_BOARD_KWORLD_DVB_310U:
3421b778
AT
487 dvb->frontend = dvb_attach(zl10353_attach,
488 &em28xx_zl10353_with_xc3028,
489 &dev->i2c_adap);
490 if (attach_xc3028(0x61, dev) < 0) {
491 result = -EINVAL;
492 goto out_free;
493 }
7e6388a1 494 break;
a84f79ae 495 case EM2880_BOARD_HAUPPAUGE_WINTV_HVR_900:
01a5fd6f 496 case EM2880_BOARD_EMPIRE_DUAL_TV:
a84f79ae
DH
497 dvb->frontend = dvb_attach(zl10353_attach,
498 &em28xx_zl10353_xc3028_no_i2c_gate,
499 &dev->i2c_adap);
500 if (attach_xc3028(0x61, dev) < 0) {
501 result = -EINVAL;
502 goto out_free;
503 }
504 break;
f797608c 505 case EM2880_BOARD_TERRATEC_HYBRID_XS:
d5b3ba9c 506 case EM2881_BOARD_PINNACLE_HYBRID_PRO:
f797608c 507 dvb->frontend = dvb_attach(zl10353_attach,
a84f79ae 508 &em28xx_zl10353_xc3028_no_i2c_gate,
f797608c
DH
509 &dev->i2c_adap);
510 if (dvb->frontend == NULL) {
511 /* This board could have either a zl10353 or a mt352.
512 If the chip id isn't for zl10353, try mt352 */
4fb202a8
DH
513 dvb->frontend = dvb_attach(mt352_attach,
514 &terratec_xs_mt352_cfg,
515 &dev->i2c_adap);
f797608c 516 }
4fb202a8 517
f797608c
DH
518 if (attach_xc3028(0x61, dev) < 0) {
519 result = -EINVAL;
520 goto out_free;
521 }
522 break;
6e7b9ea0 523 case EM2883_BOARD_KWORLD_HYBRID_330U:
19859229 524 case EM2882_BOARD_EVGA_INDTUBE:
6e7b9ea0
RK
525 dvb->frontend = dvb_attach(s5h1409_attach,
526 &em28xx_s5h1409_with_xc3028,
527 &dev->i2c_adap);
528 if (attach_xc3028(0x61, dev) < 0) {
529 result = -EINVAL;
530 goto out_free;
531 }
532 break;
d7de5d8f
FM
533 case EM2882_BOARD_KWORLD_ATSC_315U:
534 dvb->frontend = dvb_attach(lgdt330x_attach,
535 &em2880_lgdt3303_dev,
536 &dev->i2c_adap);
537 if (dvb->frontend != NULL) {
538 if (!dvb_attach(simple_tuner_attach, dvb->frontend,
539 &dev->i2c_adap, 0x61, TUNER_THOMSON_DTT761X)) {
540 result = -EINVAL;
541 goto out_free;
542 }
543 }
544 break;
17d9d558
DH
545 case EM2880_BOARD_HAUPPAUGE_WINTV_HVR_900_R2:
546#ifdef EM28XX_DRX397XD_SUPPORT
547 /* We don't have the config structure properly populated, so
548 this is commented out for now */
549 dvb->frontend = dvb_attach(drx397xD_attach,
550 &em28xx_drx397xD_with_xc3028,
551 &dev->i2c_adap);
552 if (attach_xc3028(0x61, dev) < 0) {
553 result = -EINVAL;
554 goto out_free;
555 }
556 break;
557#endif
285eb1a4
AP
558 case EM2870_BOARD_REDDO_DVB_C_USB_BOX:
559 /* Philips CU1216L NIM (Philips TDA10023 + Infineon TUA6034) */
560 dvb->frontend = dvb_attach(tda10023_attach,
561 &em28xx_tda10023_config,
562 &dev->i2c_adap, 0x48);
563 if (dvb->frontend) {
564 if (!dvb_attach(simple_tuner_attach, dvb->frontend,
565 &dev->i2c_adap, 0x60, TUNER_PHILIPS_CU1216L)) {
566 result = -EINVAL;
567 goto out_free;
568 }
569 }
570 break;
3aefb79a
MCC
571 default:
572 printk(KERN_ERR "%s/2: The frontend of your DVB/ATSC card"
573 " isn't supported yet\n",
574 dev->name);
575 break;
576 }
3421b778 577 if (NULL == dvb->frontend) {
3aefb79a
MCC
578 printk(KERN_ERR
579 "%s/2: frontend initialization failed\n",
580 dev->name);
3421b778
AT
581 result = -EINVAL;
582 goto out_free;
3aefb79a 583 }
d7cba043
MK
584 /* define general-purpose callback pointer */
585 dvb->frontend->callback = em28xx_tuner_callback;
3aefb79a
MCC
586
587 /* register everything */
3421b778
AT
588 result = register_dvb(dvb, THIS_MODULE, dev, &dev->udev->dev);
589
6ea54d93 590 if (result < 0)
3421b778 591 goto out_free;
3421b778 592
2fe3e2ee 593 em28xx_set_mode(dev, EM28XX_SUSPEND);
102a0b08 594 printk(KERN_INFO "Successfully loaded em28xx-dvb\n");
3421b778
AT
595 return 0;
596
597out_free:
2fe3e2ee 598 em28xx_set_mode(dev, EM28XX_SUSPEND);
3421b778
AT
599 kfree(dvb);
600 dev->dvb = NULL;
601 return result;
3aefb79a
MCC
602}
603
604static int dvb_fini(struct em28xx *dev)
605{
505b6d0b 606 if (!dev->board.has_dvb) {
df619181
DH
607 /* This device does not support the extension */
608 return 0;
609 }
610
3421b778
AT
611 if (dev->dvb) {
612 unregister_dvb(dev->dvb);
613 dev->dvb = NULL;
614 }
3aefb79a
MCC
615
616 return 0;
617}
618
619static struct em28xx_ops dvb_ops = {
620 .id = EM28XX_DVB,
621 .name = "Em28xx dvb Extension",
622 .init = dvb_init,
623 .fini = dvb_fini,
624};
625
626static int __init em28xx_dvb_register(void)
627{
628 return em28xx_register_extension(&dvb_ops);
629}
630
631static void __exit em28xx_dvb_unregister(void)
632{
633 em28xx_unregister_extension(&dvb_ops);
634}
635
636module_init(em28xx_dvb_register);
637module_exit(em28xx_dvb_unregister);