1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51#include <dvb_demux.h>
52#include <dvb_frontend.h>
53#include "altera-ci.h"
54#include "dvb_ca_en50221.h"
55
56
57#define NETUP_CI_INT_CTRL 0x00
58#define NETUP_CI_BUSCTRL2 0x01
59#define NETUP_CI_ADDR0 0x04
60#define NETUP_CI_ADDR1 0x05
61#define NETUP_CI_DATA 0x06
62#define NETUP_CI_BUSCTRL 0x07
63#define NETUP_CI_PID_ADDR0 0x08
64#define NETUP_CI_PID_ADDR1 0x09
65#define NETUP_CI_PID_DATA 0x0a
66#define NETUP_CI_TSA_DIV 0x0c
67#define NETUP_CI_TSB_DIV 0x0d
68#define NETUP_CI_REVISION 0x0f
69
70
71#define NETUP_CI_FLG_CTL 1
72#define NETUP_CI_FLG_RD 1
73#define NETUP_CI_FLG_AD 1
74
75static unsigned int ci_dbg;
76module_param(ci_dbg, int, 0644);
77MODULE_PARM_DESC(ci_dbg, "Enable CI debugging");
78
79static unsigned int pid_dbg;
80module_param(pid_dbg, int, 0644);
81MODULE_PARM_DESC(pid_dbg, "Enable PID filtering debugging");
82
83MODULE_DESCRIPTION("altera FPGA CI module");
84MODULE_AUTHOR("Igor M. Liplianin <liplianin@netup.ru>");
85MODULE_LICENSE("GPL");
86
87#define ci_dbg_print(args...) \
88 do { \
89 if (ci_dbg) \
90 printk(KERN_DEBUG args); \
91 } while (0)
92
93#define pid_dbg_print(args...) \
94 do { \
95 if (pid_dbg) \
96 printk(KERN_DEBUG args); \
97 } while (0)
98
99struct altera_ci_state;
100struct netup_hw_pid_filter;
101
102struct fpga_internal {
103 void *dev;
104 struct mutex fpga_mutex;
105 struct netup_hw_pid_filter *pid_filt[2];
106 struct altera_ci_state *state[2];
107 struct work_struct work;
108 int (*fpga_rw) (void *dev, int flag, int data, int rw);
109 int cis_used;
110 int filts_used;
111 int strt_wrk;
112};
113
114
115struct altera_ci_state {
116 struct fpga_internal *internal;
117 struct dvb_ca_en50221 ca;
118 int status;
119 int nr;
120};
121
122
123struct netup_hw_pid_filter {
124 struct fpga_internal *internal;
125 struct dvb_demux *demux;
126
127 int (*start_feed)(struct dvb_demux_feed *feed);
128 int (*stop_feed)(struct dvb_demux_feed *feed);
129
130 int status;
131 int nr;
132};
133
134
135struct fpga_inode {
136
137 struct fpga_internal *internal;
138 struct fpga_inode *next_inode;
139};
140
141
142static struct fpga_inode *fpga_first_inode;
143
144
145static struct fpga_inode *find_inode(void *dev)
146{
147 struct fpga_inode *temp_chip = fpga_first_inode;
148
149 if (temp_chip == NULL)
150 return temp_chip;
151
152
153
154
155 while ((temp_chip != NULL) &&
156 (temp_chip->internal->dev != dev))
157 temp_chip = temp_chip->next_inode;
158
159 return temp_chip;
160}
161
162static struct fpga_internal *check_filter(struct fpga_internal *temp_int,
163 void *demux_dev, int filt_nr)
164{
165 if (temp_int == NULL)
166 return NULL;
167
168 if ((temp_int->pid_filt[filt_nr]) == NULL)
169 return NULL;
170
171 if (temp_int->pid_filt[filt_nr]->demux == demux_dev)
172 return temp_int;
173
174 return NULL;
175}
176
177
178static struct fpga_inode *find_dinode(void *demux_dev)
179{
180 struct fpga_inode *temp_chip = fpga_first_inode;
181 struct fpga_internal *temp_int;
182
183
184
185
186
187 while (temp_chip != NULL) {
188 if (temp_chip->internal != NULL) {
189 temp_int = temp_chip->internal;
190 if (check_filter(temp_int, demux_dev, 0))
191 break;
192 if (check_filter(temp_int, demux_dev, 1))
193 break;
194 }
195
196 temp_chip = temp_chip->next_inode;
197 }
198
199 return temp_chip;
200}
201
202
203static void remove_inode(struct fpga_internal *internal)
204{
205 struct fpga_inode *prev_node = fpga_first_inode;
206 struct fpga_inode *del_node = find_inode(internal->dev);
207
208 if (del_node != NULL) {
209 if (del_node == fpga_first_inode) {
210 fpga_first_inode = del_node->next_inode;
211 } else {
212 while (prev_node->next_inode != del_node)
213 prev_node = prev_node->next_inode;
214
215 if (del_node->next_inode == NULL)
216 prev_node->next_inode = NULL;
217 else
218 prev_node->next_inode =
219 prev_node->next_inode->next_inode;
220 }
221
222 kfree(del_node);
223 }
224}
225
226
227static struct fpga_inode *append_internal(struct fpga_internal *internal)
228{
229 struct fpga_inode *new_node = fpga_first_inode;
230
231 if (new_node == NULL) {
232 new_node = kmalloc(sizeof(struct fpga_inode), GFP_KERNEL);
233 fpga_first_inode = new_node;
234 } else {
235 while (new_node->next_inode != NULL)
236 new_node = new_node->next_inode;
237
238 new_node->next_inode =
239 kmalloc(sizeof(struct fpga_inode), GFP_KERNEL);
240 if (new_node->next_inode != NULL)
241 new_node = new_node->next_inode;
242 else
243 new_node = NULL;
244 }
245
246 if (new_node != NULL) {
247 new_node->internal = internal;
248 new_node->next_inode = NULL;
249 }
250
251 return new_node;
252}
253
254static int netup_fpga_op_rw(struct fpga_internal *inter, int addr,
255 u8 val, u8 read)
256{
257 inter->fpga_rw(inter->dev, NETUP_CI_FLG_AD, addr, 0);
258 return inter->fpga_rw(inter->dev, 0, val, read);
259}
260
261
262static int altera_ci_op_cam(struct dvb_ca_en50221 *en50221, int slot,
263 u8 flag, u8 read, int addr, u8 val)
264{
265
266 struct altera_ci_state *state = en50221->data;
267 struct fpga_internal *inter = state->internal;
268
269 u8 store;
270 int mem = 0;
271
272 if (0 != slot)
273 return -EINVAL;
274
275 mutex_lock(&inter->fpga_mutex);
276
277 netup_fpga_op_rw(inter, NETUP_CI_ADDR0, ((addr << 1) & 0xfe), 0);
278 netup_fpga_op_rw(inter, NETUP_CI_ADDR1, ((addr >> 7) & 0x7f), 0);
279 store = netup_fpga_op_rw(inter, NETUP_CI_BUSCTRL, 0, NETUP_CI_FLG_RD);
280
281 store &= 0x0f;
282 store |= ((state->nr << 7) | (flag << 6));
283
284 netup_fpga_op_rw(inter, NETUP_CI_BUSCTRL, store, 0);
285 mem = netup_fpga_op_rw(inter, NETUP_CI_DATA, val, read);
286
287 mutex_unlock(&inter->fpga_mutex);
288
289 ci_dbg_print("%s: %s: addr=[0x%02x], %s=%x\n", __func__,
290 (read) ? "read" : "write", addr,
291 (flag == NETUP_CI_FLG_CTL) ? "ctl" : "mem",
292 (read) ? mem : val);
293
294 return mem;
295}
296
297static int altera_ci_read_attribute_mem(struct dvb_ca_en50221 *en50221,
298 int slot, int addr)
299{
300 return altera_ci_op_cam(en50221, slot, 0, NETUP_CI_FLG_RD, addr, 0);
301}
302
303static int altera_ci_write_attribute_mem(struct dvb_ca_en50221 *en50221,
304 int slot, int addr, u8 data)
305{
306 return altera_ci_op_cam(en50221, slot, 0, 0, addr, data);
307}
308
309static int altera_ci_read_cam_ctl(struct dvb_ca_en50221 *en50221,
310 int slot, u8 addr)
311{
312 return altera_ci_op_cam(en50221, slot, NETUP_CI_FLG_CTL,
313 NETUP_CI_FLG_RD, addr, 0);
314}
315
316static int altera_ci_write_cam_ctl(struct dvb_ca_en50221 *en50221, int slot,
317 u8 addr, u8 data)
318{
319 return altera_ci_op_cam(en50221, slot, NETUP_CI_FLG_CTL, 0, addr, data);
320}
321
322static int altera_ci_slot_reset(struct dvb_ca_en50221 *en50221, int slot)
323{
324 struct altera_ci_state *state = en50221->data;
325 struct fpga_internal *inter = state->internal;
326
327 unsigned long t_out = jiffies + msecs_to_jiffies(9999);
328 int ret;
329
330 ci_dbg_print("%s\n", __func__);
331
332 if (0 != slot)
333 return -EINVAL;
334
335 mutex_lock(&inter->fpga_mutex);
336
337 ret = netup_fpga_op_rw(inter, NETUP_CI_BUSCTRL, 0, NETUP_CI_FLG_RD);
338 netup_fpga_op_rw(inter, NETUP_CI_BUSCTRL,
339 (ret & 0xcf) | (1 << (5 - state->nr)), 0);
340
341 mutex_unlock(&inter->fpga_mutex);
342
343 for (;;) {
344 mdelay(50);
345
346 mutex_lock(&inter->fpga_mutex);
347
348 ret = netup_fpga_op_rw(inter, NETUP_CI_BUSCTRL,
349 0, NETUP_CI_FLG_RD);
350 mutex_unlock(&inter->fpga_mutex);
351
352 if ((ret & (1 << (5 - state->nr))) == 0)
353 break;
354 if (time_after(jiffies, t_out))
355 break;
356 }
357
358
359 ci_dbg_print("%s: %d msecs\n", __func__,
360 jiffies_to_msecs(jiffies + msecs_to_jiffies(9999) - t_out));
361
362 return 0;
363}
364
365static int altera_ci_slot_shutdown(struct dvb_ca_en50221 *en50221, int slot)
366{
367
368 return 0;
369}
370
371static int altera_ci_slot_ts_ctl(struct dvb_ca_en50221 *en50221, int slot)
372{
373 struct altera_ci_state *state = en50221->data;
374 struct fpga_internal *inter = state->internal;
375 int ret;
376
377 ci_dbg_print("%s\n", __func__);
378
379 if (0 != slot)
380 return -EINVAL;
381
382 mutex_lock(&inter->fpga_mutex);
383
384 ret = netup_fpga_op_rw(inter, NETUP_CI_BUSCTRL, 0, NETUP_CI_FLG_RD);
385 netup_fpga_op_rw(inter, NETUP_CI_BUSCTRL,
386 (ret & 0x0f) | (1 << (3 - state->nr)), 0);
387
388 mutex_unlock(&inter->fpga_mutex);
389
390 return 0;
391}
392
393
394static void netup_read_ci_status(struct work_struct *work)
395{
396 struct fpga_internal *inter =
397 container_of(work, struct fpga_internal, work);
398 int ret;
399
400 ci_dbg_print("%s\n", __func__);
401
402 mutex_lock(&inter->fpga_mutex);
403
404 ret = netup_fpga_op_rw(inter, NETUP_CI_INT_CTRL, 0, NETUP_CI_FLG_RD);
405 ret = netup_fpga_op_rw(inter, NETUP_CI_BUSCTRL, 0, NETUP_CI_FLG_RD);
406
407 mutex_unlock(&inter->fpga_mutex);
408
409 if (inter->state[1] != NULL) {
410 inter->state[1]->status =
411 ((ret & 1) == 0 ?
412 DVB_CA_EN50221_POLL_CAM_PRESENT |
413 DVB_CA_EN50221_POLL_CAM_READY : 0);
414 ci_dbg_print("%s: setting CI[1] status = 0x%x\n",
415 __func__, inter->state[1]->status);
416 }
417
418 if (inter->state[0] != NULL) {
419 inter->state[0]->status =
420 ((ret & 2) == 0 ?
421 DVB_CA_EN50221_POLL_CAM_PRESENT |
422 DVB_CA_EN50221_POLL_CAM_READY : 0);
423 ci_dbg_print("%s: setting CI[0] status = 0x%x\n",
424 __func__, inter->state[0]->status);
425 }
426}
427
428
429int altera_ci_irq(void *dev)
430{
431 struct fpga_inode *temp_int = NULL;
432 struct fpga_internal *inter = NULL;
433
434 ci_dbg_print("%s\n", __func__);
435
436 if (dev != NULL) {
437 temp_int = find_inode(dev);
438 if (temp_int != NULL) {
439 inter = temp_int->internal;
440 schedule_work(&inter->work);
441 }
442 }
443
444 return 1;
445}
446EXPORT_SYMBOL(altera_ci_irq);
447
448static int altera_poll_ci_slot_status(struct dvb_ca_en50221 *en50221,
449 int slot, int open)
450{
451 struct altera_ci_state *state = en50221->data;
452
453 if (0 != slot)
454 return -EINVAL;
455
456 return state->status;
457}
458
459static void altera_hw_filt_release(void *main_dev, int filt_nr)
460{
461 struct fpga_inode *temp_int = find_inode(main_dev);
462 struct netup_hw_pid_filter *pid_filt = NULL;
463
464 ci_dbg_print("%s\n", __func__);
465
466 if (temp_int != NULL) {
467 pid_filt = temp_int->internal->pid_filt[filt_nr - 1];
468
469 pid_filt->demux->start_feed = pid_filt->start_feed;
470 pid_filt->demux->stop_feed = pid_filt->stop_feed;
471
472 if (((--(temp_int->internal->filts_used)) <= 0) &&
473 ((temp_int->internal->cis_used) <= 0)) {
474
475 ci_dbg_print("%s: Actually removing\n", __func__);
476
477 remove_inode(temp_int->internal);
478 kfree(pid_filt->internal);
479 }
480
481 kfree(pid_filt);
482
483 }
484
485}
486EXPORT_SYMBOL(altera_hw_filt_release);
487
488void altera_ci_release(void *dev, int ci_nr)
489{
490 struct fpga_inode *temp_int = find_inode(dev);
491 struct altera_ci_state *state = NULL;
492
493 ci_dbg_print("%s\n", __func__);
494
495 if (temp_int != NULL) {
496 state = temp_int->internal->state[ci_nr - 1];
497 altera_hw_filt_release(dev, ci_nr);
498
499
500 if (((temp_int->internal->filts_used) <= 0) &&
501 ((--(temp_int->internal->cis_used)) <= 0)) {
502
503 ci_dbg_print("%s: Actually removing\n", __func__);
504
505 remove_inode(temp_int->internal);
506 kfree(state->internal);
507 }
508
509 if (state != NULL) {
510 if (state->ca.data != NULL)
511 dvb_ca_en50221_release(&state->ca);
512
513 kfree(state);
514 }
515 }
516
517}
518EXPORT_SYMBOL(altera_ci_release);
519
520static void altera_pid_control(struct netup_hw_pid_filter *pid_filt,
521 u16 pid, int onoff)
522{
523 struct fpga_internal *inter = pid_filt->internal;
524 u8 store = 0;
525
526
527 if ((pid == 0x2000) || (pid < 0x20))
528 return;
529
530 mutex_lock(&inter->fpga_mutex);
531
532 netup_fpga_op_rw(inter, NETUP_CI_PID_ADDR0, (pid >> 3) & 0xff, 0);
533 netup_fpga_op_rw(inter, NETUP_CI_PID_ADDR1,
534 ((pid >> 11) & 0x03) | (pid_filt->nr << 2), 0);
535
536 store = netup_fpga_op_rw(inter, NETUP_CI_PID_DATA, 0, NETUP_CI_FLG_RD);
537
538 if (onoff)
539 store |= (1 << (pid & 7));
540 else
541 store &= ~(1 << (pid & 7));
542
543 netup_fpga_op_rw(inter, NETUP_CI_PID_DATA, store, 0);
544
545 mutex_unlock(&inter->fpga_mutex);
546
547 pid_dbg_print("%s: (%d) set pid: %5d 0x%04x '%s'\n", __func__,
548 pid_filt->nr, pid, pid, onoff ? "off" : "on");
549}
550
551static void altera_toggle_fullts_streaming(struct netup_hw_pid_filter *pid_filt,
552 int filt_nr, int onoff)
553{
554 struct fpga_internal *inter = pid_filt->internal;
555 u8 store = 0;
556 int i;
557
558 pid_dbg_print("%s: pid_filt->nr[%d] now %s\n", __func__, pid_filt->nr,
559 onoff ? "off" : "on");
560
561 if (onoff)
562 store = 0xff;
563 else
564 store = 0;
565
566 mutex_lock(&inter->fpga_mutex);
567
568 for (i = 0; i < 1024; i++) {
569 netup_fpga_op_rw(inter, NETUP_CI_PID_ADDR0, i & 0xff, 0);
570
571 netup_fpga_op_rw(inter, NETUP_CI_PID_ADDR1,
572 ((i >> 8) & 0x03) | (pid_filt->nr << 2), 0);
573
574 netup_fpga_op_rw(inter, NETUP_CI_PID_DATA,
575 (i > 3 ? store : 0), 0);
576 }
577
578 mutex_unlock(&inter->fpga_mutex);
579}
580
581static int altera_pid_feed_control(void *demux_dev, int filt_nr,
582 struct dvb_demux_feed *feed, int onoff)
583{
584 struct fpga_inode *temp_int = find_dinode(demux_dev);
585 struct fpga_internal *inter = temp_int->internal;
586 struct netup_hw_pid_filter *pid_filt = inter->pid_filt[filt_nr - 1];
587
588 altera_pid_control(pid_filt, feed->pid, onoff ? 0 : 1);
589
590 if (onoff)
591 pid_filt->start_feed(feed);
592 else
593 pid_filt->stop_feed(feed);
594
595 if (feed->pid == 0x2000)
596 altera_toggle_fullts_streaming(pid_filt, filt_nr,
597 onoff ? 0 : 1);
598
599 return 0;
600}
601EXPORT_SYMBOL(altera_pid_feed_control);
602
603static int altera_ci_start_feed(struct dvb_demux_feed *feed, int num)
604{
605 altera_pid_feed_control(feed->demux, num, feed, 1);
606
607 return 0;
608}
609
610static int altera_ci_stop_feed(struct dvb_demux_feed *feed, int num)
611{
612 altera_pid_feed_control(feed->demux, num, feed, 0);
613
614 return 0;
615}
616
617static int altera_ci_start_feed_1(struct dvb_demux_feed *feed)
618{
619 return altera_ci_start_feed(feed, 1);
620}
621
622static int altera_ci_stop_feed_1(struct dvb_demux_feed *feed)
623{
624 return altera_ci_stop_feed(feed, 1);
625}
626
627static int altera_ci_start_feed_2(struct dvb_demux_feed *feed)
628{
629 return altera_ci_start_feed(feed, 2);
630}
631
632static int altera_ci_stop_feed_2(struct dvb_demux_feed *feed)
633{
634 return altera_ci_stop_feed(feed, 2);
635}
636
637static int altera_hw_filt_init(struct altera_ci_config *config, int hw_filt_nr)
638{
639 struct netup_hw_pid_filter *pid_filt = NULL;
640 struct fpga_inode *temp_int = find_inode(config->dev);
641 struct fpga_internal *inter = NULL;
642 int ret = 0;
643
644 pid_filt = kzalloc(sizeof(struct netup_hw_pid_filter), GFP_KERNEL);
645
646 ci_dbg_print("%s\n", __func__);
647
648 if (!pid_filt) {
649 ret = -ENOMEM;
650 goto err;
651 }
652
653 if (temp_int != NULL) {
654 inter = temp_int->internal;
655 (inter->filts_used)++;
656 ci_dbg_print("%s: Find Internal Structure!\n", __func__);
657 } else {
658 inter = kzalloc(sizeof(struct fpga_internal), GFP_KERNEL);
659 if (!inter) {
660 ret = -ENOMEM;
661 goto err;
662 }
663
664 temp_int = append_internal(inter);
665 inter->filts_used = 1;
666 inter->dev = config->dev;
667 inter->fpga_rw = config->fpga_rw;
668 mutex_init(&inter->fpga_mutex);
669 inter->strt_wrk = 1;
670 ci_dbg_print("%s: Create New Internal Structure!\n", __func__);
671 }
672
673 ci_dbg_print("%s: setting hw pid filter = %p for ci = %d\n", __func__,
674 pid_filt, hw_filt_nr - 1);
675 inter->pid_filt[hw_filt_nr - 1] = pid_filt;
676 pid_filt->demux = config->demux;
677 pid_filt->internal = inter;
678 pid_filt->nr = hw_filt_nr - 1;
679
680 pid_filt->start_feed = config->demux->start_feed;
681 pid_filt->stop_feed = config->demux->stop_feed;
682
683 if (hw_filt_nr == 1) {
684 pid_filt->demux->start_feed = altera_ci_start_feed_1;
685 pid_filt->demux->stop_feed = altera_ci_stop_feed_1;
686 } else if (hw_filt_nr == 2) {
687 pid_filt->demux->start_feed = altera_ci_start_feed_2;
688 pid_filt->demux->stop_feed = altera_ci_stop_feed_2;
689 }
690
691 altera_toggle_fullts_streaming(pid_filt, 0, 1);
692
693 return 0;
694err:
695 ci_dbg_print("%s: Can't init hardware filter: Error %d\n",
696 __func__, ret);
697
698 kfree(pid_filt);
699
700 return ret;
701}
702EXPORT_SYMBOL(altera_hw_filt_init);
703
704int altera_ci_init(struct altera_ci_config *config, int ci_nr)
705{
706 struct altera_ci_state *state;
707 struct fpga_inode *temp_int = find_inode(config->dev);
708 struct fpga_internal *inter = NULL;
709 int ret = 0;
710 u8 store = 0;
711
712 state = kzalloc(sizeof(struct altera_ci_state), GFP_KERNEL);
713
714 ci_dbg_print("%s\n", __func__);
715
716 if (!state) {
717 ret = -ENOMEM;
718 goto err;
719 }
720
721 if (temp_int != NULL) {
722 inter = temp_int->internal;
723 (inter->cis_used)++;
724 inter->fpga_rw = config->fpga_rw;
725 ci_dbg_print("%s: Find Internal Structure!\n", __func__);
726 } else {
727 inter = kzalloc(sizeof(struct fpga_internal), GFP_KERNEL);
728 if (!inter) {
729 ret = -ENOMEM;
730 goto err;
731 }
732
733 temp_int = append_internal(inter);
734 inter->cis_used = 1;
735 inter->dev = config->dev;
736 inter->fpga_rw = config->fpga_rw;
737 mutex_init(&inter->fpga_mutex);
738 inter->strt_wrk = 1;
739 ci_dbg_print("%s: Create New Internal Structure!\n", __func__);
740 }
741
742 ci_dbg_print("%s: setting state = %p for ci = %d\n", __func__,
743 state, ci_nr - 1);
744 state->internal = inter;
745 state->nr = ci_nr - 1;
746
747 state->ca.owner = THIS_MODULE;
748 state->ca.read_attribute_mem = altera_ci_read_attribute_mem;
749 state->ca.write_attribute_mem = altera_ci_write_attribute_mem;
750 state->ca.read_cam_control = altera_ci_read_cam_ctl;
751 state->ca.write_cam_control = altera_ci_write_cam_ctl;
752 state->ca.slot_reset = altera_ci_slot_reset;
753 state->ca.slot_shutdown = altera_ci_slot_shutdown;
754 state->ca.slot_ts_enable = altera_ci_slot_ts_ctl;
755 state->ca.poll_slot_status = altera_poll_ci_slot_status;
756 state->ca.data = state;
757
758 ret = dvb_ca_en50221_init(config->adapter,
759 &state->ca,
760 0,
761 1);
762 if (0 != ret)
763 goto err;
764
765 inter->state[ci_nr - 1] = state;
766
767 altera_hw_filt_init(config, ci_nr);
768
769 if (inter->strt_wrk) {
770 INIT_WORK(&inter->work, netup_read_ci_status);
771 inter->strt_wrk = 0;
772 }
773
774 ci_dbg_print("%s: CI initialized!\n", __func__);
775
776 mutex_lock(&inter->fpga_mutex);
777
778
779 netup_fpga_op_rw(inter, NETUP_CI_TSA_DIV, 0x0, 0);
780 netup_fpga_op_rw(inter, NETUP_CI_TSB_DIV, 0x0, 0);
781
782
783 store = netup_fpga_op_rw(inter, NETUP_CI_BUSCTRL2, 0, NETUP_CI_FLG_RD);
784 store |= (3 << 4);
785 netup_fpga_op_rw(inter, NETUP_CI_BUSCTRL2, store, 0);
786
787 ret = netup_fpga_op_rw(inter, NETUP_CI_REVISION, 0, NETUP_CI_FLG_RD);
788
789 netup_fpga_op_rw(inter, NETUP_CI_INT_CTRL, 0x44, 0);
790
791 mutex_unlock(&inter->fpga_mutex);
792
793 ci_dbg_print("%s: NetUP CI Revision = 0x%x\n", __func__, ret);
794
795 schedule_work(&inter->work);
796
797 return 0;
798err:
799 ci_dbg_print("%s: Cannot initialize CI: Error %d.\n", __func__, ret);
800
801 kfree(state);
802
803 return ret;
804}
805EXPORT_SYMBOL(altera_ci_init);
806
807int altera_ci_tuner_reset(void *dev, int ci_nr)
808{
809 struct fpga_inode *temp_int = find_inode(dev);
810 struct fpga_internal *inter = NULL;
811 u8 store;
812
813 ci_dbg_print("%s\n", __func__);
814
815 if (temp_int == NULL)
816 return -1;
817
818 if (temp_int->internal == NULL)
819 return -1;
820
821 inter = temp_int->internal;
822
823 mutex_lock(&inter->fpga_mutex);
824
825 store = netup_fpga_op_rw(inter, NETUP_CI_BUSCTRL2, 0, NETUP_CI_FLG_RD);
826 store &= ~(4 << (2 - ci_nr));
827 netup_fpga_op_rw(inter, NETUP_CI_BUSCTRL2, store, 0);
828 msleep(100);
829 store |= (4 << (2 - ci_nr));
830 netup_fpga_op_rw(inter, NETUP_CI_BUSCTRL2, store, 0);
831
832 mutex_unlock(&inter->fpga_mutex);
833
834 return 0;
835}
836EXPORT_SYMBOL(altera_ci_tuner_reset);
837