drivers/media/common/b2c2/flexcop-hw-filter.c

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