Linux Kernel  3.7.1
 All Data Structures Namespaces Files Functions Variables Typedefs Enumerations Enumerator Macros Groups Pages
vsc7326.c
Go to the documentation of this file.
1 /* $Date: 2006/04/28 19:20:06 $ $RCSfile: vsc7326.c,v $ $Revision: 1.19 $ */
2 
3 /* Driver for Vitesse VSC7326 (Schaumburg) MAC */
4 
5 #include "gmac.h"
6 #include "elmer0.h"
7 #include "vsc7326_reg.h"
8 
9 /* Update fast changing statistics every 15 seconds */
10 #define STATS_TICK_SECS 15
11 /* 30 minutes for full statistics update */
12 #define MAJOR_UPDATE_TICKS (1800 / STATS_TICK_SECS)
13 
14 #define MAX_MTU 9600
15 
16 /* The egress WM value 0x01a01fff should be used only when the
17  * interface is down (MAC port disabled). This is a workaround
18  * for disabling the T2/MAC flow-control. When the interface is
19  * enabled, the WM value should be set to 0x014a03F0.
20  */
21 #define WM_DISABLE 0x01a01fff
22 #define WM_ENABLE 0x014a03F0
23 
24 struct init_table {
27 };
28 
29 struct _cmac_instance {
32 };
33 
34 #define INITBLOCK_SLEEP 0xffffffff
35 
36 static void vsc_read(adapter_t *adapter, u32 addr, u32 *val)
37 {
38  u32 status, vlo, vhi;
39  int i;
40 
41  spin_lock_bh(&adapter->mac_lock);
42  t1_tpi_read(adapter, (addr << 2) + 4, &vlo);
43  i = 0;
44  do {
45  t1_tpi_read(adapter, (REG_LOCAL_STATUS << 2) + 4, &vlo);
46  t1_tpi_read(adapter, REG_LOCAL_STATUS << 2, &vhi);
47  status = (vhi << 16) | vlo;
48  i++;
49  } while (((status & 1) == 0) && (i < 50));
50  if (i == 50)
51  pr_err("Invalid tpi read from MAC, breaking loop.\n");
52 
53  t1_tpi_read(adapter, (REG_LOCAL_DATA << 2) + 4, &vlo);
54  t1_tpi_read(adapter, REG_LOCAL_DATA << 2, &vhi);
55 
56  *val = (vhi << 16) | vlo;
57 
58  /* pr_err("rd: block: 0x%x sublock: 0x%x reg: 0x%x data: 0x%x\n",
59  ((addr&0xe000)>>13), ((addr&0x1e00)>>9),
60  ((addr&0x01fe)>>1), *val); */
61  spin_unlock_bh(&adapter->mac_lock);
62 }
63 
64 static void vsc_write(adapter_t *adapter, u32 addr, u32 data)
65 {
66  spin_lock_bh(&adapter->mac_lock);
67  t1_tpi_write(adapter, (addr << 2) + 4, data & 0xFFFF);
68  t1_tpi_write(adapter, addr << 2, (data >> 16) & 0xFFFF);
69  /* pr_err("wr: block: 0x%x sublock: 0x%x reg: 0x%x data: 0x%x\n",
70  ((addr&0xe000)>>13), ((addr&0x1e00)>>9),
71  ((addr&0x01fe)>>1), data); */
72  spin_unlock_bh(&adapter->mac_lock);
73 }
74 
75 /* Hard reset the MAC. This wipes out *all* configuration. */
76 static void vsc7326_full_reset(adapter_t* adapter)
77 {
78  u32 val;
79  u32 result = 0xffff;
80 
81  t1_tpi_read(adapter, A_ELMER0_GPO, &val);
82  val &= ~1;
83  t1_tpi_write(adapter, A_ELMER0_GPO, val);
84  udelay(2);
85  val |= 0x1; /* Enable mac MAC itself */
86  val |= 0x800; /* Turn off the red LED */
87  t1_tpi_write(adapter, A_ELMER0_GPO, val);
88  mdelay(1);
89  vsc_write(adapter, REG_SW_RESET, 0x80000001);
90  do {
91  mdelay(1);
92  vsc_read(adapter, REG_SW_RESET, &result);
93  } while (result != 0x0);
94 }
95 
96 static struct init_table vsc7326_reset[] = {
97  { REG_IFACE_MODE, 0x00000000 },
98  { REG_CRC_CFG, 0x00000020 },
99  { REG_PLL_CLK_SPEED, 0x00050c00 },
100  { REG_PLL_CLK_SPEED, 0x00050c00 },
101  { REG_MSCH, 0x00002f14 },
102  { REG_SPI4_MISC, 0x00040409 },
103  { REG_SPI4_DESKEW, 0x00080000 },
104  { REG_SPI4_ING_SETUP2, 0x08080004 },
105  { REG_SPI4_ING_SETUP0, 0x04111004 },
106  { REG_SPI4_EGR_SETUP0, 0x80001a04 },
107  { REG_SPI4_ING_SETUP1, 0x02010000 },
108  { REG_AGE_INC(0), 0x00000000 },
109  { REG_AGE_INC(1), 0x00000000 },
110  { REG_ING_CONTROL, 0x0a200011 },
111  { REG_EGR_CONTROL, 0xa0010091 },
112 };
113 
114 static struct init_table vsc7326_portinit[4][22] = {
115  { /* Port 0 */
116  /* FIFO setup */
117  { REG_DBG(0), 0x000004f0 },
118  { REG_HDX(0), 0x00073101 },
119  { REG_TEST(0,0), 0x00000022 },
120  { REG_TEST(1,0), 0x00000022 },
121  { REG_TOP_BOTTOM(0,0), 0x003f0000 },
122  { REG_TOP_BOTTOM(1,0), 0x00120000 },
123  { REG_HIGH_LOW_WM(0,0), 0x07460757 },
124  { REG_HIGH_LOW_WM(1,0), WM_DISABLE },
125  { REG_CT_THRHLD(0,0), 0x00000000 },
126  { REG_CT_THRHLD(1,0), 0x00000000 },
127  { REG_BUCKE(0), 0x0002ffff },
128  { REG_BUCKI(0), 0x0002ffff },
129  { REG_TEST(0,0), 0x00000020 },
130  { REG_TEST(1,0), 0x00000020 },
131  /* Port config */
132  { REG_MAX_LEN(0), 0x00002710 },
133  { REG_PORT_FAIL(0), 0x00000002 },
134  { REG_NORMALIZER(0), 0x00000a64 },
135  { REG_DENORM(0), 0x00000010 },
136  { REG_STICK_BIT(0), 0x03baa370 },
137  { REG_DEV_SETUP(0), 0x00000083 },
138  { REG_DEV_SETUP(0), 0x00000082 },
139  { REG_MODE_CFG(0), 0x0200259f },
140  },
141  { /* Port 1 */
142  /* FIFO setup */
143  { REG_DBG(1), 0x000004f0 },
144  { REG_HDX(1), 0x00073101 },
145  { REG_TEST(0,1), 0x00000022 },
146  { REG_TEST(1,1), 0x00000022 },
147  { REG_TOP_BOTTOM(0,1), 0x007e003f },
148  { REG_TOP_BOTTOM(1,1), 0x00240012 },
149  { REG_HIGH_LOW_WM(0,1), 0x07460757 },
150  { REG_HIGH_LOW_WM(1,1), WM_DISABLE },
151  { REG_CT_THRHLD(0,1), 0x00000000 },
152  { REG_CT_THRHLD(1,1), 0x00000000 },
153  { REG_BUCKE(1), 0x0002ffff },
154  { REG_BUCKI(1), 0x0002ffff },
155  { REG_TEST(0,1), 0x00000020 },
156  { REG_TEST(1,1), 0x00000020 },
157  /* Port config */
158  { REG_MAX_LEN(1), 0x00002710 },
159  { REG_PORT_FAIL(1), 0x00000002 },
160  { REG_NORMALIZER(1), 0x00000a64 },
161  { REG_DENORM(1), 0x00000010 },
162  { REG_STICK_BIT(1), 0x03baa370 },
163  { REG_DEV_SETUP(1), 0x00000083 },
164  { REG_DEV_SETUP(1), 0x00000082 },
165  { REG_MODE_CFG(1), 0x0200259f },
166  },
167  { /* Port 2 */
168  /* FIFO setup */
169  { REG_DBG(2), 0x000004f0 },
170  { REG_HDX(2), 0x00073101 },
171  { REG_TEST(0,2), 0x00000022 },
172  { REG_TEST(1,2), 0x00000022 },
173  { REG_TOP_BOTTOM(0,2), 0x00bd007e },
174  { REG_TOP_BOTTOM(1,2), 0x00360024 },
175  { REG_HIGH_LOW_WM(0,2), 0x07460757 },
176  { REG_HIGH_LOW_WM(1,2), WM_DISABLE },
177  { REG_CT_THRHLD(0,2), 0x00000000 },
178  { REG_CT_THRHLD(1,2), 0x00000000 },
179  { REG_BUCKE(2), 0x0002ffff },
180  { REG_BUCKI(2), 0x0002ffff },
181  { REG_TEST(0,2), 0x00000020 },
182  { REG_TEST(1,2), 0x00000020 },
183  /* Port config */
184  { REG_MAX_LEN(2), 0x00002710 },
185  { REG_PORT_FAIL(2), 0x00000002 },
186  { REG_NORMALIZER(2), 0x00000a64 },
187  { REG_DENORM(2), 0x00000010 },
188  { REG_STICK_BIT(2), 0x03baa370 },
189  { REG_DEV_SETUP(2), 0x00000083 },
190  { REG_DEV_SETUP(2), 0x00000082 },
191  { REG_MODE_CFG(2), 0x0200259f },
192  },
193  { /* Port 3 */
194  /* FIFO setup */
195  { REG_DBG(3), 0x000004f0 },
196  { REG_HDX(3), 0x00073101 },
197  { REG_TEST(0,3), 0x00000022 },
198  { REG_TEST(1,3), 0x00000022 },
199  { REG_TOP_BOTTOM(0,3), 0x00fc00bd },
200  { REG_TOP_BOTTOM(1,3), 0x00480036 },
201  { REG_HIGH_LOW_WM(0,3), 0x07460757 },
202  { REG_HIGH_LOW_WM(1,3), WM_DISABLE },
203  { REG_CT_THRHLD(0,3), 0x00000000 },
204  { REG_CT_THRHLD(1,3), 0x00000000 },
205  { REG_BUCKE(3), 0x0002ffff },
206  { REG_BUCKI(3), 0x0002ffff },
207  { REG_TEST(0,3), 0x00000020 },
208  { REG_TEST(1,3), 0x00000020 },
209  /* Port config */
210  { REG_MAX_LEN(3), 0x00002710 },
211  { REG_PORT_FAIL(3), 0x00000002 },
212  { REG_NORMALIZER(3), 0x00000a64 },
213  { REG_DENORM(3), 0x00000010 },
214  { REG_STICK_BIT(3), 0x03baa370 },
215  { REG_DEV_SETUP(3), 0x00000083 },
216  { REG_DEV_SETUP(3), 0x00000082 },
217  { REG_MODE_CFG(3), 0x0200259f },
218  },
219 };
220 
221 static void run_table(adapter_t *adapter, struct init_table *ib, int len)
222 {
223  int i;
224 
225  for (i = 0; i < len; i++) {
226  if (ib[i].addr == INITBLOCK_SLEEP) {
227  udelay( ib[i].data );
228  pr_err("sleep %d us\n",ib[i].data);
229  } else
230  vsc_write( adapter, ib[i].addr, ib[i].data );
231  }
232 }
233 
234 static int bist_rd(adapter_t *adapter, int moduleid, int address)
235 {
236  int data = 0;
237  u32 result = 0;
238 
239  if ((address != 0x0) &&
240  (address != 0x1) &&
241  (address != 0x2) &&
242  (address != 0xd) &&
243  (address != 0xe))
244  pr_err("No bist address: 0x%x\n", address);
245 
246  data = ((0x00 << 24) | ((address & 0xff) << 16) | (0x00 << 8) |
247  ((moduleid & 0xff) << 0));
248  vsc_write(adapter, REG_RAM_BIST_CMD, data);
249 
250  udelay(10);
251 
252  vsc_read(adapter, REG_RAM_BIST_RESULT, &result);
253  if ((result & (1 << 9)) != 0x0)
254  pr_err("Still in bist read: 0x%x\n", result);
255  else if ((result & (1 << 8)) != 0x0)
256  pr_err("bist read error: 0x%x\n", result);
257 
258  return result & 0xff;
259 }
260 
261 static int bist_wr(adapter_t *adapter, int moduleid, int address, int value)
262 {
263  int data = 0;
264  u32 result = 0;
265 
266  if ((address != 0x0) &&
267  (address != 0x1) &&
268  (address != 0x2) &&
269  (address != 0xd) &&
270  (address != 0xe))
271  pr_err("No bist address: 0x%x\n", address);
272 
273  if (value > 255)
274  pr_err("Suspicious write out of range value: 0x%x\n", value);
275 
276  data = ((0x01 << 24) | ((address & 0xff) << 16) | (value << 8) |
277  ((moduleid & 0xff) << 0));
278  vsc_write(adapter, REG_RAM_BIST_CMD, data);
279 
280  udelay(5);
281 
282  vsc_read(adapter, REG_RAM_BIST_CMD, &result);
283  if ((result & (1 << 27)) != 0x0)
284  pr_err("Still in bist write: 0x%x\n", result);
285  else if ((result & (1 << 26)) != 0x0)
286  pr_err("bist write error: 0x%x\n", result);
287 
288  return 0;
289 }
290 
291 static int run_bist(adapter_t *adapter, int moduleid)
292 {
293  /*run bist*/
294  (void) bist_wr(adapter,moduleid, 0x00, 0x02);
295  (void) bist_wr(adapter,moduleid, 0x01, 0x01);
296 
297  return 0;
298 }
299 
300 static int check_bist(adapter_t *adapter, int moduleid)
301 {
302  int result=0;
303  int column=0;
304  /*check bist*/
305  result = bist_rd(adapter,moduleid, 0x02);
306  column = ((bist_rd(adapter,moduleid, 0x0e)<<8) +
307  (bist_rd(adapter,moduleid, 0x0d)));
308  if ((result & 3) != 0x3)
309  pr_err("Result: 0x%x BIST error in ram %d, column: 0x%04x\n",
310  result, moduleid, column);
311  return 0;
312 }
313 
314 static int enable_mem(adapter_t *adapter, int moduleid)
315 {
316  /*enable mem*/
317  (void) bist_wr(adapter,moduleid, 0x00, 0x00);
318  return 0;
319 }
320 
321 static int run_bist_all(adapter_t *adapter)
322 {
323  int port = 0;
324  u32 val = 0;
325 
326  vsc_write(adapter, REG_MEM_BIST, 0x5);
327  vsc_read(adapter, REG_MEM_BIST, &val);
328 
329  for (port = 0; port < 12; port++)
330  vsc_write(adapter, REG_DEV_SETUP(port), 0x0);
331 
332  udelay(300);
333  vsc_write(adapter, REG_SPI4_MISC, 0x00040409);
334  udelay(300);
335 
336  (void) run_bist(adapter,13);
337  (void) run_bist(adapter,14);
338  (void) run_bist(adapter,20);
339  (void) run_bist(adapter,21);
340  mdelay(200);
341  (void) check_bist(adapter,13);
342  (void) check_bist(adapter,14);
343  (void) check_bist(adapter,20);
344  (void) check_bist(adapter,21);
345  udelay(100);
346  (void) enable_mem(adapter,13);
347  (void) enable_mem(adapter,14);
348  (void) enable_mem(adapter,20);
349  (void) enable_mem(adapter,21);
350  udelay(300);
351  vsc_write(adapter, REG_SPI4_MISC, 0x60040400);
352  udelay(300);
353  for (port = 0; port < 12; port++)
354  vsc_write(adapter, REG_DEV_SETUP(port), 0x1);
355 
356  udelay(300);
357  vsc_write(adapter, REG_MEM_BIST, 0x0);
358  mdelay(10);
359  return 0;
360 }
361 
362 static int mac_intr_handler(struct cmac *mac)
363 {
364  return 0;
365 }
366 
367 static int mac_intr_enable(struct cmac *mac)
368 {
369  return 0;
370 }
371 
372 static int mac_intr_disable(struct cmac *mac)
373 {
374  return 0;
375 }
376 
377 static int mac_intr_clear(struct cmac *mac)
378 {
379  return 0;
380 }
381 
382 /* Expect MAC address to be in network byte order. */
383 static int mac_set_address(struct cmac* mac, u8 addr[6])
384 {
385  u32 val;
386  int port = mac->instance->index;
387 
388  vsc_write(mac->adapter, REG_MAC_LOW_ADDR(port),
389  (addr[3] << 16) | (addr[4] << 8) | addr[5]);
390  vsc_write(mac->adapter, REG_MAC_HIGH_ADDR(port),
391  (addr[0] << 16) | (addr[1] << 8) | addr[2]);
392 
393  vsc_read(mac->adapter, REG_ING_FFILT_UM_EN, &val);
394  val &= ~0xf0000000;
395  vsc_write(mac->adapter, REG_ING_FFILT_UM_EN, val | (port << 28));
396 
397  vsc_write(mac->adapter, REG_ING_FFILT_MASK0,
398  0xffff0000 | (addr[4] << 8) | addr[5]);
399  vsc_write(mac->adapter, REG_ING_FFILT_MASK1,
400  0xffff0000 | (addr[2] << 8) | addr[3]);
401  vsc_write(mac->adapter, REG_ING_FFILT_MASK2,
402  0xffff0000 | (addr[0] << 8) | addr[1]);
403  return 0;
404 }
405 
406 static int mac_get_address(struct cmac *mac, u8 addr[6])
407 {
408  u32 addr_lo, addr_hi;
409  int port = mac->instance->index;
410 
411  vsc_read(mac->adapter, REG_MAC_LOW_ADDR(port), &addr_lo);
412  vsc_read(mac->adapter, REG_MAC_HIGH_ADDR(port), &addr_hi);
413 
414  addr[0] = (u8) (addr_hi >> 16);
415  addr[1] = (u8) (addr_hi >> 8);
416  addr[2] = (u8) addr_hi;
417  addr[3] = (u8) (addr_lo >> 16);
418  addr[4] = (u8) (addr_lo >> 8);
419  addr[5] = (u8) addr_lo;
420  return 0;
421 }
422 
423 /* This is intended to reset a port, not the whole MAC */
424 static int mac_reset(struct cmac *mac)
425 {
426  int index = mac->instance->index;
427 
428  run_table(mac->adapter, vsc7326_portinit[index],
429  ARRAY_SIZE(vsc7326_portinit[index]));
430 
431  return 0;
432 }
433 
434 static int mac_set_rx_mode(struct cmac *mac, struct t1_rx_mode *rm)
435 {
436  u32 v;
437  int port = mac->instance->index;
438 
439  vsc_read(mac->adapter, REG_ING_FFILT_UM_EN, &v);
440  v |= 1 << 12;
441 
442  if (t1_rx_mode_promisc(rm))
443  v &= ~(1 << (port + 16));
444  else
445  v |= 1 << (port + 16);
446 
447  vsc_write(mac->adapter, REG_ING_FFILT_UM_EN, v);
448  return 0;
449 }
450 
451 static int mac_set_mtu(struct cmac *mac, int mtu)
452 {
453  int port = mac->instance->index;
454 
455  if (mtu > MAX_MTU)
456  return -EINVAL;
457 
458  /* max_len includes header and FCS */
459  vsc_write(mac->adapter, REG_MAX_LEN(port), mtu + 14 + 4);
460  return 0;
461 }
462 
463 static int mac_set_speed_duplex_fc(struct cmac *mac, int speed, int duplex,
464  int fc)
465 {
466  u32 v;
467  int enable, port = mac->instance->index;
468 
469  if (speed >= 0 && speed != SPEED_10 && speed != SPEED_100 &&
470  speed != SPEED_1000)
471  return -1;
472  if (duplex > 0 && duplex != DUPLEX_FULL)
473  return -1;
474 
475  if (speed >= 0) {
476  vsc_read(mac->adapter, REG_MODE_CFG(port), &v);
477  enable = v & 3; /* save tx/rx enables */
478  v &= ~0xf;
479  v |= 4; /* full duplex */
480  if (speed == SPEED_1000)
481  v |= 8; /* GigE */
482  enable |= v;
483  vsc_write(mac->adapter, REG_MODE_CFG(port), v);
484 
485  if (speed == SPEED_1000)
486  v = 0x82;
487  else if (speed == SPEED_100)
488  v = 0x84;
489  else /* SPEED_10 */
490  v = 0x86;
491  vsc_write(mac->adapter, REG_DEV_SETUP(port), v | 1); /* reset */
492  vsc_write(mac->adapter, REG_DEV_SETUP(port), v);
493  vsc_read(mac->adapter, REG_DBG(port), &v);
494  v &= ~0xff00;
495  if (speed == SPEED_1000)
496  v |= 0x400;
497  else if (speed == SPEED_100)
498  v |= 0x2000;
499  else /* SPEED_10 */
500  v |= 0xff00;
501  vsc_write(mac->adapter, REG_DBG(port), v);
502 
503  vsc_write(mac->adapter, REG_TX_IFG(port),
504  speed == SPEED_1000 ? 5 : 0x11);
505  if (duplex == DUPLEX_HALF)
506  enable = 0x0; /* 100 or 10 */
507  else if (speed == SPEED_1000)
508  enable = 0xc;
509  else /* SPEED_100 or 10 */
510  enable = 0x4;
511  enable |= 0x9 << 10; /* IFG1 */
512  enable |= 0x6 << 6; /* IFG2 */
513  enable |= 0x1 << 4; /* VLAN */
514  enable |= 0x3; /* RX/TX EN */
515  vsc_write(mac->adapter, REG_MODE_CFG(port), enable);
516 
517  }
518 
519  vsc_read(mac->adapter, REG_PAUSE_CFG(port), &v);
520  v &= 0xfff0ffff;
521  v |= 0x20000; /* xon/xoff */
522  if (fc & PAUSE_RX)
523  v |= 0x40000;
524  if (fc & PAUSE_TX)
525  v |= 0x80000;
526  if (fc == (PAUSE_RX | PAUSE_TX))
527  v |= 0x10000;
528  vsc_write(mac->adapter, REG_PAUSE_CFG(port), v);
529  return 0;
530 }
531 
532 static int mac_enable(struct cmac *mac, int which)
533 {
534  u32 val;
535  int port = mac->instance->index;
536 
537  /* Write the correct WM value when the port is enabled. */
538  vsc_write(mac->adapter, REG_HIGH_LOW_WM(1,port), WM_ENABLE);
539 
540  vsc_read(mac->adapter, REG_MODE_CFG(port), &val);
541  if (which & MAC_DIRECTION_RX)
542  val |= 0x2;
543  if (which & MAC_DIRECTION_TX)
544  val |= 1;
545  vsc_write(mac->adapter, REG_MODE_CFG(port), val);
546  return 0;
547 }
548 
549 static int mac_disable(struct cmac *mac, int which)
550 {
551  u32 val;
552  int i, port = mac->instance->index;
553 
554  /* Reset the port, this also writes the correct WM value */
555  mac_reset(mac);
556 
557  vsc_read(mac->adapter, REG_MODE_CFG(port), &val);
558  if (which & MAC_DIRECTION_RX)
559  val &= ~0x2;
560  if (which & MAC_DIRECTION_TX)
561  val &= ~0x1;
562  vsc_write(mac->adapter, REG_MODE_CFG(port), val);
563  vsc_read(mac->adapter, REG_MODE_CFG(port), &val);
564 
565  /* Clear stats */
566  for (i = 0; i <= 0x3a; ++i)
567  vsc_write(mac->adapter, CRA(4, port, i), 0);
568 
569  /* Clear software counters */
570  memset(&mac->stats, 0, sizeof(struct cmac_statistics));
571 
572  return 0;
573 }
574 
575 static void rmon_update(struct cmac *mac, unsigned int addr, u64 *stat)
576 {
577  u32 v, lo;
578 
579  vsc_read(mac->adapter, addr, &v);
580  lo = *stat;
581  *stat = *stat - lo + v;
582 
583  if (v == 0)
584  return;
585 
586  if (v < lo)
587  *stat += (1ULL << 32);
588 }
589 
590 static void port_stats_update(struct cmac *mac)
591 {
592  struct {
593  unsigned int reg;
594  unsigned int offset;
595  } hw_stats[] = {
596 
597 #define HW_STAT(reg, stat_name) \
598  { reg, (&((struct cmac_statistics *)NULL)->stat_name) - (u64 *)NULL }
599 
600  /* Rx stats */
601  HW_STAT(RxUnicast, RxUnicastFramesOK),
602  HW_STAT(RxMulticast, RxMulticastFramesOK),
603  HW_STAT(RxBroadcast, RxBroadcastFramesOK),
604  HW_STAT(Crc, RxFCSErrors),
605  HW_STAT(RxAlignment, RxAlignErrors),
606  HW_STAT(RxOversize, RxFrameTooLongErrors),
607  HW_STAT(RxPause, RxPauseFrames),
608  HW_STAT(RxJabbers, RxJabberErrors),
609  HW_STAT(RxFragments, RxRuntErrors),
610  HW_STAT(RxUndersize, RxRuntErrors),
612  HW_STAT(RxSize1519ToMax, RxJumboFramesOK),
613 
614  /* Tx stats (skip collision stats as we are full-duplex only) */
615  HW_STAT(TxUnicast, TxUnicastFramesOK),
616  HW_STAT(TxMulticast, TxMulticastFramesOK),
617  HW_STAT(TxBroadcast, TxBroadcastFramesOK),
618  HW_STAT(TxPause, TxPauseFrames),
620  HW_STAT(TxSize1519ToMax, TxJumboFramesOK),
621  }, *p = hw_stats;
622  unsigned int port = mac->instance->index;
623  u64 *stats = (u64 *)&mac->stats;
624  unsigned int i;
625 
626  for (i = 0; i < ARRAY_SIZE(hw_stats); i++)
627  rmon_update(mac, CRA(0x4, port, p->reg), stats + p->offset);
628 
629  rmon_update(mac, REG_TX_OK_BYTES(port), &mac->stats.TxOctetsOK);
630  rmon_update(mac, REG_RX_OK_BYTES(port), &mac->stats.RxOctetsOK);
631  rmon_update(mac, REG_RX_BAD_BYTES(port), &mac->stats.RxOctetsBad);
632 }
633 
634 /*
635  * This function is called periodically to accumulate the current values of the
636  * RMON counters into the port statistics. Since the counters are only 32 bits
637  * some of them can overflow in less than a minute at GigE speeds, so this
638  * function should be called every 30 seconds or so.
639  *
640  * To cut down on reading costs we update only the octet counters at each tick
641  * and do a full update at major ticks, which can be every 30 minutes or more.
642  */
643 static const struct cmac_statistics *mac_update_statistics(struct cmac *mac,
644  int flag)
645 {
646  if (flag == MAC_STATS_UPDATE_FULL ||
647  mac->instance->ticks >= MAJOR_UPDATE_TICKS) {
648  port_stats_update(mac);
649  mac->instance->ticks = 0;
650  } else {
651  int port = mac->instance->index;
652 
653  rmon_update(mac, REG_RX_OK_BYTES(port),
654  &mac->stats.RxOctetsOK);
655  rmon_update(mac, REG_RX_BAD_BYTES(port),
656  &mac->stats.RxOctetsBad);
657  rmon_update(mac, REG_TX_OK_BYTES(port),
658  &mac->stats.TxOctetsOK);
659  mac->instance->ticks++;
660  }
661  return &mac->stats;
662 }
663 
664 static void mac_destroy(struct cmac *mac)
665 {
666  kfree(mac);
667 }
668 
669 static struct cmac_ops vsc7326_ops = {
670  .destroy = mac_destroy,
671  .reset = mac_reset,
672  .interrupt_handler = mac_intr_handler,
673  .interrupt_enable = mac_intr_enable,
674  .interrupt_disable = mac_intr_disable,
675  .interrupt_clear = mac_intr_clear,
676  .enable = mac_enable,
677  .disable = mac_disable,
678  .set_mtu = mac_set_mtu,
679  .set_rx_mode = mac_set_rx_mode,
680  .set_speed_duplex_fc = mac_set_speed_duplex_fc,
681  .statistics_update = mac_update_statistics,
682  .macaddress_get = mac_get_address,
683  .macaddress_set = mac_set_address,
684 };
685 
686 static struct cmac *vsc7326_mac_create(adapter_t *adapter, int index)
687 {
688  struct cmac *mac;
689  u32 val;
690  int i;
691 
692  mac = kzalloc(sizeof(*mac) + sizeof(cmac_instance), GFP_KERNEL);
693  if (!mac)
694  return NULL;
695 
696  mac->ops = &vsc7326_ops;
697  mac->instance = (cmac_instance *)(mac + 1);
698  mac->adapter = adapter;
699 
700  mac->instance->index = index;
701  mac->instance->ticks = 0;
702 
703  i = 0;
704  do {
705  u32 vhi, vlo;
706 
707  vhi = vlo = 0;
708  t1_tpi_read(adapter, (REG_LOCAL_STATUS << 2) + 4, &vlo);
709  udelay(1);
710  t1_tpi_read(adapter, REG_LOCAL_STATUS << 2, &vhi);
711  udelay(5);
712  val = (vhi << 16) | vlo;
713  } while ((++i < 10000) && (val == 0xffffffff));
714 
715  return mac;
716 }
717 
718 static int vsc7326_mac_reset(adapter_t *adapter)
719 {
720  vsc7326_full_reset(adapter);
721  (void) run_bist_all(adapter);
722  run_table(adapter, vsc7326_reset, ARRAY_SIZE(vsc7326_reset));
723  return 0;
724 }
725 
726 const struct gmac t1_vsc7326_ops = {
727  .stats_update_period = STATS_TICK_SECS,
728  .create = vsc7326_mac_create,
729  .reset = vsc7326_mac_reset,
730 };