1 /*
2 * This file is part of linux driver the digital TV devices equipped with B2C2 FlexcopII(b)/III
3 *
4 * flexcop-hw-filter.c - pid and mac address filtering and corresponding control functions.
5 *
6 * see flexcop.c for copyright information.
7 */
8 #include "flexcop.h"
9
flexcop_rcv_data_ctrl(struct flexcop_device * fc,int onoff)10 static void flexcop_rcv_data_ctrl(struct flexcop_device *fc, int onoff)
11 {
12 flexcop_set_ibi_value(ctrl_208,Rcv_Data_sig,onoff);
13
14 deb_ts("rcv_data is now: '%s'\n",onoff ? "on" : "off");
15 }
16
flexcop_smc_ctrl(struct flexcop_device * fc,int onoff)17 void flexcop_smc_ctrl(struct flexcop_device *fc, int onoff)
18 {
19 flexcop_set_ibi_value(ctrl_208,SMC_Enable_sig,onoff);
20 }
21
flexcop_null_filter_ctrl(struct flexcop_device * fc,int onoff)22 static void flexcop_null_filter_ctrl(struct flexcop_device *fc, int onoff)
23 {
24 flexcop_set_ibi_value(ctrl_208,Null_filter_sig,onoff);
25 }
26
flexcop_set_mac_filter(struct flexcop_device * fc,u8 mac[6])27 void flexcop_set_mac_filter(struct flexcop_device *fc, u8 mac[6])
28 {
29 flexcop_ibi_value v418,v41c;
30 v41c = fc->read_ibi_reg(fc,mac_address_41c);
31
32 v418.mac_address_418.MAC1 = mac[0];
33 v418.mac_address_418.MAC2 = mac[1];
34 v418.mac_address_418.MAC3 = mac[2];
35 v418.mac_address_418.MAC6 = mac[3];
36 v41c.mac_address_41c.MAC7 = mac[4];
37 v41c.mac_address_41c.MAC8 = mac[5];
38
39 fc->write_ibi_reg(fc,mac_address_418,v418);
40 fc->write_ibi_reg(fc,mac_address_41c,v41c);
41 }
42
flexcop_mac_filter_ctrl(struct flexcop_device * fc,int onoff)43 void flexcop_mac_filter_ctrl(struct flexcop_device *fc, int onoff)
44 {
45 flexcop_set_ibi_value(ctrl_208,MAC_filter_Mode_sig,onoff);
46 }
47
flexcop_pid_group_filter(struct flexcop_device * fc,u16 pid,u16 mask)48 static void flexcop_pid_group_filter(struct flexcop_device *fc, u16 pid, u16 mask)
49 {
50 /* index_reg_310.extra_index_reg need to 0 or 7 to work */
51 flexcop_ibi_value v30c;
52 v30c.pid_filter_30c_ext_ind_0_7.Group_PID = pid;
53 v30c.pid_filter_30c_ext_ind_0_7.Group_mask = mask;
54 fc->write_ibi_reg(fc,pid_filter_30c,v30c);
55 }
56
flexcop_pid_group_filter_ctrl(struct flexcop_device * fc,int onoff)57 static void flexcop_pid_group_filter_ctrl(struct flexcop_device *fc, int onoff)
58 {
59 flexcop_set_ibi_value(ctrl_208,Mask_filter_sig,onoff);
60 }
61
62 /* this fancy define reduces the code size of the quite similar PID controlling of
63 * the first 6 PIDs
64 */
65
66 #define pid_ctrl(vregname,field,enablefield,trans_field,transval) \
67 flexcop_ibi_value vpid = fc->read_ibi_reg(fc, vregname), \
68 v208 = fc->read_ibi_reg(fc, ctrl_208); \
69 \
70 vpid.vregname.field = onoff ? pid : 0x1fff; \
71 vpid.vregname.trans_field = transval; \
72 v208.ctrl_208.enablefield = onoff; \
73 \
74 fc->write_ibi_reg(fc,vregname,vpid); \
75 fc->write_ibi_reg(fc,ctrl_208,v208);
76
flexcop_pid_Stream1_PID_ctrl(struct flexcop_device * fc,u16 pid,int onoff)77 static void flexcop_pid_Stream1_PID_ctrl(struct flexcop_device *fc, u16 pid, int onoff)
78 {
79 pid_ctrl(pid_filter_300,Stream1_PID,Stream1_filter_sig,Stream1_trans,0);
80 }
81
flexcop_pid_Stream2_PID_ctrl(struct flexcop_device * fc,u16 pid,int onoff)82 static void flexcop_pid_Stream2_PID_ctrl(struct flexcop_device *fc, u16 pid, int onoff)
83 {
84 pid_ctrl(pid_filter_300,Stream2_PID,Stream2_filter_sig,Stream2_trans,0);
85 }
86
flexcop_pid_PCR_PID_ctrl(struct flexcop_device * fc,u16 pid,int onoff)87 static void flexcop_pid_PCR_PID_ctrl(struct flexcop_device *fc, u16 pid, int onoff)
88 {
89 pid_ctrl(pid_filter_304,PCR_PID,PCR_filter_sig,PCR_trans,0);
90 }
91
flexcop_pid_PMT_PID_ctrl(struct flexcop_device * fc,u16 pid,int onoff)92 static void flexcop_pid_PMT_PID_ctrl(struct flexcop_device *fc, u16 pid, int onoff)
93 {
94 pid_ctrl(pid_filter_304,PMT_PID,PMT_filter_sig,PMT_trans,0);
95 }
96
flexcop_pid_EMM_PID_ctrl(struct flexcop_device * fc,u16 pid,int onoff)97 static void flexcop_pid_EMM_PID_ctrl(struct flexcop_device *fc, u16 pid, int onoff)
98 {
99 pid_ctrl(pid_filter_308,EMM_PID,EMM_filter_sig,EMM_trans,0);
100 }
101
flexcop_pid_ECM_PID_ctrl(struct flexcop_device * fc,u16 pid,int onoff)102 static void flexcop_pid_ECM_PID_ctrl(struct flexcop_device *fc, u16 pid, int onoff)
103 {
104 pid_ctrl(pid_filter_308,ECM_PID,ECM_filter_sig,ECM_trans,0);
105 }
106
flexcop_pid_control(struct flexcop_device * fc,int index,u16 pid,int onoff)107 static void flexcop_pid_control(struct flexcop_device *fc, int index, u16 pid,int onoff)
108 {
109 if (pid == 0x2000)
110 return;
111
112 deb_ts("setting pid: %5d %04x at index %d '%s'\n",pid,pid,index,onoff ? "on" : "off");
113
114 /* We could use bit magic here to reduce source code size.
115 * I decided against it, but to use the real register names */
116 switch (index) {
117 case 0: flexcop_pid_Stream1_PID_ctrl(fc,pid,onoff); break;
118 case 1: flexcop_pid_Stream2_PID_ctrl(fc,pid,onoff); break;
119 case 2: flexcop_pid_PCR_PID_ctrl(fc,pid,onoff); break;
120 case 3: flexcop_pid_PMT_PID_ctrl(fc,pid,onoff); break;
121 case 4: flexcop_pid_EMM_PID_ctrl(fc,pid,onoff); break;
122 case 5: flexcop_pid_ECM_PID_ctrl(fc,pid,onoff); break;
123 default:
124 if (fc->has_32_hw_pid_filter && index < 38) {
125 flexcop_ibi_value vpid,vid;
126
127 /* set the index */
128 vid = fc->read_ibi_reg(fc,index_reg_310);
129 vid.index_reg_310.index_reg = index - 6;
130 fc->write_ibi_reg(fc,index_reg_310, vid);
131
132 vpid = fc->read_ibi_reg(fc,pid_n_reg_314);
133 vpid.pid_n_reg_314.PID = onoff ? pid : 0x1fff;
134 vpid.pid_n_reg_314.PID_enable_bit = onoff;
135 fc->write_ibi_reg(fc,pid_n_reg_314, vpid);
136 }
137 break;
138 }
139 }
140
flexcop_toggle_fullts_streaming(struct flexcop_device * fc,int onoff)141 static int flexcop_toggle_fullts_streaming(struct flexcop_device *fc,int onoff)
142 {
143 if (fc->fullts_streaming_state != onoff) {
144 deb_ts("%s full TS transfer\n",onoff ? "enabling" : "disabling");
145 flexcop_pid_group_filter(fc, 0, 0x1fe0 * (!onoff));
146 flexcop_pid_group_filter_ctrl(fc,onoff);
147 fc->fullts_streaming_state = onoff;
148 }
149 return 0;
150 }
151
flexcop_pid_feed_control(struct flexcop_device * fc,struct dvb_demux_feed * dvbdmxfeed,int onoff)152 int flexcop_pid_feed_control(struct flexcop_device *fc, struct dvb_demux_feed *dvbdmxfeed, int onoff)
153 {
154 int max_pid_filter = 6 + fc->has_32_hw_pid_filter*32;
155
156 fc->feedcount += onoff ? 1 : -1; /* the number of PIDs/Feed currently requested */
157 if (dvbdmxfeed->index >= max_pid_filter)
158 fc->extra_feedcount += onoff ? 1 : -1;
159
160 /* toggle complete-TS-streaming when:
161 * - pid_filtering is not enabled and it is the first or last feed requested
162 * - pid_filtering is enabled,
163 * - but the number of requested feeds is exceeded
164 * - or the requested pid is 0x2000 */
165
166 if (!fc->pid_filtering && fc->feedcount == onoff)
167 flexcop_toggle_fullts_streaming(fc,onoff);
168
169 if (fc->pid_filtering) {
170 flexcop_pid_control(fc,dvbdmxfeed->index,dvbdmxfeed->pid,onoff);
171
172 if (fc->extra_feedcount > 0)
173 flexcop_toggle_fullts_streaming(fc,1);
174 else if (dvbdmxfeed->pid == 0x2000)
175 flexcop_toggle_fullts_streaming(fc,onoff);
176 else
177 flexcop_toggle_fullts_streaming(fc,0);
178 }
179
180 /* if it was the first or last feed request change the stream-status */
181 if (fc->feedcount == onoff) {
182 flexcop_rcv_data_ctrl(fc,onoff);
183 if (fc->stream_control) /* device specific stream control */
184 fc->stream_control(fc,onoff);
185
186 /* feeding stopped -> reset the flexcop filter*/
187 if (onoff == 0) {
188 flexcop_reset_block_300(fc);
189 flexcop_hw_filter_init(fc);
190 }
191 }
192
193 return 0;
194 }
195 EXPORT_SYMBOL(flexcop_pid_feed_control);
196
flexcop_hw_filter_init(struct flexcop_device * fc)197 void flexcop_hw_filter_init(struct flexcop_device *fc)
198 {
199 int i;
200 flexcop_ibi_value v;
201 for (i = 0; i < 6 + 32*fc->has_32_hw_pid_filter; i++)
202 flexcop_pid_control(fc,i,0x1fff,0);
203
204 flexcop_pid_group_filter(fc, 0, 0x1fe0);
205 flexcop_pid_group_filter_ctrl(fc,0);
206
207 v = fc->read_ibi_reg(fc,pid_filter_308);
208 v.pid_filter_308.EMM_filter_4 = 1;
209 v.pid_filter_308.EMM_filter_6 = 0;
210 fc->write_ibi_reg(fc,pid_filter_308,v);
211
212 flexcop_null_filter_ctrl(fc, 1);
213 }
214