1241 lines
29 KiB
C
1241 lines
29 KiB
C
|
/*
|
||
|
* dm1105.c - driver for DVB cards based on SDMC DM1105 PCI chip
|
||
|
*
|
||
|
* Copyright (C) 2008 Igor M. Liplianin <liplianin@me.by>
|
||
|
*
|
||
|
* This program is free software; you can redistribute it and/or modify
|
||
|
* it under the terms of the GNU General Public License as published by
|
||
|
* the Free Software Foundation; either version 2 of the License, or
|
||
|
* (at your option) any later version.
|
||
|
*
|
||
|
* This program is distributed in the hope that it will be useful,
|
||
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||
|
* GNU General Public License for more details.
|
||
|
*
|
||
|
*/
|
||
|
|
||
|
#include <linux/i2c.h>
|
||
|
#include <linux/i2c-algo-bit.h>
|
||
|
#include <linux/init.h>
|
||
|
#include <linux/interrupt.h>
|
||
|
#include <linux/kernel.h>
|
||
|
#include <linux/module.h>
|
||
|
#include <linux/proc_fs.h>
|
||
|
#include <linux/pci.h>
|
||
|
#include <linux/dma-mapping.h>
|
||
|
#include <linux/slab.h>
|
||
|
#include <media/rc-core.h>
|
||
|
|
||
|
#include "demux.h"
|
||
|
#include "dmxdev.h"
|
||
|
#include "dvb_demux.h"
|
||
|
#include "dvb_frontend.h"
|
||
|
#include "dvb_net.h"
|
||
|
#include "dvbdev.h"
|
||
|
#include "dvb-pll.h"
|
||
|
|
||
|
#include "stv0299.h"
|
||
|
#include "stv0288.h"
|
||
|
#include "stb6000.h"
|
||
|
#include "si21xx.h"
|
||
|
#include "cx24116.h"
|
||
|
#include "z0194a.h"
|
||
|
#include "ts2020.h"
|
||
|
#include "ds3000.h"
|
||
|
|
||
|
#define MODULE_NAME "dm1105"
|
||
|
|
||
|
#define UNSET (-1U)
|
||
|
|
||
|
#define DM1105_BOARD_NOAUTO UNSET
|
||
|
#define DM1105_BOARD_UNKNOWN 0
|
||
|
#define DM1105_BOARD_DVBWORLD_2002 1
|
||
|
#define DM1105_BOARD_DVBWORLD_2004 2
|
||
|
#define DM1105_BOARD_AXESS_DM05 3
|
||
|
#define DM1105_BOARD_UNBRANDED_I2C_ON_GPIO 4
|
||
|
|
||
|
/* ----------------------------------------------- */
|
||
|
/*
|
||
|
* PCI ID's
|
||
|
*/
|
||
|
#ifndef PCI_VENDOR_ID_TRIGEM
|
||
|
#define PCI_VENDOR_ID_TRIGEM 0x109f
|
||
|
#endif
|
||
|
#ifndef PCI_VENDOR_ID_AXESS
|
||
|
#define PCI_VENDOR_ID_AXESS 0x195d
|
||
|
#endif
|
||
|
#ifndef PCI_DEVICE_ID_DM1105
|
||
|
#define PCI_DEVICE_ID_DM1105 0x036f
|
||
|
#endif
|
||
|
#ifndef PCI_DEVICE_ID_DW2002
|
||
|
#define PCI_DEVICE_ID_DW2002 0x2002
|
||
|
#endif
|
||
|
#ifndef PCI_DEVICE_ID_DW2004
|
||
|
#define PCI_DEVICE_ID_DW2004 0x2004
|
||
|
#endif
|
||
|
#ifndef PCI_DEVICE_ID_DM05
|
||
|
#define PCI_DEVICE_ID_DM05 0x1105
|
||
|
#endif
|
||
|
/* ----------------------------------------------- */
|
||
|
/* sdmc dm1105 registers */
|
||
|
|
||
|
/* TS Control */
|
||
|
#define DM1105_TSCTR 0x00
|
||
|
#define DM1105_DTALENTH 0x04
|
||
|
|
||
|
/* GPIO Interface */
|
||
|
#define DM1105_GPIOVAL 0x08
|
||
|
#define DM1105_GPIOCTR 0x0c
|
||
|
|
||
|
/* PID serial number */
|
||
|
#define DM1105_PIDN 0x10
|
||
|
|
||
|
/* Odd-even secret key select */
|
||
|
#define DM1105_CWSEL 0x14
|
||
|
|
||
|
/* Host Command Interface */
|
||
|
#define DM1105_HOST_CTR 0x18
|
||
|
#define DM1105_HOST_AD 0x1c
|
||
|
|
||
|
/* PCI Interface */
|
||
|
#define DM1105_CR 0x30
|
||
|
#define DM1105_RST 0x34
|
||
|
#define DM1105_STADR 0x38
|
||
|
#define DM1105_RLEN 0x3c
|
||
|
#define DM1105_WRP 0x40
|
||
|
#define DM1105_INTCNT 0x44
|
||
|
#define DM1105_INTMAK 0x48
|
||
|
#define DM1105_INTSTS 0x4c
|
||
|
|
||
|
/* CW Value */
|
||
|
#define DM1105_ODD 0x50
|
||
|
#define DM1105_EVEN 0x58
|
||
|
|
||
|
/* PID Value */
|
||
|
#define DM1105_PID 0x60
|
||
|
|
||
|
/* IR Control */
|
||
|
#define DM1105_IRCTR 0x64
|
||
|
#define DM1105_IRMODE 0x68
|
||
|
#define DM1105_SYSTEMCODE 0x6c
|
||
|
#define DM1105_IRCODE 0x70
|
||
|
|
||
|
/* Unknown Values */
|
||
|
#define DM1105_ENCRYPT 0x74
|
||
|
#define DM1105_VER 0x7c
|
||
|
|
||
|
/* I2C Interface */
|
||
|
#define DM1105_I2CCTR 0x80
|
||
|
#define DM1105_I2CSTS 0x81
|
||
|
#define DM1105_I2CDAT 0x82
|
||
|
#define DM1105_I2C_RA 0x83
|
||
|
/* ----------------------------------------------- */
|
||
|
/* Interrupt Mask Bits */
|
||
|
|
||
|
#define INTMAK_TSIRQM 0x01
|
||
|
#define INTMAK_HIRQM 0x04
|
||
|
#define INTMAK_IRM 0x08
|
||
|
#define INTMAK_ALLMASK (INTMAK_TSIRQM | \
|
||
|
INTMAK_HIRQM | \
|
||
|
INTMAK_IRM)
|
||
|
#define INTMAK_NONEMASK 0x00
|
||
|
|
||
|
/* Interrupt Status Bits */
|
||
|
#define INTSTS_TSIRQ 0x01
|
||
|
#define INTSTS_HIRQ 0x04
|
||
|
#define INTSTS_IR 0x08
|
||
|
|
||
|
/* IR Control Bits */
|
||
|
#define DM1105_IR_EN 0x01
|
||
|
#define DM1105_SYS_CHK 0x02
|
||
|
#define DM1105_REP_FLG 0x08
|
||
|
|
||
|
/* EEPROM addr */
|
||
|
#define IIC_24C01_addr 0xa0
|
||
|
/* Max board count */
|
||
|
#define DM1105_MAX 0x04
|
||
|
|
||
|
#define DRIVER_NAME "dm1105"
|
||
|
#define DM1105_I2C_GPIO_NAME "dm1105-gpio"
|
||
|
|
||
|
#define DM1105_DMA_PACKETS 47
|
||
|
#define DM1105_DMA_PACKET_LENGTH (128*4)
|
||
|
#define DM1105_DMA_BYTES (128 * 4 * DM1105_DMA_PACKETS)
|
||
|
|
||
|
/* */
|
||
|
#define GPIO08 (1 << 8)
|
||
|
#define GPIO13 (1 << 13)
|
||
|
#define GPIO14 (1 << 14)
|
||
|
#define GPIO15 (1 << 15)
|
||
|
#define GPIO16 (1 << 16)
|
||
|
#define GPIO17 (1 << 17)
|
||
|
#define GPIO_ALL 0x03ffff
|
||
|
|
||
|
/* GPIO's for LNB power control */
|
||
|
#define DM1105_LNB_MASK (GPIO_ALL & ~(GPIO14 | GPIO13))
|
||
|
#define DM1105_LNB_OFF GPIO17
|
||
|
#define DM1105_LNB_13V (GPIO16 | GPIO08)
|
||
|
#define DM1105_LNB_18V GPIO08
|
||
|
|
||
|
/* GPIO's for LNB power control for Axess DM05 */
|
||
|
#define DM05_LNB_MASK (GPIO_ALL & ~(GPIO14 | GPIO13))
|
||
|
#define DM05_LNB_OFF GPIO17/* actually 13v */
|
||
|
#define DM05_LNB_13V GPIO17
|
||
|
#define DM05_LNB_18V (GPIO17 | GPIO16)
|
||
|
|
||
|
/* GPIO's for LNB power control for unbranded with I2C on GPIO */
|
||
|
#define UNBR_LNB_MASK (GPIO17 | GPIO16)
|
||
|
#define UNBR_LNB_OFF 0
|
||
|
#define UNBR_LNB_13V GPIO17
|
||
|
#define UNBR_LNB_18V (GPIO17 | GPIO16)
|
||
|
|
||
|
static unsigned int card[] = {[0 ... 3] = UNSET };
|
||
|
module_param_array(card, int, NULL, 0444);
|
||
|
MODULE_PARM_DESC(card, "card type");
|
||
|
|
||
|
static int ir_debug;
|
||
|
module_param(ir_debug, int, 0644);
|
||
|
MODULE_PARM_DESC(ir_debug, "enable debugging information for IR decoding");
|
||
|
|
||
|
static unsigned int dm1105_devcount;
|
||
|
|
||
|
DVB_DEFINE_MOD_OPT_ADAPTER_NR(adapter_nr);
|
||
|
|
||
|
struct dm1105_board {
|
||
|
char *name;
|
||
|
struct {
|
||
|
u32 mask, off, v13, v18;
|
||
|
} lnb;
|
||
|
u32 gpio_scl, gpio_sda;
|
||
|
};
|
||
|
|
||
|
struct dm1105_subid {
|
||
|
u16 subvendor;
|
||
|
u16 subdevice;
|
||
|
u32 card;
|
||
|
};
|
||
|
|
||
|
static const struct dm1105_board dm1105_boards[] = {
|
||
|
[DM1105_BOARD_UNKNOWN] = {
|
||
|
.name = "UNKNOWN/GENERIC",
|
||
|
.lnb = {
|
||
|
.mask = DM1105_LNB_MASK,
|
||
|
.off = DM1105_LNB_OFF,
|
||
|
.v13 = DM1105_LNB_13V,
|
||
|
.v18 = DM1105_LNB_18V,
|
||
|
},
|
||
|
},
|
||
|
[DM1105_BOARD_DVBWORLD_2002] = {
|
||
|
.name = "DVBWorld PCI 2002",
|
||
|
.lnb = {
|
||
|
.mask = DM1105_LNB_MASK,
|
||
|
.off = DM1105_LNB_OFF,
|
||
|
.v13 = DM1105_LNB_13V,
|
||
|
.v18 = DM1105_LNB_18V,
|
||
|
},
|
||
|
},
|
||
|
[DM1105_BOARD_DVBWORLD_2004] = {
|
||
|
.name = "DVBWorld PCI 2004",
|
||
|
.lnb = {
|
||
|
.mask = DM1105_LNB_MASK,
|
||
|
.off = DM1105_LNB_OFF,
|
||
|
.v13 = DM1105_LNB_13V,
|
||
|
.v18 = DM1105_LNB_18V,
|
||
|
},
|
||
|
},
|
||
|
[DM1105_BOARD_AXESS_DM05] = {
|
||
|
.name = "Axess/EasyTv DM05",
|
||
|
.lnb = {
|
||
|
.mask = DM05_LNB_MASK,
|
||
|
.off = DM05_LNB_OFF,
|
||
|
.v13 = DM05_LNB_13V,
|
||
|
.v18 = DM05_LNB_18V,
|
||
|
},
|
||
|
},
|
||
|
[DM1105_BOARD_UNBRANDED_I2C_ON_GPIO] = {
|
||
|
.name = "Unbranded DM1105 with i2c on GPIOs",
|
||
|
.lnb = {
|
||
|
.mask = UNBR_LNB_MASK,
|
||
|
.off = UNBR_LNB_OFF,
|
||
|
.v13 = UNBR_LNB_13V,
|
||
|
.v18 = UNBR_LNB_18V,
|
||
|
},
|
||
|
.gpio_scl = GPIO14,
|
||
|
.gpio_sda = GPIO13,
|
||
|
},
|
||
|
};
|
||
|
|
||
|
static const struct dm1105_subid dm1105_subids[] = {
|
||
|
{
|
||
|
.subvendor = 0x0000,
|
||
|
.subdevice = 0x2002,
|
||
|
.card = DM1105_BOARD_DVBWORLD_2002,
|
||
|
}, {
|
||
|
.subvendor = 0x0001,
|
||
|
.subdevice = 0x2002,
|
||
|
.card = DM1105_BOARD_DVBWORLD_2002,
|
||
|
}, {
|
||
|
.subvendor = 0x0000,
|
||
|
.subdevice = 0x2004,
|
||
|
.card = DM1105_BOARD_DVBWORLD_2004,
|
||
|
}, {
|
||
|
.subvendor = 0x0001,
|
||
|
.subdevice = 0x2004,
|
||
|
.card = DM1105_BOARD_DVBWORLD_2004,
|
||
|
}, {
|
||
|
.subvendor = 0x195d,
|
||
|
.subdevice = 0x1105,
|
||
|
.card = DM1105_BOARD_AXESS_DM05,
|
||
|
},
|
||
|
};
|
||
|
|
||
|
static void dm1105_card_list(struct pci_dev *pci)
|
||
|
{
|
||
|
int i;
|
||
|
|
||
|
if (0 == pci->subsystem_vendor &&
|
||
|
0 == pci->subsystem_device) {
|
||
|
printk(KERN_ERR
|
||
|
"dm1105: Your board has no valid PCI Subsystem ID\n"
|
||
|
"dm1105: and thus can't be autodetected\n"
|
||
|
"dm1105: Please pass card=<n> insmod option to\n"
|
||
|
"dm1105: workaround that. Redirect complaints to\n"
|
||
|
"dm1105: the vendor of the TV card. Best regards,\n"
|
||
|
"dm1105: -- tux\n");
|
||
|
} else {
|
||
|
printk(KERN_ERR
|
||
|
"dm1105: Your board isn't known (yet) to the driver.\n"
|
||
|
"dm1105: You can try to pick one of the existing\n"
|
||
|
"dm1105: card configs via card=<n> insmod option.\n"
|
||
|
"dm1105: Updating to the latest version might help\n"
|
||
|
"dm1105: as well.\n");
|
||
|
}
|
||
|
printk(KERN_ERR "Here is a list of valid choices for the card=<n> insmod option:\n");
|
||
|
for (i = 0; i < ARRAY_SIZE(dm1105_boards); i++)
|
||
|
printk(KERN_ERR "dm1105: card=%d -> %s\n",
|
||
|
i, dm1105_boards[i].name);
|
||
|
}
|
||
|
|
||
|
/* infrared remote control */
|
||
|
struct infrared {
|
||
|
struct rc_dev *dev;
|
||
|
char input_phys[32];
|
||
|
struct work_struct work;
|
||
|
u32 ir_command;
|
||
|
};
|
||
|
|
||
|
struct dm1105_dev {
|
||
|
/* pci */
|
||
|
struct pci_dev *pdev;
|
||
|
u8 __iomem *io_mem;
|
||
|
|
||
|
/* ir */
|
||
|
struct infrared ir;
|
||
|
|
||
|
/* dvb */
|
||
|
struct dmx_frontend hw_frontend;
|
||
|
struct dmx_frontend mem_frontend;
|
||
|
struct dmxdev dmxdev;
|
||
|
struct dvb_adapter dvb_adapter;
|
||
|
struct dvb_demux demux;
|
||
|
struct dvb_frontend *fe;
|
||
|
struct dvb_net dvbnet;
|
||
|
unsigned int full_ts_users;
|
||
|
unsigned int boardnr;
|
||
|
int nr;
|
||
|
|
||
|
/* i2c */
|
||
|
struct i2c_adapter i2c_adap;
|
||
|
struct i2c_adapter i2c_bb_adap;
|
||
|
struct i2c_algo_bit_data i2c_bit;
|
||
|
|
||
|
/* irq */
|
||
|
struct work_struct work;
|
||
|
struct workqueue_struct *wq;
|
||
|
char wqn[16];
|
||
|
|
||
|
/* dma */
|
||
|
dma_addr_t dma_addr;
|
||
|
unsigned char *ts_buf;
|
||
|
u32 wrp;
|
||
|
u32 nextwrp;
|
||
|
u32 buffer_size;
|
||
|
unsigned int PacketErrorCount;
|
||
|
unsigned int dmarst;
|
||
|
spinlock_t lock;
|
||
|
};
|
||
|
|
||
|
#define dm_io_mem(reg) ((unsigned long)(&dev->io_mem[reg]))
|
||
|
|
||
|
#define dm_readb(reg) inb(dm_io_mem(reg))
|
||
|
#define dm_writeb(reg, value) outb((value), (dm_io_mem(reg)))
|
||
|
|
||
|
#define dm_readw(reg) inw(dm_io_mem(reg))
|
||
|
#define dm_writew(reg, value) outw((value), (dm_io_mem(reg)))
|
||
|
|
||
|
#define dm_readl(reg) inl(dm_io_mem(reg))
|
||
|
#define dm_writel(reg, value) outl((value), (dm_io_mem(reg)))
|
||
|
|
||
|
#define dm_andorl(reg, mask, value) \
|
||
|
outl((inl(dm_io_mem(reg)) & ~(mask)) |\
|
||
|
((value) & (mask)), (dm_io_mem(reg)))
|
||
|
|
||
|
#define dm_setl(reg, bit) dm_andorl((reg), (bit), (bit))
|
||
|
#define dm_clearl(reg, bit) dm_andorl((reg), (bit), 0)
|
||
|
|
||
|
/* The chip has 18 GPIOs. In HOST mode GPIO's used as 15 bit address lines,
|
||
|
so we can use only 3 GPIO's from GPIO15 to GPIO17.
|
||
|
Here I don't check whether HOST is enebled as it is not implemented yet.
|
||
|
*/
|
||
|
static void dm1105_gpio_set(struct dm1105_dev *dev, u32 mask)
|
||
|
{
|
||
|
if (mask & 0xfffc0000)
|
||
|
printk(KERN_ERR "%s: Only 18 GPIO's are allowed\n", __func__);
|
||
|
|
||
|
if (mask & 0x0003ffff)
|
||
|
dm_setl(DM1105_GPIOVAL, mask & 0x0003ffff);
|
||
|
|
||
|
}
|
||
|
|
||
|
static void dm1105_gpio_clear(struct dm1105_dev *dev, u32 mask)
|
||
|
{
|
||
|
if (mask & 0xfffc0000)
|
||
|
printk(KERN_ERR "%s: Only 18 GPIO's are allowed\n", __func__);
|
||
|
|
||
|
if (mask & 0x0003ffff)
|
||
|
dm_clearl(DM1105_GPIOVAL, mask & 0x0003ffff);
|
||
|
|
||
|
}
|
||
|
|
||
|
static void dm1105_gpio_andor(struct dm1105_dev *dev, u32 mask, u32 val)
|
||
|
{
|
||
|
if (mask & 0xfffc0000)
|
||
|
printk(KERN_ERR "%s: Only 18 GPIO's are allowed\n", __func__);
|
||
|
|
||
|
if (mask & 0x0003ffff)
|
||
|
dm_andorl(DM1105_GPIOVAL, mask & 0x0003ffff, val);
|
||
|
|
||
|
}
|
||
|
|
||
|
static u32 dm1105_gpio_get(struct dm1105_dev *dev, u32 mask)
|
||
|
{
|
||
|
if (mask & 0xfffc0000)
|
||
|
printk(KERN_ERR "%s: Only 18 GPIO's are allowed\n", __func__);
|
||
|
|
||
|
if (mask & 0x0003ffff)
|
||
|
return dm_readl(DM1105_GPIOVAL) & mask & 0x0003ffff;
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static void dm1105_gpio_enable(struct dm1105_dev *dev, u32 mask, int asoutput)
|
||
|
{
|
||
|
if (mask & 0xfffc0000)
|
||
|
printk(KERN_ERR "%s: Only 18 GPIO's are allowed\n", __func__);
|
||
|
|
||
|
if ((mask & 0x0003ffff) && asoutput)
|
||
|
dm_clearl(DM1105_GPIOCTR, mask & 0x0003ffff);
|
||
|
else if ((mask & 0x0003ffff) && !asoutput)
|
||
|
dm_setl(DM1105_GPIOCTR, mask & 0x0003ffff);
|
||
|
|
||
|
}
|
||
|
|
||
|
static void dm1105_setline(struct dm1105_dev *dev, u32 line, int state)
|
||
|
{
|
||
|
if (state)
|
||
|
dm1105_gpio_enable(dev, line, 0);
|
||
|
else {
|
||
|
dm1105_gpio_enable(dev, line, 1);
|
||
|
dm1105_gpio_clear(dev, line);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
static void dm1105_setsda(void *data, int state)
|
||
|
{
|
||
|
struct dm1105_dev *dev = data;
|
||
|
|
||
|
dm1105_setline(dev, dm1105_boards[dev->boardnr].gpio_sda, state);
|
||
|
}
|
||
|
|
||
|
static void dm1105_setscl(void *data, int state)
|
||
|
{
|
||
|
struct dm1105_dev *dev = data;
|
||
|
|
||
|
dm1105_setline(dev, dm1105_boards[dev->boardnr].gpio_scl, state);
|
||
|
}
|
||
|
|
||
|
static int dm1105_getsda(void *data)
|
||
|
{
|
||
|
struct dm1105_dev *dev = data;
|
||
|
|
||
|
return dm1105_gpio_get(dev, dm1105_boards[dev->boardnr].gpio_sda)
|
||
|
? 1 : 0;
|
||
|
}
|
||
|
|
||
|
static int dm1105_getscl(void *data)
|
||
|
{
|
||
|
struct dm1105_dev *dev = data;
|
||
|
|
||
|
return dm1105_gpio_get(dev, dm1105_boards[dev->boardnr].gpio_scl)
|
||
|
? 1 : 0;
|
||
|
}
|
||
|
|
||
|
static int dm1105_i2c_xfer(struct i2c_adapter *i2c_adap,
|
||
|
struct i2c_msg *msgs, int num)
|
||
|
{
|
||
|
struct dm1105_dev *dev ;
|
||
|
|
||
|
int addr, rc, i, j, k, len, byte, data;
|
||
|
u8 status;
|
||
|
|
||
|
dev = i2c_adap->algo_data;
|
||
|
for (i = 0; i < num; i++) {
|
||
|
dm_writeb(DM1105_I2CCTR, 0x00);
|
||
|
if (msgs[i].flags & I2C_M_RD) {
|
||
|
/* read bytes */
|
||
|
addr = msgs[i].addr << 1;
|
||
|
addr |= 1;
|
||
|
dm_writeb(DM1105_I2CDAT, addr);
|
||
|
for (byte = 0; byte < msgs[i].len; byte++)
|
||
|
dm_writeb(DM1105_I2CDAT + byte + 1, 0);
|
||
|
|
||
|
dm_writeb(DM1105_I2CCTR, 0x81 + msgs[i].len);
|
||
|
for (j = 0; j < 55; j++) {
|
||
|
mdelay(10);
|
||
|
status = dm_readb(DM1105_I2CSTS);
|
||
|
if ((status & 0xc0) == 0x40)
|
||
|
break;
|
||
|
}
|
||
|
if (j >= 55)
|
||
|
return -1;
|
||
|
|
||
|
for (byte = 0; byte < msgs[i].len; byte++) {
|
||
|
rc = dm_readb(DM1105_I2CDAT + byte + 1);
|
||
|
if (rc < 0)
|
||
|
goto err;
|
||
|
msgs[i].buf[byte] = rc;
|
||
|
}
|
||
|
} else if ((msgs[i].buf[0] == 0xf7) && (msgs[i].addr == 0x55)) {
|
||
|
/* prepaired for cx24116 firmware */
|
||
|
/* Write in small blocks */
|
||
|
len = msgs[i].len - 1;
|
||
|
k = 1;
|
||
|
do {
|
||
|
dm_writeb(DM1105_I2CDAT, msgs[i].addr << 1);
|
||
|
dm_writeb(DM1105_I2CDAT + 1, 0xf7);
|
||
|
for (byte = 0; byte < (len > 48 ? 48 : len); byte++) {
|
||
|
data = msgs[i].buf[k + byte];
|
||
|
dm_writeb(DM1105_I2CDAT + byte + 2, data);
|
||
|
}
|
||
|
dm_writeb(DM1105_I2CCTR, 0x82 + (len > 48 ? 48 : len));
|
||
|
for (j = 0; j < 25; j++) {
|
||
|
mdelay(10);
|
||
|
status = dm_readb(DM1105_I2CSTS);
|
||
|
if ((status & 0xc0) == 0x40)
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
if (j >= 25)
|
||
|
return -1;
|
||
|
|
||
|
k += 48;
|
||
|
len -= 48;
|
||
|
} while (len > 0);
|
||
|
} else {
|
||
|
/* write bytes */
|
||
|
dm_writeb(DM1105_I2CDAT, msgs[i].addr << 1);
|
||
|
for (byte = 0; byte < msgs[i].len; byte++) {
|
||
|
data = msgs[i].buf[byte];
|
||
|
dm_writeb(DM1105_I2CDAT + byte + 1, data);
|
||
|
}
|
||
|
dm_writeb(DM1105_I2CCTR, 0x81 + msgs[i].len);
|
||
|
for (j = 0; j < 25; j++) {
|
||
|
mdelay(10);
|
||
|
status = dm_readb(DM1105_I2CSTS);
|
||
|
if ((status & 0xc0) == 0x40)
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
if (j >= 25)
|
||
|
return -1;
|
||
|
}
|
||
|
}
|
||
|
return num;
|
||
|
err:
|
||
|
return rc;
|
||
|
}
|
||
|
|
||
|
static u32 functionality(struct i2c_adapter *adap)
|
||
|
{
|
||
|
return I2C_FUNC_I2C;
|
||
|
}
|
||
|
|
||
|
static const struct i2c_algorithm dm1105_algo = {
|
||
|
.master_xfer = dm1105_i2c_xfer,
|
||
|
.functionality = functionality,
|
||
|
};
|
||
|
|
||
|
static inline struct dm1105_dev *feed_to_dm1105_dev(struct dvb_demux_feed *feed)
|
||
|
{
|
||
|
return container_of(feed->demux, struct dm1105_dev, demux);
|
||
|
}
|
||
|
|
||
|
static inline struct dm1105_dev *frontend_to_dm1105_dev(struct dvb_frontend *fe)
|
||
|
{
|
||
|
return container_of(fe->dvb, struct dm1105_dev, dvb_adapter);
|
||
|
}
|
||
|
|
||
|
static int dm1105_set_voltage(struct dvb_frontend *fe,
|
||
|
enum fe_sec_voltage voltage)
|
||
|
{
|
||
|
struct dm1105_dev *dev = frontend_to_dm1105_dev(fe);
|
||
|
|
||
|
dm1105_gpio_enable(dev, dm1105_boards[dev->boardnr].lnb.mask, 1);
|
||
|
if (voltage == SEC_VOLTAGE_18)
|
||
|
dm1105_gpio_andor(dev,
|
||
|
dm1105_boards[dev->boardnr].lnb.mask,
|
||
|
dm1105_boards[dev->boardnr].lnb.v18);
|
||
|
else if (voltage == SEC_VOLTAGE_13)
|
||
|
dm1105_gpio_andor(dev,
|
||
|
dm1105_boards[dev->boardnr].lnb.mask,
|
||
|
dm1105_boards[dev->boardnr].lnb.v13);
|
||
|
else
|
||
|
dm1105_gpio_andor(dev,
|
||
|
dm1105_boards[dev->boardnr].lnb.mask,
|
||
|
dm1105_boards[dev->boardnr].lnb.off);
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static void dm1105_set_dma_addr(struct dm1105_dev *dev)
|
||
|
{
|
||
|
dm_writel(DM1105_STADR, (__force u32)cpu_to_le32(dev->dma_addr));
|
||
|
}
|
||
|
|
||
|
static int dm1105_dma_map(struct dm1105_dev *dev)
|
||
|
{
|
||
|
dev->ts_buf = pci_alloc_consistent(dev->pdev,
|
||
|
6 * DM1105_DMA_BYTES,
|
||
|
&dev->dma_addr);
|
||
|
|
||
|
return !dev->ts_buf;
|
||
|
}
|
||
|
|
||
|
static void dm1105_dma_unmap(struct dm1105_dev *dev)
|
||
|
{
|
||
|
pci_free_consistent(dev->pdev,
|
||
|
6 * DM1105_DMA_BYTES,
|
||
|
dev->ts_buf,
|
||
|
dev->dma_addr);
|
||
|
}
|
||
|
|
||
|
static void dm1105_enable_irqs(struct dm1105_dev *dev)
|
||
|
{
|
||
|
dm_writeb(DM1105_INTMAK, INTMAK_ALLMASK);
|
||
|
dm_writeb(DM1105_CR, 1);
|
||
|
}
|
||
|
|
||
|
static void dm1105_disable_irqs(struct dm1105_dev *dev)
|
||
|
{
|
||
|
dm_writeb(DM1105_INTMAK, INTMAK_IRM);
|
||
|
dm_writeb(DM1105_CR, 0);
|
||
|
}
|
||
|
|
||
|
static int dm1105_start_feed(struct dvb_demux_feed *f)
|
||
|
{
|
||
|
struct dm1105_dev *dev = feed_to_dm1105_dev(f);
|
||
|
|
||
|
if (dev->full_ts_users++ == 0)
|
||
|
dm1105_enable_irqs(dev);
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int dm1105_stop_feed(struct dvb_demux_feed *f)
|
||
|
{
|
||
|
struct dm1105_dev *dev = feed_to_dm1105_dev(f);
|
||
|
|
||
|
if (--dev->full_ts_users == 0)
|
||
|
dm1105_disable_irqs(dev);
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
/* ir work handler */
|
||
|
static void dm1105_emit_key(struct work_struct *work)
|
||
|
{
|
||
|
struct infrared *ir = container_of(work, struct infrared, work);
|
||
|
u32 ircom = ir->ir_command;
|
||
|
u8 data;
|
||
|
|
||
|
if (ir_debug)
|
||
|
printk(KERN_INFO "%s: received byte 0x%04x\n", __func__, ircom);
|
||
|
|
||
|
data = (ircom >> 8) & 0x7f;
|
||
|
|
||
|
/* FIXME: UNKNOWN because we don't generate a full NEC scancode (yet?) */
|
||
|
rc_keydown(ir->dev, RC_PROTO_UNKNOWN, data, 0);
|
||
|
}
|
||
|
|
||
|
/* work handler */
|
||
|
static void dm1105_dmx_buffer(struct work_struct *work)
|
||
|
{
|
||
|
struct dm1105_dev *dev = container_of(work, struct dm1105_dev, work);
|
||
|
unsigned int nbpackets;
|
||
|
u32 oldwrp = dev->wrp;
|
||
|
u32 nextwrp = dev->nextwrp;
|
||
|
|
||
|
if (!((dev->ts_buf[oldwrp] == 0x47) &&
|
||
|
(dev->ts_buf[oldwrp + 188] == 0x47) &&
|
||
|
(dev->ts_buf[oldwrp + 188 * 2] == 0x47))) {
|
||
|
dev->PacketErrorCount++;
|
||
|
/* bad packet found */
|
||
|
if ((dev->PacketErrorCount >= 2) &&
|
||
|
(dev->dmarst == 0)) {
|
||
|
dm_writeb(DM1105_RST, 1);
|
||
|
dev->wrp = 0;
|
||
|
dev->PacketErrorCount = 0;
|
||
|
dev->dmarst = 0;
|
||
|
return;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
if (nextwrp < oldwrp) {
|
||
|
memcpy(dev->ts_buf + dev->buffer_size, dev->ts_buf, nextwrp);
|
||
|
nbpackets = ((dev->buffer_size - oldwrp) + nextwrp) / 188;
|
||
|
} else
|
||
|
nbpackets = (nextwrp - oldwrp) / 188;
|
||
|
|
||
|
dev->wrp = nextwrp;
|
||
|
dvb_dmx_swfilter_packets(&dev->demux, &dev->ts_buf[oldwrp], nbpackets);
|
||
|
}
|
||
|
|
||
|
static irqreturn_t dm1105_irq(int irq, void *dev_id)
|
||
|
{
|
||
|
struct dm1105_dev *dev = dev_id;
|
||
|
|
||
|
/* Read-Write INSTS Ack's Interrupt for DM1105 chip 16.03.2008 */
|
||
|
unsigned int intsts = dm_readb(DM1105_INTSTS);
|
||
|
dm_writeb(DM1105_INTSTS, intsts);
|
||
|
|
||
|
switch (intsts) {
|
||
|
case INTSTS_TSIRQ:
|
||
|
case (INTSTS_TSIRQ | INTSTS_IR):
|
||
|
dev->nextwrp = dm_readl(DM1105_WRP) - dm_readl(DM1105_STADR);
|
||
|
queue_work(dev->wq, &dev->work);
|
||
|
break;
|
||
|
case INTSTS_IR:
|
||
|
dev->ir.ir_command = dm_readl(DM1105_IRCODE);
|
||
|
schedule_work(&dev->ir.work);
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
return IRQ_HANDLED;
|
||
|
}
|
||
|
|
||
|
static int dm1105_ir_init(struct dm1105_dev *dm1105)
|
||
|
{
|
||
|
struct rc_dev *dev;
|
||
|
int err = -ENOMEM;
|
||
|
|
||
|
dev = rc_allocate_device(RC_DRIVER_SCANCODE);
|
||
|
if (!dev)
|
||
|
return -ENOMEM;
|
||
|
|
||
|
snprintf(dm1105->ir.input_phys, sizeof(dm1105->ir.input_phys),
|
||
|
"pci-%s/ir0", pci_name(dm1105->pdev));
|
||
|
|
||
|
dev->driver_name = MODULE_NAME;
|
||
|
dev->map_name = RC_MAP_DM1105_NEC;
|
||
|
dev->device_name = "DVB on-card IR receiver";
|
||
|
dev->input_phys = dm1105->ir.input_phys;
|
||
|
dev->input_id.bustype = BUS_PCI;
|
||
|
dev->input_id.version = 1;
|
||
|
if (dm1105->pdev->subsystem_vendor) {
|
||
|
dev->input_id.vendor = dm1105->pdev->subsystem_vendor;
|
||
|
dev->input_id.product = dm1105->pdev->subsystem_device;
|
||
|
} else {
|
||
|
dev->input_id.vendor = dm1105->pdev->vendor;
|
||
|
dev->input_id.product = dm1105->pdev->device;
|
||
|
}
|
||
|
dev->dev.parent = &dm1105->pdev->dev;
|
||
|
|
||
|
INIT_WORK(&dm1105->ir.work, dm1105_emit_key);
|
||
|
|
||
|
err = rc_register_device(dev);
|
||
|
if (err < 0) {
|
||
|
rc_free_device(dev);
|
||
|
return err;
|
||
|
}
|
||
|
|
||
|
dm1105->ir.dev = dev;
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static void dm1105_ir_exit(struct dm1105_dev *dm1105)
|
||
|
{
|
||
|
rc_unregister_device(dm1105->ir.dev);
|
||
|
}
|
||
|
|
||
|
static int dm1105_hw_init(struct dm1105_dev *dev)
|
||
|
{
|
||
|
dm1105_disable_irqs(dev);
|
||
|
|
||
|
dm_writeb(DM1105_HOST_CTR, 0);
|
||
|
|
||
|
/*DATALEN 188,*/
|
||
|
dm_writeb(DM1105_DTALENTH, 188);
|
||
|
/*TS_STRT TS_VALP MSBFIRST TS_MODE ALPAS TSPES*/
|
||
|
dm_writew(DM1105_TSCTR, 0xc10a);
|
||
|
|
||
|
/* map DMA and set address */
|
||
|
dm1105_dma_map(dev);
|
||
|
dm1105_set_dma_addr(dev);
|
||
|
/* big buffer */
|
||
|
dm_writel(DM1105_RLEN, 5 * DM1105_DMA_BYTES);
|
||
|
dm_writeb(DM1105_INTCNT, 47);
|
||
|
|
||
|
/* IR NEC mode enable */
|
||
|
dm_writeb(DM1105_IRCTR, (DM1105_IR_EN | DM1105_SYS_CHK));
|
||
|
dm_writeb(DM1105_IRMODE, 0);
|
||
|
dm_writew(DM1105_SYSTEMCODE, 0);
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static void dm1105_hw_exit(struct dm1105_dev *dev)
|
||
|
{
|
||
|
dm1105_disable_irqs(dev);
|
||
|
|
||
|
/* IR disable */
|
||
|
dm_writeb(DM1105_IRCTR, 0);
|
||
|
dm_writeb(DM1105_INTMAK, INTMAK_NONEMASK);
|
||
|
|
||
|
dm1105_dma_unmap(dev);
|
||
|
}
|
||
|
|
||
|
static const struct stv0299_config sharp_z0194a_config = {
|
||
|
.demod_address = 0x68,
|
||
|
.inittab = sharp_z0194a_inittab,
|
||
|
.mclk = 88000000UL,
|
||
|
.invert = 1,
|
||
|
.skip_reinit = 0,
|
||
|
.lock_output = STV0299_LOCKOUTPUT_1,
|
||
|
.volt13_op0_op1 = STV0299_VOLT13_OP1,
|
||
|
.min_delay_ms = 100,
|
||
|
.set_symbol_rate = sharp_z0194a_set_symbol_rate,
|
||
|
};
|
||
|
|
||
|
static struct stv0288_config earda_config = {
|
||
|
.demod_address = 0x68,
|
||
|
.min_delay_ms = 100,
|
||
|
};
|
||
|
|
||
|
static struct si21xx_config serit_config = {
|
||
|
.demod_address = 0x68,
|
||
|
.min_delay_ms = 100,
|
||
|
|
||
|
};
|
||
|
|
||
|
static struct cx24116_config serit_sp2633_config = {
|
||
|
.demod_address = 0x55,
|
||
|
};
|
||
|
|
||
|
static struct ds3000_config dvbworld_ds3000_config = {
|
||
|
.demod_address = 0x68,
|
||
|
};
|
||
|
|
||
|
static struct ts2020_config dvbworld_ts2020_config = {
|
||
|
.tuner_address = 0x60,
|
||
|
.clk_out_div = 1,
|
||
|
};
|
||
|
|
||
|
static int frontend_init(struct dm1105_dev *dev)
|
||
|
{
|
||
|
int ret;
|
||
|
|
||
|
switch (dev->boardnr) {
|
||
|
case DM1105_BOARD_UNBRANDED_I2C_ON_GPIO:
|
||
|
dm1105_gpio_enable(dev, GPIO15, 1);
|
||
|
dm1105_gpio_clear(dev, GPIO15);
|
||
|
msleep(100);
|
||
|
dm1105_gpio_set(dev, GPIO15);
|
||
|
msleep(200);
|
||
|
dev->fe = dvb_attach(
|
||
|
stv0299_attach, &sharp_z0194a_config,
|
||
|
&dev->i2c_bb_adap);
|
||
|
if (dev->fe) {
|
||
|
dev->fe->ops.set_voltage = dm1105_set_voltage;
|
||
|
dvb_attach(dvb_pll_attach, dev->fe, 0x60,
|
||
|
&dev->i2c_bb_adap, DVB_PLL_OPERA1);
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
dev->fe = dvb_attach(
|
||
|
stv0288_attach, &earda_config,
|
||
|
&dev->i2c_bb_adap);
|
||
|
if (dev->fe) {
|
||
|
dev->fe->ops.set_voltage = dm1105_set_voltage;
|
||
|
dvb_attach(stb6000_attach, dev->fe, 0x61,
|
||
|
&dev->i2c_bb_adap);
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
dev->fe = dvb_attach(
|
||
|
si21xx_attach, &serit_config,
|
||
|
&dev->i2c_bb_adap);
|
||
|
if (dev->fe)
|
||
|
dev->fe->ops.set_voltage = dm1105_set_voltage;
|
||
|
break;
|
||
|
case DM1105_BOARD_DVBWORLD_2004:
|
||
|
dev->fe = dvb_attach(
|
||
|
cx24116_attach, &serit_sp2633_config,
|
||
|
&dev->i2c_adap);
|
||
|
if (dev->fe) {
|
||
|
dev->fe->ops.set_voltage = dm1105_set_voltage;
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
dev->fe = dvb_attach(
|
||
|
ds3000_attach, &dvbworld_ds3000_config,
|
||
|
&dev->i2c_adap);
|
||
|
if (dev->fe) {
|
||
|
dvb_attach(ts2020_attach, dev->fe,
|
||
|
&dvbworld_ts2020_config, &dev->i2c_adap);
|
||
|
dev->fe->ops.set_voltage = dm1105_set_voltage;
|
||
|
}
|
||
|
|
||
|
break;
|
||
|
case DM1105_BOARD_DVBWORLD_2002:
|
||
|
case DM1105_BOARD_AXESS_DM05:
|
||
|
default:
|
||
|
dev->fe = dvb_attach(
|
||
|
stv0299_attach, &sharp_z0194a_config,
|
||
|
&dev->i2c_adap);
|
||
|
if (dev->fe) {
|
||
|
dev->fe->ops.set_voltage = dm1105_set_voltage;
|
||
|
dvb_attach(dvb_pll_attach, dev->fe, 0x60,
|
||
|
&dev->i2c_adap, DVB_PLL_OPERA1);
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
dev->fe = dvb_attach(
|
||
|
stv0288_attach, &earda_config,
|
||
|
&dev->i2c_adap);
|
||
|
if (dev->fe) {
|
||
|
dev->fe->ops.set_voltage = dm1105_set_voltage;
|
||
|
dvb_attach(stb6000_attach, dev->fe, 0x61,
|
||
|
&dev->i2c_adap);
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
dev->fe = dvb_attach(
|
||
|
si21xx_attach, &serit_config,
|
||
|
&dev->i2c_adap);
|
||
|
if (dev->fe)
|
||
|
dev->fe->ops.set_voltage = dm1105_set_voltage;
|
||
|
|
||
|
}
|
||
|
|
||
|
if (!dev->fe) {
|
||
|
dev_err(&dev->pdev->dev, "could not attach frontend\n");
|
||
|
return -ENODEV;
|
||
|
}
|
||
|
|
||
|
ret = dvb_register_frontend(&dev->dvb_adapter, dev->fe);
|
||
|
if (ret < 0) {
|
||
|
if (dev->fe->ops.release)
|
||
|
dev->fe->ops.release(dev->fe);
|
||
|
dev->fe = NULL;
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static void dm1105_read_mac(struct dm1105_dev *dev, u8 *mac)
|
||
|
{
|
||
|
static u8 command[1] = { 0x28 };
|
||
|
|
||
|
struct i2c_msg msg[] = {
|
||
|
{
|
||
|
.addr = IIC_24C01_addr >> 1,
|
||
|
.flags = 0,
|
||
|
.buf = command,
|
||
|
.len = 1
|
||
|
}, {
|
||
|
.addr = IIC_24C01_addr >> 1,
|
||
|
.flags = I2C_M_RD,
|
||
|
.buf = mac,
|
||
|
.len = 6
|
||
|
},
|
||
|
};
|
||
|
|
||
|
dm1105_i2c_xfer(&dev->i2c_adap, msg , 2);
|
||
|
dev_info(&dev->pdev->dev, "MAC %pM\n", mac);
|
||
|
}
|
||
|
|
||
|
static int dm1105_probe(struct pci_dev *pdev,
|
||
|
const struct pci_device_id *ent)
|
||
|
{
|
||
|
struct dm1105_dev *dev;
|
||
|
struct dvb_adapter *dvb_adapter;
|
||
|
struct dvb_demux *dvbdemux;
|
||
|
struct dmx_demux *dmx;
|
||
|
int ret = -ENOMEM;
|
||
|
int i;
|
||
|
|
||
|
dev = kzalloc(sizeof(struct dm1105_dev), GFP_KERNEL);
|
||
|
if (!dev)
|
||
|
return -ENOMEM;
|
||
|
|
||
|
/* board config */
|
||
|
dev->nr = dm1105_devcount;
|
||
|
dev->boardnr = UNSET;
|
||
|
if (card[dev->nr] < ARRAY_SIZE(dm1105_boards))
|
||
|
dev->boardnr = card[dev->nr];
|
||
|
for (i = 0; UNSET == dev->boardnr &&
|
||
|
i < ARRAY_SIZE(dm1105_subids); i++)
|
||
|
if (pdev->subsystem_vendor ==
|
||
|
dm1105_subids[i].subvendor &&
|
||
|
pdev->subsystem_device ==
|
||
|
dm1105_subids[i].subdevice)
|
||
|
dev->boardnr = dm1105_subids[i].card;
|
||
|
|
||
|
if (UNSET == dev->boardnr) {
|
||
|
dev->boardnr = DM1105_BOARD_UNKNOWN;
|
||
|
dm1105_card_list(pdev);
|
||
|
}
|
||
|
|
||
|
dm1105_devcount++;
|
||
|
dev->pdev = pdev;
|
||
|
dev->buffer_size = 5 * DM1105_DMA_BYTES;
|
||
|
dev->PacketErrorCount = 0;
|
||
|
dev->dmarst = 0;
|
||
|
|
||
|
ret = pci_enable_device(pdev);
|
||
|
if (ret < 0)
|
||
|
goto err_kfree;
|
||
|
|
||
|
ret = pci_set_dma_mask(pdev, DMA_BIT_MASK(32));
|
||
|
if (ret < 0)
|
||
|
goto err_pci_disable_device;
|
||
|
|
||
|
pci_set_master(pdev);
|
||
|
|
||
|
ret = pci_request_regions(pdev, DRIVER_NAME);
|
||
|
if (ret < 0)
|
||
|
goto err_pci_disable_device;
|
||
|
|
||
|
dev->io_mem = pci_iomap(pdev, 0, pci_resource_len(pdev, 0));
|
||
|
if (!dev->io_mem) {
|
||
|
ret = -EIO;
|
||
|
goto err_pci_release_regions;
|
||
|
}
|
||
|
|
||
|
spin_lock_init(&dev->lock);
|
||
|
pci_set_drvdata(pdev, dev);
|
||
|
|
||
|
ret = dm1105_hw_init(dev);
|
||
|
if (ret < 0)
|
||
|
goto err_pci_iounmap;
|
||
|
|
||
|
/* i2c */
|
||
|
i2c_set_adapdata(&dev->i2c_adap, dev);
|
||
|
strcpy(dev->i2c_adap.name, DRIVER_NAME);
|
||
|
dev->i2c_adap.owner = THIS_MODULE;
|
||
|
dev->i2c_adap.dev.parent = &pdev->dev;
|
||
|
dev->i2c_adap.algo = &dm1105_algo;
|
||
|
dev->i2c_adap.algo_data = dev;
|
||
|
ret = i2c_add_adapter(&dev->i2c_adap);
|
||
|
|
||
|
if (ret < 0)
|
||
|
goto err_dm1105_hw_exit;
|
||
|
|
||
|
i2c_set_adapdata(&dev->i2c_bb_adap, dev);
|
||
|
strcpy(dev->i2c_bb_adap.name, DM1105_I2C_GPIO_NAME);
|
||
|
dev->i2c_bb_adap.owner = THIS_MODULE;
|
||
|
dev->i2c_bb_adap.dev.parent = &pdev->dev;
|
||
|
dev->i2c_bb_adap.algo_data = &dev->i2c_bit;
|
||
|
dev->i2c_bit.data = dev;
|
||
|
dev->i2c_bit.setsda = dm1105_setsda;
|
||
|
dev->i2c_bit.setscl = dm1105_setscl;
|
||
|
dev->i2c_bit.getsda = dm1105_getsda;
|
||
|
dev->i2c_bit.getscl = dm1105_getscl;
|
||
|
dev->i2c_bit.udelay = 10;
|
||
|
dev->i2c_bit.timeout = 10;
|
||
|
|
||
|
/* Raise SCL and SDA */
|
||
|
dm1105_setsda(dev, 1);
|
||
|
dm1105_setscl(dev, 1);
|
||
|
|
||
|
ret = i2c_bit_add_bus(&dev->i2c_bb_adap);
|
||
|
if (ret < 0)
|
||
|
goto err_i2c_del_adapter;
|
||
|
|
||
|
/* dvb */
|
||
|
ret = dvb_register_adapter(&dev->dvb_adapter, DRIVER_NAME,
|
||
|
THIS_MODULE, &pdev->dev, adapter_nr);
|
||
|
if (ret < 0)
|
||
|
goto err_i2c_del_adapters;
|
||
|
|
||
|
dvb_adapter = &dev->dvb_adapter;
|
||
|
|
||
|
dm1105_read_mac(dev, dvb_adapter->proposed_mac);
|
||
|
|
||
|
dvbdemux = &dev->demux;
|
||
|
dvbdemux->filternum = 256;
|
||
|
dvbdemux->feednum = 256;
|
||
|
dvbdemux->start_feed = dm1105_start_feed;
|
||
|
dvbdemux->stop_feed = dm1105_stop_feed;
|
||
|
dvbdemux->dmx.capabilities = (DMX_TS_FILTERING |
|
||
|
DMX_SECTION_FILTERING | DMX_MEMORY_BASED_FILTERING);
|
||
|
ret = dvb_dmx_init(dvbdemux);
|
||
|
if (ret < 0)
|
||
|
goto err_dvb_unregister_adapter;
|
||
|
|
||
|
dmx = &dvbdemux->dmx;
|
||
|
dev->dmxdev.filternum = 256;
|
||
|
dev->dmxdev.demux = dmx;
|
||
|
dev->dmxdev.capabilities = 0;
|
||
|
|
||
|
ret = dvb_dmxdev_init(&dev->dmxdev, dvb_adapter);
|
||
|
if (ret < 0)
|
||
|
goto err_dvb_dmx_release;
|
||
|
|
||
|
dev->hw_frontend.source = DMX_FRONTEND_0;
|
||
|
|
||
|
ret = dmx->add_frontend(dmx, &dev->hw_frontend);
|
||
|
if (ret < 0)
|
||
|
goto err_dvb_dmxdev_release;
|
||
|
|
||
|
dev->mem_frontend.source = DMX_MEMORY_FE;
|
||
|
|
||
|
ret = dmx->add_frontend(dmx, &dev->mem_frontend);
|
||
|
if (ret < 0)
|
||
|
goto err_remove_hw_frontend;
|
||
|
|
||
|
ret = dmx->connect_frontend(dmx, &dev->hw_frontend);
|
||
|
if (ret < 0)
|
||
|
goto err_remove_mem_frontend;
|
||
|
|
||
|
ret = dvb_net_init(dvb_adapter, &dev->dvbnet, dmx);
|
||
|
if (ret < 0)
|
||
|
goto err_disconnect_frontend;
|
||
|
|
||
|
ret = frontend_init(dev);
|
||
|
if (ret < 0)
|
||
|
goto err_dvb_net;
|
||
|
|
||
|
dm1105_ir_init(dev);
|
||
|
|
||
|
INIT_WORK(&dev->work, dm1105_dmx_buffer);
|
||
|
sprintf(dev->wqn, "%s/%d", dvb_adapter->name, dvb_adapter->num);
|
||
|
dev->wq = create_singlethread_workqueue(dev->wqn);
|
||
|
if (!dev->wq) {
|
||
|
ret = -ENOMEM;
|
||
|
goto err_dvb_net;
|
||
|
}
|
||
|
|
||
|
ret = request_irq(pdev->irq, dm1105_irq, IRQF_SHARED,
|
||
|
DRIVER_NAME, dev);
|
||
|
if (ret < 0)
|
||
|
goto err_workqueue;
|
||
|
|
||
|
return 0;
|
||
|
|
||
|
err_workqueue:
|
||
|
destroy_workqueue(dev->wq);
|
||
|
err_dvb_net:
|
||
|
dvb_net_release(&dev->dvbnet);
|
||
|
err_disconnect_frontend:
|
||
|
dmx->disconnect_frontend(dmx);
|
||
|
err_remove_mem_frontend:
|
||
|
dmx->remove_frontend(dmx, &dev->mem_frontend);
|
||
|
err_remove_hw_frontend:
|
||
|
dmx->remove_frontend(dmx, &dev->hw_frontend);
|
||
|
err_dvb_dmxdev_release:
|
||
|
dvb_dmxdev_release(&dev->dmxdev);
|
||
|
err_dvb_dmx_release:
|
||
|
dvb_dmx_release(dvbdemux);
|
||
|
err_dvb_unregister_adapter:
|
||
|
dvb_unregister_adapter(dvb_adapter);
|
||
|
err_i2c_del_adapters:
|
||
|
i2c_del_adapter(&dev->i2c_bb_adap);
|
||
|
err_i2c_del_adapter:
|
||
|
i2c_del_adapter(&dev->i2c_adap);
|
||
|
err_dm1105_hw_exit:
|
||
|
dm1105_hw_exit(dev);
|
||
|
err_pci_iounmap:
|
||
|
pci_iounmap(pdev, dev->io_mem);
|
||
|
err_pci_release_regions:
|
||
|
pci_release_regions(pdev);
|
||
|
err_pci_disable_device:
|
||
|
pci_disable_device(pdev);
|
||
|
err_kfree:
|
||
|
kfree(dev);
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
static void dm1105_remove(struct pci_dev *pdev)
|
||
|
{
|
||
|
struct dm1105_dev *dev = pci_get_drvdata(pdev);
|
||
|
struct dvb_adapter *dvb_adapter = &dev->dvb_adapter;
|
||
|
struct dvb_demux *dvbdemux = &dev->demux;
|
||
|
struct dmx_demux *dmx = &dvbdemux->dmx;
|
||
|
|
||
|
dm1105_ir_exit(dev);
|
||
|
dmx->close(dmx);
|
||
|
dvb_net_release(&dev->dvbnet);
|
||
|
if (dev->fe)
|
||
|
dvb_unregister_frontend(dev->fe);
|
||
|
|
||
|
dmx->disconnect_frontend(dmx);
|
||
|
dmx->remove_frontend(dmx, &dev->mem_frontend);
|
||
|
dmx->remove_frontend(dmx, &dev->hw_frontend);
|
||
|
dvb_dmxdev_release(&dev->dmxdev);
|
||
|
dvb_dmx_release(dvbdemux);
|
||
|
dvb_unregister_adapter(dvb_adapter);
|
||
|
i2c_del_adapter(&dev->i2c_adap);
|
||
|
|
||
|
dm1105_hw_exit(dev);
|
||
|
free_irq(pdev->irq, dev);
|
||
|
pci_iounmap(pdev, dev->io_mem);
|
||
|
pci_release_regions(pdev);
|
||
|
pci_disable_device(pdev);
|
||
|
dm1105_devcount--;
|
||
|
kfree(dev);
|
||
|
}
|
||
|
|
||
|
static const struct pci_device_id dm1105_id_table[] = {
|
||
|
{
|
||
|
.vendor = PCI_VENDOR_ID_TRIGEM,
|
||
|
.device = PCI_DEVICE_ID_DM1105,
|
||
|
.subvendor = PCI_ANY_ID,
|
||
|
.subdevice = PCI_ANY_ID,
|
||
|
}, {
|
||
|
.vendor = PCI_VENDOR_ID_AXESS,
|
||
|
.device = PCI_DEVICE_ID_DM05,
|
||
|
.subvendor = PCI_ANY_ID,
|
||
|
.subdevice = PCI_ANY_ID,
|
||
|
}, {
|
||
|
/* empty */
|
||
|
},
|
||
|
};
|
||
|
|
||
|
MODULE_DEVICE_TABLE(pci, dm1105_id_table);
|
||
|
|
||
|
static struct pci_driver dm1105_driver = {
|
||
|
.name = DRIVER_NAME,
|
||
|
.id_table = dm1105_id_table,
|
||
|
.probe = dm1105_probe,
|
||
|
.remove = dm1105_remove,
|
||
|
};
|
||
|
|
||
|
module_pci_driver(dm1105_driver);
|
||
|
|
||
|
MODULE_AUTHOR("Igor M. Liplianin <liplianin@me.by>");
|
||
|
MODULE_DESCRIPTION("SDMC DM1105 DVB driver");
|
||
|
MODULE_LICENSE("GPL");
|