ethtool.c 21 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729
  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_sset_count(struct net_device *net_dev,
  335. int string_set)
  336. {
  337. switch (string_set) {
  338. case ETH_SS_STATS:
  339. return EFX_ETHTOOL_NUM_STATS;
  340. case ETH_SS_TEST:
  341. return efx_ethtool_fill_self_tests(netdev_priv(net_dev),
  342. NULL, NULL, NULL);
  343. default:
  344. return -EINVAL;
  345. }
  346. }
  347. static void efx_ethtool_get_strings(struct net_device *net_dev,
  348. u32 string_set, u8 *strings)
  349. {
  350. struct efx_nic *efx = netdev_priv(net_dev);
  351. struct ethtool_string *ethtool_strings =
  352. (struct ethtool_string *)strings;
  353. int i;
  354. switch (string_set) {
  355. case ETH_SS_STATS:
  356. for (i = 0; i < EFX_ETHTOOL_NUM_STATS; i++)
  357. strncpy(ethtool_strings[i].name,
  358. efx_ethtool_stats[i].name,
  359. sizeof(ethtool_strings[i].name));
  360. break;
  361. case ETH_SS_TEST:
  362. efx_ethtool_fill_self_tests(efx, NULL,
  363. ethtool_strings, NULL);
  364. break;
  365. default:
  366. /* No other string sets */
  367. break;
  368. }
  369. }
  370. static void efx_ethtool_get_stats(struct net_device *net_dev,
  371. struct ethtool_stats *stats,
  372. u64 *data)
  373. {
  374. struct efx_nic *efx = netdev_priv(net_dev);
  375. struct efx_mac_stats *mac_stats = &efx->mac_stats;
  376. struct efx_ethtool_stat *stat;
  377. struct efx_channel *channel;
  378. int i;
  379. EFX_BUG_ON_PARANOID(stats->n_stats != EFX_ETHTOOL_NUM_STATS);
  380. /* Update MAC and NIC statistics */
  381. net_dev->get_stats(net_dev);
  382. /* Fill detailed statistics buffer */
  383. for (i = 0; i < EFX_ETHTOOL_NUM_STATS; i++) {
  384. stat = &efx_ethtool_stats[i];
  385. switch (stat->source) {
  386. case EFX_ETHTOOL_STAT_SOURCE_mac_stats:
  387. data[i] = stat->get_stat((void *)mac_stats +
  388. stat->offset);
  389. break;
  390. case EFX_ETHTOOL_STAT_SOURCE_nic:
  391. data[i] = stat->get_stat((void *)efx + stat->offset);
  392. break;
  393. case EFX_ETHTOOL_STAT_SOURCE_channel:
  394. data[i] = 0;
  395. efx_for_each_channel(channel, efx)
  396. data[i] += stat->get_stat((void *)channel +
  397. stat->offset);
  398. break;
  399. }
  400. }
  401. }
  402. static int efx_ethtool_set_rx_csum(struct net_device *net_dev, u32 enable)
  403. {
  404. struct efx_nic *efx = netdev_priv(net_dev);
  405. /* No way to stop the hardware doing the checks; we just
  406. * ignore the result.
  407. */
  408. efx->rx_checksum_enabled = !!enable;
  409. return 0;
  410. }
  411. static u32 efx_ethtool_get_rx_csum(struct net_device *net_dev)
  412. {
  413. struct efx_nic *efx = netdev_priv(net_dev);
  414. return efx->rx_checksum_enabled;
  415. }
  416. static void efx_ethtool_self_test(struct net_device *net_dev,
  417. struct ethtool_test *test, u64 *data)
  418. {
  419. struct efx_nic *efx = netdev_priv(net_dev);
  420. struct efx_self_tests efx_tests;
  421. int offline, already_up;
  422. int rc;
  423. ASSERT_RTNL();
  424. if (efx->state != STATE_RUNNING) {
  425. rc = -EIO;
  426. goto fail1;
  427. }
  428. /* We need rx buffers and interrupts. */
  429. already_up = (efx->net_dev->flags & IFF_UP);
  430. if (!already_up) {
  431. rc = dev_open(efx->net_dev);
  432. if (rc) {
  433. EFX_ERR(efx, "failed opening device.\n");
  434. goto fail2;
  435. }
  436. }
  437. memset(&efx_tests, 0, sizeof(efx_tests));
  438. offline = (test->flags & ETH_TEST_FL_OFFLINE);
  439. /* Perform online self tests first */
  440. rc = efx_online_test(efx, &efx_tests);
  441. if (rc)
  442. goto out;
  443. /* Perform offline tests only if online tests passed */
  444. if (offline) {
  445. /* Stop the kernel from sending packets during the test. */
  446. efx_stop_queue(efx);
  447. rc = efx_flush_queues(efx);
  448. if (!rc)
  449. rc = efx_offline_test(efx, &efx_tests,
  450. efx->loopback_modes);
  451. efx_wake_queue(efx);
  452. }
  453. out:
  454. if (!already_up)
  455. dev_close(efx->net_dev);
  456. EFX_LOG(efx, "%s all %sline self-tests\n",
  457. rc == 0 ? "passed" : "failed", offline ? "off" : "on");
  458. fail2:
  459. fail1:
  460. /* Fill ethtool results structures */
  461. efx_ethtool_fill_self_tests(efx, &efx_tests, NULL, data);
  462. if (rc)
  463. test->flags |= ETH_TEST_FL_FAILED;
  464. }
  465. /* Restart autonegotiation */
  466. static int efx_ethtool_nway_reset(struct net_device *net_dev)
  467. {
  468. struct efx_nic *efx = netdev_priv(net_dev);
  469. return mii_nway_restart(&efx->mii);
  470. }
  471. static u32 efx_ethtool_get_link(struct net_device *net_dev)
  472. {
  473. struct efx_nic *efx = netdev_priv(net_dev);
  474. return efx->link_up;
  475. }
  476. static int efx_ethtool_get_eeprom_len(struct net_device *net_dev)
  477. {
  478. struct efx_nic *efx = netdev_priv(net_dev);
  479. struct efx_spi_device *spi = efx->spi_eeprom;
  480. if (!spi)
  481. return 0;
  482. return min(spi->size, EFX_ETHTOOL_EEPROM_MAX) -
  483. min(spi->size, EFX_ETHTOOL_EEPROM_MIN);
  484. }
  485. static int efx_ethtool_get_eeprom(struct net_device *net_dev,
  486. struct ethtool_eeprom *eeprom, u8 *buf)
  487. {
  488. struct efx_nic *efx = netdev_priv(net_dev);
  489. struct efx_spi_device *spi = efx->spi_eeprom;
  490. size_t len;
  491. int rc;
  492. rc = falcon_spi_read(spi, eeprom->offset + EFX_ETHTOOL_EEPROM_MIN,
  493. eeprom->len, &len, buf);
  494. eeprom->magic = EFX_ETHTOOL_EEPROM_MAGIC;
  495. eeprom->len = len;
  496. return rc;
  497. }
  498. static int efx_ethtool_set_eeprom(struct net_device *net_dev,
  499. struct ethtool_eeprom *eeprom, u8 *buf)
  500. {
  501. struct efx_nic *efx = netdev_priv(net_dev);
  502. struct efx_spi_device *spi = efx->spi_eeprom;
  503. size_t len;
  504. int rc;
  505. if (eeprom->magic != EFX_ETHTOOL_EEPROM_MAGIC)
  506. return -EINVAL;
  507. rc = falcon_spi_write(spi, eeprom->offset + EFX_ETHTOOL_EEPROM_MIN,
  508. eeprom->len, &len, buf);
  509. eeprom->len = len;
  510. return rc;
  511. }
  512. static int efx_ethtool_get_coalesce(struct net_device *net_dev,
  513. struct ethtool_coalesce *coalesce)
  514. {
  515. struct efx_nic *efx = netdev_priv(net_dev);
  516. struct efx_tx_queue *tx_queue;
  517. struct efx_rx_queue *rx_queue;
  518. struct efx_channel *channel;
  519. memset(coalesce, 0, sizeof(*coalesce));
  520. /* Find lowest IRQ moderation across all used TX queues */
  521. coalesce->tx_coalesce_usecs_irq = ~((u32) 0);
  522. efx_for_each_tx_queue(tx_queue, efx) {
  523. channel = tx_queue->channel;
  524. if (channel->irq_moderation < coalesce->tx_coalesce_usecs_irq) {
  525. if (channel->used_flags != EFX_USED_BY_RX_TX)
  526. coalesce->tx_coalesce_usecs_irq =
  527. channel->irq_moderation;
  528. else
  529. coalesce->tx_coalesce_usecs_irq = 0;
  530. }
  531. }
  532. /* Find lowest IRQ moderation across all used RX queues */
  533. coalesce->rx_coalesce_usecs_irq = ~((u32) 0);
  534. efx_for_each_rx_queue(rx_queue, efx) {
  535. channel = rx_queue->channel;
  536. if (channel->irq_moderation < coalesce->rx_coalesce_usecs_irq)
  537. coalesce->rx_coalesce_usecs_irq =
  538. channel->irq_moderation;
  539. }
  540. return 0;
  541. }
  542. /* Set coalescing parameters
  543. * The difficulties occur for shared channels
  544. */
  545. static int efx_ethtool_set_coalesce(struct net_device *net_dev,
  546. struct ethtool_coalesce *coalesce)
  547. {
  548. struct efx_nic *efx = netdev_priv(net_dev);
  549. struct efx_channel *channel;
  550. struct efx_tx_queue *tx_queue;
  551. unsigned tx_usecs, rx_usecs;
  552. if (coalesce->use_adaptive_rx_coalesce ||
  553. coalesce->use_adaptive_tx_coalesce)
  554. return -EOPNOTSUPP;
  555. if (coalesce->rx_coalesce_usecs || coalesce->tx_coalesce_usecs) {
  556. EFX_ERR(efx, "invalid coalescing setting. "
  557. "Only rx/tx_coalesce_usecs_irq are supported\n");
  558. return -EOPNOTSUPP;
  559. }
  560. rx_usecs = coalesce->rx_coalesce_usecs_irq;
  561. tx_usecs = coalesce->tx_coalesce_usecs_irq;
  562. /* If the channel is shared only allow RX parameters to be set */
  563. efx_for_each_tx_queue(tx_queue, efx) {
  564. if ((tx_queue->channel->used_flags == EFX_USED_BY_RX_TX) &&
  565. tx_usecs) {
  566. EFX_ERR(efx, "Channel is shared. "
  567. "Only RX coalescing may be set\n");
  568. return -EOPNOTSUPP;
  569. }
  570. }
  571. efx_init_irq_moderation(efx, tx_usecs, rx_usecs);
  572. /* Reset channel to pick up new moderation value. Note that
  573. * this may change the value of the irq_moderation field
  574. * (e.g. to allow for hardware timer granularity).
  575. */
  576. efx_for_each_channel(channel, efx)
  577. falcon_set_int_moderation(channel);
  578. return 0;
  579. }
  580. static int efx_ethtool_set_pauseparam(struct net_device *net_dev,
  581. struct ethtool_pauseparam *pause)
  582. {
  583. struct efx_nic *efx = netdev_priv(net_dev);
  584. enum efx_fc_type flow_control = efx->flow_control;
  585. int rc;
  586. flow_control &= ~(EFX_FC_RX | EFX_FC_TX | EFX_FC_AUTO);
  587. flow_control |= pause->rx_pause ? EFX_FC_RX : 0;
  588. flow_control |= pause->tx_pause ? EFX_FC_TX : 0;
  589. flow_control |= pause->autoneg ? EFX_FC_AUTO : 0;
  590. /* Try to push the pause parameters */
  591. mutex_lock(&efx->mac_lock);
  592. rc = falcon_xmac_set_pause(efx, flow_control);
  593. mutex_unlock(&efx->mac_lock);
  594. if (!rc)
  595. efx_reconfigure_port(efx);
  596. return rc;
  597. }
  598. static void efx_ethtool_get_pauseparam(struct net_device *net_dev,
  599. struct ethtool_pauseparam *pause)
  600. {
  601. struct efx_nic *efx = netdev_priv(net_dev);
  602. pause->rx_pause = !!(efx->flow_control & EFX_FC_RX);
  603. pause->tx_pause = !!(efx->flow_control & EFX_FC_TX);
  604. pause->autoneg = !!(efx->flow_control & EFX_FC_AUTO);
  605. }
  606. struct ethtool_ops efx_ethtool_ops = {
  607. .get_settings = efx_ethtool_get_settings,
  608. .set_settings = efx_ethtool_set_settings,
  609. .get_drvinfo = efx_ethtool_get_drvinfo,
  610. .nway_reset = efx_ethtool_nway_reset,
  611. .get_link = efx_ethtool_get_link,
  612. .get_eeprom_len = efx_ethtool_get_eeprom_len,
  613. .get_eeprom = efx_ethtool_get_eeprom,
  614. .set_eeprom = efx_ethtool_set_eeprom,
  615. .get_coalesce = efx_ethtool_get_coalesce,
  616. .set_coalesce = efx_ethtool_set_coalesce,
  617. .get_pauseparam = efx_ethtool_get_pauseparam,
  618. .set_pauseparam = efx_ethtool_set_pauseparam,
  619. .get_rx_csum = efx_ethtool_get_rx_csum,
  620. .set_rx_csum = efx_ethtool_set_rx_csum,
  621. .get_tx_csum = ethtool_op_get_tx_csum,
  622. .set_tx_csum = ethtool_op_set_tx_csum,
  623. .get_sg = ethtool_op_get_sg,
  624. .set_sg = ethtool_op_set_sg,
  625. .get_tso = ethtool_op_get_tso,
  626. .set_tso = ethtool_op_set_tso,
  627. .get_flags = ethtool_op_get_flags,
  628. .set_flags = ethtool_op_set_flags,
  629. .get_sset_count = efx_ethtool_get_sset_count,
  630. .self_test = efx_ethtool_self_test,
  631. .get_strings = efx_ethtool_get_strings,
  632. .phys_id = efx_ethtool_phys_id,
  633. .get_ethtool_stats = efx_ethtool_get_stats,
  634. };