ethtool.c 24 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831
  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 "workarounds.h"
  15. #include "selftest.h"
  16. #include "efx.h"
  17. #include "falcon.h"
  18. #include "spi.h"
  19. #include "mdio_10g.h"
  20. struct ethtool_string {
  21. char name[ETH_GSTRING_LEN];
  22. };
  23. struct efx_ethtool_stat {
  24. const char *name;
  25. enum {
  26. EFX_ETHTOOL_STAT_SOURCE_mac_stats,
  27. EFX_ETHTOOL_STAT_SOURCE_nic,
  28. EFX_ETHTOOL_STAT_SOURCE_channel
  29. } source;
  30. unsigned offset;
  31. u64(*get_stat) (void *field); /* Reader function */
  32. };
  33. /* Initialiser for a struct #efx_ethtool_stat with type-checking */
  34. #define EFX_ETHTOOL_STAT(stat_name, source_name, field, field_type, \
  35. get_stat_function) { \
  36. .name = #stat_name, \
  37. .source = EFX_ETHTOOL_STAT_SOURCE_##source_name, \
  38. .offset = ((((field_type *) 0) == \
  39. &((struct efx_##source_name *)0)->field) ? \
  40. offsetof(struct efx_##source_name, field) : \
  41. offsetof(struct efx_##source_name, field)), \
  42. .get_stat = get_stat_function, \
  43. }
  44. static u64 efx_get_uint_stat(void *field)
  45. {
  46. return *(unsigned int *)field;
  47. }
  48. static u64 efx_get_ulong_stat(void *field)
  49. {
  50. return *(unsigned long *)field;
  51. }
  52. static u64 efx_get_u64_stat(void *field)
  53. {
  54. return *(u64 *) field;
  55. }
  56. static u64 efx_get_atomic_stat(void *field)
  57. {
  58. return atomic_read((atomic_t *) field);
  59. }
  60. #define EFX_ETHTOOL_ULONG_MAC_STAT(field) \
  61. EFX_ETHTOOL_STAT(field, mac_stats, field, \
  62. unsigned long, efx_get_ulong_stat)
  63. #define EFX_ETHTOOL_U64_MAC_STAT(field) \
  64. EFX_ETHTOOL_STAT(field, mac_stats, field, \
  65. u64, efx_get_u64_stat)
  66. #define EFX_ETHTOOL_UINT_NIC_STAT(name) \
  67. EFX_ETHTOOL_STAT(name, nic, n_##name, \
  68. unsigned int, efx_get_uint_stat)
  69. #define EFX_ETHTOOL_ATOMIC_NIC_ERROR_STAT(field) \
  70. EFX_ETHTOOL_STAT(field, nic, field, \
  71. atomic_t, efx_get_atomic_stat)
  72. #define EFX_ETHTOOL_UINT_CHANNEL_STAT(field) \
  73. EFX_ETHTOOL_STAT(field, channel, n_##field, \
  74. unsigned int, efx_get_uint_stat)
  75. static struct efx_ethtool_stat efx_ethtool_stats[] = {
  76. EFX_ETHTOOL_U64_MAC_STAT(tx_bytes),
  77. EFX_ETHTOOL_U64_MAC_STAT(tx_good_bytes),
  78. EFX_ETHTOOL_U64_MAC_STAT(tx_bad_bytes),
  79. EFX_ETHTOOL_ULONG_MAC_STAT(tx_packets),
  80. EFX_ETHTOOL_ULONG_MAC_STAT(tx_bad),
  81. EFX_ETHTOOL_ULONG_MAC_STAT(tx_pause),
  82. EFX_ETHTOOL_ULONG_MAC_STAT(tx_control),
  83. EFX_ETHTOOL_ULONG_MAC_STAT(tx_unicast),
  84. EFX_ETHTOOL_ULONG_MAC_STAT(tx_multicast),
  85. EFX_ETHTOOL_ULONG_MAC_STAT(tx_broadcast),
  86. EFX_ETHTOOL_ULONG_MAC_STAT(tx_lt64),
  87. EFX_ETHTOOL_ULONG_MAC_STAT(tx_64),
  88. EFX_ETHTOOL_ULONG_MAC_STAT(tx_65_to_127),
  89. EFX_ETHTOOL_ULONG_MAC_STAT(tx_128_to_255),
  90. EFX_ETHTOOL_ULONG_MAC_STAT(tx_256_to_511),
  91. EFX_ETHTOOL_ULONG_MAC_STAT(tx_512_to_1023),
  92. EFX_ETHTOOL_ULONG_MAC_STAT(tx_1024_to_15xx),
  93. EFX_ETHTOOL_ULONG_MAC_STAT(tx_15xx_to_jumbo),
  94. EFX_ETHTOOL_ULONG_MAC_STAT(tx_gtjumbo),
  95. EFX_ETHTOOL_ULONG_MAC_STAT(tx_collision),
  96. EFX_ETHTOOL_ULONG_MAC_STAT(tx_single_collision),
  97. EFX_ETHTOOL_ULONG_MAC_STAT(tx_multiple_collision),
  98. EFX_ETHTOOL_ULONG_MAC_STAT(tx_excessive_collision),
  99. EFX_ETHTOOL_ULONG_MAC_STAT(tx_deferred),
  100. EFX_ETHTOOL_ULONG_MAC_STAT(tx_late_collision),
  101. EFX_ETHTOOL_ULONG_MAC_STAT(tx_excessive_deferred),
  102. EFX_ETHTOOL_ULONG_MAC_STAT(tx_non_tcpudp),
  103. EFX_ETHTOOL_ULONG_MAC_STAT(tx_mac_src_error),
  104. EFX_ETHTOOL_ULONG_MAC_STAT(tx_ip_src_error),
  105. EFX_ETHTOOL_U64_MAC_STAT(rx_bytes),
  106. EFX_ETHTOOL_U64_MAC_STAT(rx_good_bytes),
  107. EFX_ETHTOOL_U64_MAC_STAT(rx_bad_bytes),
  108. EFX_ETHTOOL_ULONG_MAC_STAT(rx_packets),
  109. EFX_ETHTOOL_ULONG_MAC_STAT(rx_good),
  110. EFX_ETHTOOL_ULONG_MAC_STAT(rx_bad),
  111. EFX_ETHTOOL_ULONG_MAC_STAT(rx_pause),
  112. EFX_ETHTOOL_ULONG_MAC_STAT(rx_control),
  113. EFX_ETHTOOL_ULONG_MAC_STAT(rx_unicast),
  114. EFX_ETHTOOL_ULONG_MAC_STAT(rx_multicast),
  115. EFX_ETHTOOL_ULONG_MAC_STAT(rx_broadcast),
  116. EFX_ETHTOOL_ULONG_MAC_STAT(rx_lt64),
  117. EFX_ETHTOOL_ULONG_MAC_STAT(rx_64),
  118. EFX_ETHTOOL_ULONG_MAC_STAT(rx_65_to_127),
  119. EFX_ETHTOOL_ULONG_MAC_STAT(rx_128_to_255),
  120. EFX_ETHTOOL_ULONG_MAC_STAT(rx_256_to_511),
  121. EFX_ETHTOOL_ULONG_MAC_STAT(rx_512_to_1023),
  122. EFX_ETHTOOL_ULONG_MAC_STAT(rx_1024_to_15xx),
  123. EFX_ETHTOOL_ULONG_MAC_STAT(rx_15xx_to_jumbo),
  124. EFX_ETHTOOL_ULONG_MAC_STAT(rx_gtjumbo),
  125. EFX_ETHTOOL_ULONG_MAC_STAT(rx_bad_lt64),
  126. EFX_ETHTOOL_ULONG_MAC_STAT(rx_bad_64_to_15xx),
  127. EFX_ETHTOOL_ULONG_MAC_STAT(rx_bad_15xx_to_jumbo),
  128. EFX_ETHTOOL_ULONG_MAC_STAT(rx_bad_gtjumbo),
  129. EFX_ETHTOOL_ULONG_MAC_STAT(rx_overflow),
  130. EFX_ETHTOOL_ULONG_MAC_STAT(rx_missed),
  131. EFX_ETHTOOL_ULONG_MAC_STAT(rx_false_carrier),
  132. EFX_ETHTOOL_ULONG_MAC_STAT(rx_symbol_error),
  133. EFX_ETHTOOL_ULONG_MAC_STAT(rx_align_error),
  134. EFX_ETHTOOL_ULONG_MAC_STAT(rx_length_error),
  135. EFX_ETHTOOL_ULONG_MAC_STAT(rx_internal_error),
  136. EFX_ETHTOOL_UINT_NIC_STAT(rx_nodesc_drop_cnt),
  137. EFX_ETHTOOL_ATOMIC_NIC_ERROR_STAT(rx_reset),
  138. EFX_ETHTOOL_UINT_CHANNEL_STAT(rx_tobe_disc),
  139. EFX_ETHTOOL_UINT_CHANNEL_STAT(rx_ip_hdr_chksum_err),
  140. EFX_ETHTOOL_UINT_CHANNEL_STAT(rx_tcp_udp_chksum_err),
  141. EFX_ETHTOOL_UINT_CHANNEL_STAT(rx_mcast_mismatch),
  142. EFX_ETHTOOL_UINT_CHANNEL_STAT(rx_frm_trunc),
  143. };
  144. /* Number of ethtool statistics */
  145. #define EFX_ETHTOOL_NUM_STATS ARRAY_SIZE(efx_ethtool_stats)
  146. #define EFX_ETHTOOL_EEPROM_MAGIC 0xEFAB
  147. /**************************************************************************
  148. *
  149. * Ethtool operations
  150. *
  151. **************************************************************************
  152. */
  153. /* Identify device by flashing LEDs */
  154. static int efx_ethtool_phys_id(struct net_device *net_dev, u32 count)
  155. {
  156. struct efx_nic *efx = netdev_priv(net_dev);
  157. do {
  158. efx->type->set_id_led(efx, EFX_LED_ON);
  159. schedule_timeout_interruptible(HZ / 2);
  160. efx->type->set_id_led(efx, EFX_LED_OFF);
  161. schedule_timeout_interruptible(HZ / 2);
  162. } while (!signal_pending(current) && --count != 0);
  163. efx->type->set_id_led(efx, EFX_LED_DEFAULT);
  164. return 0;
  165. }
  166. /* This must be called with rtnl_lock held. */
  167. int efx_ethtool_get_settings(struct net_device *net_dev,
  168. struct ethtool_cmd *ecmd)
  169. {
  170. struct efx_nic *efx = netdev_priv(net_dev);
  171. struct efx_link_state *link_state = &efx->link_state;
  172. mutex_lock(&efx->mac_lock);
  173. efx->phy_op->get_settings(efx, ecmd);
  174. mutex_unlock(&efx->mac_lock);
  175. /* Falcon GMAC does not support 1000Mbps HD */
  176. ecmd->supported &= ~SUPPORTED_1000baseT_Half;
  177. /* Both MACs support pause frames (bidirectional and respond-only) */
  178. ecmd->supported |= SUPPORTED_Pause | SUPPORTED_Asym_Pause;
  179. if (LOOPBACK_INTERNAL(efx)) {
  180. ecmd->speed = link_state->speed;
  181. ecmd->duplex = link_state->fd ? DUPLEX_FULL : DUPLEX_HALF;
  182. }
  183. return 0;
  184. }
  185. /* This must be called with rtnl_lock held. */
  186. int efx_ethtool_set_settings(struct net_device *net_dev,
  187. struct ethtool_cmd *ecmd)
  188. {
  189. struct efx_nic *efx = netdev_priv(net_dev);
  190. int rc;
  191. /* Falcon GMAC does not support 1000Mbps HD */
  192. if (ecmd->speed == SPEED_1000 && ecmd->duplex != DUPLEX_FULL) {
  193. EFX_LOG(efx, "rejecting unsupported 1000Mbps HD"
  194. " setting\n");
  195. return -EINVAL;
  196. }
  197. mutex_lock(&efx->mac_lock);
  198. rc = efx->phy_op->set_settings(efx, ecmd);
  199. mutex_unlock(&efx->mac_lock);
  200. return rc;
  201. }
  202. static void efx_ethtool_get_drvinfo(struct net_device *net_dev,
  203. struct ethtool_drvinfo *info)
  204. {
  205. struct efx_nic *efx = netdev_priv(net_dev);
  206. strlcpy(info->driver, EFX_DRIVER_NAME, sizeof(info->driver));
  207. strlcpy(info->version, EFX_DRIVER_VERSION, sizeof(info->version));
  208. strlcpy(info->bus_info, pci_name(efx->pci_dev), sizeof(info->bus_info));
  209. }
  210. /**
  211. * efx_fill_test - fill in an individual self-test entry
  212. * @test_index: Index of the test
  213. * @strings: Ethtool strings, or %NULL
  214. * @data: Ethtool test results, or %NULL
  215. * @test: Pointer to test result (used only if data != %NULL)
  216. * @unit_format: Unit name format (e.g. "chan\%d")
  217. * @unit_id: Unit id (e.g. 0 for "chan0")
  218. * @test_format: Test name format (e.g. "loopback.\%s.tx.sent")
  219. * @test_id: Test id (e.g. "PHYXS" for "loopback.PHYXS.tx_sent")
  220. *
  221. * Fill in an individual self-test entry.
  222. */
  223. static void efx_fill_test(unsigned int test_index,
  224. struct ethtool_string *strings, u64 *data,
  225. int *test, const char *unit_format, int unit_id,
  226. const char *test_format, const char *test_id)
  227. {
  228. struct ethtool_string unit_str, test_str;
  229. /* Fill data value, if applicable */
  230. if (data)
  231. data[test_index] = *test;
  232. /* Fill string, if applicable */
  233. if (strings) {
  234. if (strchr(unit_format, '%'))
  235. snprintf(unit_str.name, sizeof(unit_str.name),
  236. unit_format, unit_id);
  237. else
  238. strcpy(unit_str.name, unit_format);
  239. snprintf(test_str.name, sizeof(test_str.name),
  240. test_format, test_id);
  241. snprintf(strings[test_index].name,
  242. sizeof(strings[test_index].name),
  243. "%-6s %-24s", unit_str.name, test_str.name);
  244. }
  245. }
  246. #define EFX_CHANNEL_NAME(_channel) "chan%d", _channel->channel
  247. #define EFX_TX_QUEUE_NAME(_tx_queue) "txq%d", _tx_queue->queue
  248. #define EFX_RX_QUEUE_NAME(_rx_queue) "rxq%d", _rx_queue->queue
  249. #define EFX_LOOPBACK_NAME(_mode, _counter) \
  250. "loopback.%s." _counter, STRING_TABLE_LOOKUP(_mode, efx_loopback_mode)
  251. /**
  252. * efx_fill_loopback_test - fill in a block of loopback self-test entries
  253. * @efx: Efx NIC
  254. * @lb_tests: Efx loopback self-test results structure
  255. * @mode: Loopback test mode
  256. * @test_index: Starting index of the test
  257. * @strings: Ethtool strings, or %NULL
  258. * @data: Ethtool test results, or %NULL
  259. */
  260. static int efx_fill_loopback_test(struct efx_nic *efx,
  261. struct efx_loopback_self_tests *lb_tests,
  262. enum efx_loopback_mode mode,
  263. unsigned int test_index,
  264. struct ethtool_string *strings, u64 *data)
  265. {
  266. struct efx_tx_queue *tx_queue;
  267. efx_for_each_tx_queue(tx_queue, efx) {
  268. efx_fill_test(test_index++, strings, data,
  269. &lb_tests->tx_sent[tx_queue->queue],
  270. EFX_TX_QUEUE_NAME(tx_queue),
  271. EFX_LOOPBACK_NAME(mode, "tx_sent"));
  272. efx_fill_test(test_index++, strings, data,
  273. &lb_tests->tx_done[tx_queue->queue],
  274. EFX_TX_QUEUE_NAME(tx_queue),
  275. EFX_LOOPBACK_NAME(mode, "tx_done"));
  276. }
  277. efx_fill_test(test_index++, strings, data,
  278. &lb_tests->rx_good,
  279. "rx", 0,
  280. EFX_LOOPBACK_NAME(mode, "rx_good"));
  281. efx_fill_test(test_index++, strings, data,
  282. &lb_tests->rx_bad,
  283. "rx", 0,
  284. EFX_LOOPBACK_NAME(mode, "rx_bad"));
  285. return test_index;
  286. }
  287. /**
  288. * efx_ethtool_fill_self_tests - get self-test details
  289. * @efx: Efx NIC
  290. * @tests: Efx self-test results structure, or %NULL
  291. * @strings: Ethtool strings, or %NULL
  292. * @data: Ethtool test results, or %NULL
  293. */
  294. static int efx_ethtool_fill_self_tests(struct efx_nic *efx,
  295. struct efx_self_tests *tests,
  296. struct ethtool_string *strings,
  297. u64 *data)
  298. {
  299. struct efx_channel *channel;
  300. unsigned int n = 0, i;
  301. enum efx_loopback_mode mode;
  302. efx_fill_test(n++, strings, data, &tests->mdio,
  303. "core", 0, "mdio", NULL);
  304. efx_fill_test(n++, strings, data, &tests->nvram,
  305. "core", 0, "nvram", NULL);
  306. efx_fill_test(n++, strings, data, &tests->interrupt,
  307. "core", 0, "interrupt", NULL);
  308. /* Event queues */
  309. efx_for_each_channel(channel, efx) {
  310. efx_fill_test(n++, strings, data,
  311. &tests->eventq_dma[channel->channel],
  312. EFX_CHANNEL_NAME(channel),
  313. "eventq.dma", NULL);
  314. efx_fill_test(n++, strings, data,
  315. &tests->eventq_int[channel->channel],
  316. EFX_CHANNEL_NAME(channel),
  317. "eventq.int", NULL);
  318. efx_fill_test(n++, strings, data,
  319. &tests->eventq_poll[channel->channel],
  320. EFX_CHANNEL_NAME(channel),
  321. "eventq.poll", NULL);
  322. }
  323. efx_fill_test(n++, strings, data, &tests->registers,
  324. "core", 0, "registers", NULL);
  325. if (efx->phy_op->run_tests != NULL) {
  326. EFX_BUG_ON_PARANOID(efx->phy_op->test_name == NULL);
  327. for (i = 0; true; ++i) {
  328. const char *name;
  329. EFX_BUG_ON_PARANOID(i >= EFX_MAX_PHY_TESTS);
  330. name = efx->phy_op->test_name(efx, i);
  331. if (name == NULL)
  332. break;
  333. efx_fill_test(n++, strings, data, &tests->phy[i],
  334. "phy", 0, name, NULL);
  335. }
  336. }
  337. /* Loopback tests */
  338. for (mode = LOOPBACK_NONE; mode <= LOOPBACK_TEST_MAX; mode++) {
  339. if (!(efx->loopback_modes & (1 << mode)))
  340. continue;
  341. n = efx_fill_loopback_test(efx,
  342. &tests->loopback[mode], mode, n,
  343. strings, data);
  344. }
  345. return n;
  346. }
  347. static int efx_ethtool_get_sset_count(struct net_device *net_dev,
  348. int string_set)
  349. {
  350. switch (string_set) {
  351. case ETH_SS_STATS:
  352. return EFX_ETHTOOL_NUM_STATS;
  353. case ETH_SS_TEST:
  354. return efx_ethtool_fill_self_tests(netdev_priv(net_dev),
  355. NULL, NULL, NULL);
  356. default:
  357. return -EINVAL;
  358. }
  359. }
  360. static void efx_ethtool_get_strings(struct net_device *net_dev,
  361. u32 string_set, u8 *strings)
  362. {
  363. struct efx_nic *efx = netdev_priv(net_dev);
  364. struct ethtool_string *ethtool_strings =
  365. (struct ethtool_string *)strings;
  366. int i;
  367. switch (string_set) {
  368. case ETH_SS_STATS:
  369. for (i = 0; i < EFX_ETHTOOL_NUM_STATS; i++)
  370. strncpy(ethtool_strings[i].name,
  371. efx_ethtool_stats[i].name,
  372. sizeof(ethtool_strings[i].name));
  373. break;
  374. case ETH_SS_TEST:
  375. efx_ethtool_fill_self_tests(efx, NULL,
  376. ethtool_strings, NULL);
  377. break;
  378. default:
  379. /* No other string sets */
  380. break;
  381. }
  382. }
  383. static void efx_ethtool_get_stats(struct net_device *net_dev,
  384. struct ethtool_stats *stats,
  385. u64 *data)
  386. {
  387. struct efx_nic *efx = netdev_priv(net_dev);
  388. struct efx_mac_stats *mac_stats = &efx->mac_stats;
  389. struct efx_ethtool_stat *stat;
  390. struct efx_channel *channel;
  391. int i;
  392. EFX_BUG_ON_PARANOID(stats->n_stats != EFX_ETHTOOL_NUM_STATS);
  393. /* Update MAC and NIC statistics */
  394. dev_get_stats(net_dev);
  395. /* Fill detailed statistics buffer */
  396. for (i = 0; i < EFX_ETHTOOL_NUM_STATS; i++) {
  397. stat = &efx_ethtool_stats[i];
  398. switch (stat->source) {
  399. case EFX_ETHTOOL_STAT_SOURCE_mac_stats:
  400. data[i] = stat->get_stat((void *)mac_stats +
  401. stat->offset);
  402. break;
  403. case EFX_ETHTOOL_STAT_SOURCE_nic:
  404. data[i] = stat->get_stat((void *)efx + stat->offset);
  405. break;
  406. case EFX_ETHTOOL_STAT_SOURCE_channel:
  407. data[i] = 0;
  408. efx_for_each_channel(channel, efx)
  409. data[i] += stat->get_stat((void *)channel +
  410. stat->offset);
  411. break;
  412. }
  413. }
  414. }
  415. static int efx_ethtool_set_rx_csum(struct net_device *net_dev, u32 enable)
  416. {
  417. struct efx_nic *efx = netdev_priv(net_dev);
  418. /* No way to stop the hardware doing the checks; we just
  419. * ignore the result.
  420. */
  421. efx->rx_checksum_enabled = !!enable;
  422. return 0;
  423. }
  424. static u32 efx_ethtool_get_rx_csum(struct net_device *net_dev)
  425. {
  426. struct efx_nic *efx = netdev_priv(net_dev);
  427. return efx->rx_checksum_enabled;
  428. }
  429. static void efx_ethtool_self_test(struct net_device *net_dev,
  430. struct ethtool_test *test, u64 *data)
  431. {
  432. struct efx_nic *efx = netdev_priv(net_dev);
  433. struct efx_self_tests efx_tests;
  434. int already_up;
  435. int rc;
  436. ASSERT_RTNL();
  437. if (efx->state != STATE_RUNNING) {
  438. rc = -EIO;
  439. goto fail1;
  440. }
  441. /* We need rx buffers and interrupts. */
  442. already_up = (efx->net_dev->flags & IFF_UP);
  443. if (!already_up) {
  444. rc = dev_open(efx->net_dev);
  445. if (rc) {
  446. EFX_ERR(efx, "failed opening device.\n");
  447. goto fail2;
  448. }
  449. }
  450. memset(&efx_tests, 0, sizeof(efx_tests));
  451. rc = efx_selftest(efx, &efx_tests, test->flags);
  452. if (!already_up)
  453. dev_close(efx->net_dev);
  454. EFX_LOG(efx, "%s %sline self-tests\n",
  455. rc == 0 ? "passed" : "failed",
  456. (test->flags & ETH_TEST_FL_OFFLINE) ? "off" : "on");
  457. fail2:
  458. fail1:
  459. /* Fill ethtool results structures */
  460. efx_ethtool_fill_self_tests(efx, &efx_tests, NULL, data);
  461. if (rc)
  462. test->flags |= ETH_TEST_FL_FAILED;
  463. }
  464. /* Restart autonegotiation */
  465. static int efx_ethtool_nway_reset(struct net_device *net_dev)
  466. {
  467. struct efx_nic *efx = netdev_priv(net_dev);
  468. return mdio45_nway_restart(&efx->mdio);
  469. }
  470. static u32 efx_ethtool_get_link(struct net_device *net_dev)
  471. {
  472. struct efx_nic *efx = netdev_priv(net_dev);
  473. return efx->link_state.up;
  474. }
  475. static int efx_ethtool_get_eeprom_len(struct net_device *net_dev)
  476. {
  477. struct efx_nic *efx = netdev_priv(net_dev);
  478. struct efx_spi_device *spi = efx->spi_eeprom;
  479. if (!spi)
  480. return 0;
  481. return min(spi->size, EFX_EEPROM_BOOTCONFIG_END) -
  482. min(spi->size, EFX_EEPROM_BOOTCONFIG_START);
  483. }
  484. static int efx_ethtool_get_eeprom(struct net_device *net_dev,
  485. struct ethtool_eeprom *eeprom, u8 *buf)
  486. {
  487. struct efx_nic *efx = netdev_priv(net_dev);
  488. struct efx_spi_device *spi = efx->spi_eeprom;
  489. size_t len;
  490. int rc;
  491. rc = mutex_lock_interruptible(&efx->spi_lock);
  492. if (rc)
  493. return rc;
  494. rc = falcon_spi_read(efx, spi,
  495. eeprom->offset + EFX_EEPROM_BOOTCONFIG_START,
  496. eeprom->len, &len, buf);
  497. mutex_unlock(&efx->spi_lock);
  498. eeprom->magic = EFX_ETHTOOL_EEPROM_MAGIC;
  499. eeprom->len = len;
  500. return rc;
  501. }
  502. static int efx_ethtool_set_eeprom(struct net_device *net_dev,
  503. struct ethtool_eeprom *eeprom, u8 *buf)
  504. {
  505. struct efx_nic *efx = netdev_priv(net_dev);
  506. struct efx_spi_device *spi = efx->spi_eeprom;
  507. size_t len;
  508. int rc;
  509. if (eeprom->magic != EFX_ETHTOOL_EEPROM_MAGIC)
  510. return -EINVAL;
  511. rc = mutex_lock_interruptible(&efx->spi_lock);
  512. if (rc)
  513. return rc;
  514. rc = falcon_spi_write(efx, spi,
  515. eeprom->offset + EFX_EEPROM_BOOTCONFIG_START,
  516. eeprom->len, &len, buf);
  517. mutex_unlock(&efx->spi_lock);
  518. eeprom->len = len;
  519. return rc;
  520. }
  521. static int efx_ethtool_get_coalesce(struct net_device *net_dev,
  522. struct ethtool_coalesce *coalesce)
  523. {
  524. struct efx_nic *efx = netdev_priv(net_dev);
  525. struct efx_tx_queue *tx_queue;
  526. struct efx_channel *channel;
  527. memset(coalesce, 0, sizeof(*coalesce));
  528. /* Find lowest IRQ moderation across all used TX queues */
  529. coalesce->tx_coalesce_usecs_irq = ~((u32) 0);
  530. efx_for_each_tx_queue(tx_queue, efx) {
  531. channel = tx_queue->channel;
  532. if (channel->irq_moderation < coalesce->tx_coalesce_usecs_irq) {
  533. if (channel->used_flags != EFX_USED_BY_RX_TX)
  534. coalesce->tx_coalesce_usecs_irq =
  535. channel->irq_moderation;
  536. else
  537. coalesce->tx_coalesce_usecs_irq = 0;
  538. }
  539. }
  540. coalesce->use_adaptive_rx_coalesce = efx->irq_rx_adaptive;
  541. coalesce->rx_coalesce_usecs_irq = efx->irq_rx_moderation;
  542. coalesce->tx_coalesce_usecs_irq *= EFX_IRQ_MOD_RESOLUTION;
  543. coalesce->rx_coalesce_usecs_irq *= EFX_IRQ_MOD_RESOLUTION;
  544. return 0;
  545. }
  546. /* Set coalescing parameters
  547. * The difficulties occur for shared channels
  548. */
  549. static int efx_ethtool_set_coalesce(struct net_device *net_dev,
  550. struct ethtool_coalesce *coalesce)
  551. {
  552. struct efx_nic *efx = netdev_priv(net_dev);
  553. struct efx_channel *channel;
  554. struct efx_tx_queue *tx_queue;
  555. unsigned tx_usecs, rx_usecs, adaptive;
  556. if (coalesce->use_adaptive_tx_coalesce)
  557. return -EOPNOTSUPP;
  558. if (coalesce->rx_coalesce_usecs || coalesce->tx_coalesce_usecs) {
  559. EFX_ERR(efx, "invalid coalescing setting. "
  560. "Only rx/tx_coalesce_usecs_irq are supported\n");
  561. return -EOPNOTSUPP;
  562. }
  563. rx_usecs = coalesce->rx_coalesce_usecs_irq;
  564. tx_usecs = coalesce->tx_coalesce_usecs_irq;
  565. adaptive = coalesce->use_adaptive_rx_coalesce;
  566. /* If the channel is shared only allow RX parameters to be set */
  567. efx_for_each_tx_queue(tx_queue, efx) {
  568. if ((tx_queue->channel->used_flags == EFX_USED_BY_RX_TX) &&
  569. tx_usecs) {
  570. EFX_ERR(efx, "Channel is shared. "
  571. "Only RX coalescing may be set\n");
  572. return -EOPNOTSUPP;
  573. }
  574. }
  575. efx_init_irq_moderation(efx, tx_usecs, rx_usecs, adaptive);
  576. efx_for_each_channel(channel, efx)
  577. efx->type->push_irq_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 wanted_fc, old_fc;
  585. u32 old_adv;
  586. bool reset;
  587. int rc = 0;
  588. mutex_lock(&efx->mac_lock);
  589. wanted_fc = ((pause->rx_pause ? EFX_FC_RX : 0) |
  590. (pause->tx_pause ? EFX_FC_TX : 0) |
  591. (pause->autoneg ? EFX_FC_AUTO : 0));
  592. if ((wanted_fc & EFX_FC_TX) && !(wanted_fc & EFX_FC_RX)) {
  593. EFX_LOG(efx, "Flow control unsupported: tx ON rx OFF\n");
  594. rc = -EINVAL;
  595. goto out;
  596. }
  597. if ((wanted_fc & EFX_FC_AUTO) && !efx->link_advertising) {
  598. EFX_LOG(efx, "Autonegotiation is disabled\n");
  599. rc = -EINVAL;
  600. goto out;
  601. }
  602. /* TX flow control may automatically turn itself off if the
  603. * link partner (intermittently) stops responding to pause
  604. * frames. There isn't any indication that this has happened,
  605. * so the best we do is leave it up to the user to spot this
  606. * and fix it be cycling transmit flow control on this end. */
  607. reset = (wanted_fc & EFX_FC_TX) && !(efx->wanted_fc & EFX_FC_TX);
  608. if (EFX_WORKAROUND_11482(efx) && reset) {
  609. if (efx_nic_rev(efx) == EFX_REV_FALCON_B0) {
  610. /* Recover by resetting the EM block */
  611. falcon_stop_nic_stats(efx);
  612. falcon_drain_tx_fifo(efx);
  613. efx->mac_op->reconfigure(efx);
  614. falcon_start_nic_stats(efx);
  615. } else {
  616. /* Schedule a reset to recover */
  617. efx_schedule_reset(efx, RESET_TYPE_INVISIBLE);
  618. }
  619. }
  620. old_adv = efx->link_advertising;
  621. old_fc = efx->wanted_fc;
  622. efx_link_set_wanted_fc(efx, wanted_fc);
  623. if (efx->link_advertising != old_adv ||
  624. (efx->wanted_fc ^ old_fc) & EFX_FC_AUTO) {
  625. rc = efx->phy_op->reconfigure(efx);
  626. if (rc) {
  627. EFX_ERR(efx, "Unable to advertise requested flow "
  628. "control setting\n");
  629. goto out;
  630. }
  631. }
  632. /* Reconfigure the MAC. The PHY *may* generate a link state change event
  633. * if the user just changed the advertised capabilities, but there's no
  634. * harm doing this twice */
  635. efx->mac_op->reconfigure(efx);
  636. out:
  637. mutex_unlock(&efx->mac_lock);
  638. return rc;
  639. }
  640. static void efx_ethtool_get_pauseparam(struct net_device *net_dev,
  641. struct ethtool_pauseparam *pause)
  642. {
  643. struct efx_nic *efx = netdev_priv(net_dev);
  644. pause->rx_pause = !!(efx->wanted_fc & EFX_FC_RX);
  645. pause->tx_pause = !!(efx->wanted_fc & EFX_FC_TX);
  646. pause->autoneg = !!(efx->wanted_fc & EFX_FC_AUTO);
  647. }
  648. static void efx_ethtool_get_wol(struct net_device *net_dev,
  649. struct ethtool_wolinfo *wol)
  650. {
  651. struct efx_nic *efx = netdev_priv(net_dev);
  652. return efx->type->get_wol(efx, wol);
  653. }
  654. static int efx_ethtool_set_wol(struct net_device *net_dev,
  655. struct ethtool_wolinfo *wol)
  656. {
  657. struct efx_nic *efx = netdev_priv(net_dev);
  658. return efx->type->set_wol(efx, wol->wolopts);
  659. }
  660. extern int efx_ethtool_reset(struct net_device *net_dev, u32 *flags)
  661. {
  662. struct efx_nic *efx = netdev_priv(net_dev);
  663. enum reset_type method;
  664. enum {
  665. ETH_RESET_EFX_INVISIBLE = (ETH_RESET_DMA | ETH_RESET_FILTER |
  666. ETH_RESET_OFFLOAD | ETH_RESET_MAC)
  667. };
  668. /* Check for minimal reset flags */
  669. if ((*flags & ETH_RESET_EFX_INVISIBLE) != ETH_RESET_EFX_INVISIBLE)
  670. return -EINVAL;
  671. *flags ^= ETH_RESET_EFX_INVISIBLE;
  672. method = RESET_TYPE_INVISIBLE;
  673. if (*flags & ETH_RESET_PHY) {
  674. *flags ^= ETH_RESET_PHY;
  675. method = RESET_TYPE_ALL;
  676. }
  677. if ((*flags & efx->type->reset_world_flags) ==
  678. efx->type->reset_world_flags) {
  679. *flags ^= efx->type->reset_world_flags;
  680. method = RESET_TYPE_WORLD;
  681. }
  682. return efx_reset(efx, method);
  683. }
  684. const struct ethtool_ops efx_ethtool_ops = {
  685. .get_settings = efx_ethtool_get_settings,
  686. .set_settings = efx_ethtool_set_settings,
  687. .get_drvinfo = efx_ethtool_get_drvinfo,
  688. .nway_reset = efx_ethtool_nway_reset,
  689. .get_link = efx_ethtool_get_link,
  690. .get_eeprom_len = efx_ethtool_get_eeprom_len,
  691. .get_eeprom = efx_ethtool_get_eeprom,
  692. .set_eeprom = efx_ethtool_set_eeprom,
  693. .get_coalesce = efx_ethtool_get_coalesce,
  694. .set_coalesce = efx_ethtool_set_coalesce,
  695. .get_pauseparam = efx_ethtool_get_pauseparam,
  696. .set_pauseparam = efx_ethtool_set_pauseparam,
  697. .get_rx_csum = efx_ethtool_get_rx_csum,
  698. .set_rx_csum = efx_ethtool_set_rx_csum,
  699. .get_tx_csum = ethtool_op_get_tx_csum,
  700. .set_tx_csum = ethtool_op_set_tx_csum,
  701. .get_sg = ethtool_op_get_sg,
  702. .set_sg = ethtool_op_set_sg,
  703. .get_tso = ethtool_op_get_tso,
  704. .set_tso = ethtool_op_set_tso,
  705. .get_flags = ethtool_op_get_flags,
  706. .set_flags = ethtool_op_set_flags,
  707. .get_sset_count = efx_ethtool_get_sset_count,
  708. .self_test = efx_ethtool_self_test,
  709. .get_strings = efx_ethtool_get_strings,
  710. .phys_id = efx_ethtool_phys_id,
  711. .get_ethtool_stats = efx_ethtool_get_stats,
  712. .get_wol = efx_ethtool_get_wol,
  713. .set_wol = efx_ethtool_set_wol,
  714. .reset = efx_ethtool_reset,
  715. };