target/linux/storm/patches/005-gmac_napi_mask_intrs.patch

   1 --- a/drivers/net/sl351x_gmac.c
   2 +++ b/drivers/net/sl351x_gmac.c
   3 @@ -127,6 +127,7 @@ static      char _debug_prefetch_buf[_DEBUG_P
   4  static int     gmac_initialized = 0;
   5  TOE_INFO_T toe_private_data;
   6  static int             do_again = 0;
   7 +static int rx_poll_enabled;
   8  spinlock_t gmac_fq_lock;
   9  unsigned int FLAG_SWITCH;
  10
  11 @@ -1065,7 +1066,8 @@ static void toe_init_gmac(struct net_dev
  12             tp->intr3_enabled =         0xffffffff;
  13             tp->intr4_selected =        GMAC0_INT_BITS | CLASS_RX_FULL_INT_BITS |
  14                                                         HWFQ_EMPTY_INT_BIT | SWFQ_EMPTY_INT_BIT;
  15 -           tp->intr4_enabled =         GMAC0_INT_BITS | SWFQ_EMPTY_INT_BIT;
  16 +           tp->intr4_enabled =         GMAC0_INT_BITS | SWFQ_EMPTY_INT_BIT| GMAC0_RX_OVERRUN_INT_BIT;
  17 +           // GMAC0_TX_PAUSE_OFF_INT_BIT| GMAC0_MIB_INT_BIT;
  18
  19             data = readl(TOE_GLOBAL_BASE + GLOBAL_INTERRUPT_SELECT_0_REG) & ~tp->intr0_selected;
  20             writel(data, TOE_GLOBAL_BASE + GLOBAL_INTERRUPT_SELECT_0_REG);
  21 @@ -1115,7 +1117,7 @@ static void toe_init_gmac(struct net_dev
  22                 tp->intr3_enabled       |=      0xffffffff;
  23                 tp->intr4_selected      |=      CLASS_RX_FULL_INT_BITS |
  24                                                                 HWFQ_EMPTY_INT_BIT | SWFQ_EMPTY_INT_BIT;
  25 -               tp->intr4_enabled       |=      SWFQ_EMPTY_INT_BIT;
  26 +               tp->intr4_enabled       |=      SWFQ_EMPTY_INT_BIT | GMAC1_RX_OVERRUN_INT_BIT;
  27                 }
  28             data = readl(TOE_GLOBAL_BASE + GLOBAL_INTERRUPT_SELECT_0_REG) | tp->intr0_selected;
  29             writel(data, TOE_GLOBAL_BASE + GLOBAL_INTERRUPT_SELECT_0_REG);
  30 @@ -2408,7 +2410,7 @@ static inline void toe_gmac_fill_free_q(
  31         // unsigned short max_cnt=TOE_SW_FREEQ_DESC_NUM>>1;
  32
  33         fq_rwptr.bits32 = readl(TOE_GLOBAL_BASE + GLOBAL_SWFQ_RWPTR_REG);
  34 -       spin_lock_irqsave(&gmac_fq_lock, flags);
  35 +       // spin_lock_irqsave(&gmac_fq_lock, flags);
  36         //while ((max_cnt--) && (unsigned short)RWPTR_ADVANCE_ONE(fq_rwptr.bits.wptr,
  37         //                              TOE_SW_FREEQ_DESC_NUM) != fq_rwptr.bits.rptr) {
  38         while ((unsigned short)RWPTR_ADVANCE_ONE(fq_rwptr.bits.wptr,
  39 @@ -2428,10 +2430,47 @@ static inline void toe_gmac_fill_free_q(
  40                 SET_WPTR(TOE_GLOBAL_BASE+GLOBAL_SWFQ_RWPTR_REG, fq_rwptr.bits.wptr);
  41                 toe_private_data.fq_rx_rwptr.bits32 = fq_rwptr.bits32;
  42         }
  43 -       spin_unlock_irqrestore(&gmac_fq_lock, flags);
  44 +       // spin_unlock_irqrestore(&gmac_fq_lock, flags);
  45  }
  46  // EXPORT_SYMBOL(toe_gmac_fill_free_q);
  47
  48 +static void gmac_registers(const char *message)
  49 +{
  50 +       unsigned int            status0;
  51 +       unsigned int            status1;
  52 +       unsigned int            status2;
  53 +       unsigned int            status3;
  54 +       unsigned int            status4;
  55 +
  56 +       printk("%s\n", message);
  57 +
  58 +       status0 = readl(TOE_GLOBAL_BASE + GLOBAL_INTERRUPT_STATUS_0_REG);
  59 +       status1 = readl(TOE_GLOBAL_BASE + GLOBAL_INTERRUPT_STATUS_1_REG);
  60 +       status2 = readl(TOE_GLOBAL_BASE + GLOBAL_INTERRUPT_STATUS_2_REG);
  61 +       status3 = readl(TOE_GLOBAL_BASE + GLOBAL_INTERRUPT_STATUS_3_REG);
  62 +       status4 = readl(TOE_GLOBAL_BASE + GLOBAL_INTERRUPT_STATUS_4_REG);
  63 +
  64 +       printk("status: s0:%08X, s1:%08X, s2:%08X, s3:%08X, s4:%08X\n",
  65 +                  status0, status1, status2, status3, status4);
  66 +
  67 +       status0 = readl(TOE_GLOBAL_BASE + GLOBAL_INTERRUPT_ENABLE_0_REG);
  68 +       status1 = readl(TOE_GLOBAL_BASE + GLOBAL_INTERRUPT_ENABLE_1_REG);
  69 +       status2 = readl(TOE_GLOBAL_BASE + GLOBAL_INTERRUPT_ENABLE_2_REG);
  70 +       status3 = readl(TOE_GLOBAL_BASE + GLOBAL_INTERRUPT_ENABLE_3_REG);
  71 +       status4 = readl(TOE_GLOBAL_BASE + GLOBAL_INTERRUPT_ENABLE_4_REG);
  72 +
  73 +       printk("mask  : s0:%08X, s1:%08X, s2:%08X, s3:%08X, s4:%08X\n",
  74 +                  status0, status1, status2, status3, status4);
  75 +
  76 +       status0 = readl(TOE_GLOBAL_BASE + GLOBAL_INTERRUPT_SELECT_0_REG);
  77 +       status1 = readl(TOE_GLOBAL_BASE + GLOBAL_INTERRUPT_SELECT_1_REG);
  78 +       status2 = readl(TOE_GLOBAL_BASE + GLOBAL_INTERRUPT_SELECT_2_REG);
  79 +       status3 = readl(TOE_GLOBAL_BASE + GLOBAL_INTERRUPT_SELECT_3_REG);
  80 +       status4 = readl(TOE_GLOBAL_BASE + GLOBAL_INTERRUPT_SELECT_4_REG);
  81 +
  82 +       printk("select: s0:%08X, s1:%08X, s2:%08X, s3:%08X, s4:%08X\n",
  83 +                  status0, status1, status2, status3, status4);
  84 +}
  85  /*----------------------------------------------------------------------
  86  * toe_gmac_interrupt
  87  *----------------------------------------------------------------------*/
  88 @@ -2492,6 +2531,7 @@ if (1)
  89                 writel(status3 & tp->intr3_enabled, TOE_GLOBAL_BASE+GLOBAL_INTERRUPT_STATUS_3_REG);
  90         if (status4)
  91                 writel(status4 & tp->intr4_enabled, TOE_GLOBAL_BASE+GLOBAL_INTERRUPT_STATUS_4_REG);
  92 +
  93  #if 0
  94         /* handle freeq interrupt first */
  95         if (status4 & tp->intr4_enabled) {
  96 @@ -2536,10 +2576,31 @@ if (1)
  97                         }
  98                                 if (netif_running(dev) && (status1 & DEFAULT_Q0_INT_BIT) && (tp->intr1_enabled & DEFAULT_Q0_INT_BIT))
  99                                 {
 100 -                                       if (likely(netif_rx_schedule_prep(dev)))
 101 +                                       if (!rx_poll_enabled && likely(netif_rx_schedule_prep(dev)))
 102                                 {
 103 -                                       // unsigned int data32;
 104 -                                       // disable GMAC-0 rx interrupt
 105 +                                       unsigned int data32;
 106 +
 107 +                                               if (rx_poll_enabled)
 108 +                                                               gmac_registers("check #1");
 109 +
 110 +                                               BUG_ON(rx_poll_enabled == 1);
 111 +
 112 +#if 0
 113 +                                       /* Masks GMAC-0 rx interrupt */
 114 +                                               data32  = readl(TOE_GLOBAL_BASE + GLOBAL_INTERRUPT_ENABLE_1_REG);
 115 +                                               data32 &= ~(DEFAULT_Q0_INT_BIT);
 116 +                                               writel(data32, TOE_GLOBAL_BASE + GLOBAL_INTERRUPT_ENABLE_1_REG);
 117 +
 118 +                                       /* Masks GMAC-0 queue empty interrupt */
 119 +                                               data32  = readl(TOE_GLOBAL_BASE + GLOBAL_INTERRUPT_ENABLE_4_REG);
 120 +                                               data32 &= ~DEFAULT_Q0_INT_BIT;
 121 +                                               writel(data32, TOE_GLOBAL_BASE + GLOBAL_INTERRUPT_ENABLE_4_REG);
 122 +
 123 +                                               data32  = readl(TOE_GLOBAL_BASE + GLOBAL_INTERRUPT_SELECT_4_REG);
 124 +                                               data32 &= ~DEFAULT_Q0_INT_BIT;
 125 +                                               writel(data32, TOE_GLOBAL_BASE + GLOBAL_INTERRUPT_SELECT_4_REG);
 126 +#endif
 127 +
 128                                         // class-Q & TOE-Q are implemented in future
 129                                         //data32 = readl(TOE_GLOBAL_BASE + GLOBAL_INTERRUPT_ENABLE_1_REG);
 130                                         //data32 &= ~DEFAULT_Q0_INT_BIT;
 131 @@ -2549,7 +2610,8 @@ if (1)
 132                                                 //tp->total_q_cnt_napi=0;
 133                                                 //rx_time = jiffies;
 134                                                 //rx_old_bytes = isPtr->rx_bytes;
 135 -                               __netif_rx_schedule(dev);
 136 +                                               __netif_rx_schedule(dev);
 137 +                                               rx_poll_enabled = 1;
 138                                 }
 139                         }
 140                 }
 141 @@ -2569,9 +2631,31 @@ if (1)
 142
 143                         if (netif_running(dev) && (status1 & DEFAULT_Q1_INT_BIT) && (tp->intr1_enabled & DEFAULT_Q1_INT_BIT))
 144                         {
 145 -                               if (likely(netif_rx_schedule_prep(dev)))
 146 +                               if (!rx_poll_enabled && likely(netif_rx_schedule_prep(dev)))
 147                         {
 148 -                               // unsigned int data32;
 149 +                               unsigned int data32;
 150 +
 151 +                                       if (rx_poll_enabled)
 152 +                                                       gmac_registers("check #2");
 153 +
 154 +                                       BUG_ON(rx_poll_enabled == 1);
 155 +
 156 +#if 0
 157 +                                       /* Masks GMAC-1 rx interrupt */
 158 +                                       data32  = readl(TOE_GLOBAL_BASE + GLOBAL_INTERRUPT_ENABLE_1_REG);
 159 +                                       data32 &= ~(DEFAULT_Q1_INT_BIT);
 160 +                                       writel(data32, TOE_GLOBAL_BASE + GLOBAL_INTERRUPT_ENABLE_1_REG);
 161 +
 162 +                               /* Masks GMAC-1 queue empty interrupt */
 163 +                                       data32  = readl(TOE_GLOBAL_BASE + GLOBAL_INTERRUPT_ENABLE_4_REG);
 164 +                                       data32 &= ~DEFAULT_Q1_INT_BIT;
 165 +                                       writel(data32, TOE_GLOBAL_BASE + GLOBAL_INTERRUPT_ENABLE_4_REG);
 166 +
 167 +                                       data32  = readl(TOE_GLOBAL_BASE + GLOBAL_INTERRUPT_SELECT_4_REG);
 168 +                                       data32 &= ~DEFAULT_Q1_INT_BIT;
 169 +                                       writel(data32, TOE_GLOBAL_BASE + GLOBAL_INTERRUPT_SELECT_4_REG);
 170 +#endif
 171 +
 172                                 // disable GMAC-0 rx interrupt
 173                                 // class-Q & TOE-Q are implemented in future
 174                                 //data32 = readl(TOE_GLOBAL_BASE + GLOBAL_INTERRUPT_ENABLE_1_REG);
 175 @@ -2583,9 +2667,13 @@ if (1)
 176                                         //rx_time = jiffies;
 177                                         //rx_old_bytes = isPtr->rx_bytes;
 178                                 __netif_rx_schedule(dev);
 179 +                               rx_poll_enabled = 1;
 180                         }
 181                         }
 182                 }
 183 +       } else {
 184 +
 185 +               gmac_registers("check #3");
 186         }
 187
 188         // Interrupt Status 0
 189 @@ -3306,8 +3394,10 @@ next_rx:
 190                 SET_RPTR(&tp->default_qhdr->word1, rwptr.bits.rptr);
 191         tp->rx_rwptr.bits32 = rwptr.bits32;
 192
 193 -               toe_gmac_fill_free_q();
 194         }
 195 +
 196 +       /* Handles first available packets only then refill the queue. */
 197 +       toe_gmac_fill_free_q();
 198  }
 199
 200  /*----------------------------------------------------------------------
 201 @@ -4217,6 +4307,7 @@ static int gmac_rx_poll(struct net_devic
 202      GMAC_RXDESC_T      *curr_desc;
 203         struct sk_buff          *skb;
 204      DMA_RWPTR_T                        rwptr;
 205 +    unsigned int data32;
 206         unsigned int            pkt_size;
 207         unsigned int        desc_count;
 208         unsigned int        good_frame, chksum_status, rx_status;
 209 @@ -4231,7 +4322,7 @@ static int gmac_rx_poll(struct net_devic
 210         //unsigned long long    rx_time;
 211
 212
 213 -
 214 +       BUG_ON(rx_poll_enabled == 0);
 215  #if 1
 216         if (do_again)
 217         {
 218 @@ -4516,6 +4607,30 @@ static int gmac_rx_poll(struct net_devic
 219  #endif
 220          //toe_gmac_fill_free_q();
 221          netif_rx_complete(dev);
 222 +
 223 +               rx_poll_enabled = 0;
 224 +
 225 +               data32 = readl(TOE_GLOBAL_BASE + GLOBAL_INTERRUPT_ENABLE_1_REG);
 226 +               if (tp->port_id == 0)
 227 +                               data32 |= DEFAULT_Q0_INT_BIT;
 228 +               else
 229 +                               data32 |= DEFAULT_Q1_INT_BIT;
 230 +               writel(data32, TOE_GLOBAL_BASE + GLOBAL_INTERRUPT_ENABLE_1_REG);
 231 +
 232 +               data32 = readl(TOE_GLOBAL_BASE + GLOBAL_INTERRUPT_ENABLE_4_REG);
 233 +               if (tp->port_id == 0)
 234 +                               data32 |= DEFAULT_Q0_INT_BIT;
 235 +               else
 236 +                               data32 |= DEFAULT_Q1_INT_BIT;
 237 +               writel(data32, TOE_GLOBAL_BASE + GLOBAL_INTERRUPT_ENABLE_4_REG);
 238 +
 239 +               data32 = readl(TOE_GLOBAL_BASE + GLOBAL_INTERRUPT_SELECT_4_REG);
 240 +               if (tp->port_id == 0)
 241 +                               data32 |= DEFAULT_Q0_INT_BIT;
 242 +               else
 243 +                               data32 |= DEFAULT_Q1_INT_BIT;
 244 +               writel(data32, TOE_GLOBAL_BASE + GLOBAL_INTERRUPT_SELECT_4_REG);
 245 +
 246          // enable GMAC-0 rx interrupt
 247          // class-Q & TOE-Q are implemented in future
 248          //data32 = readl(TOE_GLOBAL_BASE + GLOBAL_INTERRUPT_ENABLE_1_REG);