GUI: Fix Tomato RAF theme for all builds. Compilation typo.
[tomato.git] / release / src-rt-6.x.4708 / linux / linux-2.6.36 / drivers / media / dvb / dm1105 / dm1105.c
blobbca07c0bcd01e4b872bd02a364bc760fd38735d5
1 /*
2 * dm1105.c - driver for DVB cards based on SDMC DM1105 PCI chip
4 * Copyright (C) 2008 Igor M. Liplianin <liplianin@me.by>
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; either version 2 of the License, or
9 * (at your option) any later version.
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
16 * You should have received a copy of the GNU General Public License
17 * along with this program; if not, write to the Free Software
18 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
22 #include <linux/i2c.h>
23 #include <linux/init.h>
24 #include <linux/kernel.h>
25 #include <linux/module.h>
26 #include <linux/proc_fs.h>
27 #include <linux/pci.h>
28 #include <linux/dma-mapping.h>
29 #include <linux/input.h>
30 #include <linux/slab.h>
31 #include <media/ir-core.h>
33 #include "demux.h"
34 #include "dmxdev.h"
35 #include "dvb_demux.h"
36 #include "dvb_frontend.h"
37 #include "dvb_net.h"
38 #include "dvbdev.h"
39 #include "dvb-pll.h"
41 #include "stv0299.h"
42 #include "stv0288.h"
43 #include "stb6000.h"
44 #include "si21xx.h"
45 #include "cx24116.h"
46 #include "z0194a.h"
47 #include "ds3000.h"
49 #define MODULE_NAME "dm1105"
51 #define UNSET (-1U)
53 #define DM1105_BOARD_NOAUTO UNSET
54 #define DM1105_BOARD_UNKNOWN 0
55 #define DM1105_BOARD_DVBWORLD_2002 1
56 #define DM1105_BOARD_DVBWORLD_2004 2
57 #define DM1105_BOARD_AXESS_DM05 3
59 /* ----------------------------------------------- */
61 * PCI ID's
63 #ifndef PCI_VENDOR_ID_TRIGEM
64 #define PCI_VENDOR_ID_TRIGEM 0x109f
65 #endif
66 #ifndef PCI_VENDOR_ID_AXESS
67 #define PCI_VENDOR_ID_AXESS 0x195d
68 #endif
69 #ifndef PCI_DEVICE_ID_DM1105
70 #define PCI_DEVICE_ID_DM1105 0x036f
71 #endif
72 #ifndef PCI_DEVICE_ID_DW2002
73 #define PCI_DEVICE_ID_DW2002 0x2002
74 #endif
75 #ifndef PCI_DEVICE_ID_DW2004
76 #define PCI_DEVICE_ID_DW2004 0x2004
77 #endif
78 #ifndef PCI_DEVICE_ID_DM05
79 #define PCI_DEVICE_ID_DM05 0x1105
80 #endif
81 /* ----------------------------------------------- */
82 /* sdmc dm1105 registers */
84 /* TS Control */
85 #define DM1105_TSCTR 0x00
86 #define DM1105_DTALENTH 0x04
88 /* GPIO Interface */
89 #define DM1105_GPIOVAL 0x08
90 #define DM1105_GPIOCTR 0x0c
92 /* PID serial number */
93 #define DM1105_PIDN 0x10
95 /* Odd-even secret key select */
96 #define DM1105_CWSEL 0x14
98 /* Host Command Interface */
99 #define DM1105_HOST_CTR 0x18
100 #define DM1105_HOST_AD 0x1c
102 /* PCI Interface */
103 #define DM1105_CR 0x30
104 #define DM1105_RST 0x34
105 #define DM1105_STADR 0x38
106 #define DM1105_RLEN 0x3c
107 #define DM1105_WRP 0x40
108 #define DM1105_INTCNT 0x44
109 #define DM1105_INTMAK 0x48
110 #define DM1105_INTSTS 0x4c
112 /* CW Value */
113 #define DM1105_ODD 0x50
114 #define DM1105_EVEN 0x58
116 /* PID Value */
117 #define DM1105_PID 0x60
119 /* IR Control */
120 #define DM1105_IRCTR 0x64
121 #define DM1105_IRMODE 0x68
122 #define DM1105_SYSTEMCODE 0x6c
123 #define DM1105_IRCODE 0x70
125 /* Unknown Values */
126 #define DM1105_ENCRYPT 0x74
127 #define DM1105_VER 0x7c
129 /* I2C Interface */
130 #define DM1105_I2CCTR 0x80
131 #define DM1105_I2CSTS 0x81
132 #define DM1105_I2CDAT 0x82
133 #define DM1105_I2C_RA 0x83
134 /* ----------------------------------------------- */
135 /* Interrupt Mask Bits */
137 #define INTMAK_TSIRQM 0x01
138 #define INTMAK_HIRQM 0x04
139 #define INTMAK_IRM 0x08
140 #define INTMAK_ALLMASK (INTMAK_TSIRQM | \
141 INTMAK_HIRQM | \
142 INTMAK_IRM)
143 #define INTMAK_NONEMASK 0x00
145 /* Interrupt Status Bits */
146 #define INTSTS_TSIRQ 0x01
147 #define INTSTS_HIRQ 0x04
148 #define INTSTS_IR 0x08
150 /* IR Control Bits */
151 #define DM1105_IR_EN 0x01
152 #define DM1105_SYS_CHK 0x02
153 #define DM1105_REP_FLG 0x08
155 /* EEPROM addr */
156 #define IIC_24C01_addr 0xa0
157 /* Max board count */
158 #define DM1105_MAX 0x04
160 #define DRIVER_NAME "dm1105"
162 #define DM1105_DMA_PACKETS 47
163 #define DM1105_DMA_PACKET_LENGTH (128*4)
164 #define DM1105_DMA_BYTES (128 * 4 * DM1105_DMA_PACKETS)
166 /* GPIO's for LNB power control */
167 #define DM1105_LNB_MASK 0x00000000
168 #define DM1105_LNB_OFF 0x00020000
169 #define DM1105_LNB_13V 0x00010100
170 #define DM1105_LNB_18V 0x00000100
172 /* GPIO's for LNB power control for Axess DM05 */
173 #define DM05_LNB_MASK 0x00000000
174 #define DM05_LNB_OFF 0x00020000/* actually 13v */
175 #define DM05_LNB_13V 0x00020000
176 #define DM05_LNB_18V 0x00030000
178 static unsigned int card[] = {[0 ... 3] = UNSET };
179 module_param_array(card, int, NULL, 0444);
180 MODULE_PARM_DESC(card, "card type");
182 static int ir_debug;
183 module_param(ir_debug, int, 0644);
184 MODULE_PARM_DESC(ir_debug, "enable debugging information for IR decoding");
186 static unsigned int dm1105_devcount;
188 DVB_DEFINE_MOD_OPT_ADAPTER_NR(adapter_nr);
190 struct dm1105_board {
191 char *name;
194 struct dm1105_subid {
195 u16 subvendor;
196 u16 subdevice;
197 u32 card;
200 static const struct dm1105_board dm1105_boards[] = {
201 [DM1105_BOARD_UNKNOWN] = {
202 .name = "UNKNOWN/GENERIC",
204 [DM1105_BOARD_DVBWORLD_2002] = {
205 .name = "DVBWorld PCI 2002",
207 [DM1105_BOARD_DVBWORLD_2004] = {
208 .name = "DVBWorld PCI 2004",
210 [DM1105_BOARD_AXESS_DM05] = {
211 .name = "Axess/EasyTv DM05",
215 static const struct dm1105_subid dm1105_subids[] = {
217 .subvendor = 0x0000,
218 .subdevice = 0x2002,
219 .card = DM1105_BOARD_DVBWORLD_2002,
220 }, {
221 .subvendor = 0x0001,
222 .subdevice = 0x2002,
223 .card = DM1105_BOARD_DVBWORLD_2002,
224 }, {
225 .subvendor = 0x0000,
226 .subdevice = 0x2004,
227 .card = DM1105_BOARD_DVBWORLD_2004,
228 }, {
229 .subvendor = 0x0001,
230 .subdevice = 0x2004,
231 .card = DM1105_BOARD_DVBWORLD_2004,
232 }, {
233 .subvendor = 0x195d,
234 .subdevice = 0x1105,
235 .card = DM1105_BOARD_AXESS_DM05,
239 static void dm1105_card_list(struct pci_dev *pci)
241 int i;
243 if (0 == pci->subsystem_vendor &&
244 0 == pci->subsystem_device) {
245 printk(KERN_ERR
246 "dm1105: Your board has no valid PCI Subsystem ID\n"
247 "dm1105: and thus can't be autodetected\n"
248 "dm1105: Please pass card=<n> insmod option to\n"
249 "dm1105: workaround that. Redirect complaints to\n"
250 "dm1105: the vendor of the TV card. Best regards,\n"
251 "dm1105: -- tux\n");
252 } else {
253 printk(KERN_ERR
254 "dm1105: Your board isn't known (yet) to the driver.\n"
255 "dm1105: You can try to pick one of the existing\n"
256 "dm1105: card configs via card=<n> insmod option.\n"
257 "dm1105: Updating to the latest version might help\n"
258 "dm1105: as well.\n");
260 printk(KERN_ERR "Here is a list of valid choices for the card=<n> "
261 "insmod option:\n");
262 for (i = 0; i < ARRAY_SIZE(dm1105_boards); i++)
263 printk(KERN_ERR "dm1105: card=%d -> %s\n",
264 i, dm1105_boards[i].name);
267 /* infrared remote control */
268 struct infrared {
269 struct input_dev *input_dev;
270 char input_phys[32];
271 struct work_struct work;
272 u32 ir_command;
275 struct dm1105_dev {
276 /* pci */
277 struct pci_dev *pdev;
278 u8 __iomem *io_mem;
280 /* ir */
281 struct infrared ir;
283 /* dvb */
284 struct dmx_frontend hw_frontend;
285 struct dmx_frontend mem_frontend;
286 struct dmxdev dmxdev;
287 struct dvb_adapter dvb_adapter;
288 struct dvb_demux demux;
289 struct dvb_frontend *fe;
290 struct dvb_net dvbnet;
291 unsigned int full_ts_users;
292 unsigned int boardnr;
293 int nr;
295 /* i2c */
296 struct i2c_adapter i2c_adap;
298 /* irq */
299 struct work_struct work;
300 struct workqueue_struct *wq;
301 char wqn[16];
303 /* dma */
304 dma_addr_t dma_addr;
305 unsigned char *ts_buf;
306 u32 wrp;
307 u32 nextwrp;
308 u32 buffer_size;
309 unsigned int PacketErrorCount;
310 unsigned int dmarst;
311 spinlock_t lock;
314 #define dm_io_mem(reg) ((unsigned long)(&dev->io_mem[reg]))
316 #define dm_readb(reg) inb(dm_io_mem(reg))
317 #define dm_writeb(reg, value) outb((value), (dm_io_mem(reg)))
319 #define dm_readw(reg) inw(dm_io_mem(reg))
320 #define dm_writew(reg, value) outw((value), (dm_io_mem(reg)))
322 #define dm_readl(reg) inl(dm_io_mem(reg))
323 #define dm_writel(reg, value) outl((value), (dm_io_mem(reg)))
325 #define dm_andorl(reg, mask, value) \
326 outl((inl(dm_io_mem(reg)) & ~(mask)) |\
327 ((value) & (mask)), (dm_io_mem(reg)))
329 #define dm_setl(reg, bit) dm_andorl((reg), (bit), (bit))
330 #define dm_clearl(reg, bit) dm_andorl((reg), (bit), 0)
332 static int dm1105_i2c_xfer(struct i2c_adapter *i2c_adap,
333 struct i2c_msg *msgs, int num)
335 struct dm1105_dev *dev ;
337 int addr, rc, i, j, k, len, byte, data;
338 u8 status;
340 dev = i2c_adap->algo_data;
341 for (i = 0; i < num; i++) {
342 dm_writeb(DM1105_I2CCTR, 0x00);
343 if (msgs[i].flags & I2C_M_RD) {
344 /* read bytes */
345 addr = msgs[i].addr << 1;
346 addr |= 1;
347 dm_writeb(DM1105_I2CDAT, addr);
348 for (byte = 0; byte < msgs[i].len; byte++)
349 dm_writeb(DM1105_I2CDAT + byte + 1, 0);
351 dm_writeb(DM1105_I2CCTR, 0x81 + msgs[i].len);
352 for (j = 0; j < 55; j++) {
353 mdelay(10);
354 status = dm_readb(DM1105_I2CSTS);
355 if ((status & 0xc0) == 0x40)
356 break;
358 if (j >= 55)
359 return -1;
361 for (byte = 0; byte < msgs[i].len; byte++) {
362 rc = dm_readb(DM1105_I2CDAT + byte + 1);
363 if (rc < 0)
364 goto err;
365 msgs[i].buf[byte] = rc;
367 } else if ((msgs[i].buf[0] == 0xf7) && (msgs[i].addr == 0x55)) {
368 /* prepaired for cx24116 firmware */
369 /* Write in small blocks */
370 len = msgs[i].len - 1;
371 k = 1;
372 do {
373 dm_writeb(DM1105_I2CDAT, msgs[i].addr << 1);
374 dm_writeb(DM1105_I2CDAT + 1, 0xf7);
375 for (byte = 0; byte < (len > 48 ? 48 : len); byte++) {
376 data = msgs[i].buf[k + byte];
377 dm_writeb(DM1105_I2CDAT + byte + 2, data);
379 dm_writeb(DM1105_I2CCTR, 0x82 + (len > 48 ? 48 : len));
380 for (j = 0; j < 25; j++) {
381 mdelay(10);
382 status = dm_readb(DM1105_I2CSTS);
383 if ((status & 0xc0) == 0x40)
384 break;
387 if (j >= 25)
388 return -1;
390 k += 48;
391 len -= 48;
392 } while (len > 0);
393 } else {
394 /* write bytes */
395 dm_writeb(DM1105_I2CDAT, msgs[i].addr << 1);
396 for (byte = 0; byte < msgs[i].len; byte++) {
397 data = msgs[i].buf[byte];
398 dm_writeb(DM1105_I2CDAT + byte + 1, data);
400 dm_writeb(DM1105_I2CCTR, 0x81 + msgs[i].len);
401 for (j = 0; j < 25; j++) {
402 mdelay(10);
403 status = dm_readb(DM1105_I2CSTS);
404 if ((status & 0xc0) == 0x40)
405 break;
408 if (j >= 25)
409 return -1;
412 return num;
413 err:
414 return rc;
417 static u32 functionality(struct i2c_adapter *adap)
419 return I2C_FUNC_I2C;
422 static struct i2c_algorithm dm1105_algo = {
423 .master_xfer = dm1105_i2c_xfer,
424 .functionality = functionality,
427 static inline struct dm1105_dev *feed_to_dm1105_dev(struct dvb_demux_feed *feed)
429 return container_of(feed->demux, struct dm1105_dev, demux);
432 static inline struct dm1105_dev *frontend_to_dm1105_dev(struct dvb_frontend *fe)
434 return container_of(fe->dvb, struct dm1105_dev, dvb_adapter);
437 static int dm1105_set_voltage(struct dvb_frontend *fe, fe_sec_voltage_t voltage)
439 struct dm1105_dev *dev = frontend_to_dm1105_dev(fe);
440 u32 lnb_mask, lnb_13v, lnb_18v, lnb_off;
442 switch (dev->boardnr) {
443 case DM1105_BOARD_AXESS_DM05:
444 lnb_mask = DM05_LNB_MASK;
445 lnb_off = DM05_LNB_OFF;
446 lnb_13v = DM05_LNB_13V;
447 lnb_18v = DM05_LNB_18V;
448 break;
449 case DM1105_BOARD_DVBWORLD_2002:
450 case DM1105_BOARD_DVBWORLD_2004:
451 default:
452 lnb_mask = DM1105_LNB_MASK;
453 lnb_off = DM1105_LNB_OFF;
454 lnb_13v = DM1105_LNB_13V;
455 lnb_18v = DM1105_LNB_18V;
458 dm_writel(DM1105_GPIOCTR, lnb_mask);
459 if (voltage == SEC_VOLTAGE_18)
460 dm_writel(DM1105_GPIOVAL, lnb_18v);
461 else if (voltage == SEC_VOLTAGE_13)
462 dm_writel(DM1105_GPIOVAL, lnb_13v);
463 else
464 dm_writel(DM1105_GPIOVAL, lnb_off);
466 return 0;
469 static void dm1105_set_dma_addr(struct dm1105_dev *dev)
471 dm_writel(DM1105_STADR, cpu_to_le32(dev->dma_addr));
474 static int __devinit dm1105_dma_map(struct dm1105_dev *dev)
476 dev->ts_buf = pci_alloc_consistent(dev->pdev,
477 6 * DM1105_DMA_BYTES,
478 &dev->dma_addr);
480 return !dev->ts_buf;
483 static void dm1105_dma_unmap(struct dm1105_dev *dev)
485 pci_free_consistent(dev->pdev,
486 6 * DM1105_DMA_BYTES,
487 dev->ts_buf,
488 dev->dma_addr);
491 static void dm1105_enable_irqs(struct dm1105_dev *dev)
493 dm_writeb(DM1105_INTMAK, INTMAK_ALLMASK);
494 dm_writeb(DM1105_CR, 1);
497 static void dm1105_disable_irqs(struct dm1105_dev *dev)
499 dm_writeb(DM1105_INTMAK, INTMAK_IRM);
500 dm_writeb(DM1105_CR, 0);
503 static int dm1105_start_feed(struct dvb_demux_feed *f)
505 struct dm1105_dev *dev = feed_to_dm1105_dev(f);
507 if (dev->full_ts_users++ == 0)
508 dm1105_enable_irqs(dev);
510 return 0;
513 static int dm1105_stop_feed(struct dvb_demux_feed *f)
515 struct dm1105_dev *dev = feed_to_dm1105_dev(f);
517 if (--dev->full_ts_users == 0)
518 dm1105_disable_irqs(dev);
520 return 0;
523 /* ir work handler */
524 static void dm1105_emit_key(struct work_struct *work)
526 struct infrared *ir = container_of(work, struct infrared, work);
527 u32 ircom = ir->ir_command;
528 u8 data;
530 if (ir_debug)
531 printk(KERN_INFO "%s: received byte 0x%04x\n", __func__, ircom);
533 data = (ircom >> 8) & 0x7f;
535 ir_keydown(ir->input_dev, data, 0);
538 /* work handler */
539 static void dm1105_dmx_buffer(struct work_struct *work)
541 struct dm1105_dev *dev = container_of(work, struct dm1105_dev, work);
542 unsigned int nbpackets;
543 u32 oldwrp = dev->wrp;
544 u32 nextwrp = dev->nextwrp;
546 if (!((dev->ts_buf[oldwrp] == 0x47) &&
547 (dev->ts_buf[oldwrp + 188] == 0x47) &&
548 (dev->ts_buf[oldwrp + 188 * 2] == 0x47))) {
549 dev->PacketErrorCount++;
550 /* bad packet found */
551 if ((dev->PacketErrorCount >= 2) &&
552 (dev->dmarst == 0)) {
553 dm_writeb(DM1105_RST, 1);
554 dev->wrp = 0;
555 dev->PacketErrorCount = 0;
556 dev->dmarst = 0;
557 return;
561 if (nextwrp < oldwrp) {
562 memcpy(dev->ts_buf + dev->buffer_size, dev->ts_buf, nextwrp);
563 nbpackets = ((dev->buffer_size - oldwrp) + nextwrp) / 188;
564 } else
565 nbpackets = (nextwrp - oldwrp) / 188;
567 dev->wrp = nextwrp;
568 dvb_dmx_swfilter_packets(&dev->demux, &dev->ts_buf[oldwrp], nbpackets);
571 static irqreturn_t dm1105_irq(int irq, void *dev_id)
573 struct dm1105_dev *dev = dev_id;
575 /* Read-Write INSTS Ack's Interrupt for DM1105 chip 16.03.2008 */
576 unsigned int intsts = dm_readb(DM1105_INTSTS);
577 dm_writeb(DM1105_INTSTS, intsts);
579 switch (intsts) {
580 case INTSTS_TSIRQ:
581 case (INTSTS_TSIRQ | INTSTS_IR):
582 dev->nextwrp = dm_readl(DM1105_WRP) - dm_readl(DM1105_STADR);
583 queue_work(dev->wq, &dev->work);
584 break;
585 case INTSTS_IR:
586 dev->ir.ir_command = dm_readl(DM1105_IRCODE);
587 schedule_work(&dev->ir.work);
588 break;
591 return IRQ_HANDLED;
594 int __devinit dm1105_ir_init(struct dm1105_dev *dm1105)
596 struct input_dev *input_dev;
597 char *ir_codes = RC_MAP_DM1105_NEC;
598 int err = -ENOMEM;
600 input_dev = input_allocate_device();
601 if (!input_dev)
602 return -ENOMEM;
604 dm1105->ir.input_dev = input_dev;
605 snprintf(dm1105->ir.input_phys, sizeof(dm1105->ir.input_phys),
606 "pci-%s/ir0", pci_name(dm1105->pdev));
608 input_dev->name = "DVB on-card IR receiver";
609 input_dev->phys = dm1105->ir.input_phys;
610 input_dev->id.bustype = BUS_PCI;
611 input_dev->id.version = 1;
612 if (dm1105->pdev->subsystem_vendor) {
613 input_dev->id.vendor = dm1105->pdev->subsystem_vendor;
614 input_dev->id.product = dm1105->pdev->subsystem_device;
615 } else {
616 input_dev->id.vendor = dm1105->pdev->vendor;
617 input_dev->id.product = dm1105->pdev->device;
620 input_dev->dev.parent = &dm1105->pdev->dev;
622 INIT_WORK(&dm1105->ir.work, dm1105_emit_key);
624 err = ir_input_register(input_dev, ir_codes, NULL, MODULE_NAME);
625 if (err < 0) {
626 input_free_device(input_dev);
627 return err;
630 return 0;
633 void __devexit dm1105_ir_exit(struct dm1105_dev *dm1105)
635 ir_input_unregister(dm1105->ir.input_dev);
638 static int __devinit dm1105_hw_init(struct dm1105_dev *dev)
640 dm1105_disable_irqs(dev);
642 dm_writeb(DM1105_HOST_CTR, 0);
644 /*DATALEN 188,*/
645 dm_writeb(DM1105_DTALENTH, 188);
646 /*TS_STRT TS_VALP MSBFIRST TS_MODE ALPAS TSPES*/
647 dm_writew(DM1105_TSCTR, 0xc10a);
649 /* map DMA and set address */
650 dm1105_dma_map(dev);
651 dm1105_set_dma_addr(dev);
652 /* big buffer */
653 dm_writel(DM1105_RLEN, 5 * DM1105_DMA_BYTES);
654 dm_writeb(DM1105_INTCNT, 47);
656 /* IR NEC mode enable */
657 dm_writeb(DM1105_IRCTR, (DM1105_IR_EN | DM1105_SYS_CHK));
658 dm_writeb(DM1105_IRMODE, 0);
659 dm_writew(DM1105_SYSTEMCODE, 0);
661 return 0;
664 static void dm1105_hw_exit(struct dm1105_dev *dev)
666 dm1105_disable_irqs(dev);
668 /* IR disable */
669 dm_writeb(DM1105_IRCTR, 0);
670 dm_writeb(DM1105_INTMAK, INTMAK_NONEMASK);
672 dm1105_dma_unmap(dev);
675 static struct stv0299_config sharp_z0194a_config = {
676 .demod_address = 0x68,
677 .inittab = sharp_z0194a_inittab,
678 .mclk = 88000000UL,
679 .invert = 1,
680 .skip_reinit = 0,
681 .lock_output = STV0299_LOCKOUTPUT_1,
682 .volt13_op0_op1 = STV0299_VOLT13_OP1,
683 .min_delay_ms = 100,
684 .set_symbol_rate = sharp_z0194a_set_symbol_rate,
687 static struct stv0288_config earda_config = {
688 .demod_address = 0x68,
689 .min_delay_ms = 100,
692 static struct si21xx_config serit_config = {
693 .demod_address = 0x68,
694 .min_delay_ms = 100,
698 static struct cx24116_config serit_sp2633_config = {
699 .demod_address = 0x55,
702 static struct ds3000_config dvbworld_ds3000_config = {
703 .demod_address = 0x68,
706 static int __devinit frontend_init(struct dm1105_dev *dev)
708 int ret;
710 switch (dev->boardnr) {
711 case DM1105_BOARD_DVBWORLD_2004:
712 dev->fe = dvb_attach(
713 cx24116_attach, &serit_sp2633_config,
714 &dev->i2c_adap);
715 if (dev->fe) {
716 dev->fe->ops.set_voltage = dm1105_set_voltage;
717 break;
720 dev->fe = dvb_attach(
721 ds3000_attach, &dvbworld_ds3000_config,
722 &dev->i2c_adap);
723 if (dev->fe)
724 dev->fe->ops.set_voltage = dm1105_set_voltage;
726 break;
727 case DM1105_BOARD_DVBWORLD_2002:
728 case DM1105_BOARD_AXESS_DM05:
729 default:
730 dev->fe = dvb_attach(
731 stv0299_attach, &sharp_z0194a_config,
732 &dev->i2c_adap);
733 if (dev->fe) {
734 dev->fe->ops.set_voltage = dm1105_set_voltage;
735 dvb_attach(dvb_pll_attach, dev->fe, 0x60,
736 &dev->i2c_adap, DVB_PLL_OPERA1);
737 break;
740 dev->fe = dvb_attach(
741 stv0288_attach, &earda_config,
742 &dev->i2c_adap);
743 if (dev->fe) {
744 dev->fe->ops.set_voltage = dm1105_set_voltage;
745 dvb_attach(stb6000_attach, dev->fe, 0x61,
746 &dev->i2c_adap);
747 break;
750 dev->fe = dvb_attach(
751 si21xx_attach, &serit_config,
752 &dev->i2c_adap);
753 if (dev->fe)
754 dev->fe->ops.set_voltage = dm1105_set_voltage;
758 if (!dev->fe) {
759 dev_err(&dev->pdev->dev, "could not attach frontend\n");
760 return -ENODEV;
763 ret = dvb_register_frontend(&dev->dvb_adapter, dev->fe);
764 if (ret < 0) {
765 if (dev->fe->ops.release)
766 dev->fe->ops.release(dev->fe);
767 dev->fe = NULL;
768 return ret;
771 return 0;
774 static void __devinit dm1105_read_mac(struct dm1105_dev *dev, u8 *mac)
776 static u8 command[1] = { 0x28 };
778 struct i2c_msg msg[] = {
780 .addr = IIC_24C01_addr >> 1,
781 .flags = 0,
782 .buf = command,
783 .len = 1
784 }, {
785 .addr = IIC_24C01_addr >> 1,
786 .flags = I2C_M_RD,
787 .buf = mac,
788 .len = 6
792 dm1105_i2c_xfer(&dev->i2c_adap, msg , 2);
793 dev_info(&dev->pdev->dev, "MAC %pM\n", mac);
796 static int __devinit dm1105_probe(struct pci_dev *pdev,
797 const struct pci_device_id *ent)
799 struct dm1105_dev *dev;
800 struct dvb_adapter *dvb_adapter;
801 struct dvb_demux *dvbdemux;
802 struct dmx_demux *dmx;
803 int ret = -ENOMEM;
804 int i;
806 dev = kzalloc(sizeof(struct dm1105_dev), GFP_KERNEL);
807 if (!dev)
808 return -ENOMEM;
810 /* board config */
811 dev->nr = dm1105_devcount;
812 dev->boardnr = UNSET;
813 if (card[dev->nr] < ARRAY_SIZE(dm1105_boards))
814 dev->boardnr = card[dev->nr];
815 for (i = 0; UNSET == dev->boardnr &&
816 i < ARRAY_SIZE(dm1105_subids); i++)
817 if (pdev->subsystem_vendor ==
818 dm1105_subids[i].subvendor &&
819 pdev->subsystem_device ==
820 dm1105_subids[i].subdevice)
821 dev->boardnr = dm1105_subids[i].card;
823 if (UNSET == dev->boardnr) {
824 dev->boardnr = DM1105_BOARD_UNKNOWN;
825 dm1105_card_list(pdev);
828 dm1105_devcount++;
829 dev->pdev = pdev;
830 dev->buffer_size = 5 * DM1105_DMA_BYTES;
831 dev->PacketErrorCount = 0;
832 dev->dmarst = 0;
834 ret = pci_enable_device(pdev);
835 if (ret < 0)
836 goto err_kfree;
838 ret = pci_set_dma_mask(pdev, DMA_BIT_MASK(32));
839 if (ret < 0)
840 goto err_pci_disable_device;
842 pci_set_master(pdev);
844 ret = pci_request_regions(pdev, DRIVER_NAME);
845 if (ret < 0)
846 goto err_pci_disable_device;
848 dev->io_mem = pci_iomap(pdev, 0, pci_resource_len(pdev, 0));
849 if (!dev->io_mem) {
850 ret = -EIO;
851 goto err_pci_release_regions;
854 spin_lock_init(&dev->lock);
855 pci_set_drvdata(pdev, dev);
857 ret = dm1105_hw_init(dev);
858 if (ret < 0)
859 goto err_pci_iounmap;
861 /* i2c */
862 i2c_set_adapdata(&dev->i2c_adap, dev);
863 strcpy(dev->i2c_adap.name, DRIVER_NAME);
864 dev->i2c_adap.owner = THIS_MODULE;
865 dev->i2c_adap.class = I2C_CLASS_TV_DIGITAL;
866 dev->i2c_adap.dev.parent = &pdev->dev;
867 dev->i2c_adap.algo = &dm1105_algo;
868 dev->i2c_adap.algo_data = dev;
869 ret = i2c_add_adapter(&dev->i2c_adap);
871 if (ret < 0)
872 goto err_dm1105_hw_exit;
874 /* dvb */
875 ret = dvb_register_adapter(&dev->dvb_adapter, DRIVER_NAME,
876 THIS_MODULE, &pdev->dev, adapter_nr);
877 if (ret < 0)
878 goto err_i2c_del_adapter;
880 dvb_adapter = &dev->dvb_adapter;
882 dm1105_read_mac(dev, dvb_adapter->proposed_mac);
884 dvbdemux = &dev->demux;
885 dvbdemux->filternum = 256;
886 dvbdemux->feednum = 256;
887 dvbdemux->start_feed = dm1105_start_feed;
888 dvbdemux->stop_feed = dm1105_stop_feed;
889 dvbdemux->dmx.capabilities = (DMX_TS_FILTERING |
890 DMX_SECTION_FILTERING | DMX_MEMORY_BASED_FILTERING);
891 ret = dvb_dmx_init(dvbdemux);
892 if (ret < 0)
893 goto err_dvb_unregister_adapter;
895 dmx = &dvbdemux->dmx;
896 dev->dmxdev.filternum = 256;
897 dev->dmxdev.demux = dmx;
898 dev->dmxdev.capabilities = 0;
900 ret = dvb_dmxdev_init(&dev->dmxdev, dvb_adapter);
901 if (ret < 0)
902 goto err_dvb_dmx_release;
904 dev->hw_frontend.source = DMX_FRONTEND_0;
906 ret = dmx->add_frontend(dmx, &dev->hw_frontend);
907 if (ret < 0)
908 goto err_dvb_dmxdev_release;
910 dev->mem_frontend.source = DMX_MEMORY_FE;
912 ret = dmx->add_frontend(dmx, &dev->mem_frontend);
913 if (ret < 0)
914 goto err_remove_hw_frontend;
916 ret = dmx->connect_frontend(dmx, &dev->hw_frontend);
917 if (ret < 0)
918 goto err_remove_mem_frontend;
920 ret = frontend_init(dev);
921 if (ret < 0)
922 goto err_disconnect_frontend;
924 dvb_net_init(dvb_adapter, &dev->dvbnet, dmx);
925 dm1105_ir_init(dev);
927 INIT_WORK(&dev->work, dm1105_dmx_buffer);
928 sprintf(dev->wqn, "%s/%d", dvb_adapter->name, dvb_adapter->num);
929 dev->wq = create_singlethread_workqueue(dev->wqn);
930 if (!dev->wq)
931 goto err_dvb_net;
933 ret = request_irq(pdev->irq, dm1105_irq, IRQF_SHARED,
934 DRIVER_NAME, dev);
935 if (ret < 0)
936 goto err_workqueue;
938 return 0;
940 err_workqueue:
941 destroy_workqueue(dev->wq);
942 err_dvb_net:
943 dvb_net_release(&dev->dvbnet);
944 err_disconnect_frontend:
945 dmx->disconnect_frontend(dmx);
946 err_remove_mem_frontend:
947 dmx->remove_frontend(dmx, &dev->mem_frontend);
948 err_remove_hw_frontend:
949 dmx->remove_frontend(dmx, &dev->hw_frontend);
950 err_dvb_dmxdev_release:
951 dvb_dmxdev_release(&dev->dmxdev);
952 err_dvb_dmx_release:
953 dvb_dmx_release(dvbdemux);
954 err_dvb_unregister_adapter:
955 dvb_unregister_adapter(dvb_adapter);
956 err_i2c_del_adapter:
957 i2c_del_adapter(&dev->i2c_adap);
958 err_dm1105_hw_exit:
959 dm1105_hw_exit(dev);
960 err_pci_iounmap:
961 pci_iounmap(pdev, dev->io_mem);
962 err_pci_release_regions:
963 pci_release_regions(pdev);
964 err_pci_disable_device:
965 pci_disable_device(pdev);
966 err_kfree:
967 pci_set_drvdata(pdev, NULL);
968 kfree(dev);
969 return ret;
972 static void __devexit dm1105_remove(struct pci_dev *pdev)
974 struct dm1105_dev *dev = pci_get_drvdata(pdev);
975 struct dvb_adapter *dvb_adapter = &dev->dvb_adapter;
976 struct dvb_demux *dvbdemux = &dev->demux;
977 struct dmx_demux *dmx = &dvbdemux->dmx;
979 dm1105_ir_exit(dev);
980 dmx->close(dmx);
981 dvb_net_release(&dev->dvbnet);
982 if (dev->fe)
983 dvb_unregister_frontend(dev->fe);
985 dmx->disconnect_frontend(dmx);
986 dmx->remove_frontend(dmx, &dev->mem_frontend);
987 dmx->remove_frontend(dmx, &dev->hw_frontend);
988 dvb_dmxdev_release(&dev->dmxdev);
989 dvb_dmx_release(dvbdemux);
990 dvb_unregister_adapter(dvb_adapter);
991 if (&dev->i2c_adap)
992 i2c_del_adapter(&dev->i2c_adap);
994 dm1105_hw_exit(dev);
995 synchronize_irq(pdev->irq);
996 free_irq(pdev->irq, dev);
997 pci_iounmap(pdev, dev->io_mem);
998 pci_release_regions(pdev);
999 pci_disable_device(pdev);
1000 pci_set_drvdata(pdev, NULL);
1001 dm1105_devcount--;
1002 kfree(dev);
1005 static struct pci_device_id dm1105_id_table[] __devinitdata = {
1007 .vendor = PCI_VENDOR_ID_TRIGEM,
1008 .device = PCI_DEVICE_ID_DM1105,
1009 .subvendor = PCI_ANY_ID,
1010 .subdevice = PCI_ANY_ID,
1011 }, {
1012 .vendor = PCI_VENDOR_ID_AXESS,
1013 .device = PCI_DEVICE_ID_DM05,
1014 .subvendor = PCI_ANY_ID,
1015 .subdevice = PCI_ANY_ID,
1016 }, {
1017 /* empty */
1021 MODULE_DEVICE_TABLE(pci, dm1105_id_table);
1023 static struct pci_driver dm1105_driver = {
1024 .name = DRIVER_NAME,
1025 .id_table = dm1105_id_table,
1026 .probe = dm1105_probe,
1027 .remove = __devexit_p(dm1105_remove),
1030 static int __init dm1105_init(void)
1032 return pci_register_driver(&dm1105_driver);
1035 static void __exit dm1105_exit(void)
1037 pci_unregister_driver(&dm1105_driver);
1040 module_init(dm1105_init);
1041 module_exit(dm1105_exit);
1043 MODULE_AUTHOR("Igor M. Liplianin <liplianin@me.by>");
1044 MODULE_DESCRIPTION("SDMC DM1105 DVB driver");
1045 MODULE_LICENSE("GPL");