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