xgmac.c 19 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641
  1. /*
  2. * Copyright (c) 2005-2007 Chelsio, Inc. All rights reserved.
  3. *
  4. * This software is available to you under a choice of one of two
  5. * licenses. You may choose to be licensed under the terms of the GNU
  6. * General Public License (GPL) Version 2, available from the file
  7. * COPYING in the main directory of this source tree, or the
  8. * OpenIB.org BSD license below:
  9. *
  10. * Redistribution and use in source and binary forms, with or
  11. * without modification, are permitted provided that the following
  12. * conditions are met:
  13. *
  14. * - Redistributions of source code must retain the above
  15. * copyright notice, this list of conditions and the following
  16. * disclaimer.
  17. *
  18. * - Redistributions in binary form must reproduce the above
  19. * copyright notice, this list of conditions and the following
  20. * disclaimer in the documentation and/or other materials
  21. * provided with the distribution.
  22. *
  23. * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
  24. * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
  25. * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
  26. * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
  27. * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
  28. * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
  29. * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
  30. * SOFTWARE.
  31. */
  32. #include "common.h"
  33. #include "regs.h"
  34. /*
  35. * # of exact address filters. The first one is used for the station address,
  36. * the rest are available for multicast addresses.
  37. */
  38. #define EXACT_ADDR_FILTERS 8
  39. static inline int macidx(const struct cmac *mac)
  40. {
  41. return mac->offset / (XGMAC0_1_BASE_ADDR - XGMAC0_0_BASE_ADDR);
  42. }
  43. static void xaui_serdes_reset(struct cmac *mac)
  44. {
  45. static const unsigned int clear[] = {
  46. F_PWRDN0 | F_PWRDN1, F_RESETPLL01, F_RESET0 | F_RESET1,
  47. F_PWRDN2 | F_PWRDN3, F_RESETPLL23, F_RESET2 | F_RESET3
  48. };
  49. int i;
  50. struct adapter *adap = mac->adapter;
  51. u32 ctrl = A_XGM_SERDES_CTRL0 + mac->offset;
  52. t3_write_reg(adap, ctrl, adap->params.vpd.xauicfg[macidx(mac)] |
  53. F_RESET3 | F_RESET2 | F_RESET1 | F_RESET0 |
  54. F_PWRDN3 | F_PWRDN2 | F_PWRDN1 | F_PWRDN0 |
  55. F_RESETPLL23 | F_RESETPLL01);
  56. t3_read_reg(adap, ctrl);
  57. udelay(15);
  58. for (i = 0; i < ARRAY_SIZE(clear); i++) {
  59. t3_set_reg_field(adap, ctrl, clear[i], 0);
  60. udelay(15);
  61. }
  62. }
  63. void t3b_pcs_reset(struct cmac *mac)
  64. {
  65. t3_set_reg_field(mac->adapter, A_XGM_RESET_CTRL + mac->offset,
  66. F_PCS_RESET_, 0);
  67. udelay(20);
  68. t3_set_reg_field(mac->adapter, A_XGM_RESET_CTRL + mac->offset, 0,
  69. F_PCS_RESET_);
  70. }
  71. int t3_mac_reset(struct cmac *mac)
  72. {
  73. static const struct addr_val_pair mac_reset_avp[] = {
  74. {A_XGM_TX_CTRL, 0},
  75. {A_XGM_RX_CTRL, 0},
  76. {A_XGM_RX_CFG, F_DISPAUSEFRAMES | F_EN1536BFRAMES |
  77. F_RMFCS | F_ENJUMBO | F_ENHASHMCAST},
  78. {A_XGM_RX_HASH_LOW, 0},
  79. {A_XGM_RX_HASH_HIGH, 0},
  80. {A_XGM_RX_EXACT_MATCH_LOW_1, 0},
  81. {A_XGM_RX_EXACT_MATCH_LOW_2, 0},
  82. {A_XGM_RX_EXACT_MATCH_LOW_3, 0},
  83. {A_XGM_RX_EXACT_MATCH_LOW_4, 0},
  84. {A_XGM_RX_EXACT_MATCH_LOW_5, 0},
  85. {A_XGM_RX_EXACT_MATCH_LOW_6, 0},
  86. {A_XGM_RX_EXACT_MATCH_LOW_7, 0},
  87. {A_XGM_RX_EXACT_MATCH_LOW_8, 0},
  88. {A_XGM_STAT_CTRL, F_CLRSTATS}
  89. };
  90. u32 val;
  91. struct adapter *adap = mac->adapter;
  92. unsigned int oft = mac->offset;
  93. t3_write_reg(adap, A_XGM_RESET_CTRL + oft, F_MAC_RESET_);
  94. t3_read_reg(adap, A_XGM_RESET_CTRL + oft); /* flush */
  95. t3_write_regs(adap, mac_reset_avp, ARRAY_SIZE(mac_reset_avp), oft);
  96. t3_set_reg_field(adap, A_XGM_RXFIFO_CFG + oft,
  97. F_RXSTRFRWRD | F_DISERRFRAMES,
  98. uses_xaui(adap) ? 0 : F_RXSTRFRWRD);
  99. if (uses_xaui(adap)) {
  100. if (adap->params.rev == 0) {
  101. t3_set_reg_field(adap, A_XGM_SERDES_CTRL + oft, 0,
  102. F_RXENABLE | F_TXENABLE);
  103. if (t3_wait_op_done(adap, A_XGM_SERDES_STATUS1 + oft,
  104. F_CMULOCK, 1, 5, 2)) {
  105. CH_ERR(adap,
  106. "MAC %d XAUI SERDES CMU lock failed\n",
  107. macidx(mac));
  108. return -1;
  109. }
  110. t3_set_reg_field(adap, A_XGM_SERDES_CTRL + oft, 0,
  111. F_SERDESRESET_);
  112. } else
  113. xaui_serdes_reset(mac);
  114. }
  115. val = F_MAC_RESET_;
  116. if (is_10G(adap))
  117. val |= F_PCS_RESET_;
  118. else if (uses_xaui(adap))
  119. val |= F_PCS_RESET_ | F_XG2G_RESET_;
  120. else
  121. val |= F_RGMII_RESET_ | F_XG2G_RESET_;
  122. t3_write_reg(adap, A_XGM_RESET_CTRL + oft, val);
  123. t3_read_reg(adap, A_XGM_RESET_CTRL + oft); /* flush */
  124. if ((val & F_PCS_RESET_) && adap->params.rev) {
  125. msleep(1);
  126. t3b_pcs_reset(mac);
  127. }
  128. memset(&mac->stats, 0, sizeof(mac->stats));
  129. return 0;
  130. }
  131. static int t3b2_mac_reset(struct cmac *mac)
  132. {
  133. struct adapter *adap = mac->adapter;
  134. unsigned int oft = mac->offset;
  135. u32 val;
  136. if (!macidx(mac))
  137. t3_set_reg_field(adap, A_MPS_CFG, F_PORT0ACTIVE, 0);
  138. else
  139. t3_set_reg_field(adap, A_MPS_CFG, F_PORT1ACTIVE, 0);
  140. t3_write_reg(adap, A_XGM_RESET_CTRL + oft, F_MAC_RESET_);
  141. t3_read_reg(adap, A_XGM_RESET_CTRL + oft); /* flush */
  142. msleep(10);
  143. /* Check for xgm Rx fifo empty */
  144. if (t3_wait_op_done(adap, A_XGM_RX_MAX_PKT_SIZE_ERR_CNT + oft,
  145. 0x80000000, 1, 5, 2)) {
  146. CH_ERR(adap, "MAC %d Rx fifo drain failed\n",
  147. macidx(mac));
  148. return -1;
  149. }
  150. t3_write_reg(adap, A_XGM_RESET_CTRL + oft, 0);
  151. t3_read_reg(adap, A_XGM_RESET_CTRL + oft); /* flush */
  152. val = F_MAC_RESET_;
  153. if (is_10G(adap))
  154. val |= F_PCS_RESET_;
  155. else if (uses_xaui(adap))
  156. val |= F_PCS_RESET_ | F_XG2G_RESET_;
  157. else
  158. val |= F_RGMII_RESET_ | F_XG2G_RESET_;
  159. t3_write_reg(adap, A_XGM_RESET_CTRL + oft, val);
  160. t3_read_reg(adap, A_XGM_RESET_CTRL + oft); /* flush */
  161. if ((val & F_PCS_RESET_) && adap->params.rev) {
  162. msleep(1);
  163. t3b_pcs_reset(mac);
  164. }
  165. t3_write_reg(adap, A_XGM_RX_CFG + oft,
  166. F_DISPAUSEFRAMES | F_EN1536BFRAMES |
  167. F_RMFCS | F_ENJUMBO | F_ENHASHMCAST);
  168. if (!macidx(mac))
  169. t3_set_reg_field(adap, A_MPS_CFG, 0, F_PORT0ACTIVE);
  170. else
  171. t3_set_reg_field(adap, A_MPS_CFG, 0, F_PORT1ACTIVE);
  172. return 0;
  173. }
  174. /*
  175. * Set the exact match register 'idx' to recognize the given Ethernet address.
  176. */
  177. static void set_addr_filter(struct cmac *mac, int idx, const u8 * addr)
  178. {
  179. u32 addr_lo, addr_hi;
  180. unsigned int oft = mac->offset + idx * 8;
  181. addr_lo = (addr[3] << 24) | (addr[2] << 16) | (addr[1] << 8) | addr[0];
  182. addr_hi = (addr[5] << 8) | addr[4];
  183. t3_write_reg(mac->adapter, A_XGM_RX_EXACT_MATCH_LOW_1 + oft, addr_lo);
  184. t3_write_reg(mac->adapter, A_XGM_RX_EXACT_MATCH_HIGH_1 + oft, addr_hi);
  185. }
  186. /* Set one of the station's unicast MAC addresses. */
  187. int t3_mac_set_address(struct cmac *mac, unsigned int idx, u8 addr[6])
  188. {
  189. if (idx >= mac->nucast)
  190. return -EINVAL;
  191. set_addr_filter(mac, idx, addr);
  192. return 0;
  193. }
  194. /*
  195. * Specify the number of exact address filters that should be reserved for
  196. * unicast addresses. Caller should reload the unicast and multicast addresses
  197. * after calling this.
  198. */
  199. int t3_mac_set_num_ucast(struct cmac *mac, int n)
  200. {
  201. if (n > EXACT_ADDR_FILTERS)
  202. return -EINVAL;
  203. mac->nucast = n;
  204. return 0;
  205. }
  206. static void disable_exact_filters(struct cmac *mac)
  207. {
  208. unsigned int i, reg = mac->offset + A_XGM_RX_EXACT_MATCH_LOW_1;
  209. for (i = 0; i < EXACT_ADDR_FILTERS; i++, reg += 8) {
  210. u32 v = t3_read_reg(mac->adapter, reg);
  211. t3_write_reg(mac->adapter, reg, v);
  212. }
  213. t3_read_reg(mac->adapter, A_XGM_RX_EXACT_MATCH_LOW_1); /* flush */
  214. }
  215. static void enable_exact_filters(struct cmac *mac)
  216. {
  217. unsigned int i, reg = mac->offset + A_XGM_RX_EXACT_MATCH_HIGH_1;
  218. for (i = 0; i < EXACT_ADDR_FILTERS; i++, reg += 8) {
  219. u32 v = t3_read_reg(mac->adapter, reg);
  220. t3_write_reg(mac->adapter, reg, v);
  221. }
  222. t3_read_reg(mac->adapter, A_XGM_RX_EXACT_MATCH_LOW_1); /* flush */
  223. }
  224. /* Calculate the RX hash filter index of an Ethernet address */
  225. static int hash_hw_addr(const u8 * addr)
  226. {
  227. int hash = 0, octet, bit, i = 0, c;
  228. for (octet = 0; octet < 6; ++octet)
  229. for (c = addr[octet], bit = 0; bit < 8; c >>= 1, ++bit) {
  230. hash ^= (c & 1) << i;
  231. if (++i == 6)
  232. i = 0;
  233. }
  234. return hash;
  235. }
  236. int t3_mac_set_rx_mode(struct cmac *mac, struct t3_rx_mode *rm)
  237. {
  238. u32 val, hash_lo, hash_hi;
  239. struct adapter *adap = mac->adapter;
  240. unsigned int oft = mac->offset;
  241. val = t3_read_reg(adap, A_XGM_RX_CFG + oft) & ~F_COPYALLFRAMES;
  242. if (rm->dev->flags & IFF_PROMISC)
  243. val |= F_COPYALLFRAMES;
  244. t3_write_reg(adap, A_XGM_RX_CFG + oft, val);
  245. if (rm->dev->flags & IFF_ALLMULTI)
  246. hash_lo = hash_hi = 0xffffffff;
  247. else {
  248. u8 *addr;
  249. int exact_addr_idx = mac->nucast;
  250. hash_lo = hash_hi = 0;
  251. while ((addr = t3_get_next_mcaddr(rm)))
  252. if (exact_addr_idx < EXACT_ADDR_FILTERS)
  253. set_addr_filter(mac, exact_addr_idx++, addr);
  254. else {
  255. int hash = hash_hw_addr(addr);
  256. if (hash < 32)
  257. hash_lo |= (1 << hash);
  258. else
  259. hash_hi |= (1 << (hash - 32));
  260. }
  261. }
  262. t3_write_reg(adap, A_XGM_RX_HASH_LOW + oft, hash_lo);
  263. t3_write_reg(adap, A_XGM_RX_HASH_HIGH + oft, hash_hi);
  264. return 0;
  265. }
  266. static int rx_fifo_hwm(int mtu)
  267. {
  268. int hwm;
  269. hwm = max(MAC_RXFIFO_SIZE - 3 * mtu, (MAC_RXFIFO_SIZE * 38) / 100);
  270. return min(hwm, MAC_RXFIFO_SIZE - 8192);
  271. }
  272. int t3_mac_set_mtu(struct cmac *mac, unsigned int mtu)
  273. {
  274. int hwm, lwm;
  275. unsigned int thres, v;
  276. struct adapter *adap = mac->adapter;
  277. /*
  278. * MAX_FRAME_SIZE inludes header + FCS, mtu doesn't. The HW max
  279. * packet size register includes header, but not FCS.
  280. */
  281. mtu += 14;
  282. if (mtu > MAX_FRAME_SIZE - 4)
  283. return -EINVAL;
  284. t3_write_reg(adap, A_XGM_RX_MAX_PKT_SIZE + mac->offset, mtu);
  285. /*
  286. * Adjust the PAUSE frame watermarks. We always set the LWM, and the
  287. * HWM only if flow-control is enabled.
  288. */
  289. hwm = max_t(unsigned int, MAC_RXFIFO_SIZE - 3 * mtu,
  290. MAC_RXFIFO_SIZE * 38 / 100);
  291. hwm = min(hwm, MAC_RXFIFO_SIZE - 8192);
  292. lwm = min(3 * (int)mtu, MAC_RXFIFO_SIZE / 4);
  293. if (adap->params.rev == T3_REV_B2 &&
  294. (t3_read_reg(adap, A_XGM_RX_CTRL + mac->offset) & F_RXEN)) {
  295. disable_exact_filters(mac);
  296. v = t3_read_reg(adap, A_XGM_RX_CFG + mac->offset);
  297. t3_set_reg_field(adap, A_XGM_RX_CFG + mac->offset,
  298. F_ENHASHMCAST | F_COPYALLFRAMES, F_DISBCAST);
  299. /* drain rx FIFO */
  300. if (t3_wait_op_done(adap,
  301. A_XGM_RX_MAX_PKT_SIZE_ERR_CNT +
  302. mac->offset,
  303. 1 << 31, 1, 20, 5)) {
  304. t3_write_reg(adap, A_XGM_RX_CFG + mac->offset, v);
  305. enable_exact_filters(mac);
  306. return -EIO;
  307. }
  308. t3_write_reg(adap, A_XGM_RX_MAX_PKT_SIZE + mac->offset, mtu);
  309. t3_write_reg(adap, A_XGM_RX_CFG + mac->offset, v);
  310. enable_exact_filters(mac);
  311. } else
  312. t3_write_reg(adap, A_XGM_RX_MAX_PKT_SIZE + mac->offset, mtu);
  313. /*
  314. * Adjust the PAUSE frame watermarks. We always set the LWM, and the
  315. * HWM only if flow-control is enabled.
  316. */
  317. hwm = rx_fifo_hwm(mtu);
  318. lwm = min(3 * (int)mtu, MAC_RXFIFO_SIZE / 4);
  319. v = t3_read_reg(adap, A_XGM_RXFIFO_CFG + mac->offset);
  320. v &= ~V_RXFIFOPAUSELWM(M_RXFIFOPAUSELWM);
  321. v |= V_RXFIFOPAUSELWM(lwm / 8);
  322. if (G_RXFIFOPAUSEHWM(v))
  323. v = (v & ~V_RXFIFOPAUSEHWM(M_RXFIFOPAUSEHWM)) |
  324. V_RXFIFOPAUSEHWM(hwm / 8);
  325. t3_write_reg(adap, A_XGM_RXFIFO_CFG + mac->offset, v);
  326. /* Adjust the TX FIFO threshold based on the MTU */
  327. thres = (adap->params.vpd.cclk * 1000) / 15625;
  328. thres = (thres * mtu) / 1000;
  329. if (is_10G(adap))
  330. thres /= 10;
  331. thres = mtu > thres ? (mtu - thres + 7) / 8 : 0;
  332. thres = max(thres, 8U); /* need at least 8 */
  333. t3_set_reg_field(adap, A_XGM_TXFIFO_CFG + mac->offset,
  334. V_TXFIFOTHRESH(M_TXFIFOTHRESH) | V_TXIPG(M_TXIPG),
  335. V_TXFIFOTHRESH(thres) | V_TXIPG(1));
  336. if (adap->params.rev > 0)
  337. t3_write_reg(adap, A_XGM_PAUSE_TIMER + mac->offset,
  338. (hwm - lwm) * 4 / 8);
  339. t3_write_reg(adap, A_XGM_TX_PAUSE_QUANTA + mac->offset,
  340. MAC_RXFIFO_SIZE * 4 * 8 / 512);
  341. return 0;
  342. }
  343. int t3_mac_set_speed_duplex_fc(struct cmac *mac, int speed, int duplex, int fc)
  344. {
  345. u32 val;
  346. struct adapter *adap = mac->adapter;
  347. unsigned int oft = mac->offset;
  348. if (duplex >= 0 && duplex != DUPLEX_FULL)
  349. return -EINVAL;
  350. if (speed >= 0) {
  351. if (speed == SPEED_10)
  352. val = V_PORTSPEED(0);
  353. else if (speed == SPEED_100)
  354. val = V_PORTSPEED(1);
  355. else if (speed == SPEED_1000)
  356. val = V_PORTSPEED(2);
  357. else if (speed == SPEED_10000)
  358. val = V_PORTSPEED(3);
  359. else
  360. return -EINVAL;
  361. t3_set_reg_field(adap, A_XGM_PORT_CFG + oft,
  362. V_PORTSPEED(M_PORTSPEED), val);
  363. }
  364. val = t3_read_reg(adap, A_XGM_RXFIFO_CFG + oft);
  365. val &= ~V_RXFIFOPAUSEHWM(M_RXFIFOPAUSEHWM);
  366. if (fc & PAUSE_TX)
  367. val |= V_RXFIFOPAUSEHWM(rx_fifo_hwm(
  368. t3_read_reg(adap,
  369. A_XGM_RX_MAX_PKT_SIZE
  370. + oft)) / 8);
  371. t3_write_reg(adap, A_XGM_RXFIFO_CFG + oft, val);
  372. t3_set_reg_field(adap, A_XGM_TX_CFG + oft, F_TXPAUSEEN,
  373. (fc & PAUSE_RX) ? F_TXPAUSEEN : 0);
  374. return 0;
  375. }
  376. int t3_mac_enable(struct cmac *mac, int which)
  377. {
  378. int idx = macidx(mac);
  379. struct adapter *adap = mac->adapter;
  380. unsigned int oft = mac->offset;
  381. struct mac_stats *s = &mac->stats;
  382. if (which & MAC_DIRECTION_TX) {
  383. t3_write_reg(adap, A_TP_PIO_ADDR, A_TP_TX_DROP_CFG_CH0 + idx);
  384. t3_write_reg(adap, A_TP_PIO_DATA, 0xc0ede401);
  385. t3_write_reg(adap, A_TP_PIO_ADDR, A_TP_TX_DROP_MODE);
  386. t3_set_reg_field(adap, A_TP_PIO_DATA, 1 << idx, 1 << idx);
  387. t3_write_reg(adap, A_XGM_TX_CTRL + oft, F_TXEN);
  388. t3_write_reg(adap, A_TP_PIO_ADDR, A_TP_TX_DROP_CNT_CH0 + idx);
  389. mac->tx_mcnt = s->tx_frames;
  390. mac->tx_tcnt = (G_TXDROPCNTCH0RCVD(t3_read_reg(adap,
  391. A_TP_PIO_DATA)));
  392. mac->tx_xcnt = (G_TXSPI4SOPCNT(t3_read_reg(adap,
  393. A_XGM_TX_SPI4_SOP_EOP_CNT +
  394. oft)));
  395. mac->rx_mcnt = s->rx_frames;
  396. mac->rx_pause = s->rx_pause;
  397. mac->rx_xcnt = (G_TXSPI4SOPCNT(t3_read_reg(adap,
  398. A_XGM_RX_SPI4_SOP_EOP_CNT +
  399. oft)));
  400. mac->rx_ocnt = s->rx_fifo_ovfl;
  401. mac->txen = F_TXEN;
  402. mac->toggle_cnt = 0;
  403. }
  404. if (which & MAC_DIRECTION_RX)
  405. t3_write_reg(adap, A_XGM_RX_CTRL + oft, F_RXEN);
  406. return 0;
  407. }
  408. int t3_mac_disable(struct cmac *mac, int which)
  409. {
  410. struct adapter *adap = mac->adapter;
  411. if (which & MAC_DIRECTION_TX) {
  412. t3_write_reg(adap, A_XGM_TX_CTRL + mac->offset, 0);
  413. mac->txen = 0;
  414. }
  415. if (which & MAC_DIRECTION_RX) {
  416. int val = F_MAC_RESET_;
  417. t3_set_reg_field(mac->adapter, A_XGM_RESET_CTRL + mac->offset,
  418. F_PCS_RESET_, 0);
  419. msleep(100);
  420. t3_write_reg(adap, A_XGM_RX_CTRL + mac->offset, 0);
  421. if (is_10G(adap))
  422. val |= F_PCS_RESET_;
  423. else if (uses_xaui(adap))
  424. val |= F_PCS_RESET_ | F_XG2G_RESET_;
  425. else
  426. val |= F_RGMII_RESET_ | F_XG2G_RESET_;
  427. t3_write_reg(mac->adapter, A_XGM_RESET_CTRL + mac->offset, val);
  428. }
  429. return 0;
  430. }
  431. int t3b2_mac_watchdog_task(struct cmac *mac)
  432. {
  433. struct adapter *adap = mac->adapter;
  434. struct mac_stats *s = &mac->stats;
  435. unsigned int tx_tcnt, tx_xcnt;
  436. unsigned int tx_mcnt = s->tx_frames;
  437. unsigned int rx_mcnt = s->rx_frames;
  438. unsigned int rx_xcnt;
  439. int status;
  440. status = 0;
  441. tx_xcnt = 1; /* By default tx_xcnt is making progress */
  442. tx_tcnt = mac->tx_tcnt; /* If tx_mcnt is progressing ignore tx_tcnt */
  443. rx_xcnt = 1; /* By default rx_xcnt is making progress */
  444. if (tx_mcnt == mac->tx_mcnt && mac->rx_pause == s->rx_pause) {
  445. tx_xcnt = (G_TXSPI4SOPCNT(t3_read_reg(adap,
  446. A_XGM_TX_SPI4_SOP_EOP_CNT +
  447. mac->offset)));
  448. if (tx_xcnt == 0) {
  449. t3_write_reg(adap, A_TP_PIO_ADDR,
  450. A_TP_TX_DROP_CNT_CH0 + macidx(mac));
  451. tx_tcnt = (G_TXDROPCNTCH0RCVD(t3_read_reg(adap,
  452. A_TP_PIO_DATA)));
  453. } else {
  454. goto rxcheck;
  455. }
  456. } else {
  457. mac->toggle_cnt = 0;
  458. goto rxcheck;
  459. }
  460. if ((tx_tcnt != mac->tx_tcnt) && (mac->tx_xcnt == 0)) {
  461. if (mac->toggle_cnt > 4) {
  462. status = 2;
  463. goto out;
  464. } else {
  465. status = 1;
  466. goto out;
  467. }
  468. } else {
  469. mac->toggle_cnt = 0;
  470. goto rxcheck;
  471. }
  472. rxcheck:
  473. if (rx_mcnt != mac->rx_mcnt) {
  474. rx_xcnt = (G_TXSPI4SOPCNT(t3_read_reg(adap,
  475. A_XGM_RX_SPI4_SOP_EOP_CNT +
  476. mac->offset))) +
  477. (s->rx_fifo_ovfl -
  478. mac->rx_ocnt);
  479. mac->rx_ocnt = s->rx_fifo_ovfl;
  480. } else
  481. goto out;
  482. if (mac->rx_mcnt != s->rx_frames && rx_xcnt == 0 &&
  483. mac->rx_xcnt == 0) {
  484. status = 2;
  485. goto out;
  486. }
  487. out:
  488. mac->tx_tcnt = tx_tcnt;
  489. mac->tx_xcnt = tx_xcnt;
  490. mac->tx_mcnt = s->tx_frames;
  491. mac->rx_xcnt = rx_xcnt;
  492. mac->rx_mcnt = s->rx_frames;
  493. mac->rx_pause = s->rx_pause;
  494. if (status == 1) {
  495. t3_write_reg(adap, A_XGM_TX_CTRL + mac->offset, 0);
  496. t3_read_reg(adap, A_XGM_TX_CTRL + mac->offset); /* flush */
  497. t3_write_reg(adap, A_XGM_TX_CTRL + mac->offset, mac->txen);
  498. t3_read_reg(adap, A_XGM_TX_CTRL + mac->offset); /* flush */
  499. mac->toggle_cnt++;
  500. } else if (status == 2) {
  501. t3b2_mac_reset(mac);
  502. mac->toggle_cnt = 0;
  503. }
  504. return status;
  505. }
  506. /*
  507. * This function is called periodically to accumulate the current values of the
  508. * RMON counters into the port statistics. Since the packet counters are only
  509. * 32 bits they can overflow in ~286 secs at 10G, so the function should be
  510. * called more frequently than that. The byte counters are 45-bit wide, they
  511. * would overflow in ~7.8 hours.
  512. */
  513. const struct mac_stats *t3_mac_update_stats(struct cmac *mac)
  514. {
  515. #define RMON_READ(mac, addr) t3_read_reg(mac->adapter, addr + mac->offset)
  516. #define RMON_UPDATE(mac, name, reg) \
  517. (mac)->stats.name += (u64)RMON_READ(mac, A_XGM_STAT_##reg)
  518. #define RMON_UPDATE64(mac, name, reg_lo, reg_hi) \
  519. (mac)->stats.name += RMON_READ(mac, A_XGM_STAT_##reg_lo) + \
  520. ((u64)RMON_READ(mac, A_XGM_STAT_##reg_hi) << 32)
  521. u32 v, lo;
  522. RMON_UPDATE64(mac, rx_octets, RX_BYTES_LOW, RX_BYTES_HIGH);
  523. RMON_UPDATE64(mac, rx_frames, RX_FRAMES_LOW, RX_FRAMES_HIGH);
  524. RMON_UPDATE(mac, rx_mcast_frames, RX_MCAST_FRAMES);
  525. RMON_UPDATE(mac, rx_bcast_frames, RX_BCAST_FRAMES);
  526. RMON_UPDATE(mac, rx_fcs_errs, RX_CRC_ERR_FRAMES);
  527. RMON_UPDATE(mac, rx_pause, RX_PAUSE_FRAMES);
  528. RMON_UPDATE(mac, rx_jabber, RX_JABBER_FRAMES);
  529. RMON_UPDATE(mac, rx_short, RX_SHORT_FRAMES);
  530. RMON_UPDATE(mac, rx_symbol_errs, RX_SYM_CODE_ERR_FRAMES);
  531. RMON_UPDATE(mac, rx_too_long, RX_OVERSIZE_FRAMES);
  532. v = RMON_READ(mac, A_XGM_RX_MAX_PKT_SIZE_ERR_CNT);
  533. if (mac->adapter->params.rev == T3_REV_B2)
  534. v &= 0x7fffffff;
  535. mac->stats.rx_too_long += v;
  536. RMON_UPDATE(mac, rx_frames_64, RX_64B_FRAMES);
  537. RMON_UPDATE(mac, rx_frames_65_127, RX_65_127B_FRAMES);
  538. RMON_UPDATE(mac, rx_frames_128_255, RX_128_255B_FRAMES);
  539. RMON_UPDATE(mac, rx_frames_256_511, RX_256_511B_FRAMES);
  540. RMON_UPDATE(mac, rx_frames_512_1023, RX_512_1023B_FRAMES);
  541. RMON_UPDATE(mac, rx_frames_1024_1518, RX_1024_1518B_FRAMES);
  542. RMON_UPDATE(mac, rx_frames_1519_max, RX_1519_MAXB_FRAMES);
  543. RMON_UPDATE64(mac, tx_octets, TX_BYTE_LOW, TX_BYTE_HIGH);
  544. RMON_UPDATE64(mac, tx_frames, TX_FRAME_LOW, TX_FRAME_HIGH);
  545. RMON_UPDATE(mac, tx_mcast_frames, TX_MCAST);
  546. RMON_UPDATE(mac, tx_bcast_frames, TX_BCAST);
  547. RMON_UPDATE(mac, tx_pause, TX_PAUSE);
  548. /* This counts error frames in general (bad FCS, underrun, etc). */
  549. RMON_UPDATE(mac, tx_underrun, TX_ERR_FRAMES);
  550. RMON_UPDATE(mac, tx_frames_64, TX_64B_FRAMES);
  551. RMON_UPDATE(mac, tx_frames_65_127, TX_65_127B_FRAMES);
  552. RMON_UPDATE(mac, tx_frames_128_255, TX_128_255B_FRAMES);
  553. RMON_UPDATE(mac, tx_frames_256_511, TX_256_511B_FRAMES);
  554. RMON_UPDATE(mac, tx_frames_512_1023, TX_512_1023B_FRAMES);
  555. RMON_UPDATE(mac, tx_frames_1024_1518, TX_1024_1518B_FRAMES);
  556. RMON_UPDATE(mac, tx_frames_1519_max, TX_1519_MAXB_FRAMES);
  557. /* The next stat isn't clear-on-read. */
  558. t3_write_reg(mac->adapter, A_TP_MIB_INDEX, mac->offset ? 51 : 50);
  559. v = t3_read_reg(mac->adapter, A_TP_MIB_RDATA);
  560. lo = (u32) mac->stats.rx_cong_drops;
  561. mac->stats.rx_cong_drops += (u64) (v - lo);
  562. return &mac->stats;
  563. }