ethtool.c 21 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728
  1. /****************************************************************************
  2. * Driver for Solarflare Solarstorm network controllers and boards
  3. * Copyright 2005-2006 Fen Systems Ltd.
  4. * Copyright 2006-2008 Solarflare Communications Inc.
  5. *
  6. * This program is free software; you can redistribute it and/or modify it
  7. * under the terms of the GNU General Public License version 2 as published
  8. * by the Free Software Foundation, incorporated herein by reference.
  9. */
  10. #include <linux/netdevice.h>
  11. #include <linux/ethtool.h>
  12. #include <linux/rtnetlink.h>
  13. #include "net_driver.h"
  14. #include "selftest.h"
  15. #include "efx.h"
  16. #include "ethtool.h"
  17. #include "falcon.h"
  18. #include "gmii.h"
  19. #include "spi.h"
  20. #include "mac.h"
  21. const char *efx_loopback_mode_names[] = {
  22. [LOOPBACK_NONE] = "NONE",
  23. [LOOPBACK_MAC] = "MAC",
  24. [LOOPBACK_XGMII] = "XGMII",
  25. [LOOPBACK_XGXS] = "XGXS",
  26. [LOOPBACK_XAUI] = "XAUI",
  27. [LOOPBACK_PHY] = "PHY",
  28. [LOOPBACK_PHYXS] = "PHY(XS)",
  29. [LOOPBACK_PCS] = "PHY(PCS)",
  30. [LOOPBACK_PMAPMD] = "PHY(PMAPMD)",
  31. [LOOPBACK_NETWORK] = "NETWORK",
  32. };
  33. struct ethtool_string {
  34. char name[ETH_GSTRING_LEN];
  35. };
  36. struct efx_ethtool_stat {
  37. const char *name;
  38. enum {
  39. EFX_ETHTOOL_STAT_SOURCE_mac_stats,
  40. EFX_ETHTOOL_STAT_SOURCE_nic,
  41. EFX_ETHTOOL_STAT_SOURCE_channel
  42. } source;
  43. unsigned offset;
  44. u64(*get_stat) (void *field); /* Reader function */
  45. };
  46. /* Initialiser for a struct #efx_ethtool_stat with type-checking */
  47. #define EFX_ETHTOOL_STAT(stat_name, source_name, field, field_type, \
  48. get_stat_function) { \
  49. .name = #stat_name, \
  50. .source = EFX_ETHTOOL_STAT_SOURCE_##source_name, \
  51. .offset = ((((field_type *) 0) == \
  52. &((struct efx_##source_name *)0)->field) ? \
  53. offsetof(struct efx_##source_name, field) : \
  54. offsetof(struct efx_##source_name, field)), \
  55. .get_stat = get_stat_function, \
  56. }
  57. static u64 efx_get_uint_stat(void *field)
  58. {
  59. return *(unsigned int *)field;
  60. }
  61. static u64 efx_get_ulong_stat(void *field)
  62. {
  63. return *(unsigned long *)field;
  64. }
  65. static u64 efx_get_u64_stat(void *field)
  66. {
  67. return *(u64 *) field;
  68. }
  69. static u64 efx_get_atomic_stat(void *field)
  70. {
  71. return atomic_read((atomic_t *) field);
  72. }
  73. #define EFX_ETHTOOL_ULONG_MAC_STAT(field) \
  74. EFX_ETHTOOL_STAT(field, mac_stats, field, \
  75. unsigned long, efx_get_ulong_stat)
  76. #define EFX_ETHTOOL_U64_MAC_STAT(field) \
  77. EFX_ETHTOOL_STAT(field, mac_stats, field, \
  78. u64, efx_get_u64_stat)
  79. #define EFX_ETHTOOL_UINT_NIC_STAT(name) \
  80. EFX_ETHTOOL_STAT(name, nic, n_##name, \
  81. unsigned int, efx_get_uint_stat)
  82. #define EFX_ETHTOOL_ATOMIC_NIC_ERROR_STAT(field) \
  83. EFX_ETHTOOL_STAT(field, nic, field, \
  84. atomic_t, efx_get_atomic_stat)
  85. #define EFX_ETHTOOL_UINT_CHANNEL_STAT(field) \
  86. EFX_ETHTOOL_STAT(field, channel, n_##field, \
  87. unsigned int, efx_get_uint_stat)
  88. static struct efx_ethtool_stat efx_ethtool_stats[] = {
  89. EFX_ETHTOOL_U64_MAC_STAT(tx_bytes),
  90. EFX_ETHTOOL_U64_MAC_STAT(tx_good_bytes),
  91. EFX_ETHTOOL_U64_MAC_STAT(tx_bad_bytes),
  92. EFX_ETHTOOL_ULONG_MAC_STAT(tx_packets),
  93. EFX_ETHTOOL_ULONG_MAC_STAT(tx_bad),
  94. EFX_ETHTOOL_ULONG_MAC_STAT(tx_pause),
  95. EFX_ETHTOOL_ULONG_MAC_STAT(tx_control),
  96. EFX_ETHTOOL_ULONG_MAC_STAT(tx_unicast),
  97. EFX_ETHTOOL_ULONG_MAC_STAT(tx_multicast),
  98. EFX_ETHTOOL_ULONG_MAC_STAT(tx_broadcast),
  99. EFX_ETHTOOL_ULONG_MAC_STAT(tx_lt64),
  100. EFX_ETHTOOL_ULONG_MAC_STAT(tx_64),
  101. EFX_ETHTOOL_ULONG_MAC_STAT(tx_65_to_127),
  102. EFX_ETHTOOL_ULONG_MAC_STAT(tx_128_to_255),
  103. EFX_ETHTOOL_ULONG_MAC_STAT(tx_256_to_511),
  104. EFX_ETHTOOL_ULONG_MAC_STAT(tx_512_to_1023),
  105. EFX_ETHTOOL_ULONG_MAC_STAT(tx_1024_to_15xx),
  106. EFX_ETHTOOL_ULONG_MAC_STAT(tx_15xx_to_jumbo),
  107. EFX_ETHTOOL_ULONG_MAC_STAT(tx_gtjumbo),
  108. EFX_ETHTOOL_ULONG_MAC_STAT(tx_collision),
  109. EFX_ETHTOOL_ULONG_MAC_STAT(tx_single_collision),
  110. EFX_ETHTOOL_ULONG_MAC_STAT(tx_multiple_collision),
  111. EFX_ETHTOOL_ULONG_MAC_STAT(tx_excessive_collision),
  112. EFX_ETHTOOL_ULONG_MAC_STAT(tx_deferred),
  113. EFX_ETHTOOL_ULONG_MAC_STAT(tx_late_collision),
  114. EFX_ETHTOOL_ULONG_MAC_STAT(tx_excessive_deferred),
  115. EFX_ETHTOOL_ULONG_MAC_STAT(tx_non_tcpudp),
  116. EFX_ETHTOOL_ULONG_MAC_STAT(tx_mac_src_error),
  117. EFX_ETHTOOL_ULONG_MAC_STAT(tx_ip_src_error),
  118. EFX_ETHTOOL_U64_MAC_STAT(rx_bytes),
  119. EFX_ETHTOOL_U64_MAC_STAT(rx_good_bytes),
  120. EFX_ETHTOOL_U64_MAC_STAT(rx_bad_bytes),
  121. EFX_ETHTOOL_ULONG_MAC_STAT(rx_packets),
  122. EFX_ETHTOOL_ULONG_MAC_STAT(rx_good),
  123. EFX_ETHTOOL_ULONG_MAC_STAT(rx_bad),
  124. EFX_ETHTOOL_ULONG_MAC_STAT(rx_pause),
  125. EFX_ETHTOOL_ULONG_MAC_STAT(rx_control),
  126. EFX_ETHTOOL_ULONG_MAC_STAT(rx_unicast),
  127. EFX_ETHTOOL_ULONG_MAC_STAT(rx_multicast),
  128. EFX_ETHTOOL_ULONG_MAC_STAT(rx_broadcast),
  129. EFX_ETHTOOL_ULONG_MAC_STAT(rx_lt64),
  130. EFX_ETHTOOL_ULONG_MAC_STAT(rx_64),
  131. EFX_ETHTOOL_ULONG_MAC_STAT(rx_65_to_127),
  132. EFX_ETHTOOL_ULONG_MAC_STAT(rx_128_to_255),
  133. EFX_ETHTOOL_ULONG_MAC_STAT(rx_256_to_511),
  134. EFX_ETHTOOL_ULONG_MAC_STAT(rx_512_to_1023),
  135. EFX_ETHTOOL_ULONG_MAC_STAT(rx_1024_to_15xx),
  136. EFX_ETHTOOL_ULONG_MAC_STAT(rx_15xx_to_jumbo),
  137. EFX_ETHTOOL_ULONG_MAC_STAT(rx_gtjumbo),
  138. EFX_ETHTOOL_ULONG_MAC_STAT(rx_bad_lt64),
  139. EFX_ETHTOOL_ULONG_MAC_STAT(rx_bad_64_to_15xx),
  140. EFX_ETHTOOL_ULONG_MAC_STAT(rx_bad_15xx_to_jumbo),
  141. EFX_ETHTOOL_ULONG_MAC_STAT(rx_bad_gtjumbo),
  142. EFX_ETHTOOL_ULONG_MAC_STAT(rx_overflow),
  143. EFX_ETHTOOL_ULONG_MAC_STAT(rx_missed),
  144. EFX_ETHTOOL_ULONG_MAC_STAT(rx_false_carrier),
  145. EFX_ETHTOOL_ULONG_MAC_STAT(rx_symbol_error),
  146. EFX_ETHTOOL_ULONG_MAC_STAT(rx_align_error),
  147. EFX_ETHTOOL_ULONG_MAC_STAT(rx_length_error),
  148. EFX_ETHTOOL_ULONG_MAC_STAT(rx_internal_error),
  149. EFX_ETHTOOL_UINT_NIC_STAT(rx_nodesc_drop_cnt),
  150. EFX_ETHTOOL_ATOMIC_NIC_ERROR_STAT(rx_reset),
  151. EFX_ETHTOOL_UINT_CHANNEL_STAT(rx_tobe_disc),
  152. EFX_ETHTOOL_UINT_CHANNEL_STAT(rx_ip_hdr_chksum_err),
  153. EFX_ETHTOOL_UINT_CHANNEL_STAT(rx_tcp_udp_chksum_err),
  154. EFX_ETHTOOL_UINT_CHANNEL_STAT(rx_frm_trunc),
  155. };
  156. /* Number of ethtool statistics */
  157. #define EFX_ETHTOOL_NUM_STATS ARRAY_SIZE(efx_ethtool_stats)
  158. /* EEPROM range with gPXE configuration */
  159. #define EFX_ETHTOOL_EEPROM_MAGIC 0xEFAB
  160. #define EFX_ETHTOOL_EEPROM_MIN 0x100U
  161. #define EFX_ETHTOOL_EEPROM_MAX 0x400U
  162. /**************************************************************************
  163. *
  164. * Ethtool operations
  165. *
  166. **************************************************************************
  167. */
  168. /* Identify device by flashing LEDs */
  169. static int efx_ethtool_phys_id(struct net_device *net_dev, u32 seconds)
  170. {
  171. struct efx_nic *efx = netdev_priv(net_dev);
  172. efx->board_info.blink(efx, 1);
  173. schedule_timeout_interruptible(seconds * HZ);
  174. efx->board_info.blink(efx, 0);
  175. return 0;
  176. }
  177. /* This must be called with rtnl_lock held. */
  178. int efx_ethtool_get_settings(struct net_device *net_dev,
  179. struct ethtool_cmd *ecmd)
  180. {
  181. struct efx_nic *efx = netdev_priv(net_dev);
  182. int rc;
  183. mutex_lock(&efx->mac_lock);
  184. rc = falcon_xmac_get_settings(efx, ecmd);
  185. mutex_unlock(&efx->mac_lock);
  186. return rc;
  187. }
  188. /* This must be called with rtnl_lock held. */
  189. int efx_ethtool_set_settings(struct net_device *net_dev,
  190. struct ethtool_cmd *ecmd)
  191. {
  192. struct efx_nic *efx = netdev_priv(net_dev);
  193. int rc;
  194. mutex_lock(&efx->mac_lock);
  195. rc = falcon_xmac_set_settings(efx, ecmd);
  196. mutex_unlock(&efx->mac_lock);
  197. if (!rc)
  198. efx_reconfigure_port(efx);
  199. return rc;
  200. }
  201. static void efx_ethtool_get_drvinfo(struct net_device *net_dev,
  202. struct ethtool_drvinfo *info)
  203. {
  204. struct efx_nic *efx = netdev_priv(net_dev);
  205. strlcpy(info->driver, EFX_DRIVER_NAME, sizeof(info->driver));
  206. strlcpy(info->version, EFX_DRIVER_VERSION, sizeof(info->version));
  207. strlcpy(info->bus_info, pci_name(efx->pci_dev), sizeof(info->bus_info));
  208. }
  209. /**
  210. * efx_fill_test - fill in an individual self-test entry
  211. * @test_index: Index of the test
  212. * @strings: Ethtool strings, or %NULL
  213. * @data: Ethtool test results, or %NULL
  214. * @test: Pointer to test result (used only if data != %NULL)
  215. * @unit_format: Unit name format (e.g. "channel\%d")
  216. * @unit_id: Unit id (e.g. 0 for "channel0")
  217. * @test_format: Test name format (e.g. "loopback.\%s.tx.sent")
  218. * @test_id: Test id (e.g. "PHY" for "loopback.PHY.tx_sent")
  219. *
  220. * Fill in an individual self-test entry.
  221. */
  222. static void efx_fill_test(unsigned int test_index,
  223. struct ethtool_string *strings, u64 *data,
  224. int *test, const char *unit_format, int unit_id,
  225. const char *test_format, const char *test_id)
  226. {
  227. struct ethtool_string unit_str, test_str;
  228. /* Fill data value, if applicable */
  229. if (data)
  230. data[test_index] = *test;
  231. /* Fill string, if applicable */
  232. if (strings) {
  233. snprintf(unit_str.name, sizeof(unit_str.name),
  234. unit_format, unit_id);
  235. snprintf(test_str.name, sizeof(test_str.name),
  236. test_format, test_id);
  237. snprintf(strings[test_index].name,
  238. sizeof(strings[test_index].name),
  239. "%-9s%-17s", unit_str.name, test_str.name);
  240. }
  241. }
  242. #define EFX_PORT_NAME "port%d", 0
  243. #define EFX_CHANNEL_NAME(_channel) "channel%d", _channel->channel
  244. #define EFX_TX_QUEUE_NAME(_tx_queue) "txq%d", _tx_queue->queue
  245. #define EFX_RX_QUEUE_NAME(_rx_queue) "rxq%d", _rx_queue->queue
  246. #define EFX_LOOPBACK_NAME(_mode, _counter) \
  247. "loopback.%s." _counter, LOOPBACK_MODE_NAME(mode)
  248. /**
  249. * efx_fill_loopback_test - fill in a block of loopback self-test entries
  250. * @efx: Efx NIC
  251. * @lb_tests: Efx loopback self-test results structure
  252. * @mode: Loopback test mode
  253. * @test_index: Starting index of the test
  254. * @strings: Ethtool strings, or %NULL
  255. * @data: Ethtool test results, or %NULL
  256. */
  257. static int efx_fill_loopback_test(struct efx_nic *efx,
  258. struct efx_loopback_self_tests *lb_tests,
  259. enum efx_loopback_mode mode,
  260. unsigned int test_index,
  261. struct ethtool_string *strings, u64 *data)
  262. {
  263. struct efx_tx_queue *tx_queue;
  264. efx_for_each_tx_queue(tx_queue, efx) {
  265. efx_fill_test(test_index++, strings, data,
  266. &lb_tests->tx_sent[tx_queue->queue],
  267. EFX_TX_QUEUE_NAME(tx_queue),
  268. EFX_LOOPBACK_NAME(mode, "tx_sent"));
  269. efx_fill_test(test_index++, strings, data,
  270. &lb_tests->tx_done[tx_queue->queue],
  271. EFX_TX_QUEUE_NAME(tx_queue),
  272. EFX_LOOPBACK_NAME(mode, "tx_done"));
  273. }
  274. efx_fill_test(test_index++, strings, data,
  275. &lb_tests->rx_good,
  276. EFX_PORT_NAME,
  277. EFX_LOOPBACK_NAME(mode, "rx_good"));
  278. efx_fill_test(test_index++, strings, data,
  279. &lb_tests->rx_bad,
  280. EFX_PORT_NAME,
  281. EFX_LOOPBACK_NAME(mode, "rx_bad"));
  282. return test_index;
  283. }
  284. /**
  285. * efx_ethtool_fill_self_tests - get self-test details
  286. * @efx: Efx NIC
  287. * @tests: Efx self-test results structure, or %NULL
  288. * @strings: Ethtool strings, or %NULL
  289. * @data: Ethtool test results, or %NULL
  290. */
  291. static int efx_ethtool_fill_self_tests(struct efx_nic *efx,
  292. struct efx_self_tests *tests,
  293. struct ethtool_string *strings,
  294. u64 *data)
  295. {
  296. struct efx_channel *channel;
  297. unsigned int n = 0;
  298. enum efx_loopback_mode mode;
  299. /* Interrupt */
  300. efx_fill_test(n++, strings, data, &tests->interrupt,
  301. "core", 0, "interrupt", NULL);
  302. /* Event queues */
  303. efx_for_each_channel(channel, efx) {
  304. efx_fill_test(n++, strings, data,
  305. &tests->eventq_dma[channel->channel],
  306. EFX_CHANNEL_NAME(channel),
  307. "eventq.dma", NULL);
  308. efx_fill_test(n++, strings, data,
  309. &tests->eventq_int[channel->channel],
  310. EFX_CHANNEL_NAME(channel),
  311. "eventq.int", NULL);
  312. efx_fill_test(n++, strings, data,
  313. &tests->eventq_poll[channel->channel],
  314. EFX_CHANNEL_NAME(channel),
  315. "eventq.poll", NULL);
  316. }
  317. /* PHY presence */
  318. efx_fill_test(n++, strings, data, &tests->phy_ok,
  319. EFX_PORT_NAME, "phy_ok", NULL);
  320. /* Loopback tests */
  321. efx_fill_test(n++, strings, data, &tests->loopback_speed,
  322. EFX_PORT_NAME, "loopback.speed", NULL);
  323. efx_fill_test(n++, strings, data, &tests->loopback_full_duplex,
  324. EFX_PORT_NAME, "loopback.full_duplex", NULL);
  325. for (mode = LOOPBACK_NONE; mode < LOOPBACK_TEST_MAX; mode++) {
  326. if (!(efx->loopback_modes & (1 << mode)))
  327. continue;
  328. n = efx_fill_loopback_test(efx,
  329. &tests->loopback[mode], mode, n,
  330. strings, data);
  331. }
  332. return n;
  333. }
  334. static int efx_ethtool_get_stats_count(struct net_device *net_dev)
  335. {
  336. return EFX_ETHTOOL_NUM_STATS;
  337. }
  338. static int efx_ethtool_self_test_count(struct net_device *net_dev)
  339. {
  340. struct efx_nic *efx = netdev_priv(net_dev);
  341. return efx_ethtool_fill_self_tests(efx, NULL, NULL, NULL);
  342. }
  343. static void efx_ethtool_get_strings(struct net_device *net_dev,
  344. u32 string_set, u8 *strings)
  345. {
  346. struct efx_nic *efx = netdev_priv(net_dev);
  347. struct ethtool_string *ethtool_strings =
  348. (struct ethtool_string *)strings;
  349. int i;
  350. switch (string_set) {
  351. case ETH_SS_STATS:
  352. for (i = 0; i < EFX_ETHTOOL_NUM_STATS; i++)
  353. strncpy(ethtool_strings[i].name,
  354. efx_ethtool_stats[i].name,
  355. sizeof(ethtool_strings[i].name));
  356. break;
  357. case ETH_SS_TEST:
  358. efx_ethtool_fill_self_tests(efx, NULL,
  359. ethtool_strings, NULL);
  360. break;
  361. default:
  362. /* No other string sets */
  363. break;
  364. }
  365. }
  366. static void efx_ethtool_get_stats(struct net_device *net_dev,
  367. struct ethtool_stats *stats,
  368. u64 *data)
  369. {
  370. struct efx_nic *efx = netdev_priv(net_dev);
  371. struct efx_mac_stats *mac_stats = &efx->mac_stats;
  372. struct efx_ethtool_stat *stat;
  373. struct efx_channel *channel;
  374. int i;
  375. EFX_BUG_ON_PARANOID(stats->n_stats != EFX_ETHTOOL_NUM_STATS);
  376. /* Update MAC and NIC statistics */
  377. net_dev->get_stats(net_dev);
  378. /* Fill detailed statistics buffer */
  379. for (i = 0; i < EFX_ETHTOOL_NUM_STATS; i++) {
  380. stat = &efx_ethtool_stats[i];
  381. switch (stat->source) {
  382. case EFX_ETHTOOL_STAT_SOURCE_mac_stats:
  383. data[i] = stat->get_stat((void *)mac_stats +
  384. stat->offset);
  385. break;
  386. case EFX_ETHTOOL_STAT_SOURCE_nic:
  387. data[i] = stat->get_stat((void *)efx + stat->offset);
  388. break;
  389. case EFX_ETHTOOL_STAT_SOURCE_channel:
  390. data[i] = 0;
  391. efx_for_each_channel(channel, efx)
  392. data[i] += stat->get_stat((void *)channel +
  393. stat->offset);
  394. break;
  395. }
  396. }
  397. }
  398. static int efx_ethtool_set_rx_csum(struct net_device *net_dev, u32 enable)
  399. {
  400. struct efx_nic *efx = netdev_priv(net_dev);
  401. /* No way to stop the hardware doing the checks; we just
  402. * ignore the result.
  403. */
  404. efx->rx_checksum_enabled = !!enable;
  405. return 0;
  406. }
  407. static u32 efx_ethtool_get_rx_csum(struct net_device *net_dev)
  408. {
  409. struct efx_nic *efx = netdev_priv(net_dev);
  410. return efx->rx_checksum_enabled;
  411. }
  412. static void efx_ethtool_self_test(struct net_device *net_dev,
  413. struct ethtool_test *test, u64 *data)
  414. {
  415. struct efx_nic *efx = netdev_priv(net_dev);
  416. struct efx_self_tests efx_tests;
  417. int offline, already_up;
  418. int rc;
  419. ASSERT_RTNL();
  420. if (efx->state != STATE_RUNNING) {
  421. rc = -EIO;
  422. goto fail1;
  423. }
  424. /* We need rx buffers and interrupts. */
  425. already_up = (efx->net_dev->flags & IFF_UP);
  426. if (!already_up) {
  427. rc = dev_open(efx->net_dev);
  428. if (rc) {
  429. EFX_ERR(efx, "failed opening device.\n");
  430. goto fail2;
  431. }
  432. }
  433. memset(&efx_tests, 0, sizeof(efx_tests));
  434. offline = (test->flags & ETH_TEST_FL_OFFLINE);
  435. /* Perform online self tests first */
  436. rc = efx_online_test(efx, &efx_tests);
  437. if (rc)
  438. goto out;
  439. /* Perform offline tests only if online tests passed */
  440. if (offline) {
  441. /* Stop the kernel from sending packets during the test. */
  442. efx_stop_queue(efx);
  443. rc = efx_flush_queues(efx);
  444. if (!rc)
  445. rc = efx_offline_test(efx, &efx_tests,
  446. efx->loopback_modes);
  447. efx_wake_queue(efx);
  448. }
  449. out:
  450. if (!already_up)
  451. dev_close(efx->net_dev);
  452. EFX_LOG(efx, "%s all %sline self-tests\n",
  453. rc == 0 ? "passed" : "failed", offline ? "off" : "on");
  454. fail2:
  455. fail1:
  456. /* Fill ethtool results structures */
  457. efx_ethtool_fill_self_tests(efx, &efx_tests, NULL, data);
  458. if (rc)
  459. test->flags |= ETH_TEST_FL_FAILED;
  460. }
  461. /* Restart autonegotiation */
  462. static int efx_ethtool_nway_reset(struct net_device *net_dev)
  463. {
  464. struct efx_nic *efx = netdev_priv(net_dev);
  465. return mii_nway_restart(&efx->mii);
  466. }
  467. static u32 efx_ethtool_get_link(struct net_device *net_dev)
  468. {
  469. struct efx_nic *efx = netdev_priv(net_dev);
  470. return efx->link_up;
  471. }
  472. static int efx_ethtool_get_eeprom_len(struct net_device *net_dev)
  473. {
  474. struct efx_nic *efx = netdev_priv(net_dev);
  475. struct efx_spi_device *spi = efx->spi_eeprom;
  476. if (!spi)
  477. return 0;
  478. return min(spi->size, EFX_ETHTOOL_EEPROM_MAX) -
  479. min(spi->size, EFX_ETHTOOL_EEPROM_MIN);
  480. }
  481. static int efx_ethtool_get_eeprom(struct net_device *net_dev,
  482. struct ethtool_eeprom *eeprom, u8 *buf)
  483. {
  484. struct efx_nic *efx = netdev_priv(net_dev);
  485. struct efx_spi_device *spi = efx->spi_eeprom;
  486. size_t len;
  487. int rc;
  488. rc = falcon_spi_read(spi, eeprom->offset + EFX_ETHTOOL_EEPROM_MIN,
  489. eeprom->len, &len, buf);
  490. eeprom->magic = EFX_ETHTOOL_EEPROM_MAGIC;
  491. eeprom->len = len;
  492. return rc;
  493. }
  494. static int efx_ethtool_set_eeprom(struct net_device *net_dev,
  495. struct ethtool_eeprom *eeprom, u8 *buf)
  496. {
  497. struct efx_nic *efx = netdev_priv(net_dev);
  498. struct efx_spi_device *spi = efx->spi_eeprom;
  499. size_t len;
  500. int rc;
  501. if (eeprom->magic != EFX_ETHTOOL_EEPROM_MAGIC)
  502. return -EINVAL;
  503. rc = falcon_spi_write(spi, eeprom->offset + EFX_ETHTOOL_EEPROM_MIN,
  504. eeprom->len, &len, buf);
  505. eeprom->len = len;
  506. return rc;
  507. }
  508. static int efx_ethtool_get_coalesce(struct net_device *net_dev,
  509. struct ethtool_coalesce *coalesce)
  510. {
  511. struct efx_nic *efx = netdev_priv(net_dev);
  512. struct efx_tx_queue *tx_queue;
  513. struct efx_rx_queue *rx_queue;
  514. struct efx_channel *channel;
  515. memset(coalesce, 0, sizeof(*coalesce));
  516. /* Find lowest IRQ moderation across all used TX queues */
  517. coalesce->tx_coalesce_usecs_irq = ~((u32) 0);
  518. efx_for_each_tx_queue(tx_queue, efx) {
  519. channel = tx_queue->channel;
  520. if (channel->irq_moderation < coalesce->tx_coalesce_usecs_irq) {
  521. if (channel->used_flags != EFX_USED_BY_RX_TX)
  522. coalesce->tx_coalesce_usecs_irq =
  523. channel->irq_moderation;
  524. else
  525. coalesce->tx_coalesce_usecs_irq = 0;
  526. }
  527. }
  528. /* Find lowest IRQ moderation across all used RX queues */
  529. coalesce->rx_coalesce_usecs_irq = ~((u32) 0);
  530. efx_for_each_rx_queue(rx_queue, efx) {
  531. channel = rx_queue->channel;
  532. if (channel->irq_moderation < coalesce->rx_coalesce_usecs_irq)
  533. coalesce->rx_coalesce_usecs_irq =
  534. channel->irq_moderation;
  535. }
  536. return 0;
  537. }
  538. /* Set coalescing parameters
  539. * The difficulties occur for shared channels
  540. */
  541. static int efx_ethtool_set_coalesce(struct net_device *net_dev,
  542. struct ethtool_coalesce *coalesce)
  543. {
  544. struct efx_nic *efx = netdev_priv(net_dev);
  545. struct efx_channel *channel;
  546. struct efx_tx_queue *tx_queue;
  547. unsigned tx_usecs, rx_usecs;
  548. if (coalesce->use_adaptive_rx_coalesce ||
  549. coalesce->use_adaptive_tx_coalesce)
  550. return -EOPNOTSUPP;
  551. if (coalesce->rx_coalesce_usecs || coalesce->tx_coalesce_usecs) {
  552. EFX_ERR(efx, "invalid coalescing setting. "
  553. "Only rx/tx_coalesce_usecs_irq are supported\n");
  554. return -EOPNOTSUPP;
  555. }
  556. rx_usecs = coalesce->rx_coalesce_usecs_irq;
  557. tx_usecs = coalesce->tx_coalesce_usecs_irq;
  558. /* If the channel is shared only allow RX parameters to be set */
  559. efx_for_each_tx_queue(tx_queue, efx) {
  560. if ((tx_queue->channel->used_flags == EFX_USED_BY_RX_TX) &&
  561. tx_usecs) {
  562. EFX_ERR(efx, "Channel is shared. "
  563. "Only RX coalescing may be set\n");
  564. return -EOPNOTSUPP;
  565. }
  566. }
  567. efx_init_irq_moderation(efx, tx_usecs, rx_usecs);
  568. /* Reset channel to pick up new moderation value. Note that
  569. * this may change the value of the irq_moderation field
  570. * (e.g. to allow for hardware timer granularity).
  571. */
  572. efx_for_each_channel(channel, efx)
  573. falcon_set_int_moderation(channel);
  574. return 0;
  575. }
  576. static int efx_ethtool_set_pauseparam(struct net_device *net_dev,
  577. struct ethtool_pauseparam *pause)
  578. {
  579. struct efx_nic *efx = netdev_priv(net_dev);
  580. enum efx_fc_type flow_control = efx->flow_control;
  581. int rc;
  582. flow_control &= ~(EFX_FC_RX | EFX_FC_TX | EFX_FC_AUTO);
  583. flow_control |= pause->rx_pause ? EFX_FC_RX : 0;
  584. flow_control |= pause->tx_pause ? EFX_FC_TX : 0;
  585. flow_control |= pause->autoneg ? EFX_FC_AUTO : 0;
  586. /* Try to push the pause parameters */
  587. mutex_lock(&efx->mac_lock);
  588. rc = falcon_xmac_set_pause(efx, flow_control);
  589. mutex_unlock(&efx->mac_lock);
  590. if (!rc)
  591. efx_reconfigure_port(efx);
  592. return rc;
  593. }
  594. static void efx_ethtool_get_pauseparam(struct net_device *net_dev,
  595. struct ethtool_pauseparam *pause)
  596. {
  597. struct efx_nic *efx = netdev_priv(net_dev);
  598. pause->rx_pause = !!(efx->flow_control & EFX_FC_RX);
  599. pause->tx_pause = !!(efx->flow_control & EFX_FC_TX);
  600. pause->autoneg = !!(efx->flow_control & EFX_FC_AUTO);
  601. }
  602. struct ethtool_ops efx_ethtool_ops = {
  603. .get_settings = efx_ethtool_get_settings,
  604. .set_settings = efx_ethtool_set_settings,
  605. .get_drvinfo = efx_ethtool_get_drvinfo,
  606. .nway_reset = efx_ethtool_nway_reset,
  607. .get_link = efx_ethtool_get_link,
  608. .get_eeprom_len = efx_ethtool_get_eeprom_len,
  609. .get_eeprom = efx_ethtool_get_eeprom,
  610. .set_eeprom = efx_ethtool_set_eeprom,
  611. .get_coalesce = efx_ethtool_get_coalesce,
  612. .set_coalesce = efx_ethtool_set_coalesce,
  613. .get_pauseparam = efx_ethtool_get_pauseparam,
  614. .set_pauseparam = efx_ethtool_set_pauseparam,
  615. .get_rx_csum = efx_ethtool_get_rx_csum,
  616. .set_rx_csum = efx_ethtool_set_rx_csum,
  617. .get_tx_csum = ethtool_op_get_tx_csum,
  618. .set_tx_csum = ethtool_op_set_tx_csum,
  619. .get_sg = ethtool_op_get_sg,
  620. .set_sg = ethtool_op_set_sg,
  621. .get_tso = ethtool_op_get_tso,
  622. .set_tso = ethtool_op_set_tso,
  623. .get_flags = ethtool_op_get_flags,
  624. .set_flags = ethtool_op_set_flags,
  625. .self_test_count = efx_ethtool_self_test_count,
  626. .self_test = efx_ethtool_self_test,
  627. .get_strings = efx_ethtool_get_strings,
  628. .phys_id = efx_ethtool_phys_id,
  629. .get_stats_count = efx_ethtool_get_stats_count,
  630. .get_ethtool_stats = efx_ethtool_get_stats,
  631. };