| /* $Date: 2006/04/28 19:20:06 $ $RCSfile: vsc7326.c,v $ $Revision: 1.19 $ */ |
| |
| /* Driver for Vitesse VSC7326 (Schaumburg) MAC */ |
| |
| #include "gmac.h" |
| #include "elmer0.h" |
| #include "vsc7326_reg.h" |
| |
| /* Update fast changing statistics every 15 seconds */ |
| #define STATS_TICK_SECS 15 |
| /* 30 minutes for full statistics update */ |
| #define MAJOR_UPDATE_TICKS (1800 / STATS_TICK_SECS) |
| |
| #define MAX_MTU 9600 |
| |
| /* The egress WM value 0x01a01fff should be used only when the |
| * interface is down (MAC port disabled). This is a workaround |
| * for disabling the T2/MAC flow-control. When the interface is |
| * enabled, the WM value should be set to 0x014a03F0. |
| */ |
| #define WM_DISABLE 0x01a01fff |
| #define WM_ENABLE 0x014a03F0 |
| |
| struct init_table { |
| u32 addr; |
| u32 data; |
| }; |
| |
| struct _cmac_instance { |
| u32 index; |
| u32 ticks; |
| }; |
| |
| #define INITBLOCK_SLEEP 0xffffffff |
| |
| static void vsc_read(adapter_t *adapter, u32 addr, u32 *val) |
| { |
| u32 status, vlo, vhi; |
| int i; |
| |
| spin_lock_bh(&adapter->mac_lock); |
| t1_tpi_read(adapter, (addr << 2) + 4, &vlo); |
| i = 0; |
| do { |
| t1_tpi_read(adapter, (REG_LOCAL_STATUS << 2) + 4, &vlo); |
| t1_tpi_read(adapter, REG_LOCAL_STATUS << 2, &vhi); |
| status = (vhi << 16) | vlo; |
| i++; |
| } while (((status & 1) == 0) && (i < 50)); |
| if (i == 50) |
| CH_ERR("Invalid tpi read from MAC, breaking loop.\n"); |
| |
| t1_tpi_read(adapter, (REG_LOCAL_DATA << 2) + 4, &vlo); |
| t1_tpi_read(adapter, REG_LOCAL_DATA << 2, &vhi); |
| |
| *val = (vhi << 16) | vlo; |
| |
| /* CH_ERR("rd: block: 0x%x sublock: 0x%x reg: 0x%x data: 0x%x\n", |
| ((addr&0xe000)>>13), ((addr&0x1e00)>>9), |
| ((addr&0x01fe)>>1), *val); */ |
| spin_unlock_bh(&adapter->mac_lock); |
| } |
| |
| static void vsc_write(adapter_t *adapter, u32 addr, u32 data) |
| { |
| spin_lock_bh(&adapter->mac_lock); |
| t1_tpi_write(adapter, (addr << 2) + 4, data & 0xFFFF); |
| t1_tpi_write(adapter, addr << 2, (data >> 16) & 0xFFFF); |
| /* CH_ERR("wr: block: 0x%x sublock: 0x%x reg: 0x%x data: 0x%x\n", |
| ((addr&0xe000)>>13), ((addr&0x1e00)>>9), |
| ((addr&0x01fe)>>1), data); */ |
| spin_unlock_bh(&adapter->mac_lock); |
| } |
| |
| /* Hard reset the MAC. This wipes out *all* configuration. */ |
| static void vsc7326_full_reset(adapter_t* adapter) |
| { |
| u32 val; |
| u32 result = 0xffff; |
| |
| t1_tpi_read(adapter, A_ELMER0_GPO, &val); |
| val &= ~1; |
| t1_tpi_write(adapter, A_ELMER0_GPO, val); |
| udelay(2); |
| val |= 0x1; /* Enable mac MAC itself */ |
| val |= 0x800; /* Turn off the red LED */ |
| t1_tpi_write(adapter, A_ELMER0_GPO, val); |
| mdelay(1); |
| vsc_write(adapter, REG_SW_RESET, 0x80000001); |
| do { |
| mdelay(1); |
| vsc_read(adapter, REG_SW_RESET, &result); |
| } while (result != 0x0); |
| } |
| |
| static struct init_table vsc7326_reset[] = { |
| { REG_IFACE_MODE, 0x00000000 }, |
| { REG_CRC_CFG, 0x00000020 }, |
| { REG_PLL_CLK_SPEED, 0x00050c00 }, |
| { REG_PLL_CLK_SPEED, 0x00050c00 }, |
| { REG_MSCH, 0x00002f14 }, |
| { REG_SPI4_MISC, 0x00040409 }, |
| { REG_SPI4_DESKEW, 0x00080000 }, |
| { REG_SPI4_ING_SETUP2, 0x08080004 }, |
| { REG_SPI4_ING_SETUP0, 0x04111004 }, |
| { REG_SPI4_EGR_SETUP0, 0x80001a04 }, |
| { REG_SPI4_ING_SETUP1, 0x02010000 }, |
| { REG_AGE_INC(0), 0x00000000 }, |
| { REG_AGE_INC(1), 0x00000000 }, |
| { REG_ING_CONTROL, 0x0a200011 }, |
| { REG_EGR_CONTROL, 0xa0010091 }, |
| }; |
| |
| static struct init_table vsc7326_portinit[4][22] = { |
| { /* Port 0 */ |
| /* FIFO setup */ |
| { REG_DBG(0), 0x000004f0 }, |
| { REG_HDX(0), 0x00073101 }, |
| { REG_TEST(0,0), 0x00000022 }, |
| { REG_TEST(1,0), 0x00000022 }, |
| { REG_TOP_BOTTOM(0,0), 0x003f0000 }, |
| { REG_TOP_BOTTOM(1,0), 0x00120000 }, |
| { REG_HIGH_LOW_WM(0,0), 0x07460757 }, |
| { REG_HIGH_LOW_WM(1,0), WM_DISABLE }, |
| { REG_CT_THRHLD(0,0), 0x00000000 }, |
| { REG_CT_THRHLD(1,0), 0x00000000 }, |
| { REG_BUCKE(0), 0x0002ffff }, |
| { REG_BUCKI(0), 0x0002ffff }, |
| { REG_TEST(0,0), 0x00000020 }, |
| { REG_TEST(1,0), 0x00000020 }, |
| /* Port config */ |
| { REG_MAX_LEN(0), 0x00002710 }, |
| { REG_PORT_FAIL(0), 0x00000002 }, |
| { REG_NORMALIZER(0), 0x00000a64 }, |
| { REG_DENORM(0), 0x00000010 }, |
| { REG_STICK_BIT(0), 0x03baa370 }, |
| { REG_DEV_SETUP(0), 0x00000083 }, |
| { REG_DEV_SETUP(0), 0x00000082 }, |
| { REG_MODE_CFG(0), 0x0200259f }, |
| }, |
| { /* Port 1 */ |
| /* FIFO setup */ |
| { REG_DBG(1), 0x000004f0 }, |
| { REG_HDX(1), 0x00073101 }, |
| { REG_TEST(0,1), 0x00000022 }, |
| { REG_TEST(1,1), 0x00000022 }, |
| { REG_TOP_BOTTOM(0,1), 0x007e003f }, |
| { REG_TOP_BOTTOM(1,1), 0x00240012 }, |
| { REG_HIGH_LOW_WM(0,1), 0x07460757 }, |
| { REG_HIGH_LOW_WM(1,1), WM_DISABLE }, |
| { REG_CT_THRHLD(0,1), 0x00000000 }, |
| { REG_CT_THRHLD(1,1), 0x00000000 }, |
| { REG_BUCKE(1), 0x0002ffff }, |
| { REG_BUCKI(1), 0x0002ffff }, |
| { REG_TEST(0,1), 0x00000020 }, |
| { REG_TEST(1,1), 0x00000020 }, |
| /* Port config */ |
| { REG_MAX_LEN(1), 0x00002710 }, |
| { REG_PORT_FAIL(1), 0x00000002 }, |
| { REG_NORMALIZER(1), 0x00000a64 }, |
| { REG_DENORM(1), 0x00000010 }, |
| { REG_STICK_BIT(1), 0x03baa370 }, |
| { REG_DEV_SETUP(1), 0x00000083 }, |
| { REG_DEV_SETUP(1), 0x00000082 }, |
| { REG_MODE_CFG(1), 0x0200259f }, |
| }, |
| { /* Port 2 */ |
| /* FIFO setup */ |
| { REG_DBG(2), 0x000004f0 }, |
| { REG_HDX(2), 0x00073101 }, |
| { REG_TEST(0,2), 0x00000022 }, |
| { REG_TEST(1,2), 0x00000022 }, |
| { REG_TOP_BOTTOM(0,2), 0x00bd007e }, |
| { REG_TOP_BOTTOM(1,2), 0x00360024 }, |
| { REG_HIGH_LOW_WM(0,2), 0x07460757 }, |
| { REG_HIGH_LOW_WM(1,2), WM_DISABLE }, |
| { REG_CT_THRHLD(0,2), 0x00000000 }, |
| { REG_CT_THRHLD(1,2), 0x00000000 }, |
| { REG_BUCKE(2), 0x0002ffff }, |
| { REG_BUCKI(2), 0x0002ffff }, |
| { REG_TEST(0,2), 0x00000020 }, |
| { REG_TEST(1,2), 0x00000020 }, |
| /* Port config */ |
| { REG_MAX_LEN(2), 0x00002710 }, |
| { REG_PORT_FAIL(2), 0x00000002 }, |
| { REG_NORMALIZER(2), 0x00000a64 }, |
| { REG_DENORM(2), 0x00000010 }, |
| { REG_STICK_BIT(2), 0x03baa370 }, |
| { REG_DEV_SETUP(2), 0x00000083 }, |
| { REG_DEV_SETUP(2), 0x00000082 }, |
| { REG_MODE_CFG(2), 0x0200259f }, |
| }, |
| { /* Port 3 */ |
| /* FIFO setup */ |
| { REG_DBG(3), 0x000004f0 }, |
| { REG_HDX(3), 0x00073101 }, |
| { REG_TEST(0,3), 0x00000022 }, |
| { REG_TEST(1,3), 0x00000022 }, |
| { REG_TOP_BOTTOM(0,3), 0x00fc00bd }, |
| { REG_TOP_BOTTOM(1,3), 0x00480036 }, |
| { REG_HIGH_LOW_WM(0,3), 0x07460757 }, |
| { REG_HIGH_LOW_WM(1,3), WM_DISABLE }, |
| { REG_CT_THRHLD(0,3), 0x00000000 }, |
| { REG_CT_THRHLD(1,3), 0x00000000 }, |
| { REG_BUCKE(3), 0x0002ffff }, |
| { REG_BUCKI(3), 0x0002ffff }, |
| { REG_TEST(0,3), 0x00000020 }, |
| { REG_TEST(1,3), 0x00000020 }, |
| /* Port config */ |
| { REG_MAX_LEN(3), 0x00002710 }, |
| { REG_PORT_FAIL(3), 0x00000002 }, |
| { REG_NORMALIZER(3), 0x00000a64 }, |
| { REG_DENORM(3), 0x00000010 }, |
| { REG_STICK_BIT(3), 0x03baa370 }, |
| { REG_DEV_SETUP(3), 0x00000083 }, |
| { REG_DEV_SETUP(3), 0x00000082 }, |
| { REG_MODE_CFG(3), 0x0200259f }, |
| }, |
| }; |
| |
| static void run_table(adapter_t *adapter, struct init_table *ib, int len) |
| { |
| int i; |
| |
| for (i = 0; i < len; i++) { |
| if (ib[i].addr == INITBLOCK_SLEEP) { |
| udelay( ib[i].data ); |
| CH_ERR("sleep %d us\n",ib[i].data); |
| } else |
| vsc_write( adapter, ib[i].addr, ib[i].data ); |
| } |
| } |
| |
| static int bist_rd(adapter_t *adapter, int moduleid, int address) |
| { |
| int data = 0; |
| u32 result = 0; |
| |
| if ((address != 0x0) && |
| (address != 0x1) && |
| (address != 0x2) && |
| (address != 0xd) && |
| (address != 0xe)) |
| CH_ERR("No bist address: 0x%x\n", address); |
| |
| data = ((0x00 << 24) | ((address & 0xff) << 16) | (0x00 << 8) | |
| ((moduleid & 0xff) << 0)); |
| vsc_write(adapter, REG_RAM_BIST_CMD, data); |
| |
| udelay(10); |
| |
| vsc_read(adapter, REG_RAM_BIST_RESULT, &result); |
| if ((result & (1 << 9)) != 0x0) |
| CH_ERR("Still in bist read: 0x%x\n", result); |
| else if ((result & (1 << 8)) != 0x0) |
| CH_ERR("bist read error: 0x%x\n", result); |
| |
| return (result & 0xff); |
| } |
| |
| static int bist_wr(adapter_t *adapter, int moduleid, int address, int value) |
| { |
| int data = 0; |
| u32 result = 0; |
| |
| if ((address != 0x0) && |
| (address != 0x1) && |
| (address != 0x2) && |
| (address != 0xd) && |
| (address != 0xe)) |
| CH_ERR("No bist address: 0x%x\n", address); |
| |
| if (value > 255) |
| CH_ERR("Suspicious write out of range value: 0x%x\n", value); |
| |
| data = ((0x01 << 24) | ((address & 0xff) << 16) | (value << 8) | |
| ((moduleid & 0xff) << 0)); |
| vsc_write(adapter, REG_RAM_BIST_CMD, data); |
| |
| udelay(5); |
| |
| vsc_read(adapter, REG_RAM_BIST_CMD, &result); |
| if ((result & (1 << 27)) != 0x0) |
| CH_ERR("Still in bist write: 0x%x\n", result); |
| else if ((result & (1 << 26)) != 0x0) |
| CH_ERR("bist write error: 0x%x\n", result); |
| |
| return 0; |
| } |
| |
| static int run_bist(adapter_t *adapter, int moduleid) |
| { |
| /*run bist*/ |
| (void) bist_wr(adapter,moduleid, 0x00, 0x02); |
| (void) bist_wr(adapter,moduleid, 0x01, 0x01); |
| |
| return 0; |
| } |
| |
| static int check_bist(adapter_t *adapter, int moduleid) |
| { |
| int result=0; |
| int column=0; |
| /*check bist*/ |
| result = bist_rd(adapter,moduleid, 0x02); |
| column = ((bist_rd(adapter,moduleid, 0x0e)<<8) + |
| (bist_rd(adapter,moduleid, 0x0d))); |
| if ((result & 3) != 0x3) |
| CH_ERR("Result: 0x%x BIST error in ram %d, column: 0x%04x\n", |
| result, moduleid, column); |
| return 0; |
| } |
| |
| static int enable_mem(adapter_t *adapter, int moduleid) |
| { |
| /*enable mem*/ |
| (void) bist_wr(adapter,moduleid, 0x00, 0x00); |
| return 0; |
| } |
| |
| static int run_bist_all(adapter_t *adapter) |
| { |
| int port = 0; |
| u32 val = 0; |
| |
| vsc_write(adapter, REG_MEM_BIST, 0x5); |
| vsc_read(adapter, REG_MEM_BIST, &val); |
| |
| for (port = 0; port < 12; port++) |
| vsc_write(adapter, REG_DEV_SETUP(port), 0x0); |
| |
| udelay(300); |
| vsc_write(adapter, REG_SPI4_MISC, 0x00040409); |
| udelay(300); |
| |
| (void) run_bist(adapter,13); |
| (void) run_bist(adapter,14); |
| (void) run_bist(adapter,20); |
| (void) run_bist(adapter,21); |
| mdelay(200); |
| (void) check_bist(adapter,13); |
| (void) check_bist(adapter,14); |
| (void) check_bist(adapter,20); |
| (void) check_bist(adapter,21); |
| udelay(100); |
| (void) enable_mem(adapter,13); |
| (void) enable_mem(adapter,14); |
| (void) enable_mem(adapter,20); |
| (void) enable_mem(adapter,21); |
| udelay(300); |
| vsc_write(adapter, REG_SPI4_MISC, 0x60040400); |
| udelay(300); |
| for (port = 0; port < 12; port++) |
| vsc_write(adapter, REG_DEV_SETUP(port), 0x1); |
| |
| udelay(300); |
| vsc_write(adapter, REG_MEM_BIST, 0x0); |
| mdelay(10); |
| return 0; |
| } |
| |
| static int mac_intr_handler(struct cmac *mac) |
| { |
| return 0; |
| } |
| |
| static int mac_intr_enable(struct cmac *mac) |
| { |
| return 0; |
| } |
| |
| static int mac_intr_disable(struct cmac *mac) |
| { |
| return 0; |
| } |
| |
| static int mac_intr_clear(struct cmac *mac) |
| { |
| return 0; |
| } |
| |
| /* Expect MAC address to be in network byte order. */ |
| static int mac_set_address(struct cmac* mac, u8 addr[6]) |
| { |
| u32 val; |
| int port = mac->instance->index; |
| |
| vsc_write(mac->adapter, REG_MAC_LOW_ADDR(port), |
| (addr[3] << 16) | (addr[4] << 8) | addr[5]); |
| vsc_write(mac->adapter, REG_MAC_HIGH_ADDR(port), |
| (addr[0] << 16) | (addr[1] << 8) | addr[2]); |
| |
| vsc_read(mac->adapter, REG_ING_FFILT_UM_EN, &val); |
| val &= ~0xf0000000; |
| vsc_write(mac->adapter, REG_ING_FFILT_UM_EN, val | (port << 28)); |
| |
| vsc_write(mac->adapter, REG_ING_FFILT_MASK0, |
| 0xffff0000 | (addr[4] << 8) | addr[5]); |
| vsc_write(mac->adapter, REG_ING_FFILT_MASK1, |
| 0xffff0000 | (addr[2] << 8) | addr[3]); |
| vsc_write(mac->adapter, REG_ING_FFILT_MASK2, |
| 0xffff0000 | (addr[0] << 8) | addr[1]); |
| return 0; |
| } |
| |
| static int mac_get_address(struct cmac *mac, u8 addr[6]) |
| { |
| u32 addr_lo, addr_hi; |
| int port = mac->instance->index; |
| |
| vsc_read(mac->adapter, REG_MAC_LOW_ADDR(port), &addr_lo); |
| vsc_read(mac->adapter, REG_MAC_HIGH_ADDR(port), &addr_hi); |
| |
| addr[0] = (u8) (addr_hi >> 16); |
| addr[1] = (u8) (addr_hi >> 8); |
| addr[2] = (u8) addr_hi; |
| addr[3] = (u8) (addr_lo >> 16); |
| addr[4] = (u8) (addr_lo >> 8); |
| addr[5] = (u8) addr_lo; |
| return 0; |
| } |
| |
| /* This is intended to reset a port, not the whole MAC */ |
| static int mac_reset(struct cmac *mac) |
| { |
| int index = mac->instance->index; |
| |
| run_table(mac->adapter, vsc7326_portinit[index], |
| ARRAY_SIZE(vsc7326_portinit[index])); |
| |
| return 0; |
| } |
| |
| static int mac_set_rx_mode(struct cmac *mac, struct t1_rx_mode *rm) |
| { |
| u32 v; |
| int port = mac->instance->index; |
| |
| vsc_read(mac->adapter, REG_ING_FFILT_UM_EN, &v); |
| v |= 1 << 12; |
| |
| if (t1_rx_mode_promisc(rm)) |
| v &= ~(1 << (port + 16)); |
| else |
| v |= 1 << (port + 16); |
| |
| vsc_write(mac->adapter, REG_ING_FFILT_UM_EN, v); |
| return 0; |
| } |
| |
| static int mac_set_mtu(struct cmac *mac, int mtu) |
| { |
| int port = mac->instance->index; |
| |
| if (mtu > MAX_MTU) |
| return -EINVAL; |
| |
| /* max_len includes header and FCS */ |
| vsc_write(mac->adapter, REG_MAX_LEN(port), mtu + 14 + 4); |
| return 0; |
| } |
| |
| static int mac_set_speed_duplex_fc(struct cmac *mac, int speed, int duplex, |
| int fc) |
| { |
| u32 v; |
| int enable, port = mac->instance->index; |
| |
| if (speed >= 0 && speed != SPEED_10 && speed != SPEED_100 && |
| speed != SPEED_1000) |
| return -1; |
| if (duplex > 0 && duplex != DUPLEX_FULL) |
| return -1; |
| |
| if (speed >= 0) { |
| vsc_read(mac->adapter, REG_MODE_CFG(port), &v); |
| enable = v & 3; /* save tx/rx enables */ |
| v &= ~0xf; |
| v |= 4; /* full duplex */ |
| if (speed == SPEED_1000) |
| v |= 8; /* GigE */ |
| enable |= v; |
| vsc_write(mac->adapter, REG_MODE_CFG(port), v); |
| |
| if (speed == SPEED_1000) |
| v = 0x82; |
| else if (speed == SPEED_100) |
| v = 0x84; |
| else /* SPEED_10 */ |
| v = 0x86; |
| vsc_write(mac->adapter, REG_DEV_SETUP(port), v | 1); /* reset */ |
| vsc_write(mac->adapter, REG_DEV_SETUP(port), v); |
| vsc_read(mac->adapter, REG_DBG(port), &v); |
| v &= ~0xff00; |
| if (speed == SPEED_1000) |
| v |= 0x400; |
| else if (speed == SPEED_100) |
| v |= 0x2000; |
| else /* SPEED_10 */ |
| v |= 0xff00; |
| vsc_write(mac->adapter, REG_DBG(port), v); |
| |
| vsc_write(mac->adapter, REG_TX_IFG(port), |
| speed == SPEED_1000 ? 5 : 0x11); |
| if (duplex == DUPLEX_HALF) |
| enable = 0x0; /* 100 or 10 */ |
| else if (speed == SPEED_1000) |
| enable = 0xc; |
| else /* SPEED_100 or 10 */ |
| enable = 0x4; |
| enable |= 0x9 << 10; /* IFG1 */ |
| enable |= 0x6 << 6; /* IFG2 */ |
| enable |= 0x1 << 4; /* VLAN */ |
| enable |= 0x3; /* RX/TX EN */ |
| vsc_write(mac->adapter, REG_MODE_CFG(port), enable); |
| |
| } |
| |
| vsc_read(mac->adapter, REG_PAUSE_CFG(port), &v); |
| v &= 0xfff0ffff; |
| v |= 0x20000; /* xon/xoff */ |
| if (fc & PAUSE_RX) |
| v |= 0x40000; |
| if (fc & PAUSE_TX) |
| v |= 0x80000; |
| if (fc == (PAUSE_RX | PAUSE_TX)) |
| v |= 0x10000; |
| vsc_write(mac->adapter, REG_PAUSE_CFG(port), v); |
| return 0; |
| } |
| |
| static int mac_enable(struct cmac *mac, int which) |
| { |
| u32 val; |
| int port = mac->instance->index; |
| |
| /* Write the correct WM value when the port is enabled. */ |
| vsc_write(mac->adapter, REG_HIGH_LOW_WM(1,port), WM_ENABLE); |
| |
| vsc_read(mac->adapter, REG_MODE_CFG(port), &val); |
| if (which & MAC_DIRECTION_RX) |
| val |= 0x2; |
| if (which & MAC_DIRECTION_TX) |
| val |= 1; |
| vsc_write(mac->adapter, REG_MODE_CFG(port), val); |
| return 0; |
| } |
| |
| static int mac_disable(struct cmac *mac, int which) |
| { |
| u32 val; |
| int i, port = mac->instance->index; |
| |
| /* Reset the port, this also writes the correct WM value */ |
| mac_reset(mac); |
| |
| vsc_read(mac->adapter, REG_MODE_CFG(port), &val); |
| if (which & MAC_DIRECTION_RX) |
| val &= ~0x2; |
| if (which & MAC_DIRECTION_TX) |
| val &= ~0x1; |
| vsc_write(mac->adapter, REG_MODE_CFG(port), val); |
| vsc_read(mac->adapter, REG_MODE_CFG(port), &val); |
| |
| /* Clear stats */ |
| for (i = 0; i <= 0x3a; ++i) |
| vsc_write(mac->adapter, CRA(4, port, i), 0); |
| |
| /* Clear sofware counters */ |
| memset(&mac->stats, 0, sizeof(struct cmac_statistics)); |
| |
| return 0; |
| } |
| |
| static void rmon_update(struct cmac *mac, unsigned int addr, u64 *stat) |
| { |
| u32 v, lo; |
| |
| vsc_read(mac->adapter, addr, &v); |
| lo = *stat; |
| *stat = *stat - lo + v; |
| |
| if (v == 0) |
| return; |
| |
| if (v < lo) |
| *stat += (1ULL << 32); |
| } |
| |
| static void port_stats_update(struct cmac *mac) |
| { |
| struct { |
| unsigned int reg; |
| unsigned int offset; |
| } hw_stats[] = { |
| |
| #define HW_STAT(reg, stat_name) \ |
| { reg, (&((struct cmac_statistics *)NULL)->stat_name) - (u64 *)NULL } |
| |
| /* Rx stats */ |
| HW_STAT(RxUnicast, RxUnicastFramesOK), |
| HW_STAT(RxMulticast, RxMulticastFramesOK), |
| HW_STAT(RxBroadcast, RxBroadcastFramesOK), |
| HW_STAT(Crc, RxFCSErrors), |
| HW_STAT(RxAlignment, RxAlignErrors), |
| HW_STAT(RxOversize, RxFrameTooLongErrors), |
| HW_STAT(RxPause, RxPauseFrames), |
| HW_STAT(RxJabbers, RxJabberErrors), |
| HW_STAT(RxFragments, RxRuntErrors), |
| HW_STAT(RxUndersize, RxRuntErrors), |
| HW_STAT(RxSymbolCarrier, RxSymbolErrors), |
| HW_STAT(RxSize1519ToMax, RxJumboFramesOK), |
| |
| /* Tx stats (skip collision stats as we are full-duplex only) */ |
| HW_STAT(TxUnicast, TxUnicastFramesOK), |
| HW_STAT(TxMulticast, TxMulticastFramesOK), |
| HW_STAT(TxBroadcast, TxBroadcastFramesOK), |
| HW_STAT(TxPause, TxPauseFrames), |
| HW_STAT(TxUnderrun, TxUnderrun), |
| HW_STAT(TxSize1519ToMax, TxJumboFramesOK), |
| }, *p = hw_stats; |
| unsigned int port = mac->instance->index; |
| u64 *stats = (u64 *)&mac->stats; |
| unsigned int i; |
| |
| for (i = 0; i < ARRAY_SIZE(hw_stats); i++) |
| rmon_update(mac, CRA(0x4, port, p->reg), stats + p->offset); |
| |
| rmon_update(mac, REG_TX_OK_BYTES(port), &mac->stats.TxOctetsOK); |
| rmon_update(mac, REG_RX_OK_BYTES(port), &mac->stats.RxOctetsOK); |
| rmon_update(mac, REG_RX_BAD_BYTES(port), &mac->stats.RxOctetsBad); |
| } |
| |
| /* |
| * This function is called periodically to accumulate the current values of the |
| * RMON counters into the port statistics. Since the counters are only 32 bits |
| * some of them can overflow in less than a minute at GigE speeds, so this |
| * function should be called every 30 seconds or so. |
| * |
| * To cut down on reading costs we update only the octet counters at each tick |
| * and do a full update at major ticks, which can be every 30 minutes or more. |
| */ |
| static const struct cmac_statistics *mac_update_statistics(struct cmac *mac, |
| int flag) |
| { |
| if (flag == MAC_STATS_UPDATE_FULL || |
| mac->instance->ticks >= MAJOR_UPDATE_TICKS) { |
| port_stats_update(mac); |
| mac->instance->ticks = 0; |
| } else { |
| int port = mac->instance->index; |
| |
| rmon_update(mac, REG_RX_OK_BYTES(port), |
| &mac->stats.RxOctetsOK); |
| rmon_update(mac, REG_RX_BAD_BYTES(port), |
| &mac->stats.RxOctetsBad); |
| rmon_update(mac, REG_TX_OK_BYTES(port), |
| &mac->stats.TxOctetsOK); |
| mac->instance->ticks++; |
| } |
| return &mac->stats; |
| } |
| |
| static void mac_destroy(struct cmac *mac) |
| { |
| kfree(mac); |
| } |
| |
| static struct cmac_ops vsc7326_ops = { |
| .destroy = mac_destroy, |
| .reset = mac_reset, |
| .interrupt_handler = mac_intr_handler, |
| .interrupt_enable = mac_intr_enable, |
| .interrupt_disable = mac_intr_disable, |
| .interrupt_clear = mac_intr_clear, |
| .enable = mac_enable, |
| .disable = mac_disable, |
| .set_mtu = mac_set_mtu, |
| .set_rx_mode = mac_set_rx_mode, |
| .set_speed_duplex_fc = mac_set_speed_duplex_fc, |
| .statistics_update = mac_update_statistics, |
| .macaddress_get = mac_get_address, |
| .macaddress_set = mac_set_address, |
| }; |
| |
| static struct cmac *vsc7326_mac_create(adapter_t *adapter, int index) |
| { |
| struct cmac *mac; |
| u32 val; |
| int i; |
| |
| mac = kzalloc(sizeof(*mac) + sizeof(cmac_instance), GFP_KERNEL); |
| if (!mac) |
| return NULL; |
| |
| mac->ops = &vsc7326_ops; |
| mac->instance = (cmac_instance *)(mac + 1); |
| mac->adapter = adapter; |
| |
| mac->instance->index = index; |
| mac->instance->ticks = 0; |
| |
| i = 0; |
| do { |
| u32 vhi, vlo; |
| |
| vhi = vlo = 0; |
| t1_tpi_read(adapter, (REG_LOCAL_STATUS << 2) + 4, &vlo); |
| udelay(1); |
| t1_tpi_read(adapter, REG_LOCAL_STATUS << 2, &vhi); |
| udelay(5); |
| val = (vhi << 16) | vlo; |
| } while ((++i < 10000) && (val == 0xffffffff)); |
| |
| return mac; |
| } |
| |
| static int vsc7326_mac_reset(adapter_t *adapter) |
| { |
| vsc7326_full_reset(adapter); |
| (void) run_bist_all(adapter); |
| run_table(adapter, vsc7326_reset, ARRAY_SIZE(vsc7326_reset)); |
| return 0; |
| } |
| |
| const struct gmac t1_vsc7326_ops = { |
| .stats_update_period = STATS_TICK_SECS, |
| .create = vsc7326_mac_create, |
| .reset = vsc7326_mac_reset, |
| }; |