common/b2c2/flexcop-hw-filter.c

9 static void flexcop_rcv_data_ctrl(struct flexcop_device *fc, int onoff)
15 void flexcop_smc_ctrl(struct flexcop_device *fc, int onoff)
20 static void flexcop_null_filter_ctrl(struct flexcop_device *fc, int onoff)
25 void flexcop_set_mac_filter(struct flexcop_device *fc, u8 mac[6])
28 	v41c = fc->read_ibi_reg(fc, mac_address_41c);
37 	fc->write_ibi_reg(fc, mac_address_418, v418);
38 	fc->write_ibi_reg(fc, mac_address_41c, v41c);
41 void flexcop_mac_filter_ctrl(struct flexcop_device *fc, int onoff)
46 static void flexcop_pid_group_filter(struct flexcop_device *fc,
53 	fc->write_ibi_reg(fc, pid_filter_30c, v30c);
56 static void flexcop_pid_group_filter_ctrl(struct flexcop_device *fc, int onoff)
66 	flexcop_ibi_value vpid = fc->read_ibi_reg(fc, vregname), \
67 v208 = fc->read_ibi_reg(fc, ctrl_208); \
71 fc->write_ibi_reg(fc, vregname, vpid); \
72 fc->write_ibi_reg(fc, ctrl_208, v208)
74 static void flexcop_pid_Stream1_PID_ctrl(struct flexcop_device *fc,
81 static void flexcop_pid_Stream2_PID_ctrl(struct flexcop_device *fc,
88 static void flexcop_pid_PCR_PID_ctrl(struct flexcop_device *fc,
94 static void flexcop_pid_PMT_PID_ctrl(struct flexcop_device *fc,
100 static void flexcop_pid_EMM_PID_ctrl(struct flexcop_device *fc,
106 static void flexcop_pid_ECM_PID_ctrl(struct flexcop_device *fc,
112 static void flexcop_pid_control(struct flexcop_device *fc,
122 	if (fc->skip_6_hw_pid_filter)
129 		flexcop_pid_Stream1_PID_ctrl(fc, pid, onoff);
132 		flexcop_pid_Stream2_PID_ctrl(fc, pid, onoff);
135 		flexcop_pid_PCR_PID_ctrl(fc, pid, onoff);
138 		flexcop_pid_PMT_PID_ctrl(fc, pid, onoff);
141 		flexcop_pid_EMM_PID_ctrl(fc, pid, onoff);
144 		flexcop_pid_ECM_PID_ctrl(fc, pid, onoff);
147 		if (fc->has_32_hw_pid_filter && index < 38) {
151 			vid = fc->read_ibi_reg(fc, index_reg_310);
153 			fc->write_ibi_reg(fc, index_reg_310, vid);
155 			vpid = fc->read_ibi_reg(fc, pid_n_reg_314);
158 			fc->write_ibi_reg(fc, pid_n_reg_314, vpid);
164 static int flexcop_toggle_fullts_streaming(struct flexcop_device *fc, int onoff)
166 	if (fc->fullts_streaming_state != onoff) {
168 		flexcop_pid_group_filter(fc, 0, 0x1fe0 * (!onoff));
169 		flexcop_pid_group_filter_ctrl(fc, onoff);
170 		fc->fullts_streaming_state = onoff;
175 int flexcop_pid_feed_control(struct flexcop_device *fc,
180 	max_pid_filter -= 6 * fc->skip_6_hw_pid_filter;
181 	max_pid_filter += 32 * fc->has_32_hw_pid_filter;
183 	fc->feedcount += onoff ? 1 : -1; /* the number of PIDs/Feed currently requested */
185 		fc->extra_feedcount += onoff ? 1 : -1;
193 	if (!fc->pid_filtering && fc->feedcount == onoff)
194 		flexcop_toggle_fullts_streaming(fc, onoff);
196 	if (fc->pid_filtering) {
198 			(fc, dvbdmxfeed->index, dvbdmxfeed->pid, onoff);
200 		if (fc->extra_feedcount > 0)
201 			flexcop_toggle_fullts_streaming(fc, 1);
203 			flexcop_toggle_fullts_streaming(fc, onoff);
205 			flexcop_toggle_fullts_streaming(fc, 0);
209 	if (fc->feedcount == onoff) {
210 		flexcop_rcv_data_ctrl(fc, onoff);
211 		if (fc->stream_control) /* device specific stream control */
212 			fc->stream_control(fc, onoff);
216 			flexcop_reset_block_300(fc);
217 			flexcop_hw_filter_init(fc);
224 void flexcop_hw_filter_init(struct flexcop_device *fc)
230 	max_pid_filter -= 6 * fc->skip_6_hw_pid_filter;
231 	max_pid_filter += 32 * fc->has_32_hw_pid_filter;
234 		flexcop_pid_control(fc, i, 0x1fff, 0);
236 	flexcop_pid_group_filter(fc, 0, 0x1fe0);
237 	flexcop_pid_group_filter_ctrl(fc, 0);
239 	v = fc->read_ibi_reg(fc, pid_filter_308);
242 	fc->write_ibi_reg(fc, pid_filter_308, v);
244 	flexcop_null_filter_ctrl(fc, 1);