4 * CI driver in conjunction with NetUp Dual DVB-T/C RF CI card
6 * Copyright (C) 2010,2011 NetUP Inc.
7 * Copyright (C) 2010,2011 Igor M. Liplianin <liplianin@netup.ru>
9 * This program is free software; you can redistribute it and/or modify
10 * it under the terms of the GNU General Public License as published by
11 * the Free Software Foundation; either version 2 of the License, or
12 * (at your option) any later version.
14 * This program is distributed in the hope that it will be useful,
15 * but WITHOUT ANY WARRANTY; without even the implied warranty of
16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
18 * GNU General Public License for more details.
22 * currently cx23885 GPIO's used.
25 * GPIO-2 ~reset chips out
26 * GPIO-3 to GPIO-10 data/addr for CA in/out
37 * Bit definitions for MC417_RWD and MC417_OEN registers
42 * bit 15 bit 14 bit 13 bit 12 bit 11 bit 10 bit 9 bit 8
43 * +-------+-------+-------+-------+-------+-------+-------+-------+
44 * | TDI | TDO | TCK | RDY# | #RD | #WR | AD_RG | #CS |
45 * +-------+-------+-------+-------+-------+-------+-------+-------+
46 * bit 7 bit 6 bit 5 bit 4 bit 3 bit 2 bit 1 bit 0
47 * +-------+-------+-------+-------+-------+-------+-------+-------+
48 * | DATA7| DATA6| DATA5| DATA4| DATA3| DATA2| DATA1| DATA0|
49 * +-------+-------+-------+-------+-------+-------+-------+-------+
52 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
54 #include <dvb_demux.h>
55 #include <dvb_frontend.h>
56 #include "altera-ci.h"
57 #include "dvb_ca_en50221.h"
60 #define NETUP_CI_INT_CTRL 0x00
61 #define NETUP_CI_BUSCTRL2 0x01
62 #define NETUP_CI_ADDR0 0x04
63 #define NETUP_CI_ADDR1 0x05
64 #define NETUP_CI_DATA 0x06
65 #define NETUP_CI_BUSCTRL 0x07
66 #define NETUP_CI_PID_ADDR0 0x08
67 #define NETUP_CI_PID_ADDR1 0x09
68 #define NETUP_CI_PID_DATA 0x0a
69 #define NETUP_CI_TSA_DIV 0x0c
70 #define NETUP_CI_TSB_DIV 0x0d
71 #define NETUP_CI_REVISION 0x0f
74 #define NETUP_CI_FLG_CTL 1
75 #define NETUP_CI_FLG_RD 1
76 #define NETUP_CI_FLG_AD 1
78 static unsigned int ci_dbg;
79 module_param(ci_dbg, int, 0644);
80 MODULE_PARM_DESC(ci_dbg, "Enable CI debugging");
82 static unsigned int pid_dbg;
83 module_param(pid_dbg, int, 0644);
84 MODULE_PARM_DESC(pid_dbg, "Enable PID filtering debugging");
86 MODULE_DESCRIPTION("altera FPGA CI module");
87 MODULE_AUTHOR("Igor M. Liplianin <liplianin@netup.ru>");
88 MODULE_LICENSE("GPL");
90 #define ci_dbg_print(fmt, args...) \
93 printk(KERN_DEBUG pr_fmt("%s: " fmt), \
97 #define pid_dbg_print(fmt, args...) \
100 printk(KERN_DEBUG pr_fmt("%s: " fmt), \
104 struct altera_ci_state;
105 struct netup_hw_pid_filter;
107 struct fpga_internal {
109 struct mutex fpga_mutex;/* two CI's on the same fpga */
110 struct netup_hw_pid_filter *pid_filt[2];
111 struct altera_ci_state *state[2];
112 struct work_struct work;
113 int (*fpga_rw) (void *dev, int flag, int data, int rw);
119 /* stores all private variables for communication with CI */
120 struct altera_ci_state {
121 struct fpga_internal *internal;
122 struct dvb_ca_en50221 ca;
127 /* stores all private variables for hardware pid filtering */
128 struct netup_hw_pid_filter {
129 struct fpga_internal *internal;
130 struct dvb_demux *demux;
131 /* save old functions */
132 int (*start_feed)(struct dvb_demux_feed *feed);
133 int (*stop_feed)(struct dvb_demux_feed *feed);
139 /* internal params node */
141 /* pointer for internal params, one for each pair of CI's */
142 struct fpga_internal *internal;
143 struct fpga_inode *next_inode;
146 /* first internal params */
147 static struct fpga_inode *fpga_first_inode;
149 /* find chip by dev */
150 static struct fpga_inode *find_inode(void *dev)
152 struct fpga_inode *temp_chip = fpga_first_inode;
154 if (temp_chip == NULL)
158 Search for the last fpga CI chip or
160 while ((temp_chip != NULL) &&
161 (temp_chip->internal->dev != dev))
162 temp_chip = temp_chip->next_inode;
167 static struct fpga_internal *check_filter(struct fpga_internal *temp_int,
168 void *demux_dev, int filt_nr)
170 if (temp_int == NULL)
173 if ((temp_int->pid_filt[filt_nr]) == NULL)
176 if (temp_int->pid_filt[filt_nr]->demux == demux_dev)
182 /* find chip by demux */
183 static struct fpga_inode *find_dinode(void *demux_dev)
185 struct fpga_inode *temp_chip = fpga_first_inode;
186 struct fpga_internal *temp_int;
189 * Search of the last fpga CI chip or
192 while (temp_chip != NULL) {
193 if (temp_chip->internal != NULL) {
194 temp_int = temp_chip->internal;
195 if (check_filter(temp_int, demux_dev, 0))
197 if (check_filter(temp_int, demux_dev, 1))
201 temp_chip = temp_chip->next_inode;
207 /* deallocating chip */
208 static void remove_inode(struct fpga_internal *internal)
210 struct fpga_inode *prev_node = fpga_first_inode;
211 struct fpga_inode *del_node = find_inode(internal->dev);
213 if (del_node != NULL) {
214 if (del_node == fpga_first_inode) {
215 fpga_first_inode = del_node->next_inode;
217 while (prev_node->next_inode != del_node)
218 prev_node = prev_node->next_inode;
220 if (del_node->next_inode == NULL)
221 prev_node->next_inode = NULL;
223 prev_node->next_inode =
224 prev_node->next_inode->next_inode;
231 /* allocating new chip */
232 static struct fpga_inode *append_internal(struct fpga_internal *internal)
234 struct fpga_inode *new_node = fpga_first_inode;
236 if (new_node == NULL) {
237 new_node = kmalloc(sizeof(struct fpga_inode), GFP_KERNEL);
238 fpga_first_inode = new_node;
240 while (new_node->next_inode != NULL)
241 new_node = new_node->next_inode;
243 new_node->next_inode =
244 kmalloc(sizeof(struct fpga_inode), GFP_KERNEL);
245 if (new_node->next_inode != NULL)
246 new_node = new_node->next_inode;
251 if (new_node != NULL) {
252 new_node->internal = internal;
253 new_node->next_inode = NULL;
259 static int netup_fpga_op_rw(struct fpga_internal *inter, int addr,
262 inter->fpga_rw(inter->dev, NETUP_CI_FLG_AD, addr, 0);
263 return inter->fpga_rw(inter->dev, 0, val, read);
266 /* flag - mem/io, read - read/write */
267 static int altera_ci_op_cam(struct dvb_ca_en50221 *en50221, int slot,
268 u8 flag, u8 read, int addr, u8 val)
271 struct altera_ci_state *state = en50221->data;
272 struct fpga_internal *inter = state->internal;
280 mutex_lock(&inter->fpga_mutex);
282 netup_fpga_op_rw(inter, NETUP_CI_ADDR0, ((addr << 1) & 0xfe), 0);
283 netup_fpga_op_rw(inter, NETUP_CI_ADDR1, ((addr >> 7) & 0x7f), 0);
284 store = netup_fpga_op_rw(inter, NETUP_CI_BUSCTRL, 0, NETUP_CI_FLG_RD);
287 store |= ((state->nr << 7) | (flag << 6));
289 netup_fpga_op_rw(inter, NETUP_CI_BUSCTRL, store, 0);
290 mem = netup_fpga_op_rw(inter, NETUP_CI_DATA, val, read);
292 mutex_unlock(&inter->fpga_mutex);
294 ci_dbg_print("%s: %s: addr=[0x%02x], %s=%x\n", __func__,
295 (read) ? "read" : "write", addr,
296 (flag == NETUP_CI_FLG_CTL) ? "ctl" : "mem",
302 static int altera_ci_read_attribute_mem(struct dvb_ca_en50221 *en50221,
305 return altera_ci_op_cam(en50221, slot, 0, NETUP_CI_FLG_RD, addr, 0);
308 static int altera_ci_write_attribute_mem(struct dvb_ca_en50221 *en50221,
309 int slot, int addr, u8 data)
311 return altera_ci_op_cam(en50221, slot, 0, 0, addr, data);
314 static int altera_ci_read_cam_ctl(struct dvb_ca_en50221 *en50221,
317 return altera_ci_op_cam(en50221, slot, NETUP_CI_FLG_CTL,
318 NETUP_CI_FLG_RD, addr, 0);
321 static int altera_ci_write_cam_ctl(struct dvb_ca_en50221 *en50221, int slot,
324 return altera_ci_op_cam(en50221, slot, NETUP_CI_FLG_CTL, 0, addr, data);
327 static int altera_ci_slot_reset(struct dvb_ca_en50221 *en50221, int slot)
329 struct altera_ci_state *state = en50221->data;
330 struct fpga_internal *inter = state->internal;
331 /* reasonable timeout for CI reset is 10 seconds */
332 unsigned long t_out = jiffies + msecs_to_jiffies(9999);
335 ci_dbg_print("%s\n", __func__);
340 mutex_lock(&inter->fpga_mutex);
342 ret = netup_fpga_op_rw(inter, NETUP_CI_BUSCTRL, 0, NETUP_CI_FLG_RD);
343 netup_fpga_op_rw(inter, NETUP_CI_BUSCTRL,
344 (ret & 0xcf) | (1 << (5 - state->nr)), 0);
346 mutex_unlock(&inter->fpga_mutex);
351 mutex_lock(&inter->fpga_mutex);
353 ret = netup_fpga_op_rw(inter, NETUP_CI_BUSCTRL,
355 mutex_unlock(&inter->fpga_mutex);
357 if ((ret & (1 << (5 - state->nr))) == 0)
359 if (time_after(jiffies, t_out))
364 ci_dbg_print("%s: %d msecs\n", __func__,
365 jiffies_to_msecs(jiffies + msecs_to_jiffies(9999) - t_out));
370 static int altera_ci_slot_shutdown(struct dvb_ca_en50221 *en50221, int slot)
372 /* not implemented */
376 static int altera_ci_slot_ts_ctl(struct dvb_ca_en50221 *en50221, int slot)
378 struct altera_ci_state *state = en50221->data;
379 struct fpga_internal *inter = state->internal;
382 ci_dbg_print("%s\n", __func__);
387 mutex_lock(&inter->fpga_mutex);
389 ret = netup_fpga_op_rw(inter, NETUP_CI_BUSCTRL, 0, NETUP_CI_FLG_RD);
390 netup_fpga_op_rw(inter, NETUP_CI_BUSCTRL,
391 (ret & 0x0f) | (1 << (3 - state->nr)), 0);
393 mutex_unlock(&inter->fpga_mutex);
399 static void netup_read_ci_status(struct work_struct *work)
401 struct fpga_internal *inter =
402 container_of(work, struct fpga_internal, work);
405 ci_dbg_print("%s\n", __func__);
407 mutex_lock(&inter->fpga_mutex);
409 ret = netup_fpga_op_rw(inter, NETUP_CI_INT_CTRL, 0, NETUP_CI_FLG_RD);
410 ret = netup_fpga_op_rw(inter, NETUP_CI_BUSCTRL, 0, NETUP_CI_FLG_RD);
412 mutex_unlock(&inter->fpga_mutex);
414 if (inter->state[1] != NULL) {
415 inter->state[1]->status =
417 DVB_CA_EN50221_POLL_CAM_PRESENT |
418 DVB_CA_EN50221_POLL_CAM_READY : 0);
419 ci_dbg_print("%s: setting CI[1] status = 0x%x\n",
420 __func__, inter->state[1]->status);
423 if (inter->state[0] != NULL) {
424 inter->state[0]->status =
426 DVB_CA_EN50221_POLL_CAM_PRESENT |
427 DVB_CA_EN50221_POLL_CAM_READY : 0);
428 ci_dbg_print("%s: setting CI[0] status = 0x%x\n",
429 __func__, inter->state[0]->status);
434 int altera_ci_irq(void *dev)
436 struct fpga_inode *temp_int = NULL;
437 struct fpga_internal *inter = NULL;
439 ci_dbg_print("%s\n", __func__);
442 temp_int = find_inode(dev);
443 if (temp_int != NULL) {
444 inter = temp_int->internal;
445 schedule_work(&inter->work);
451 EXPORT_SYMBOL(altera_ci_irq);
453 static int altera_poll_ci_slot_status(struct dvb_ca_en50221 *en50221,
456 struct altera_ci_state *state = en50221->data;
461 return state->status;
464 static void altera_hw_filt_release(void *main_dev, int filt_nr)
466 struct fpga_inode *temp_int = find_inode(main_dev);
467 struct netup_hw_pid_filter *pid_filt = NULL;
469 ci_dbg_print("%s\n", __func__);
471 if (temp_int != NULL) {
472 pid_filt = temp_int->internal->pid_filt[filt_nr - 1];
473 /* stored old feed controls */
474 pid_filt->demux->start_feed = pid_filt->start_feed;
475 pid_filt->demux->stop_feed = pid_filt->stop_feed;
477 if (((--(temp_int->internal->filts_used)) <= 0) &&
478 ((temp_int->internal->cis_used) <= 0)) {
480 ci_dbg_print("%s: Actually removing\n", __func__);
482 remove_inode(temp_int->internal);
483 kfree(pid_filt->internal);
492 void altera_ci_release(void *dev, int ci_nr)
494 struct fpga_inode *temp_int = find_inode(dev);
495 struct altera_ci_state *state = NULL;
497 ci_dbg_print("%s\n", __func__);
499 if (temp_int != NULL) {
500 state = temp_int->internal->state[ci_nr - 1];
501 altera_hw_filt_release(dev, ci_nr);
504 if (((temp_int->internal->filts_used) <= 0) &&
505 ((--(temp_int->internal->cis_used)) <= 0)) {
507 ci_dbg_print("%s: Actually removing\n", __func__);
509 remove_inode(temp_int->internal);
510 kfree(state->internal);
514 if (state->ca.data != NULL)
515 dvb_ca_en50221_release(&state->ca);
522 EXPORT_SYMBOL(altera_ci_release);
524 static void altera_pid_control(struct netup_hw_pid_filter *pid_filt,
527 struct fpga_internal *inter = pid_filt->internal;
530 /* pid 0-0x1f always enabled, don't touch them */
531 if ((pid == 0x2000) || (pid < 0x20))
534 mutex_lock(&inter->fpga_mutex);
536 netup_fpga_op_rw(inter, NETUP_CI_PID_ADDR0, (pid >> 3) & 0xff, 0);
537 netup_fpga_op_rw(inter, NETUP_CI_PID_ADDR1,
538 ((pid >> 11) & 0x03) | (pid_filt->nr << 2), 0);
540 store = netup_fpga_op_rw(inter, NETUP_CI_PID_DATA, 0, NETUP_CI_FLG_RD);
542 if (onoff)/* 0 - on, 1 - off */
543 store |= (1 << (pid & 7));
545 store &= ~(1 << (pid & 7));
547 netup_fpga_op_rw(inter, NETUP_CI_PID_DATA, store, 0);
549 mutex_unlock(&inter->fpga_mutex);
551 pid_dbg_print("%s: (%d) set pid: %5d 0x%04x '%s'\n", __func__,
552 pid_filt->nr, pid, pid, onoff ? "off" : "on");
555 static void altera_toggle_fullts_streaming(struct netup_hw_pid_filter *pid_filt,
556 int filt_nr, int onoff)
558 struct fpga_internal *inter = pid_filt->internal;
562 pid_dbg_print("%s: pid_filt->nr[%d] now %s\n", __func__, pid_filt->nr,
563 onoff ? "off" : "on");
565 if (onoff)/* 0 - on, 1 - off */
566 store = 0xff;/* ignore pid */
568 store = 0;/* enable pid */
570 mutex_lock(&inter->fpga_mutex);
572 for (i = 0; i < 1024; i++) {
573 netup_fpga_op_rw(inter, NETUP_CI_PID_ADDR0, i & 0xff, 0);
575 netup_fpga_op_rw(inter, NETUP_CI_PID_ADDR1,
576 ((i >> 8) & 0x03) | (pid_filt->nr << 2), 0);
577 /* pid 0-0x1f always enabled */
578 netup_fpga_op_rw(inter, NETUP_CI_PID_DATA,
579 (i > 3 ? store : 0), 0);
582 mutex_unlock(&inter->fpga_mutex);
585 static int altera_pid_feed_control(void *demux_dev, int filt_nr,
586 struct dvb_demux_feed *feed, int onoff)
588 struct fpga_inode *temp_int = find_dinode(demux_dev);
589 struct fpga_internal *inter = temp_int->internal;
590 struct netup_hw_pid_filter *pid_filt = inter->pid_filt[filt_nr - 1];
592 altera_pid_control(pid_filt, feed->pid, onoff ? 0 : 1);
593 /* call old feed proc's */
595 pid_filt->start_feed(feed);
597 pid_filt->stop_feed(feed);
599 if (feed->pid == 0x2000)
600 altera_toggle_fullts_streaming(pid_filt, filt_nr,
606 static int altera_ci_start_feed(struct dvb_demux_feed *feed, int num)
608 altera_pid_feed_control(feed->demux, num, feed, 1);
613 static int altera_ci_stop_feed(struct dvb_demux_feed *feed, int num)
615 altera_pid_feed_control(feed->demux, num, feed, 0);
620 static int altera_ci_start_feed_1(struct dvb_demux_feed *feed)
622 return altera_ci_start_feed(feed, 1);
625 static int altera_ci_stop_feed_1(struct dvb_demux_feed *feed)
627 return altera_ci_stop_feed(feed, 1);
630 static int altera_ci_start_feed_2(struct dvb_demux_feed *feed)
632 return altera_ci_start_feed(feed, 2);
635 static int altera_ci_stop_feed_2(struct dvb_demux_feed *feed)
637 return altera_ci_stop_feed(feed, 2);
640 static int altera_hw_filt_init(struct altera_ci_config *config, int hw_filt_nr)
642 struct netup_hw_pid_filter *pid_filt = NULL;
643 struct fpga_inode *temp_int = find_inode(config->dev);
644 struct fpga_internal *inter = NULL;
647 pid_filt = kzalloc(sizeof(struct netup_hw_pid_filter), GFP_KERNEL);
649 ci_dbg_print("%s\n", __func__);
656 if (temp_int != NULL) {
657 inter = temp_int->internal;
658 (inter->filts_used)++;
659 ci_dbg_print("%s: Find Internal Structure!\n", __func__);
661 inter = kzalloc(sizeof(struct fpga_internal), GFP_KERNEL);
667 temp_int = append_internal(inter);
672 inter->filts_used = 1;
673 inter->dev = config->dev;
674 inter->fpga_rw = config->fpga_rw;
675 mutex_init(&inter->fpga_mutex);
677 ci_dbg_print("%s: Create New Internal Structure!\n", __func__);
680 ci_dbg_print("%s: setting hw pid filter = %p for ci = %d\n", __func__,
681 pid_filt, hw_filt_nr - 1);
682 inter->pid_filt[hw_filt_nr - 1] = pid_filt;
683 pid_filt->demux = config->demux;
684 pid_filt->internal = inter;
685 pid_filt->nr = hw_filt_nr - 1;
686 /* store old feed controls */
687 pid_filt->start_feed = config->demux->start_feed;
688 pid_filt->stop_feed = config->demux->stop_feed;
689 /* replace with new feed controls */
690 if (hw_filt_nr == 1) {
691 pid_filt->demux->start_feed = altera_ci_start_feed_1;
692 pid_filt->demux->stop_feed = altera_ci_stop_feed_1;
693 } else if (hw_filt_nr == 2) {
694 pid_filt->demux->start_feed = altera_ci_start_feed_2;
695 pid_filt->demux->stop_feed = altera_ci_stop_feed_2;
698 altera_toggle_fullts_streaming(pid_filt, 0, 1);
702 ci_dbg_print("%s: Can't init hardware filter: Error %d\n",
711 int altera_ci_init(struct altera_ci_config *config, int ci_nr)
713 struct altera_ci_state *state;
714 struct fpga_inode *temp_int = find_inode(config->dev);
715 struct fpga_internal *inter = NULL;
719 state = kzalloc(sizeof(struct altera_ci_state), GFP_KERNEL);
721 ci_dbg_print("%s\n", __func__);
728 if (temp_int != NULL) {
729 inter = temp_int->internal;
731 inter->fpga_rw = config->fpga_rw;
732 ci_dbg_print("%s: Find Internal Structure!\n", __func__);
734 inter = kzalloc(sizeof(struct fpga_internal), GFP_KERNEL);
740 temp_int = append_internal(inter);
746 inter->dev = config->dev;
747 inter->fpga_rw = config->fpga_rw;
748 mutex_init(&inter->fpga_mutex);
750 ci_dbg_print("%s: Create New Internal Structure!\n", __func__);
753 ci_dbg_print("%s: setting state = %p for ci = %d\n", __func__,
755 state->internal = inter;
756 state->nr = ci_nr - 1;
758 state->ca.owner = THIS_MODULE;
759 state->ca.read_attribute_mem = altera_ci_read_attribute_mem;
760 state->ca.write_attribute_mem = altera_ci_write_attribute_mem;
761 state->ca.read_cam_control = altera_ci_read_cam_ctl;
762 state->ca.write_cam_control = altera_ci_write_cam_ctl;
763 state->ca.slot_reset = altera_ci_slot_reset;
764 state->ca.slot_shutdown = altera_ci_slot_shutdown;
765 state->ca.slot_ts_enable = altera_ci_slot_ts_ctl;
766 state->ca.poll_slot_status = altera_poll_ci_slot_status;
767 state->ca.data = state;
769 ret = dvb_ca_en50221_init(config->adapter,
776 inter->state[ci_nr - 1] = state;
778 altera_hw_filt_init(config, ci_nr);
780 if (inter->strt_wrk) {
781 INIT_WORK(&inter->work, netup_read_ci_status);
785 ci_dbg_print("%s: CI initialized!\n", __func__);
787 mutex_lock(&inter->fpga_mutex);
790 netup_fpga_op_rw(inter, NETUP_CI_TSA_DIV, 0x0, 0);
791 netup_fpga_op_rw(inter, NETUP_CI_TSB_DIV, 0x0, 0);
794 store = netup_fpga_op_rw(inter, NETUP_CI_BUSCTRL2, 0, NETUP_CI_FLG_RD);
796 netup_fpga_op_rw(inter, NETUP_CI_BUSCTRL2, store, 0);
798 ret = netup_fpga_op_rw(inter, NETUP_CI_REVISION, 0, NETUP_CI_FLG_RD);
800 netup_fpga_op_rw(inter, NETUP_CI_INT_CTRL, 0x44, 0);
802 mutex_unlock(&inter->fpga_mutex);
804 ci_dbg_print("%s: NetUP CI Revision = 0x%x\n", __func__, ret);
806 schedule_work(&inter->work);
810 ci_dbg_print("%s: Cannot initialize CI: Error %d.\n", __func__, ret);
817 EXPORT_SYMBOL(altera_ci_init);
819 int altera_ci_tuner_reset(void *dev, int ci_nr)
821 struct fpga_inode *temp_int = find_inode(dev);
822 struct fpga_internal *inter = NULL;
825 ci_dbg_print("%s\n", __func__);
827 if (temp_int == NULL)
830 if (temp_int->internal == NULL)
833 inter = temp_int->internal;
835 mutex_lock(&inter->fpga_mutex);
837 store = netup_fpga_op_rw(inter, NETUP_CI_BUSCTRL2, 0, NETUP_CI_FLG_RD);
838 store &= ~(4 << (2 - ci_nr));
839 netup_fpga_op_rw(inter, NETUP_CI_BUSCTRL2, store, 0);
841 store |= (4 << (2 - ci_nr));
842 netup_fpga_op_rw(inter, NETUP_CI_BUSCTRL2, store, 0);
844 mutex_unlock(&inter->fpga_mutex);
848 EXPORT_SYMBOL(altera_ci_tuner_reset);