diff options
-rw-r--r-- | linux/drivers/media/dvb/bt8xx/dst.c | 72 | ||||
-rw-r--r-- | linux/drivers/media/dvb/bt8xx/dst_ca.c | 841 |
2 files changed, 482 insertions, 431 deletions
diff --git a/linux/drivers/media/dvb/bt8xx/dst.c b/linux/drivers/media/dvb/bt8xx/dst.c index c26e7d017..9da5b2fcb 100644 --- a/linux/drivers/media/dvb/bt8xx/dst.c +++ b/linux/drivers/media/dvb/bt8xx/dst.c @@ -34,13 +34,13 @@ #include "dst_common.h" -static unsigned int dst_verbose = 0; -module_param(dst_verbose, int, 0644); -MODULE_PARM_DESC(dst_verbose, "verbose startup messages, default is 1 (yes)"); +static unsigned int verbose = 0; +module_param(verbose, int, 0644); +MODULE_PARM_DESC(verbose, "verbose startup messages, default is 1 (yes)"); -static unsigned int dst_debug = 0; -module_param(dst_debug, int, 0644); -MODULE_PARM_DESC(dst_debug, "debug messages, default is 0 (no)"); +static unsigned int debug = 0; +module_param(debug, int, 0644); +MODULE_PARM_DESC(debug, "debug messages, default is 0 (no)"); static unsigned int dst_addons = 0; module_param(dst_addons, int, 0644); @@ -52,7 +52,7 @@ MODULE_PARM_DESC(new_fw, "Support for the new interface firmware, default 0"); -#define dprintk if (dst_debug) printk +#define dprintk if (debug) printk #define HAS_LOCK 1 #define ATTEMPT_TUNE 2 @@ -74,7 +74,8 @@ int dst_gpio_outb(struct dst_state* state, u32 mask, u32 enbb, u32 outhigh, int enb.enb.mask = mask; enb.enb.enable = enbb; - dprintk("%s: mask=[%04x], enbb=[%04x], outhigh=[%04x]\n", __FUNCTION__, mask, enbb, outhigh); + if (verbose > 4) + dprintk("%s: mask=[%04x], enbb=[%04x], outhigh=[%04x]\n", __FUNCTION__, mask, enbb, outhigh); if ((err = bt878_device_control(state->bt, DST_IG_ENABLE, &enb)) < 0) { dprintk("%s: dst_gpio_enb error (err == %i, mask == %02x, enb == %02x)\n", __FUNCTION__, err, mask, enbb); @@ -120,7 +121,8 @@ EXPORT_SYMBOL(dst_gpio_inb); int rdc_reset_state(struct dst_state *state) { - dprintk("%s: Resetting state machine\n", __FUNCTION__); + if (verbose > 1) + dprintk("%s: Resetting state machine\n", __FUNCTION__); if (dst_gpio_outb(state, RDC_8820_INT, RDC_8820_INT, 0, NO_DELAY) < 0) { dprintk("%s: dst_gpio_outb ERROR !\n", __FUNCTION__); @@ -141,7 +143,8 @@ EXPORT_SYMBOL(rdc_reset_state); int rdc_8820_reset(struct dst_state *state) { - dprintk("%s: Resetting DST\n", __FUNCTION__); + if (verbose > 1) + dprintk("%s: Resetting DST\n", __FUNCTION__); if (dst_gpio_outb(state, RDC_8820_RESET, RDC_8820_RESET, 0, NO_DELAY) < 0) { dprintk("%s: dst_gpio_outb ERROR !\n", __FUNCTION__); @@ -193,12 +196,14 @@ int dst_wait_dst_ready(struct dst_state *state, u8 delay_mode) } if ((reply & RDC_8820_PIO_0_ENABLE) == 0) { - dprintk("%s: dst wait ready after %d\n", __FUNCTION__, i); + if (verbose > 4) + dprintk("%s: dst wait ready after %d\n", __FUNCTION__, i); return 1; } msleep(1); } - dprintk("%s: dst wait NOT ready after %d\n", __FUNCTION__, i); + if (verbose > 1) + dprintk("%s: dst wait NOT ready after %d\n", __FUNCTION__, i); return 0; } @@ -230,7 +235,8 @@ EXPORT_SYMBOL(dst_error_bailout); int dst_comm_init(struct dst_state* state) { - dprintk ("%s: Initializing DST..\n", __FUNCTION__); + if (verbose > 1) + dprintk ("%s: Initializing DST..\n", __FUNCTION__); if ((dst_pio_enable(state)) < 0) { dprintk("%s: PIO Enable Failed.\n", __FUNCTION__); return -1; @@ -252,12 +258,14 @@ int write_dst(struct dst_state *state, u8 *data, u8 len) int err; int cnt; - if (dst_debug && dst_verbose) { + if (debug && (verbose > 4)) { u8 i; - dprintk("%s writing", __FUNCTION__); - for (i = 0; i < len; i++) - dprintk(" %02x", data[i]); - dprintk("\n"); + if (verbose > 4) { + dprintk("%s writing", __FUNCTION__); + for (i = 0; i < len; i++) + dprintk(" %02x", data[i]); + dprintk("\n"); + } } for (cnt = 0; cnt < 2; cnt++) { if ((err = i2c_transfer(state->i2c, &msg, 1)) < 0) { @@ -269,7 +277,8 @@ int write_dst(struct dst_state *state, u8 *data, u8 len) } if (cnt >= 2) { - printk("%s: RDC 8820 RESET...\n", __FUNCTION__); + if (verbose > 1) + printk("%s: RDC 8820 RESET...\n", __FUNCTION__); dst_error_bailout(state); return -1; @@ -296,14 +305,14 @@ int read_dst(struct dst_state *state, u8 * ret, u8 len) break; } if (cnt >= 2) { - printk("%s: RDC 8820 RESET...\n", __FUNCTION__); + if (verbose > 1) + printk("%s: RDC 8820 RESET...\n", __FUNCTION__); dst_error_bailout(state); return -1; } - - dprintk("%s reply is 0x%x\n", __FUNCTION__, ret[0]); - if (dst_debug && dst_verbose) { + if (debug && (verbose > 4)) { + dprintk("%s reply is 0x%x\n", __FUNCTION__, ret[0]); for (err = 1; err < len; err++) dprintk(" 0x%x", ret[err]); if (err > 1) @@ -783,7 +792,8 @@ int dst_command(struct dst_state* state, u8 * data, u8 len) } if (write_dst(state, data, len)) { - dprintk("%s: Tring to recover.. \n", __FUNCTION__); + if (verbose > 1) + dprintk("%s: Tring to recover.. \n", __FUNCTION__); if ((dst_error_recovery(state)) < 0) { dprintk("%s: Recovery Failed.\n", __FUNCTION__); return -1; @@ -796,7 +806,8 @@ int dst_command(struct dst_state* state, u8 * data, u8 len) } if (read_dst(state, &reply, GET_ACK)) { - dprintk("%s: Trying to recover.. \n", __FUNCTION__); + if (verbose > 1) + dprintk("%s: Trying to recover.. \n", __FUNCTION__); if ((dst_error_recovery(state)) < 0) { dprintk("%s: Recovery Failed.\n", __FUNCTION__); return -1; @@ -814,7 +825,8 @@ int dst_command(struct dst_state* state, u8 * data, u8 len) return -1; if (read_dst(state, state->rxbuffer, FIXED_COMM)) { - dprintk("%s: Trying to recover.. \n", __FUNCTION__); + if (verbose > 1) + dprintk("%s: Trying to recover.. \n", __FUNCTION__); if ((dst_error_recovery(state)) < 0) { dprintk("%s: Recovery failed.\n", __FUNCTION__); return -1; @@ -1168,13 +1180,15 @@ static int dst_set_frontend(struct dvb_frontend* fe, struct dvb_frontend_paramet struct dst_state* state = (struct dst_state*) fe->demodulator_priv; dst_set_freq(state, p->frequency); - dprintk("Set Frequency = [%d]\n", p->frequency); + if (verbose > 4) + dprintk("Set Frequency = [%d]\n", p->frequency); dst_set_inversion(state, p->inversion); if (state->dst_type == DST_TYPE_IS_SAT) { dst_set_fec(state, p->u.qpsk.fec_inner); dst_set_symbolrate(state, p->u.qpsk.symbol_rate); - dprintk("Set Symbolrate = [%d]\n", p->u.qpsk.symbol_rate); + if (verbose > 4) + dprintk("Set Symbolrate = [%d]\n", p->u.qpsk.symbol_rate); } else if (state->dst_type == DST_TYPE_IS_TERR) { dst_set_bandwidth(state, p->u.ofdm.bandwidth); @@ -1340,8 +1354,6 @@ static struct dvb_frontend_ops dst_dvbc_ops = { }; - - MODULE_DESCRIPTION("DST DVB-S/T/C Combo Frontend driver"); MODULE_AUTHOR("Jamie Honan, Manu Abraham"); MODULE_LICENSE("GPL"); diff --git a/linux/drivers/media/dvb/bt8xx/dst_ca.c b/linux/drivers/media/dvb/bt8xx/dst_ca.c index 24e6e2187..6800f7c84 100644 --- a/linux/drivers/media/dvb/bt8xx/dst_ca.c +++ b/linux/drivers/media/dvb/bt8xx/dst_ca.c @@ -32,12 +32,12 @@ #include "dst_ca.h" #include "dst_common.h" -static unsigned int dst_ca_verbose = 0; -module_param(dst_ca_verbose, int, 0644); -MODULE_PARM_DESC(dst_ca_verbose, "verbose startup messages, default is 1 (yes)"); +static unsigned int verbose = 0; +module_param(verbose, int, 0644); +MODULE_PARM_DESC(verbose, "verbose startup messages, default is 1 (yes)"); -static unsigned int dst_ca_debug = 0; -module_param(dst_ca_debug, int, 0644); +static unsigned int debug = 0; +module_param(debug, int, 0644); MODULE_PARM_DESC(dst_ca_debug, "debug messages, default is 0 (no)"); static unsigned int session = 0; @@ -48,184 +48,111 @@ static unsigned int new_ca = 0; module_param(new_ca, int, 0644); MODULE_PARM_DESC(new_ca, "Support for the new CA interface firmware, default 0"); -#define dprintk if (dst_ca_debug) printk +#define dprintk if (debug) printk -/* Module functions */ -static int dst_ca_open(struct inode *inode, struct file *file); -static int dst_ca_release(struct inode *inode, struct file *file); -static int dst_ca_read(struct file *file, char __user * buffer, size_t length, loff_t * offset); -static int dst_ca_write(struct file *file, const char __user * buffer, size_t length, loff_t * offset); -static int dst_ca_ioctl(struct inode *inode, struct file *file, unsigned int cmd, void *arg); - -/* DVB API style implementation */ -static int ca_send_message(struct dst_state *state, struct ca_msg *p_ca_message, void *arg); -static int ca_get_slot_descr(struct dst_state *state, struct ca_msg *p_ca_message, void *arg); -static int ca_get_slot_info(struct dst_state *state, struct ca_slot_info *p_ca_slot_info, void *arg); -static int ca_get_message(struct dst_state *state, struct ca_msg *p_ca_message, void *arg); -static int ca_get_slot_caps(struct dst_state *state, struct ca_caps *p_ca_caps, void *arg); -static int ca_set_pid(void); -static int ca_set_slot_descr(void); - -/* Device specific functions */ -static int ca_set_pmt(struct dst_state *state, struct ca_msg *p_ca_message, struct ca_msg *hw_buffer, u8 reply, u8 query); -static int dst_check_ca_pmt(struct dst_state *state, struct ca_msg *p_ca_message, struct ca_msg *hw_buffer); -static int ca_get_app_info(struct dst_state *state); - - -/* Helper functions */ -static int dst_put_ci(struct dst_state *state, u8 *data, int len, u8 *ca_string, int read); -static int put_checksum(u8 *check_string, int length); -static int handle_en50221_tag(struct ca_msg *p_ca_message, struct ca_msg *hw_buffer); -static int write_to_8820(struct dst_state *state, struct ca_msg *hw_buffer, u8 reply); -static int debug_8820_buffer(struct ca_msg *hw_buffer); - - -static struct file_operations dst_ca_fops = { - .owner = THIS_MODULE, - .ioctl = (void *)dst_ca_ioctl, - .open = dst_ca_open, - .release = dst_ca_release, - .read = dst_ca_read, - .write = dst_ca_write -}; - +static int ca_set_slot_descr(void) +{ + /* We could make this more graceful ? */ + return -EOPNOTSUPP; +} -static struct dvb_device dvbdev_ca = { - .priv = NULL, - .users = 1, - .readers = 1, - .writers = 1, - .fops = &dst_ca_fops -}; +static int ca_set_pid(void) +{ + /* We could make this more graceful ? */ + return -EOPNOTSUPP; +} -static int dst_ca_ioctl(struct inode *inode, struct file *file, unsigned int cmd, void *arg) +static int put_checksum(u8 *check_string, int length) { - struct dvb_device* dvbdev = (struct dvb_device*) file->private_data; - struct dst_state* state = (struct dst_state*) dvbdev->priv; - struct ca_slot_info *p_ca_slot_info; - struct ca_caps *p_ca_caps; - struct ca_msg *p_ca_message; + u8 i = 0, checksum = 0; - if ((p_ca_message = (struct ca_msg *) kmalloc(sizeof (struct ca_msg), GFP_KERNEL)) == NULL) { - printk("%s: Memory allocation failure\n", __FUNCTION__); - return -ENOMEM; - } + if (verbose > 3) { + dprintk("%s: ========================= Checksum calculation ===========================\n", __FUNCTION__); + dprintk("%s: String Length=[0x%02x]\n", __FUNCTION__, length); - if ((p_ca_slot_info = (struct ca_slot_info *) kmalloc(sizeof (struct ca_slot_info), GFP_KERNEL)) == NULL) { - printk("%s: Memory allocation failure\n", __FUNCTION__); - return -ENOMEM; + dprintk("%s: String=[", __FUNCTION__); } - - if ((p_ca_caps = (struct ca_caps *) kmalloc(sizeof (struct ca_caps), GFP_KERNEL)) == NULL) { - printk("%s: Memory allocation failure\n", __FUNCTION__); - return -ENOMEM; + while (i < length) { + if (verbose > 3) + dprintk(" %02x", check_string[i]); + checksum += check_string[i]; + i++; + } + if (verbose > 3) { + dprintk(" ]\n"); + dprintk("%s: Sum=[%02x]\n", __FUNCTION__, checksum); + } + check_string[length] = ~checksum + 1; + if (verbose > 3) { + dprintk("%s: Checksum=[%02x]\n", __FUNCTION__, check_string[length]); + dprintk("%s: ==========================================================================\n", __FUNCTION__); } - /* We have now only the standard ioctl's, the driver is upposed to handle internals. */ - switch (cmd) { - case CA_SEND_MSG: - if (dst_ca_verbose) - dprintk("%s: Sending message\n", __FUNCTION__); - if ((ca_send_message(state, p_ca_message, arg)) < 0) { - dprintk("%s: -->CA_SEND_MSG Failed !\n", __FUNCTION__); - return -1; - } - - break; - - case CA_GET_MSG: - if (dst_ca_verbose) - dprintk("%s: Getting message\n", __FUNCTION__); - if ((ca_get_message(state, p_ca_message, arg)) < 0) { - dprintk("%s: -->CA_GET_MSG Failed !\n", __FUNCTION__); - return -1; - } - dprintk("%s: -->CA_GET_MSG Success !\n", __FUNCTION__); - - break; - - case CA_RESET: - if (dst_ca_verbose) - dprintk("%s: Resetting DST\n", __FUNCTION__); - dst_error_bailout(state); - msleep(4000); + return 0; +} - break; +static int dst_ci_command(struct dst_state* state, u8 * data, u8 *ca_string, u8 len, int read) +{ + u8 reply; - case CA_GET_SLOT_INFO: - if (dst_ca_verbose) - dprintk("%s: Getting Slot info\n", __FUNCTION__); - if ((ca_get_slot_info(state, p_ca_slot_info, arg)) < 0) { - dprintk("%s: -->CA_GET_SLOT_INFO Failed !\n", __FUNCTION__); - return -1; - } - dprintk("%s: -->CA_GET_SLOT_INFO Success !\n", __FUNCTION__); + dst_comm_init(state); + msleep(65); - break; + if (write_dst(state, data, len)) { + dprintk("%s: Write not successful, trying to recover\n", __FUNCTION__); + dst_error_recovery(state); + return -1; + } - case CA_GET_CAP: - if (dst_ca_verbose) - dprintk("%s: Getting Slot capabilities\n", __FUNCTION__); - if ((ca_get_slot_caps(state, p_ca_caps, arg)) < 0) { - dprintk("%s: -->CA_GET_CAP Failed !\n", __FUNCTION__); - return -1; - } - dprintk("%s: -->CA_GET_CAP Success !\n", __FUNCTION__); + if ((dst_pio_disable(state)) < 0) { + dprintk("%s: DST PIO disable failed.\n", __FUNCTION__); + return -1; + } - break; + if (read_dst(state, &reply, GET_ACK) < 0) { + dprintk("%s: Read not successful, trying to recover\n", __FUNCTION__); + dst_error_recovery(state); + return -1; + } - case CA_GET_DESCR_INFO: - if (dst_ca_verbose) - dprintk("%s: Getting descrambler description\n", __FUNCTION__); - if ((ca_get_slot_descr(state, p_ca_message, arg)) < 0) { - dprintk("%s: -->CA_GET_DESCR_INFO Failed !\n", __FUNCTION__); - return -1; - } - dprintk("%s: -->CA_GET_DESCR_INFO Success !\n", __FUNCTION__); + if (read) { + if (! dst_wait_dst_ready(state, LONG_DELAY)) { + dprintk("%s: 8820 not ready\n", __FUNCTION__); + return -1; + } - break; + if (read_dst(state, ca_string, 128) < 0) { /* Try to make this dynamic */ + dprintk("%s: Read not successful, trying to recover\n", __FUNCTION__); + dst_error_recovery(state); + return -1; + } + } - case CA_SET_DESCR: - if (dst_ca_verbose) - dprintk("%s: Setting descrambler\n", __FUNCTION__); - if ((ca_set_slot_descr()) < 0) { - dprintk("%s: -->CA_SET_DESCR Failed !\n", __FUNCTION__); - return -1; - } - dprintk("%s: -->CA_SET_DESCR Success !\n", __FUNCTION__); + return 0; +} - break; - case CA_SET_PID: - if (dst_ca_verbose) - dprintk("%s: Setting PID\n", __FUNCTION__); - if ((ca_set_pid()) < 0) { - dprintk("%s: -->CA_SET_PID Failed !\n", __FUNCTION__); - return -1; - } - dprintk("%s: -->CA_SET_PID Success !\n", __FUNCTION__); +static int dst_put_ci(struct dst_state *state, u8 *data, int len, u8 *ca_string, int read) +{ + u8 dst_ca_comm_err = 0; - default: - return -EOPNOTSUPP; - }; + while (dst_ca_comm_err < RETRIES) { + dst_comm_init(state); + if (verbose > 2) + dprintk("%s: Put Command\n", __FUNCTION__); + if (dst_ci_command(state, data, ca_string, len, read)) { // If error + dst_error_recovery(state); + dst_ca_comm_err++; // work required here. + } + break; + } return 0; } -static int ca_set_slot_descr(void) -{ - /* We could make this more graceful ? */ - return -EOPNOTSUPP; -} - -static int ca_set_pid(void) -{ - /* We could make this more graceful ? */ - return -EOPNOTSUPP; -} static int ca_get_app_info(struct dst_state *state) { @@ -236,13 +163,15 @@ static int ca_get_app_info(struct dst_state *state) dprintk("%s: -->dst_put_ci FAILED !\n", __FUNCTION__); return -1; } - dprintk("%s: -->dst_put_ci SUCCESS !\n", __FUNCTION__); - - dprintk("%s: ================================ CI Module Application Info ======================================\n", __FUNCTION__); - dprintk("%s: Application Type=[%d], Application Vendor=[%d], Vendor Code=[%d]\n%s: Application info=[%s]\n", - __FUNCTION__, state->messages[7], (state->messages[8] << 8) | state->messages[9], - (state->messages[10] << 8) | state->messages[11], __FUNCTION__, (char *)(&state->messages[11])); - dprintk("%s: ==================================================================================================\n", __FUNCTION__); + if (verbose > 1) { + dprintk("%s: -->dst_put_ci SUCCESS !\n", __FUNCTION__); + + dprintk("%s: ================================ CI Module Application Info ======================================\n", __FUNCTION__); + dprintk("%s: Application Type=[%d], Application Vendor=[%d], Vendor Code=[%d]\n%s: Application info=[%s]\n", + __FUNCTION__, state->messages[7], (state->messages[8] << 8) | state->messages[9], + (state->messages[10] << 8) | state->messages[11], __FUNCTION__, (char *)(&state->messages[11])); + dprintk("%s: ==================================================================================================\n", __FUNCTION__); + } return 0; } @@ -258,15 +187,18 @@ static int ca_get_slot_caps(struct dst_state *state, struct ca_caps *p_ca_caps, dprintk("%s: -->dst_put_ci FAILED !\n", __FUNCTION__); return -1; } - dprintk("%s: -->dst_put_ci SUCCESS !\n", __FUNCTION__); + if (verbose > 1) + dprintk("%s: -->dst_put_ci SUCCESS !\n", __FUNCTION__); /* Will implement the rest soon */ - dprintk("%s: Slot cap = [%d]\n", __FUNCTION__, slot_cap[7]); - dprintk("===================================\n"); - for (i = 0; i < 8; i++) - dprintk(" %d", slot_cap[i]); - dprintk("\n"); + if (verbose > 1) { + dprintk("%s: Slot cap = [%d]\n", __FUNCTION__, slot_cap[7]); + dprintk("===================================\n"); + for (i = 0; i < 8; i++) + dprintk(" %d", slot_cap[i]); + dprintk("\n"); + } p_ca_caps->slot_num = 1; p_ca_caps->slot_type = 1; @@ -300,15 +232,18 @@ static int ca_get_slot_info(struct dst_state *state, struct ca_slot_info *p_ca_s dprintk("%s: -->dst_put_ci FAILED !\n", __FUNCTION__); return -1; } - dprintk("%s: -->dst_put_ci SUCCESS !\n", __FUNCTION__); + if (verbose > 1) + dprintk("%s: -->dst_put_ci SUCCESS !\n", __FUNCTION__); /* Will implement the rest soon */ - dprintk("%s: Slot info = [%d]\n", __FUNCTION__, slot_info[3]); - dprintk("===================================\n"); - for (i = 0; i < 8; i++) - dprintk(" %d", slot_info[i]); - dprintk("\n"); + if (verbose > 1) { + dprintk("%s: Slot info = [%d]\n", __FUNCTION__, slot_info[3]); + dprintk("===================================\n"); + for (i = 0; i < 8; i++) + dprintk(" %d", slot_info[i]); + dprintk("\n"); + } if (slot_info[4] & 0x80) { p_ca_slot_info->flags = CA_CI_MODULE_PRESENT; @@ -332,140 +267,77 @@ static int ca_get_slot_info(struct dst_state *state, struct ca_slot_info *p_ca_s } -static int put_checksum(u8 *check_string, int length) -{ - u8 i = 0, checksum = 0; - - dprintk("%s: ========================= Checksum calculation ===========================\n", __FUNCTION__); - dprintk("%s: String Length=[0x%02x]\n", __FUNCTION__, length); - - dprintk("%s: String=[", __FUNCTION__); - while (i < length) { - dprintk(" %02x", check_string[i]); - checksum += check_string[i]; - i++; - } - dprintk(" ]\n"); - dprintk("%s: Sum=[%02x]\n", __FUNCTION__, checksum); - check_string[length] = ~checksum + 1; - dprintk("%s: Checksum=[%02x]\n", __FUNCTION__, check_string[length]); - dprintk("%s: ==========================================================================\n", __FUNCTION__); - - return 0; -} static int ca_get_message(struct dst_state *state, struct ca_msg *p_ca_message, void *arg) { - memcpy(p_ca_message->msg, state->messages, 128); - /* CA Get should not be harder than this */ - if (copy_to_user((void *)arg, p_ca_message, sizeof (struct ca_msg))) { - return -EFAULT; - } - - return 0; -} - -static int ca_send_message(struct dst_state *state, struct ca_msg *p_ca_message, void *arg) -{ - int i = 0; - unsigned int ca_message_header_len; - + u8 i = 0; u32 command = 0; - struct ca_msg *hw_buffer; - - if ((hw_buffer = (struct ca_msg *) kmalloc(sizeof (struct ca_msg), GFP_KERNEL)) == NULL) { - printk("%s: Memory allocation failure\n", __FUNCTION__); - return -ENOMEM; - } - - dprintk("%s\n", __FUNCTION__); if (copy_from_user(p_ca_message, (void *)arg, sizeof (struct ca_msg))) return -EFAULT; + if (p_ca_message->msg) { - ca_message_header_len = p_ca_message->length; /* Restore it back when you are done */ - /* EN50221 tag */ - command = 0; + if (verbose > 3) + dprintk("Message = [%02x %02x %02x]\n", p_ca_message->msg[0], p_ca_message->msg[1], p_ca_message->msg[2]); for (i = 0; i < 3; i++) { command = command | p_ca_message->msg[i]; if (i < 2) command = command << 8; } - dprintk("%s:Command=[0x%x]\n", __FUNCTION__, command); + if (verbose > 3) + dprintk("%s:Command=[0x%x]\n", __FUNCTION__, command); switch (command) { - case CA_PMT: - dprintk("Command = SEND_CA_PMT\n"); - if ((ca_set_pmt(state, p_ca_message, hw_buffer, 0, 0)) < 0) { - dprintk("%s: -->CA_PMT Failed !\n", __FUNCTION__); - return -1; - } - dprintk("%s: -->CA_PMT Success !\n", __FUNCTION__); -// retval = dummy_set_pmt(state, p_ca_message, hw_buffer, 0, 0); - - break; - - case CA_PMT_REPLY: - dprintk("Command = CA_PMT_REPLY\n"); - /* Have to handle the 2 basic types of cards here */ - if ((dst_check_ca_pmt(state, p_ca_message, hw_buffer)) < 0) { - dprintk("%s: -->CA_PMT_REPLY Failed !\n", __FUNCTION__); - return -1; - } - dprintk("%s: -->CA_PMT_REPLY Success !\n", __FUNCTION__); - - /* Certain boards do behave different ? */ -// retval = ca_set_pmt(state, p_ca_message, hw_buffer, 1, 1); - - case CA_APP_INFO_ENQUIRY: // only for debugging - if (dst_ca_verbose) - dprintk("%s: Getting Cam Application information\n", __FUNCTION__); - - if ((ca_get_app_info(state)) < 0) { - dprintk("%s: -->CA_APP_INFO_ENQUIRY Failed !\n", __FUNCTION__); - return -1; - } - printk("%s: -->CA_APP_INFO_ENQUIRY Success !\n", __FUNCTION__); - - break; + case CA_APP_INFO: + memcpy(p_ca_message->msg, state->messages, 128); + if (copy_to_user((void *)arg, p_ca_message, sizeof (struct ca_msg)) ) + return -EFAULT; + break; } } + return 0; } -/* Board supports CA PMT reply ? */ -static int dst_check_ca_pmt(struct dst_state *state, struct ca_msg *p_ca_message, struct ca_msg *hw_buffer) +static int handle_en50221_tag(struct ca_msg *p_ca_message, struct ca_msg *hw_buffer) { - int ca_pmt_reply_test = 0; + if (session) { + hw_buffer->msg[2] = p_ca_message->msg[1]; /* MSB */ + hw_buffer->msg[3] = p_ca_message->msg[2]; /* LSB */ + } + else { + hw_buffer->msg[2] = 0x03; + hw_buffer->msg[3] = 0x00; + } + return 0; +} - /* Do test board */ - /* Not there yet but soon */ +static int debug_8820_buffer(struct ca_msg *hw_buffer) +{ + unsigned int i; + dprintk("%s:Debug=[", __FUNCTION__); + for (i = 0; i < (hw_buffer->msg[0] + 1); i++) + dprintk(" %02x", hw_buffer->msg[i]); + dprintk("]\n"); - /* CA PMT Reply capable */ - if (ca_pmt_reply_test) { - if ((ca_set_pmt(state, p_ca_message, hw_buffer, 1, GET_REPLY)) < 0) { - dprintk("%s: ca_set_pmt.. failed !\n", __FUNCTION__); - return -1; - } + return 0; +} - /* Process CA PMT Reply */ - /* will implement soon */ - dprintk("%s: Not there yet\n", __FUNCTION__); +static int write_to_8820(struct dst_state *state, struct ca_msg *hw_buffer, u8 reply) +{ + if ((dst_put_ci(state, hw_buffer->msg, (hw_buffer->length + 1), hw_buffer->msg, reply)) < 0) { + dprintk("%s: DST-CI Command failed.\n", __FUNCTION__); + dprintk("%s: Resetting DST.\n", __FUNCTION__); + rdc_reset_state(state); + return -1; } - /* CA PMT Reply not capable */ - if (!ca_pmt_reply_test) { - if ((ca_set_pmt(state, p_ca_message, hw_buffer, 0, NO_REPLY)) < 0) { - dprintk("%s: ca_set_pmt.. failed !\n", __FUNCTION__); - return -1; - } - dprintk("%s: ca_set_pmt.. success !\n", __FUNCTION__); - /* put a dummy message */ + if (verbose > 2) + dprintk("%s: DST-CI Command succes.\n", __FUNCTION__); - } return 0; } @@ -476,7 +348,8 @@ static int ca_set_pmt(struct dst_state *state, struct ca_msg *p_ca_message, stru u32 program_info_length = 0, es_info_length = 0, length = 0, words = 0; u8 found_prog_ca_desc = 0, found_stream_ca_desc = 0, error_condition = 0, hw_buffer_length = 0; - dprintk("%s, p_ca_message length %d (0x%x)\n", __FUNCTION__,p_ca_message->length,p_ca_message->length ); + if (verbose > 3) + dprintk("%s, p_ca_message length %d (0x%x)\n", __FUNCTION__,p_ca_message->length,p_ca_message->length ); handle_en50221_tag(p_ca_message, hw_buffer); /* EN50221 tag */ @@ -492,29 +365,34 @@ static int ca_set_pmt(struct dst_state *state, struct ca_msg *p_ca_message, stru length = length | p_ca_message->msg[4 + i]; } } - dprintk("%s:Length=[%d (0x%x)], Words=[%d]\n", __FUNCTION__, length,length, words); - - /* Debug Input string */ - for (i = 0; i < length; i++) - dprintk(" %02x", p_ca_message->msg[i]); - dprintk("]\n"); + if (verbose > 4) { + dprintk("%s:Length=[%d (0x%x)], Words=[%d]\n", __FUNCTION__, length,length, words); + /* Debug Input string */ + for (i = 0; i < length; i++) + dprintk(" %02x", p_ca_message->msg[i]); + dprintk("]\n"); + } hw_offset = 7; buf_offset = words + 4; /* Program Header */ - dprintk("\n%s:Program Header=[", __FUNCTION__); + if (verbose > 4) + dprintk("\n%s:Program Header=[", __FUNCTION__); for (i = 0; i < 6; i++) { hw_buffer->msg[hw_offset] = p_ca_message->msg[buf_offset]; - dprintk(" %02x", p_ca_message->msg[buf_offset]); + if (verbose > 4) + dprintk(" %02x", p_ca_message->msg[buf_offset]); hw_offset++, buf_offset++, hw_buffer_length++; } - dprintk("]\n"); + if (verbose > 4) + dprintk("]\n"); program_info_length = 0; program_info_length = (((program_info_length | p_ca_message->msg[words + 8]) & 0x0f) << 8) | p_ca_message->msg[words + 9]; - dprintk("%s:Program info Length=[%d][%02x], hw_offset=[%d], buf_offset=[%d] \n", + if (verbose > 4) + dprintk("%s:Program info Length=[%d][%02x], hw_offset=[%d], buf_offset=[%d] \n", __FUNCTION__, program_info_length, program_info_length, hw_offset, buf_offset); if (program_info_length && (program_info_length < 256)) { /* If program_info_length */ @@ -523,7 +401,8 @@ static int ca_set_pmt(struct dst_state *state, struct ca_msg *p_ca_message, stru if (p_ca_message->msg[buf_offset + 1] == 0x09) { /* Check CA descriptor */ found_prog_ca_desc = 1; - dprintk("%s: Found CA descriptor @ Program level\n", __FUNCTION__); + if (verbose > 4) + dprintk("%s: Found CA descriptor @ Program level\n", __FUNCTION__); } if (found_prog_ca_desc) { /* Command only if CA descriptor */ @@ -532,10 +411,10 @@ static int ca_set_pmt(struct dst_state *state, struct ca_msg *p_ca_message, stru } /* Program descriptors */ - - dprintk("%s:**********>buf_offset=[%d], hw_offset=[%d]\n", __FUNCTION__, buf_offset, hw_offset); - dprintk("%s:Program descriptors=[", __FUNCTION__); - + if (verbose > 4) { + dprintk("%s:**********>buf_offset=[%d], hw_offset=[%d]\n", __FUNCTION__, buf_offset, hw_offset); + dprintk("%s:Program descriptors=[", __FUNCTION__); + } while (program_info_length && !error_condition) { /* Copy prog descriptors */ if (program_info_length > p_ca_message->length) { /* Error situation */ dprintk ("%s:\"WARNING\" Length error, line=[%d], prog_info_length=[%d]\n", @@ -549,21 +428,25 @@ static int ca_set_pmt(struct dst_state *state, struct ca_msg *p_ca_message, stru dprintk(" %02x", p_ca_message->msg[buf_offset]); hw_offset++, buf_offset++, hw_buffer_length++, program_info_length--; } - dprintk("]\n"); - dprintk("%s:**********>buf_offset=[%d], hw_offset=[%d]\n", __FUNCTION__, buf_offset, hw_offset); - + if (verbose > 4) { + dprintk("]\n"); + dprintk("%s:**********>buf_offset=[%d], hw_offset=[%d]\n", __FUNCTION__, buf_offset, hw_offset); + } if (found_prog_ca_desc) { if (!reply) { hw_buffer->msg[13] = 0x01; /* OK descrambling */ - dprintk("CA PMT Command = OK Descrambling\n"); + if (verbose > 1) + dprintk("CA PMT Command = OK Descrambling\n"); } else { hw_buffer->msg[13] = 0x02; /* Ok MMI */ - dprintk("CA PMT Command = Ok MMI\n"); + if (verbose > 1) + dprintk("CA PMT Command = Ok MMI\n"); } if (query) { hw_buffer->msg[13] = 0x03; /* Query */ - dprintk("CA PMT Command = CA PMT query\n"); + if (verbose > 1) + dprintk("CA PMT Command = CA PMT query\n"); } } } @@ -571,9 +454,9 @@ static int ca_set_pmt(struct dst_state *state, struct ca_msg *p_ca_message, stru hw_buffer->msg[11] = hw_buffer->msg[11] & 0xf0; /* Don't write to ASIC */ hw_buffer->msg[12] = hw_buffer->msg[12] = 0x00; } - - dprintk("%s:**********>p_ca_message->length=[%d], buf_offset=[%d], hw_offset=[%d]\n", - __FUNCTION__, p_ca_message->length, buf_offset, hw_offset); + if (verbose > 4) + dprintk("%s:**********>p_ca_message->length=[%d], buf_offset=[%d], hw_offset=[%d]\n", + __FUNCTION__, p_ca_message->length, buf_offset, hw_offset); while ((buf_offset < p_ca_message->length) && !error_condition) { /* Bail out in case of an indefinite loop */ @@ -595,15 +478,16 @@ static int ca_set_pmt(struct dst_state *state, struct ca_msg *p_ca_message, stru es_info_length = 0; es_info_length = (es_info_length | (p_ca_message->msg[buf_offset + 3] & 0x0f)) << 8 | p_ca_message->msg[buf_offset + 4]; - dprintk("\n%s:----->Stream header=[%02x %02x %02x %02x %02x]\n", __FUNCTION__, - p_ca_message->msg[buf_offset + 0], p_ca_message->msg[buf_offset + 1], - p_ca_message->msg[buf_offset + 2], p_ca_message->msg[buf_offset + 3], - p_ca_message->msg[buf_offset + 4]); - - dprintk("%s:----->Stream type=[%02x], es length=[%d (0x%x)], Chars=[%02x] [%02x], buf_offset=[%d]\n", __FUNCTION__, - p_ca_message->msg[buf_offset + 0], es_info_length, es_info_length, - p_ca_message->msg[buf_offset + 3], p_ca_message->msg[buf_offset + 4], buf_offset); + if (verbose > 4) { + dprintk("\n%s:----->Stream header=[%02x %02x %02x %02x %02x]\n", __FUNCTION__, + p_ca_message->msg[buf_offset + 0], p_ca_message->msg[buf_offset + 1], + p_ca_message->msg[buf_offset + 2], p_ca_message->msg[buf_offset + 3], + p_ca_message->msg[buf_offset + 4]); + dprintk("%s:----->Stream type=[%02x], es length=[%d (0x%x)], Chars=[%02x] [%02x], buf_offset=[%d]\n", __FUNCTION__, + p_ca_message->msg[buf_offset + 0], es_info_length, es_info_length, + p_ca_message->msg[buf_offset + 3], p_ca_message->msg[buf_offset + 4], buf_offset); + } hw_buffer->msg[hw_offset + 3] &= 0x0f; /* req only 4 bits */ @@ -616,7 +500,8 @@ static int ca_set_pmt(struct dst_state *state, struct ca_msg *p_ca_message, stru /* Check for CA descriptor */ if (p_ca_message->msg[buf_offset + 1] == 0x09) { - dprintk("%s:Found CA descriptor @ Stream level\n", __FUNCTION__); + if (verbose > 4) + dprintk("%s:Found CA descriptor @ Stream level\n", __FUNCTION__); found_stream_ca_desc = 1; } @@ -625,25 +510,29 @@ static int ca_set_pmt(struct dst_state *state, struct ca_msg *p_ca_message, stru if (es_info_length && !error_condition && !found_prog_ca_desc && found_stream_ca_desc) { // if (!ca_pmt_done) { hw_buffer->msg[hw_offset] = p_ca_message->msg[buf_offset]; /* CA PMT cmd(es) */ - printk("%s:----->CA PMT Command ID=[%02x]\n", __FUNCTION__, p_ca_message->msg[buf_offset]); + if (verbose > 4) + printk("%s:----->CA PMT Command ID=[%02x]\n", __FUNCTION__, p_ca_message->msg[buf_offset]); // hw_offset++, buf_offset++, hw_buffer_length++, es_info_length--, ca_pmt_done = 1; hw_offset++, buf_offset++, hw_buffer_length++, es_info_length--; // } - - dprintk("%s:----->ES descriptors=[", __FUNCTION__); + if (verbose > 4) + dprintk("%s:----->ES descriptors=[", __FUNCTION__); while (es_info_length && !error_condition) { /* ES descriptors */ if ((es_info_length > p_ca_message->length) || (buf_offset > p_ca_message->length)) { - dprintk("%s:\"WARNING\" ES Length error, line=[%d], es_info_length=[%d], buf_offset=[%d]\n", + if (verbose > 4) { + dprintk("%s:\"WARNING\" ES Length error, line=[%d], es_info_length=[%d], buf_offset=[%d]\n", __FUNCTION__, __LINE__, es_info_length, buf_offset); - dprintk("%s:\"WARNING\" Bailing out of possible loop\n", __FUNCTION__); + dprintk("%s:\"WARNING\" Bailing out of possible loop\n", __FUNCTION__); + } error_condition = 1; break; } hw_buffer->msg[hw_offset] = p_ca_message->msg[buf_offset]; - dprintk("%02x ", hw_buffer->msg[hw_offset]); + if (verbose > 3) + dprintk("%02x ", hw_buffer->msg[hw_offset]); hw_offset++, buf_offset++, hw_buffer_length++, es_info_length--; } found_stream_ca_desc = 0; /* unset for new streams */ @@ -666,123 +555,254 @@ static int ca_set_pmt(struct dst_state *state, struct ca_msg *p_ca_message, stru put_checksum(&hw_buffer->msg[0], hw_buffer->msg[0]); /* Do the actual write */ - - dprintk("%s:======================DEBUGGING================================\n", __FUNCTION__); - dprintk("%s: Actual Length=[%d]\n", __FUNCTION__, hw_buffer_length); + if (verbose > 4) { + dprintk("%s:======================DEBUGGING================================\n", __FUNCTION__); + dprintk("%s: Actual Length=[%d]\n", __FUNCTION__, hw_buffer_length); + } /* Only for debugging! */ - debug_8820_buffer(hw_buffer); - dprintk("%s: Reply = [%d]\n", __FUNCTION__, reply); + if (verbose > 2) + debug_8820_buffer(hw_buffer); + if (verbose > 3) + dprintk("%s: Reply = [%d]\n", __FUNCTION__, reply); write_to_8820(state, hw_buffer, reply); return 0; } -/* Set PMT Helper functions */ - -static int handle_en50221_tag(struct ca_msg *p_ca_message, struct ca_msg *hw_buffer) +/* Board supports CA PMT reply ? */ +static int dst_check_ca_pmt(struct dst_state *state, struct ca_msg *p_ca_message, struct ca_msg *hw_buffer) { - if (session) { - hw_buffer->msg[2] = p_ca_message->msg[1]; /* MSB */ - hw_buffer->msg[3] = p_ca_message->msg[2]; /* LSB */ + int ca_pmt_reply_test = 0; + + /* Do test board */ + /* Not there yet but soon */ + + + /* CA PMT Reply capable */ + if (ca_pmt_reply_test) { + if ((ca_set_pmt(state, p_ca_message, hw_buffer, 1, GET_REPLY)) < 0) { + dprintk("%s: ca_set_pmt.. failed !\n", __FUNCTION__); + return -1; + } + + /* Process CA PMT Reply */ + /* will implement soon */ + dprintk("%s: Not there yet\n", __FUNCTION__); } - else { - hw_buffer->msg[2] = 0x03; - hw_buffer->msg[3] = 0x00; + /* CA PMT Reply not capable */ + if (!ca_pmt_reply_test) { + if ((ca_set_pmt(state, p_ca_message, hw_buffer, 0, NO_REPLY)) < 0) { + dprintk("%s: ca_set_pmt.. failed !\n", __FUNCTION__); + return -1; + } + if (verbose > 3) + dprintk("%s: ca_set_pmt.. success !\n", __FUNCTION__); + /* put a dummy message */ + } return 0; } -static int write_to_8820(struct dst_state *state, struct ca_msg *hw_buffer, u8 reply) +static int ca_send_message(struct dst_state *state, struct ca_msg *p_ca_message, void *arg) { - if ((dst_put_ci(state, hw_buffer->msg, (hw_buffer->length + 1), hw_buffer->msg, reply)) < 0) { - dprintk("%s: DST-CI Command failed.\n", __FUNCTION__); - dprintk("%s: Resetting DST.\n", __FUNCTION__); - rdc_reset_state(state); - return -1; + int i = 0; + unsigned int ca_message_header_len; + + u32 command = 0; + struct ca_msg *hw_buffer; + + if ((hw_buffer = (struct ca_msg *) kmalloc(sizeof (struct ca_msg), GFP_KERNEL)) == NULL) { + printk("%s: Memory allocation failure\n", __FUNCTION__); + return -ENOMEM; } - dprintk("%s: DST-CI Command succes.\n", __FUNCTION__); + if (verbose > 3) + dprintk("%s\n", __FUNCTION__); - return 0; -} + if (copy_from_user(p_ca_message, (void *)arg, sizeof (struct ca_msg))) + return -EFAULT; -static int debug_8820_buffer(struct ca_msg *hw_buffer) -{ - unsigned int i; + if (p_ca_message->msg) { + ca_message_header_len = p_ca_message->length; /* Restore it back when you are done */ + /* EN50221 tag */ + command = 0; - dprintk("%s:Debug=[", __FUNCTION__); - for (i = 0; i < (hw_buffer->msg[0] + 1); i++) - dprintk(" %02x", hw_buffer->msg[i]); - dprintk("]\n"); + for (i = 0; i < 3; i++) { + command = command | p_ca_message->msg[i]; + if (i < 2) + command = command << 8; + } + if (verbose > 3) + dprintk("%s:Command=[0x%x]\n", __FUNCTION__, command); - return 0; -} + switch (command) { + case CA_PMT: + if (verbose > 3) + dprintk("Command = SEND_CA_PMT\n"); + if ((ca_set_pmt(state, p_ca_message, hw_buffer, 0, 0)) < 0) { + dprintk("%s: -->CA_PMT Failed !\n", __FUNCTION__); + return -1; + } + if (verbose > 3) + dprintk("%s: -->CA_PMT Success !\n", __FUNCTION__); +// retval = dummy_set_pmt(state, p_ca_message, hw_buffer, 0, 0); -/* End of Set PMT Helper functions */ + break; + case CA_PMT_REPLY: + if (verbose > 3) + dprintk("Command = CA_PMT_REPLY\n"); + /* Have to handle the 2 basic types of cards here */ + if ((dst_check_ca_pmt(state, p_ca_message, hw_buffer)) < 0) { + dprintk("%s: -->CA_PMT_REPLY Failed !\n", __FUNCTION__); + return -1; + } + if (verbose > 3) + dprintk("%s: -->CA_PMT_REPLY Success !\n", __FUNCTION__); -static int dst_ci_command(struct dst_state* state, u8 * data, u8 *ca_string, u8 len, int read) -{ - u8 reply; + /* Certain boards do behave different ? */ +// retval = ca_set_pmt(state, p_ca_message, hw_buffer, 1, 1); - dst_comm_init(state); - msleep(65); + case CA_APP_INFO_ENQUIRY: // only for debugging + if (verbose > 3) + dprintk("%s: Getting Cam Application information\n", __FUNCTION__); - if (write_dst(state, data, len)) { - dprintk("%s: Write not successful, trying to recover\n", __FUNCTION__); - dst_error_recovery(state); - return -1; - } + if ((ca_get_app_info(state)) < 0) { + dprintk("%s: -->CA_APP_INFO_ENQUIRY Failed !\n", __FUNCTION__); + return -1; + } + if (verbose > 3) + printk("%s: -->CA_APP_INFO_ENQUIRY Success !\n", __FUNCTION__); - if ((dst_pio_disable(state)) < 0) { - dprintk("%s: DST PIO disable failed.\n", __FUNCTION__); - return -1; + break; + } } + return 0; +} - if (read_dst(state, &reply, GET_ACK) < 0) { - dprintk("%s: Read not successful, trying to recover\n", __FUNCTION__); - dst_error_recovery(state); - return -1; +static int dst_ca_ioctl(struct inode *inode, struct file *file, unsigned int cmd, void *arg) +{ + struct dvb_device* dvbdev = (struct dvb_device*) file->private_data; + struct dst_state* state = (struct dst_state*) dvbdev->priv; + struct ca_slot_info *p_ca_slot_info; + struct ca_caps *p_ca_caps; + struct ca_msg *p_ca_message; + + if ((p_ca_message = (struct ca_msg *) kmalloc(sizeof (struct ca_msg), GFP_KERNEL)) == NULL) { + printk("%s: Memory allocation failure\n", __FUNCTION__); + return -ENOMEM; } - if (read) { - if (! dst_wait_dst_ready(state, LONG_DELAY)) { - dprintk("%s: 8820 not ready\n", __FUNCTION__); - return -1; - } + if ((p_ca_slot_info = (struct ca_slot_info *) kmalloc(sizeof (struct ca_slot_info), GFP_KERNEL)) == NULL) { + printk("%s: Memory allocation failure\n", __FUNCTION__); + return -ENOMEM; + } - if (read_dst(state, ca_string, 128) < 0) { /* Try to make this dynamic */ - dprintk("%s: Read not successful, trying to recover\n", __FUNCTION__); - dst_error_recovery(state); - return -1; - } + if ((p_ca_caps = (struct ca_caps *) kmalloc(sizeof (struct ca_caps), GFP_KERNEL)) == NULL) { + printk("%s: Memory allocation failure\n", __FUNCTION__); + return -ENOMEM; } - return 0; -} + /* We have now only the standard ioctl's, the driver is upposed to handle internals. */ + switch (cmd) { + case CA_SEND_MSG: + if (verbose > 1) + dprintk("%s: Sending message\n", __FUNCTION__); + if ((ca_send_message(state, p_ca_message, arg)) < 0) { + dprintk("%s: -->CA_SEND_MSG Failed !\n", __FUNCTION__); + return -1; + } + break; -static int dst_put_ci(struct dst_state *state, u8 *data, int len, u8 *ca_string, int read) -{ - u8 dst_ca_comm_err = 0; + case CA_GET_MSG: + if (verbose > 1) + dprintk("%s: Getting message\n", __FUNCTION__); + if ((ca_get_message(state, p_ca_message, arg)) < 0) { + dprintk("%s: -->CA_GET_MSG Failed !\n", __FUNCTION__); + return -1; + } + if (verbose > 1) + dprintk("%s: -->CA_GET_MSG Success !\n", __FUNCTION__); - while (dst_ca_comm_err < RETRIES) { - dst_comm_init(state); + break; - dprintk("%s: Put Command\n", __FUNCTION__); - if (dst_ci_command(state, data, ca_string, len, read)) { // If error - dst_error_recovery(state); - dst_ca_comm_err++; // work required here. - } - break; - } + case CA_RESET: + if (verbose > 1) + dprintk("%s: Resetting DST\n", __FUNCTION__); + dst_error_bailout(state); + msleep(4000); + + break; + + case CA_GET_SLOT_INFO: + if (verbose > 1) + dprintk("%s: Getting Slot info\n", __FUNCTION__); + if ((ca_get_slot_info(state, p_ca_slot_info, arg)) < 0) { + dprintk("%s: -->CA_GET_SLOT_INFO Failed !\n", __FUNCTION__); + return -1; + } + if (verbose > 1) + dprintk("%s: -->CA_GET_SLOT_INFO Success !\n", __FUNCTION__); + + break; + + case CA_GET_CAP: + if (verbose > 1) + dprintk("%s: Getting Slot capabilities\n", __FUNCTION__); + if ((ca_get_slot_caps(state, p_ca_caps, arg)) < 0) { + dprintk("%s: -->CA_GET_CAP Failed !\n", __FUNCTION__); + return -1; + } + if (verbose > 1) + dprintk("%s: -->CA_GET_CAP Success !\n", __FUNCTION__); + + break; + + case CA_GET_DESCR_INFO: + if (verbose > 1) + dprintk("%s: Getting descrambler description\n", __FUNCTION__); + if ((ca_get_slot_descr(state, p_ca_message, arg)) < 0) { + dprintk("%s: -->CA_GET_DESCR_INFO Failed !\n", __FUNCTION__); + return -1; + } + if (verbose > 1) + dprintk("%s: -->CA_GET_DESCR_INFO Success !\n", __FUNCTION__); + + break; + + case CA_SET_DESCR: + if (verbose > 1) + dprintk("%s: Setting descrambler\n", __FUNCTION__); + if ((ca_set_slot_descr()) < 0) { + dprintk("%s: -->CA_SET_DESCR Failed !\n", __FUNCTION__); + return -1; + } + if (verbose > 1) + dprintk("%s: -->CA_SET_DESCR Success !\n", __FUNCTION__); + + break; + + case CA_SET_PID: + if (verbose > 1) + dprintk("%s: Setting PID\n", __FUNCTION__); + if ((ca_set_pid()) < 0) { + dprintk("%s: -->CA_SET_PID Failed !\n", __FUNCTION__); + return -1; + } + if (verbose > 1) + dprintk("%s: -->CA_SET_PID Success !\n", __FUNCTION__); + + default: + return -EOPNOTSUPP; + }; return 0; } - static int dst_ca_open(struct inode *inode, struct file *file) { - dprintk("%s:Device opened [%p]\n", __FUNCTION__, file); + if (verbose > 4) + dprintk("%s:Device opened [%p]\n", __FUNCTION__, file); try_module_get(THIS_MODULE); return 0; @@ -790,7 +810,8 @@ static int dst_ca_open(struct inode *inode, struct file *file) static int dst_ca_release(struct inode *inode, struct file *file) { - dprintk("%s:Device closed.\n", __FUNCTION__); + if (verbose > 4) + dprintk("%s:Device closed.\n", __FUNCTION__); module_put(THIS_MODULE); return 0; @@ -799,25 +820,43 @@ static int dst_ca_release(struct inode *inode, struct file *file) static int dst_ca_read(struct file *file, char __user * buffer, size_t length, loff_t * offset) { int bytes_read = 0; - dprintk("%s:Device read.\n", __FUNCTION__); + + if (verbose > 4) + dprintk("%s:Device read.\n", __FUNCTION__); return bytes_read; } static int dst_ca_write(struct file *file, const char __user * buffer, size_t length, loff_t * offset) { - dprintk("%s:Device write.\n", __FUNCTION__); + if (verbose > 4) + dprintk("%s:Device write.\n", __FUNCTION__); return 0; } +static struct file_operations dst_ca_fops = { + .owner = THIS_MODULE, + .ioctl = (void *)dst_ca_ioctl, + .open = dst_ca_open, + .release = dst_ca_release, + .read = dst_ca_read, + .write = dst_ca_write +}; + +static struct dvb_device dvbdev_ca = { + .priv = NULL, + .users = 1, + .readers = 1, + .writers = 1, + .fops = &dst_ca_fops +}; int dst_ca_attach(struct dst_state *dst, struct dvb_adapter *dvb_adapter) { - struct dvb_device *dvbdev; - - dprintk("%s:registering DST-CA device\n", __FUNCTION__); + if (verbose > 4) + dprintk("%s:registering DST-CA device\n", __FUNCTION__); dvb_register_device(dvb_adapter, &dvbdev, &dvbdev_ca, dst, DVB_DEVICE_CA); return 0; } |