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

   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
  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
  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 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, 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 \
  68         vpid.vregname.field = onoff ? pid : 0x1fff; \
  69         vpid.vregname.trans_field = transval; \
  70         v208.ctrl_208.enablefield = onoff; \
  71 \
  72         fc->write_ibi_reg(fc,vregname,vpid); \
  73         fc->write_ibi_reg(fc,ctrl_208,v208);
  74
  75 static void flexcop_pid_Stream1_PID_ctrl(struct flexcop_device *fc, u16 pid, int onoff)
  76 {
  77         pid_ctrl(pid_filter_300,Stream1_PID,Stream1_filter_sig,Stream1_trans,0);
  78 }
  79
  80 static void flexcop_pid_Stream2_PID_ctrl(struct flexcop_device *fc, u16 pid, int onoff)
  81 {
  82         pid_ctrl(pid_filter_300,Stream2_PID,Stream2_filter_sig,Stream2_trans,0);
  83 }
  84
  85 static void flexcop_pid_PCR_PID_ctrl(struct flexcop_device *fc, u16 pid, int onoff)
  86 {
  87         pid_ctrl(pid_filter_304,PCR_PID,PCR_filter_sig,PCR_trans,0);
  88 }
  89
  90 static void flexcop_pid_PMT_PID_ctrl(struct flexcop_device *fc, u16 pid, int onoff)
  91 {
  92         pid_ctrl(pid_filter_304,PMT_PID,PMT_filter_sig,PMT_trans,0);
  93 }
  94
  95 static void flexcop_pid_EMM_PID_ctrl(struct flexcop_device *fc, u16 pid, int onoff)
  96 {
  97         pid_ctrl(pid_filter_308,EMM_PID,EMM_filter_sig,EMM_trans,0);
  98 }
  99
 100 static void flexcop_pid_ECM_PID_ctrl(struct flexcop_device *fc, u16 pid, int onoff)
 101 {
 102         pid_ctrl(pid_filter_308,ECM_PID,ECM_filter_sig,ECM_trans,0);
 103 }
 104
 105 static void flexcop_pid_control(struct flexcop_device *fc, int index, u16 pid,int onoff)
 106 {
 107         if (pid == 0x2000)
 108                 return;
 109
 110         deb_ts("setting pid: %5d %04x at index %d '%s'\n",pid,pid,index,onoff ? "on" : "off");
 111
 112         /* We could use bit magic here to reduce source code size.
 113          * I decided against it, but to use the real register names */
 114         switch (index) {
 115                 case 0: flexcop_pid_Stream1_PID_ctrl(fc,pid,onoff); break;
 116                 case 1: flexcop_pid_Stream2_PID_ctrl(fc,pid,onoff); break;
 117                 case 2: flexcop_pid_PCR_PID_ctrl(fc,pid,onoff); break;
 118                 case 3: flexcop_pid_PMT_PID_ctrl(fc,pid,onoff); break;
 119                 case 4: flexcop_pid_EMM_PID_ctrl(fc,pid,onoff); break;
 120                 case 5: flexcop_pid_ECM_PID_ctrl(fc,pid,onoff); break;
 121                 default:
 122                         if (fc->has_32_hw_pid_filter && index < 38) {
 123                                 flexcop_ibi_value vpid,vid;
 124
 125                                 /* set the index */
 126                                 vid = fc->read_ibi_reg(fc,index_reg_310);
 127                                 vid.index_reg_310.index_reg = index - 6;
 128                                 fc->write_ibi_reg(fc,index_reg_310, vid);
 129
 130                                 vpid = fc->read_ibi_reg(fc,pid_n_reg_314);
 131                                 vpid.pid_n_reg_314.PID = onoff ? pid : 0x1fff;
 132                                 vpid.pid_n_reg_314.PID_enable_bit = onoff;
 133                                 fc->write_ibi_reg(fc,pid_n_reg_314, vpid);
 134                         }
 135                         break;
 136         }
 137 }
 138
 139 static int flexcop_toggle_fullts_streaming(struct flexcop_device *fc,int onoff)
 140 {
 141         if (fc->fullts_streaming_state != onoff) {
 142                 deb_ts("%s full TS transfer\n",onoff ? "enabling" : "disabling");
 143                 flexcop_pid_group_filter(fc, 0, 0x1fe0 * (!onoff));
 144                 flexcop_pid_group_filter_ctrl(fc,onoff);
 145                 fc->fullts_streaming_state = onoff;
 146         }
 147         return 0;
 148 }
 149
 150 int flexcop_pid_feed_control(struct flexcop_device *fc, struct dvb_demux_feed *dvbdmxfeed, int onoff)
 151 {
 152         int max_pid_filter = 6 + fc->has_32_hw_pid_filter*32;
 153
 154         fc->feedcount += onoff ? 1 : -1;
 155         if (dvbdmxfeed->index >= max_pid_filter)
 156                 fc->extra_feedcount += onoff ? 1 : -1;
 157
 158         /* toggle complete-TS-streaming when:
 159          * - pid_filtering is not enabled and it is the first or last feed requested
 160          * - pid_filtering is enabled,
 161          *   - but the number of requested feeds is exceeded
 162          *   - or the requested pid is 0x2000 */
 163
 164         if (!fc->pid_filtering && fc->feedcount == onoff)
 165                 flexcop_toggle_fullts_streaming(fc,onoff);
 166
 167         if (fc->pid_filtering) {
 168                 flexcop_pid_control(fc,dvbdmxfeed->index,dvbdmxfeed->pid,onoff);
 169
 170                 if (fc->extra_feedcount > 0)
 171                         flexcop_toggle_fullts_streaming(fc,1);
 172                 else if (dvbdmxfeed->pid == 0x2000)
 173                         flexcop_toggle_fullts_streaming(fc,onoff);
 174                 else
 175                         flexcop_toggle_fullts_streaming(fc,0);
 176         }
 177
 178         /* if it was the first or last feed request change the stream-status */
 179         if (fc->feedcount == onoff) {
 180                 flexcop_rcv_data_ctrl(fc,onoff);
 181                 if (fc->stream_control)
 182                         fc->stream_control(fc,onoff);
 183         }
 184
 185         return 0;
 186 }
 187
 188 void flexcop_hw_filter_init(struct flexcop_device *fc)
 189 {
 190         int i;
 191         flexcop_ibi_value v;
 192         for (i = 0; i < 6 + 32*fc->has_32_hw_pid_filter; i++)
 193                 flexcop_pid_control(fc,i,0x1fff,0);
 194
 195         flexcop_pid_group_filter(fc, 0, 0x1fe0);
 196         flexcop_pid_group_filter_ctrl(fc,0);
 197
 198         v = fc->read_ibi_reg(fc,pid_filter_308);
 199         v.pid_filter_308.EMM_filter_4 = 1;
 200         v.pid_filter_308.EMM_filter_6 = 0;
 201         fc->write_ibi_reg(fc,pid_filter_308,v);
 202
 203         flexcop_null_filter_ctrl(fc, 1);
 204 }