V4L/DVB (9589): Properly support capture start on em2874
[linux-2.6] / drivers / net / chelsio / vsc7326.c
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 {
25         u32 addr;
26         u32 data;
27 };
28
29 struct _cmac_instance {
30         u32 index;
31         u32 ticks;
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                 CH_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         /* CH_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         /* CH_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                         CH_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                         CH_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                 CH_ERR("Still in bist read: 0x%x\n", result);
255         else if ((result & (1 << 8)) != 0x0)
256                 CH_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                         CH_ERR("No bist address: 0x%x\n", address);
272
273         if (value > 255)
274                 CH_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                 CH_ERR("Still in bist write: 0x%x\n", result);
285         else if ((result & (1 << 26)) != 0x0)
286                 CH_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                 CH_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 sofware 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),
611                 HW_STAT(RxSymbolCarrier, RxSymbolErrors),
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),
619                 HW_STAT(TxUnderrun, TxUnderrun),
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 };