fm10k_pci.c 65 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413
  1. /* Intel(R) Ethernet Switch Host Interface Driver
  2. * Copyright(c) 2013 - 2016 Intel Corporation.
  3. *
  4. * This program is free software; you can redistribute it and/or modify it
  5. * under the terms and conditions of the GNU General Public License,
  6. * version 2, as published by the Free Software Foundation.
  7. *
  8. * This program is distributed in the hope it will be useful, but WITHOUT
  9. * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  10. * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
  11. * more details.
  12. *
  13. * The full GNU General Public License is included in this distribution in
  14. * the file called "COPYING".
  15. *
  16. * Contact Information:
  17. * e1000-devel Mailing List <e1000-devel@lists.sourceforge.net>
  18. * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
  19. */
  20. #include <linux/module.h>
  21. #include <linux/aer.h>
  22. #include "fm10k.h"
  23. static const struct fm10k_info *fm10k_info_tbl[] = {
  24. [fm10k_device_pf] = &fm10k_pf_info,
  25. [fm10k_device_vf] = &fm10k_vf_info,
  26. };
  27. /**
  28. * fm10k_pci_tbl - PCI Device ID Table
  29. *
  30. * Wildcard entries (PCI_ANY_ID) should come last
  31. * Last entry must be all 0s
  32. *
  33. * { Vendor ID, Device ID, SubVendor ID, SubDevice ID,
  34. * Class, Class Mask, private data (not used) }
  35. */
  36. static const struct pci_device_id fm10k_pci_tbl[] = {
  37. { PCI_VDEVICE(INTEL, FM10K_DEV_ID_PF), fm10k_device_pf },
  38. { PCI_VDEVICE(INTEL, FM10K_DEV_ID_VF), fm10k_device_vf },
  39. /* required last entry */
  40. { 0, }
  41. };
  42. MODULE_DEVICE_TABLE(pci, fm10k_pci_tbl);
  43. u16 fm10k_read_pci_cfg_word(struct fm10k_hw *hw, u32 reg)
  44. {
  45. struct fm10k_intfc *interface = hw->back;
  46. u16 value = 0;
  47. if (FM10K_REMOVED(hw->hw_addr))
  48. return ~value;
  49. pci_read_config_word(interface->pdev, reg, &value);
  50. if (value == 0xFFFF)
  51. fm10k_write_flush(hw);
  52. return value;
  53. }
  54. u32 fm10k_read_reg(struct fm10k_hw *hw, int reg)
  55. {
  56. u32 __iomem *hw_addr = ACCESS_ONCE(hw->hw_addr);
  57. u32 value = 0;
  58. if (FM10K_REMOVED(hw_addr))
  59. return ~value;
  60. value = readl(&hw_addr[reg]);
  61. if (!(~value) && (!reg || !(~readl(hw_addr)))) {
  62. struct fm10k_intfc *interface = hw->back;
  63. struct net_device *netdev = interface->netdev;
  64. hw->hw_addr = NULL;
  65. netif_device_detach(netdev);
  66. netdev_err(netdev, "PCIe link lost, device now detached\n");
  67. }
  68. return value;
  69. }
  70. static int fm10k_hw_ready(struct fm10k_intfc *interface)
  71. {
  72. struct fm10k_hw *hw = &interface->hw;
  73. fm10k_write_flush(hw);
  74. return FM10K_REMOVED(hw->hw_addr) ? -ENODEV : 0;
  75. }
  76. void fm10k_service_event_schedule(struct fm10k_intfc *interface)
  77. {
  78. if (!test_bit(__FM10K_SERVICE_DISABLE, &interface->state) &&
  79. !test_and_set_bit(__FM10K_SERVICE_SCHED, &interface->state))
  80. queue_work(fm10k_workqueue, &interface->service_task);
  81. }
  82. static void fm10k_service_event_complete(struct fm10k_intfc *interface)
  83. {
  84. WARN_ON(!test_bit(__FM10K_SERVICE_SCHED, &interface->state));
  85. /* flush memory to make sure state is correct before next watchog */
  86. smp_mb__before_atomic();
  87. clear_bit(__FM10K_SERVICE_SCHED, &interface->state);
  88. }
  89. /**
  90. * fm10k_service_timer - Timer Call-back
  91. * @data: pointer to interface cast into an unsigned long
  92. **/
  93. static void fm10k_service_timer(unsigned long data)
  94. {
  95. struct fm10k_intfc *interface = (struct fm10k_intfc *)data;
  96. /* Reset the timer */
  97. mod_timer(&interface->service_timer, (HZ * 2) + jiffies);
  98. fm10k_service_event_schedule(interface);
  99. }
  100. static void fm10k_detach_subtask(struct fm10k_intfc *interface)
  101. {
  102. struct net_device *netdev = interface->netdev;
  103. /* do nothing if device is still present or hw_addr is set */
  104. if (netif_device_present(netdev) || interface->hw.hw_addr)
  105. return;
  106. rtnl_lock();
  107. if (netif_running(netdev))
  108. dev_close(netdev);
  109. rtnl_unlock();
  110. }
  111. static void fm10k_prepare_for_reset(struct fm10k_intfc *interface)
  112. {
  113. struct net_device *netdev = interface->netdev;
  114. WARN_ON(in_interrupt());
  115. /* put off any impending NetWatchDogTimeout */
  116. netif_trans_update(netdev);
  117. while (test_and_set_bit(__FM10K_RESETTING, &interface->state))
  118. usleep_range(1000, 2000);
  119. rtnl_lock();
  120. fm10k_iov_suspend(interface->pdev);
  121. if (netif_running(netdev))
  122. fm10k_close(netdev);
  123. fm10k_mbx_free_irq(interface);
  124. /* free interrupts */
  125. fm10k_clear_queueing_scheme(interface);
  126. /* delay any future reset requests */
  127. interface->last_reset = jiffies + (10 * HZ);
  128. rtnl_unlock();
  129. }
  130. static int fm10k_handle_reset(struct fm10k_intfc *interface)
  131. {
  132. struct net_device *netdev = interface->netdev;
  133. struct fm10k_hw *hw = &interface->hw;
  134. int err;
  135. rtnl_lock();
  136. /* reset and initialize the hardware so it is in a known state */
  137. err = hw->mac.ops.reset_hw(hw);
  138. if (err) {
  139. dev_err(&interface->pdev->dev, "reset_hw failed: %d\n", err);
  140. goto reinit_err;
  141. }
  142. err = hw->mac.ops.init_hw(hw);
  143. if (err) {
  144. dev_err(&interface->pdev->dev, "init_hw failed: %d\n", err);
  145. goto reinit_err;
  146. }
  147. err = fm10k_init_queueing_scheme(interface);
  148. if (err) {
  149. dev_err(&interface->pdev->dev,
  150. "init_queueing_scheme failed: %d\n", err);
  151. goto reinit_err;
  152. }
  153. /* re-associate interrupts */
  154. err = fm10k_mbx_request_irq(interface);
  155. if (err)
  156. goto err_mbx_irq;
  157. err = fm10k_hw_ready(interface);
  158. if (err)
  159. goto err_open;
  160. /* update hardware address for VFs if perm_addr has changed */
  161. if (hw->mac.type == fm10k_mac_vf) {
  162. if (is_valid_ether_addr(hw->mac.perm_addr)) {
  163. ether_addr_copy(hw->mac.addr, hw->mac.perm_addr);
  164. ether_addr_copy(netdev->perm_addr, hw->mac.perm_addr);
  165. ether_addr_copy(netdev->dev_addr, hw->mac.perm_addr);
  166. netdev->addr_assign_type &= ~NET_ADDR_RANDOM;
  167. }
  168. if (hw->mac.vlan_override)
  169. netdev->features &= ~NETIF_F_HW_VLAN_CTAG_RX;
  170. else
  171. netdev->features |= NETIF_F_HW_VLAN_CTAG_RX;
  172. }
  173. err = netif_running(netdev) ? fm10k_open(netdev) : 0;
  174. if (err)
  175. goto err_open;
  176. fm10k_iov_resume(interface->pdev);
  177. rtnl_unlock();
  178. clear_bit(__FM10K_RESETTING, &interface->state);
  179. return err;
  180. err_open:
  181. fm10k_mbx_free_irq(interface);
  182. err_mbx_irq:
  183. fm10k_clear_queueing_scheme(interface);
  184. reinit_err:
  185. netif_device_detach(netdev);
  186. rtnl_unlock();
  187. clear_bit(__FM10K_RESETTING, &interface->state);
  188. return err;
  189. }
  190. static void fm10k_reinit(struct fm10k_intfc *interface)
  191. {
  192. int err;
  193. fm10k_prepare_for_reset(interface);
  194. err = fm10k_handle_reset(interface);
  195. if (err)
  196. dev_err(&interface->pdev->dev,
  197. "fm10k_handle_reset failed: %d\n", err);
  198. }
  199. static void fm10k_reset_subtask(struct fm10k_intfc *interface)
  200. {
  201. if (!(interface->flags & FM10K_FLAG_RESET_REQUESTED))
  202. return;
  203. interface->flags &= ~FM10K_FLAG_RESET_REQUESTED;
  204. netdev_err(interface->netdev, "Reset interface\n");
  205. fm10k_reinit(interface);
  206. }
  207. /**
  208. * fm10k_configure_swpri_map - Configure Receive SWPRI to PC mapping
  209. * @interface: board private structure
  210. *
  211. * Configure the SWPRI to PC mapping for the port.
  212. **/
  213. static void fm10k_configure_swpri_map(struct fm10k_intfc *interface)
  214. {
  215. struct net_device *netdev = interface->netdev;
  216. struct fm10k_hw *hw = &interface->hw;
  217. int i;
  218. /* clear flag indicating update is needed */
  219. interface->flags &= ~FM10K_FLAG_SWPRI_CONFIG;
  220. /* these registers are only available on the PF */
  221. if (hw->mac.type != fm10k_mac_pf)
  222. return;
  223. /* configure SWPRI to PC map */
  224. for (i = 0; i < FM10K_SWPRI_MAX; i++)
  225. fm10k_write_reg(hw, FM10K_SWPRI_MAP(i),
  226. netdev_get_prio_tc_map(netdev, i));
  227. }
  228. /**
  229. * fm10k_watchdog_update_host_state - Update the link status based on host.
  230. * @interface: board private structure
  231. **/
  232. static void fm10k_watchdog_update_host_state(struct fm10k_intfc *interface)
  233. {
  234. struct fm10k_hw *hw = &interface->hw;
  235. s32 err;
  236. if (test_bit(__FM10K_LINK_DOWN, &interface->state)) {
  237. interface->host_ready = false;
  238. if (time_is_after_jiffies(interface->link_down_event))
  239. return;
  240. clear_bit(__FM10K_LINK_DOWN, &interface->state);
  241. }
  242. if (interface->flags & FM10K_FLAG_SWPRI_CONFIG) {
  243. if (rtnl_trylock()) {
  244. fm10k_configure_swpri_map(interface);
  245. rtnl_unlock();
  246. }
  247. }
  248. /* lock the mailbox for transmit and receive */
  249. fm10k_mbx_lock(interface);
  250. err = hw->mac.ops.get_host_state(hw, &interface->host_ready);
  251. if (err && time_is_before_jiffies(interface->last_reset))
  252. interface->flags |= FM10K_FLAG_RESET_REQUESTED;
  253. /* free the lock */
  254. fm10k_mbx_unlock(interface);
  255. }
  256. /**
  257. * fm10k_mbx_subtask - Process upstream and downstream mailboxes
  258. * @interface: board private structure
  259. *
  260. * This function will process both the upstream and downstream mailboxes.
  261. **/
  262. static void fm10k_mbx_subtask(struct fm10k_intfc *interface)
  263. {
  264. /* process upstream mailbox and update device state */
  265. fm10k_watchdog_update_host_state(interface);
  266. /* process downstream mailboxes */
  267. fm10k_iov_mbx(interface);
  268. }
  269. /**
  270. * fm10k_watchdog_host_is_ready - Update netdev status based on host ready
  271. * @interface: board private structure
  272. **/
  273. static void fm10k_watchdog_host_is_ready(struct fm10k_intfc *interface)
  274. {
  275. struct net_device *netdev = interface->netdev;
  276. /* only continue if link state is currently down */
  277. if (netif_carrier_ok(netdev))
  278. return;
  279. netif_info(interface, drv, netdev, "NIC Link is up\n");
  280. netif_carrier_on(netdev);
  281. netif_tx_wake_all_queues(netdev);
  282. }
  283. /**
  284. * fm10k_watchdog_host_not_ready - Update netdev status based on host not ready
  285. * @interface: board private structure
  286. **/
  287. static void fm10k_watchdog_host_not_ready(struct fm10k_intfc *interface)
  288. {
  289. struct net_device *netdev = interface->netdev;
  290. /* only continue if link state is currently up */
  291. if (!netif_carrier_ok(netdev))
  292. return;
  293. netif_info(interface, drv, netdev, "NIC Link is down\n");
  294. netif_carrier_off(netdev);
  295. netif_tx_stop_all_queues(netdev);
  296. }
  297. /**
  298. * fm10k_update_stats - Update the board statistics counters.
  299. * @interface: board private structure
  300. **/
  301. void fm10k_update_stats(struct fm10k_intfc *interface)
  302. {
  303. struct net_device_stats *net_stats = &interface->netdev->stats;
  304. struct fm10k_hw *hw = &interface->hw;
  305. u64 hw_csum_tx_good = 0, hw_csum_rx_good = 0, rx_length_errors = 0;
  306. u64 rx_switch_errors = 0, rx_drops = 0, rx_pp_errors = 0;
  307. u64 rx_link_errors = 0;
  308. u64 rx_errors = 0, rx_csum_errors = 0, tx_csum_errors = 0;
  309. u64 restart_queue = 0, tx_busy = 0, alloc_failed = 0;
  310. u64 rx_bytes_nic = 0, rx_pkts_nic = 0, rx_drops_nic = 0;
  311. u64 tx_bytes_nic = 0, tx_pkts_nic = 0;
  312. u64 bytes, pkts;
  313. int i;
  314. /* ensure only one thread updates stats at a time */
  315. if (test_and_set_bit(__FM10K_UPDATING_STATS, &interface->state))
  316. return;
  317. /* do not allow stats update via service task for next second */
  318. interface->next_stats_update = jiffies + HZ;
  319. /* gather some stats to the interface struct that are per queue */
  320. for (bytes = 0, pkts = 0, i = 0; i < interface->num_tx_queues; i++) {
  321. struct fm10k_ring *tx_ring = READ_ONCE(interface->tx_ring[i]);
  322. if (!tx_ring)
  323. continue;
  324. restart_queue += tx_ring->tx_stats.restart_queue;
  325. tx_busy += tx_ring->tx_stats.tx_busy;
  326. tx_csum_errors += tx_ring->tx_stats.csum_err;
  327. bytes += tx_ring->stats.bytes;
  328. pkts += tx_ring->stats.packets;
  329. hw_csum_tx_good += tx_ring->tx_stats.csum_good;
  330. }
  331. interface->restart_queue = restart_queue;
  332. interface->tx_busy = tx_busy;
  333. net_stats->tx_bytes = bytes;
  334. net_stats->tx_packets = pkts;
  335. interface->tx_csum_errors = tx_csum_errors;
  336. interface->hw_csum_tx_good = hw_csum_tx_good;
  337. /* gather some stats to the interface struct that are per queue */
  338. for (bytes = 0, pkts = 0, i = 0; i < interface->num_rx_queues; i++) {
  339. struct fm10k_ring *rx_ring = READ_ONCE(interface->rx_ring[i]);
  340. if (!rx_ring)
  341. continue;
  342. bytes += rx_ring->stats.bytes;
  343. pkts += rx_ring->stats.packets;
  344. alloc_failed += rx_ring->rx_stats.alloc_failed;
  345. rx_csum_errors += rx_ring->rx_stats.csum_err;
  346. rx_errors += rx_ring->rx_stats.errors;
  347. hw_csum_rx_good += rx_ring->rx_stats.csum_good;
  348. rx_switch_errors += rx_ring->rx_stats.switch_errors;
  349. rx_drops += rx_ring->rx_stats.drops;
  350. rx_pp_errors += rx_ring->rx_stats.pp_errors;
  351. rx_link_errors += rx_ring->rx_stats.link_errors;
  352. rx_length_errors += rx_ring->rx_stats.length_errors;
  353. }
  354. net_stats->rx_bytes = bytes;
  355. net_stats->rx_packets = pkts;
  356. interface->alloc_failed = alloc_failed;
  357. interface->rx_csum_errors = rx_csum_errors;
  358. interface->hw_csum_rx_good = hw_csum_rx_good;
  359. interface->rx_switch_errors = rx_switch_errors;
  360. interface->rx_drops = rx_drops;
  361. interface->rx_pp_errors = rx_pp_errors;
  362. interface->rx_link_errors = rx_link_errors;
  363. interface->rx_length_errors = rx_length_errors;
  364. hw->mac.ops.update_hw_stats(hw, &interface->stats);
  365. for (i = 0; i < hw->mac.max_queues; i++) {
  366. struct fm10k_hw_stats_q *q = &interface->stats.q[i];
  367. tx_bytes_nic += q->tx_bytes.count;
  368. tx_pkts_nic += q->tx_packets.count;
  369. rx_bytes_nic += q->rx_bytes.count;
  370. rx_pkts_nic += q->rx_packets.count;
  371. rx_drops_nic += q->rx_drops.count;
  372. }
  373. interface->tx_bytes_nic = tx_bytes_nic;
  374. interface->tx_packets_nic = tx_pkts_nic;
  375. interface->rx_bytes_nic = rx_bytes_nic;
  376. interface->rx_packets_nic = rx_pkts_nic;
  377. interface->rx_drops_nic = rx_drops_nic;
  378. /* Fill out the OS statistics structure */
  379. net_stats->rx_errors = rx_errors;
  380. net_stats->rx_dropped = interface->stats.nodesc_drop.count;
  381. clear_bit(__FM10K_UPDATING_STATS, &interface->state);
  382. }
  383. /**
  384. * fm10k_watchdog_flush_tx - flush queues on host not ready
  385. * @interface - pointer to the device interface structure
  386. **/
  387. static void fm10k_watchdog_flush_tx(struct fm10k_intfc *interface)
  388. {
  389. int some_tx_pending = 0;
  390. int i;
  391. /* nothing to do if carrier is up */
  392. if (netif_carrier_ok(interface->netdev))
  393. return;
  394. for (i = 0; i < interface->num_tx_queues; i++) {
  395. struct fm10k_ring *tx_ring = interface->tx_ring[i];
  396. if (tx_ring->next_to_use != tx_ring->next_to_clean) {
  397. some_tx_pending = 1;
  398. break;
  399. }
  400. }
  401. /* We've lost link, so the controller stops DMA, but we've got
  402. * queued Tx work that's never going to get done, so reset
  403. * controller to flush Tx.
  404. */
  405. if (some_tx_pending)
  406. interface->flags |= FM10K_FLAG_RESET_REQUESTED;
  407. }
  408. /**
  409. * fm10k_watchdog_subtask - check and bring link up
  410. * @interface - pointer to the device interface structure
  411. **/
  412. static void fm10k_watchdog_subtask(struct fm10k_intfc *interface)
  413. {
  414. /* if interface is down do nothing */
  415. if (test_bit(__FM10K_DOWN, &interface->state) ||
  416. test_bit(__FM10K_RESETTING, &interface->state))
  417. return;
  418. if (interface->host_ready)
  419. fm10k_watchdog_host_is_ready(interface);
  420. else
  421. fm10k_watchdog_host_not_ready(interface);
  422. /* update stats only once every second */
  423. if (time_is_before_jiffies(interface->next_stats_update))
  424. fm10k_update_stats(interface);
  425. /* flush any uncompleted work */
  426. fm10k_watchdog_flush_tx(interface);
  427. }
  428. /**
  429. * fm10k_check_hang_subtask - check for hung queues and dropped interrupts
  430. * @interface - pointer to the device interface structure
  431. *
  432. * This function serves two purposes. First it strobes the interrupt lines
  433. * in order to make certain interrupts are occurring. Secondly it sets the
  434. * bits needed to check for TX hangs. As a result we should immediately
  435. * determine if a hang has occurred.
  436. */
  437. static void fm10k_check_hang_subtask(struct fm10k_intfc *interface)
  438. {
  439. int i;
  440. /* If we're down or resetting, just bail */
  441. if (test_bit(__FM10K_DOWN, &interface->state) ||
  442. test_bit(__FM10K_RESETTING, &interface->state))
  443. return;
  444. /* rate limit tx hang checks to only once every 2 seconds */
  445. if (time_is_after_eq_jiffies(interface->next_tx_hang_check))
  446. return;
  447. interface->next_tx_hang_check = jiffies + (2 * HZ);
  448. if (netif_carrier_ok(interface->netdev)) {
  449. /* Force detection of hung controller */
  450. for (i = 0; i < interface->num_tx_queues; i++)
  451. set_check_for_tx_hang(interface->tx_ring[i]);
  452. /* Rearm all in-use q_vectors for immediate firing */
  453. for (i = 0; i < interface->num_q_vectors; i++) {
  454. struct fm10k_q_vector *qv = interface->q_vector[i];
  455. if (!qv->tx.count && !qv->rx.count)
  456. continue;
  457. writel(FM10K_ITR_ENABLE | FM10K_ITR_PENDING2, qv->itr);
  458. }
  459. }
  460. }
  461. /**
  462. * fm10k_service_task - manages and runs subtasks
  463. * @work: pointer to work_struct containing our data
  464. **/
  465. static void fm10k_service_task(struct work_struct *work)
  466. {
  467. struct fm10k_intfc *interface;
  468. interface = container_of(work, struct fm10k_intfc, service_task);
  469. /* tasks run even when interface is down */
  470. fm10k_mbx_subtask(interface);
  471. fm10k_detach_subtask(interface);
  472. fm10k_reset_subtask(interface);
  473. /* tasks only run when interface is up */
  474. fm10k_watchdog_subtask(interface);
  475. fm10k_check_hang_subtask(interface);
  476. /* release lock on service events to allow scheduling next event */
  477. fm10k_service_event_complete(interface);
  478. }
  479. /**
  480. * fm10k_configure_tx_ring - Configure Tx ring after Reset
  481. * @interface: board private structure
  482. * @ring: structure containing ring specific data
  483. *
  484. * Configure the Tx descriptor ring after a reset.
  485. **/
  486. static void fm10k_configure_tx_ring(struct fm10k_intfc *interface,
  487. struct fm10k_ring *ring)
  488. {
  489. struct fm10k_hw *hw = &interface->hw;
  490. u64 tdba = ring->dma;
  491. u32 size = ring->count * sizeof(struct fm10k_tx_desc);
  492. u32 txint = FM10K_INT_MAP_DISABLE;
  493. u32 txdctl = BIT(FM10K_TXDCTL_MAX_TIME_SHIFT) | FM10K_TXDCTL_ENABLE;
  494. u8 reg_idx = ring->reg_idx;
  495. /* disable queue to avoid issues while updating state */
  496. fm10k_write_reg(hw, FM10K_TXDCTL(reg_idx), 0);
  497. fm10k_write_flush(hw);
  498. /* possible poll here to verify ring resources have been cleaned */
  499. /* set location and size for descriptor ring */
  500. fm10k_write_reg(hw, FM10K_TDBAL(reg_idx), tdba & DMA_BIT_MASK(32));
  501. fm10k_write_reg(hw, FM10K_TDBAH(reg_idx), tdba >> 32);
  502. fm10k_write_reg(hw, FM10K_TDLEN(reg_idx), size);
  503. /* reset head and tail pointers */
  504. fm10k_write_reg(hw, FM10K_TDH(reg_idx), 0);
  505. fm10k_write_reg(hw, FM10K_TDT(reg_idx), 0);
  506. /* store tail pointer */
  507. ring->tail = &interface->uc_addr[FM10K_TDT(reg_idx)];
  508. /* reset ntu and ntc to place SW in sync with hardware */
  509. ring->next_to_clean = 0;
  510. ring->next_to_use = 0;
  511. /* Map interrupt */
  512. if (ring->q_vector) {
  513. txint = ring->q_vector->v_idx + NON_Q_VECTORS(hw);
  514. txint |= FM10K_INT_MAP_TIMER0;
  515. }
  516. fm10k_write_reg(hw, FM10K_TXINT(reg_idx), txint);
  517. /* enable use of FTAG bit in Tx descriptor, register is RO for VF */
  518. fm10k_write_reg(hw, FM10K_PFVTCTL(reg_idx),
  519. FM10K_PFVTCTL_FTAG_DESC_ENABLE);
  520. /* Initialize XPS */
  521. if (!test_and_set_bit(__FM10K_TX_XPS_INIT_DONE, &ring->state) &&
  522. ring->q_vector)
  523. netif_set_xps_queue(ring->netdev,
  524. &ring->q_vector->affinity_mask,
  525. ring->queue_index);
  526. /* enable queue */
  527. fm10k_write_reg(hw, FM10K_TXDCTL(reg_idx), txdctl);
  528. }
  529. /**
  530. * fm10k_enable_tx_ring - Verify Tx ring is enabled after configuration
  531. * @interface: board private structure
  532. * @ring: structure containing ring specific data
  533. *
  534. * Verify the Tx descriptor ring is ready for transmit.
  535. **/
  536. static void fm10k_enable_tx_ring(struct fm10k_intfc *interface,
  537. struct fm10k_ring *ring)
  538. {
  539. struct fm10k_hw *hw = &interface->hw;
  540. int wait_loop = 10;
  541. u32 txdctl;
  542. u8 reg_idx = ring->reg_idx;
  543. /* if we are already enabled just exit */
  544. if (fm10k_read_reg(hw, FM10K_TXDCTL(reg_idx)) & FM10K_TXDCTL_ENABLE)
  545. return;
  546. /* poll to verify queue is enabled */
  547. do {
  548. usleep_range(1000, 2000);
  549. txdctl = fm10k_read_reg(hw, FM10K_TXDCTL(reg_idx));
  550. } while (!(txdctl & FM10K_TXDCTL_ENABLE) && --wait_loop);
  551. if (!wait_loop)
  552. netif_err(interface, drv, interface->netdev,
  553. "Could not enable Tx Queue %d\n", reg_idx);
  554. }
  555. /**
  556. * fm10k_configure_tx - Configure Transmit Unit after Reset
  557. * @interface: board private structure
  558. *
  559. * Configure the Tx unit of the MAC after a reset.
  560. **/
  561. static void fm10k_configure_tx(struct fm10k_intfc *interface)
  562. {
  563. int i;
  564. /* Setup the HW Tx Head and Tail descriptor pointers */
  565. for (i = 0; i < interface->num_tx_queues; i++)
  566. fm10k_configure_tx_ring(interface, interface->tx_ring[i]);
  567. /* poll here to verify that Tx rings are now enabled */
  568. for (i = 0; i < interface->num_tx_queues; i++)
  569. fm10k_enable_tx_ring(interface, interface->tx_ring[i]);
  570. }
  571. /**
  572. * fm10k_configure_rx_ring - Configure Rx ring after Reset
  573. * @interface: board private structure
  574. * @ring: structure containing ring specific data
  575. *
  576. * Configure the Rx descriptor ring after a reset.
  577. **/
  578. static void fm10k_configure_rx_ring(struct fm10k_intfc *interface,
  579. struct fm10k_ring *ring)
  580. {
  581. u64 rdba = ring->dma;
  582. struct fm10k_hw *hw = &interface->hw;
  583. u32 size = ring->count * sizeof(union fm10k_rx_desc);
  584. u32 rxqctl = FM10K_RXQCTL_ENABLE | FM10K_RXQCTL_PF;
  585. u32 rxdctl = FM10K_RXDCTL_WRITE_BACK_MIN_DELAY;
  586. u32 srrctl = FM10K_SRRCTL_BUFFER_CHAINING_EN;
  587. u32 rxint = FM10K_INT_MAP_DISABLE;
  588. u8 rx_pause = interface->rx_pause;
  589. u8 reg_idx = ring->reg_idx;
  590. /* disable queue to avoid issues while updating state */
  591. fm10k_write_reg(hw, FM10K_RXQCTL(reg_idx), 0);
  592. fm10k_write_flush(hw);
  593. /* possible poll here to verify ring resources have been cleaned */
  594. /* set location and size for descriptor ring */
  595. fm10k_write_reg(hw, FM10K_RDBAL(reg_idx), rdba & DMA_BIT_MASK(32));
  596. fm10k_write_reg(hw, FM10K_RDBAH(reg_idx), rdba >> 32);
  597. fm10k_write_reg(hw, FM10K_RDLEN(reg_idx), size);
  598. /* reset head and tail pointers */
  599. fm10k_write_reg(hw, FM10K_RDH(reg_idx), 0);
  600. fm10k_write_reg(hw, FM10K_RDT(reg_idx), 0);
  601. /* store tail pointer */
  602. ring->tail = &interface->uc_addr[FM10K_RDT(reg_idx)];
  603. /* reset ntu and ntc to place SW in sync with hardware */
  604. ring->next_to_clean = 0;
  605. ring->next_to_use = 0;
  606. ring->next_to_alloc = 0;
  607. /* Configure the Rx buffer size for one buff without split */
  608. srrctl |= FM10K_RX_BUFSZ >> FM10K_SRRCTL_BSIZEPKT_SHIFT;
  609. /* Configure the Rx ring to suppress loopback packets */
  610. srrctl |= FM10K_SRRCTL_LOOPBACK_SUPPRESS;
  611. fm10k_write_reg(hw, FM10K_SRRCTL(reg_idx), srrctl);
  612. /* Enable drop on empty */
  613. #ifdef CONFIG_DCB
  614. if (interface->pfc_en)
  615. rx_pause = interface->pfc_en;
  616. #endif
  617. if (!(rx_pause & BIT(ring->qos_pc)))
  618. rxdctl |= FM10K_RXDCTL_DROP_ON_EMPTY;
  619. fm10k_write_reg(hw, FM10K_RXDCTL(reg_idx), rxdctl);
  620. /* assign default VLAN to queue */
  621. ring->vid = hw->mac.default_vid;
  622. /* if we have an active VLAN, disable default VLAN ID */
  623. if (test_bit(hw->mac.default_vid, interface->active_vlans))
  624. ring->vid |= FM10K_VLAN_CLEAR;
  625. /* Map interrupt */
  626. if (ring->q_vector) {
  627. rxint = ring->q_vector->v_idx + NON_Q_VECTORS(hw);
  628. rxint |= FM10K_INT_MAP_TIMER1;
  629. }
  630. fm10k_write_reg(hw, FM10K_RXINT(reg_idx), rxint);
  631. /* enable queue */
  632. fm10k_write_reg(hw, FM10K_RXQCTL(reg_idx), rxqctl);
  633. /* place buffers on ring for receive data */
  634. fm10k_alloc_rx_buffers(ring, fm10k_desc_unused(ring));
  635. }
  636. /**
  637. * fm10k_update_rx_drop_en - Configures the drop enable bits for Rx rings
  638. * @interface: board private structure
  639. *
  640. * Configure the drop enable bits for the Rx rings.
  641. **/
  642. void fm10k_update_rx_drop_en(struct fm10k_intfc *interface)
  643. {
  644. struct fm10k_hw *hw = &interface->hw;
  645. u8 rx_pause = interface->rx_pause;
  646. int i;
  647. #ifdef CONFIG_DCB
  648. if (interface->pfc_en)
  649. rx_pause = interface->pfc_en;
  650. #endif
  651. for (i = 0; i < interface->num_rx_queues; i++) {
  652. struct fm10k_ring *ring = interface->rx_ring[i];
  653. u32 rxdctl = FM10K_RXDCTL_WRITE_BACK_MIN_DELAY;
  654. u8 reg_idx = ring->reg_idx;
  655. if (!(rx_pause & BIT(ring->qos_pc)))
  656. rxdctl |= FM10K_RXDCTL_DROP_ON_EMPTY;
  657. fm10k_write_reg(hw, FM10K_RXDCTL(reg_idx), rxdctl);
  658. }
  659. }
  660. /**
  661. * fm10k_configure_dglort - Configure Receive DGLORT after reset
  662. * @interface: board private structure
  663. *
  664. * Configure the DGLORT description and RSS tables.
  665. **/
  666. static void fm10k_configure_dglort(struct fm10k_intfc *interface)
  667. {
  668. struct fm10k_dglort_cfg dglort = { 0 };
  669. struct fm10k_hw *hw = &interface->hw;
  670. int i;
  671. u32 mrqc;
  672. /* Fill out hash function seeds */
  673. for (i = 0; i < FM10K_RSSRK_SIZE; i++)
  674. fm10k_write_reg(hw, FM10K_RSSRK(0, i), interface->rssrk[i]);
  675. /* Write RETA table to hardware */
  676. for (i = 0; i < FM10K_RETA_SIZE; i++)
  677. fm10k_write_reg(hw, FM10K_RETA(0, i), interface->reta[i]);
  678. /* Generate RSS hash based on packet types, TCP/UDP
  679. * port numbers and/or IPv4/v6 src and dst addresses
  680. */
  681. mrqc = FM10K_MRQC_IPV4 |
  682. FM10K_MRQC_TCP_IPV4 |
  683. FM10K_MRQC_IPV6 |
  684. FM10K_MRQC_TCP_IPV6;
  685. if (interface->flags & FM10K_FLAG_RSS_FIELD_IPV4_UDP)
  686. mrqc |= FM10K_MRQC_UDP_IPV4;
  687. if (interface->flags & FM10K_FLAG_RSS_FIELD_IPV6_UDP)
  688. mrqc |= FM10K_MRQC_UDP_IPV6;
  689. fm10k_write_reg(hw, FM10K_MRQC(0), mrqc);
  690. /* configure default DGLORT mapping for RSS/DCB */
  691. dglort.inner_rss = 1;
  692. dglort.rss_l = fls(interface->ring_feature[RING_F_RSS].mask);
  693. dglort.pc_l = fls(interface->ring_feature[RING_F_QOS].mask);
  694. hw->mac.ops.configure_dglort_map(hw, &dglort);
  695. /* assign GLORT per queue for queue mapped testing */
  696. if (interface->glort_count > 64) {
  697. memset(&dglort, 0, sizeof(dglort));
  698. dglort.inner_rss = 1;
  699. dglort.glort = interface->glort + 64;
  700. dglort.idx = fm10k_dglort_pf_queue;
  701. dglort.queue_l = fls(interface->num_rx_queues - 1);
  702. hw->mac.ops.configure_dglort_map(hw, &dglort);
  703. }
  704. /* assign glort value for RSS/DCB specific to this interface */
  705. memset(&dglort, 0, sizeof(dglort));
  706. dglort.inner_rss = 1;
  707. dglort.glort = interface->glort;
  708. dglort.rss_l = fls(interface->ring_feature[RING_F_RSS].mask);
  709. dglort.pc_l = fls(interface->ring_feature[RING_F_QOS].mask);
  710. /* configure DGLORT mapping for RSS/DCB */
  711. dglort.idx = fm10k_dglort_pf_rss;
  712. if (interface->l2_accel)
  713. dglort.shared_l = fls(interface->l2_accel->size);
  714. hw->mac.ops.configure_dglort_map(hw, &dglort);
  715. }
  716. /**
  717. * fm10k_configure_rx - Configure Receive Unit after Reset
  718. * @interface: board private structure
  719. *
  720. * Configure the Rx unit of the MAC after a reset.
  721. **/
  722. static void fm10k_configure_rx(struct fm10k_intfc *interface)
  723. {
  724. int i;
  725. /* Configure SWPRI to PC map */
  726. fm10k_configure_swpri_map(interface);
  727. /* Configure RSS and DGLORT map */
  728. fm10k_configure_dglort(interface);
  729. /* Setup the HW Rx Head and Tail descriptor pointers */
  730. for (i = 0; i < interface->num_rx_queues; i++)
  731. fm10k_configure_rx_ring(interface, interface->rx_ring[i]);
  732. /* possible poll here to verify that Rx rings are now enabled */
  733. }
  734. static void fm10k_napi_enable_all(struct fm10k_intfc *interface)
  735. {
  736. struct fm10k_q_vector *q_vector;
  737. int q_idx;
  738. for (q_idx = 0; q_idx < interface->num_q_vectors; q_idx++) {
  739. q_vector = interface->q_vector[q_idx];
  740. napi_enable(&q_vector->napi);
  741. }
  742. }
  743. static irqreturn_t fm10k_msix_clean_rings(int __always_unused irq, void *data)
  744. {
  745. struct fm10k_q_vector *q_vector = data;
  746. if (q_vector->rx.count || q_vector->tx.count)
  747. napi_schedule_irqoff(&q_vector->napi);
  748. return IRQ_HANDLED;
  749. }
  750. static irqreturn_t fm10k_msix_mbx_vf(int __always_unused irq, void *data)
  751. {
  752. struct fm10k_intfc *interface = data;
  753. struct fm10k_hw *hw = &interface->hw;
  754. struct fm10k_mbx_info *mbx = &hw->mbx;
  755. /* re-enable mailbox interrupt and indicate 20us delay */
  756. fm10k_write_reg(hw, FM10K_VFITR(FM10K_MBX_VECTOR),
  757. (FM10K_MBX_INT_DELAY >> hw->mac.itr_scale) |
  758. FM10K_ITR_ENABLE);
  759. /* service upstream mailbox */
  760. if (fm10k_mbx_trylock(interface)) {
  761. mbx->ops.process(hw, mbx);
  762. fm10k_mbx_unlock(interface);
  763. }
  764. hw->mac.get_host_state = true;
  765. fm10k_service_event_schedule(interface);
  766. return IRQ_HANDLED;
  767. }
  768. #ifdef CONFIG_NET_POLL_CONTROLLER
  769. /**
  770. * fm10k_netpoll - A Polling 'interrupt' handler
  771. * @netdev: network interface device structure
  772. *
  773. * This is used by netconsole to send skbs without having to re-enable
  774. * interrupts. It's not called while the normal interrupt routine is executing.
  775. **/
  776. void fm10k_netpoll(struct net_device *netdev)
  777. {
  778. struct fm10k_intfc *interface = netdev_priv(netdev);
  779. int i;
  780. /* if interface is down do nothing */
  781. if (test_bit(__FM10K_DOWN, &interface->state))
  782. return;
  783. for (i = 0; i < interface->num_q_vectors; i++)
  784. fm10k_msix_clean_rings(0, interface->q_vector[i]);
  785. }
  786. #endif
  787. #define FM10K_ERR_MSG(type) case (type): error = #type; break
  788. static void fm10k_handle_fault(struct fm10k_intfc *interface, int type,
  789. struct fm10k_fault *fault)
  790. {
  791. struct pci_dev *pdev = interface->pdev;
  792. struct fm10k_hw *hw = &interface->hw;
  793. struct fm10k_iov_data *iov_data = interface->iov_data;
  794. char *error;
  795. switch (type) {
  796. case FM10K_PCA_FAULT:
  797. switch (fault->type) {
  798. default:
  799. error = "Unknown PCA error";
  800. break;
  801. FM10K_ERR_MSG(PCA_NO_FAULT);
  802. FM10K_ERR_MSG(PCA_UNMAPPED_ADDR);
  803. FM10K_ERR_MSG(PCA_BAD_QACCESS_PF);
  804. FM10K_ERR_MSG(PCA_BAD_QACCESS_VF);
  805. FM10K_ERR_MSG(PCA_MALICIOUS_REQ);
  806. FM10K_ERR_MSG(PCA_POISONED_TLP);
  807. FM10K_ERR_MSG(PCA_TLP_ABORT);
  808. }
  809. break;
  810. case FM10K_THI_FAULT:
  811. switch (fault->type) {
  812. default:
  813. error = "Unknown THI error";
  814. break;
  815. FM10K_ERR_MSG(THI_NO_FAULT);
  816. FM10K_ERR_MSG(THI_MAL_DIS_Q_FAULT);
  817. }
  818. break;
  819. case FM10K_FUM_FAULT:
  820. switch (fault->type) {
  821. default:
  822. error = "Unknown FUM error";
  823. break;
  824. FM10K_ERR_MSG(FUM_NO_FAULT);
  825. FM10K_ERR_MSG(FUM_UNMAPPED_ADDR);
  826. FM10K_ERR_MSG(FUM_BAD_VF_QACCESS);
  827. FM10K_ERR_MSG(FUM_ADD_DECODE_ERR);
  828. FM10K_ERR_MSG(FUM_RO_ERROR);
  829. FM10K_ERR_MSG(FUM_QPRC_CRC_ERROR);
  830. FM10K_ERR_MSG(FUM_CSR_TIMEOUT);
  831. FM10K_ERR_MSG(FUM_INVALID_TYPE);
  832. FM10K_ERR_MSG(FUM_INVALID_LENGTH);
  833. FM10K_ERR_MSG(FUM_INVALID_BE);
  834. FM10K_ERR_MSG(FUM_INVALID_ALIGN);
  835. }
  836. break;
  837. default:
  838. error = "Undocumented fault";
  839. break;
  840. }
  841. dev_warn(&pdev->dev,
  842. "%s Address: 0x%llx SpecInfo: 0x%x Func: %02x.%0x\n",
  843. error, fault->address, fault->specinfo,
  844. PCI_SLOT(fault->func), PCI_FUNC(fault->func));
  845. /* For VF faults, clear out the respective LPORT, reset the queue
  846. * resources, and then reconnect to the mailbox. This allows the
  847. * VF in question to resume behavior. For transient faults that are
  848. * the result of non-malicious behavior this will log the fault and
  849. * allow the VF to resume functionality. Obviously for malicious VFs
  850. * they will be able to attempt malicious behavior again. In this
  851. * case, the system administrator will need to step in and manually
  852. * remove or disable the VF in question.
  853. */
  854. if (fault->func && iov_data) {
  855. int vf = fault->func - 1;
  856. struct fm10k_vf_info *vf_info = &iov_data->vf_info[vf];
  857. hw->iov.ops.reset_lport(hw, vf_info);
  858. hw->iov.ops.reset_resources(hw, vf_info);
  859. /* reset_lport disables the VF, so re-enable it */
  860. hw->iov.ops.set_lport(hw, vf_info, vf,
  861. FM10K_VF_FLAG_MULTI_CAPABLE);
  862. /* reset_resources will disconnect from the mbx */
  863. vf_info->mbx.ops.connect(hw, &vf_info->mbx);
  864. }
  865. }
  866. static void fm10k_report_fault(struct fm10k_intfc *interface, u32 eicr)
  867. {
  868. struct fm10k_hw *hw = &interface->hw;
  869. struct fm10k_fault fault = { 0 };
  870. int type, err;
  871. for (eicr &= FM10K_EICR_FAULT_MASK, type = FM10K_PCA_FAULT;
  872. eicr;
  873. eicr >>= 1, type += FM10K_FAULT_SIZE) {
  874. /* only check if there is an error reported */
  875. if (!(eicr & 0x1))
  876. continue;
  877. /* retrieve fault info */
  878. err = hw->mac.ops.get_fault(hw, type, &fault);
  879. if (err) {
  880. dev_err(&interface->pdev->dev,
  881. "error reading fault\n");
  882. continue;
  883. }
  884. fm10k_handle_fault(interface, type, &fault);
  885. }
  886. }
  887. static void fm10k_reset_drop_on_empty(struct fm10k_intfc *interface, u32 eicr)
  888. {
  889. struct fm10k_hw *hw = &interface->hw;
  890. const u32 rxdctl = FM10K_RXDCTL_WRITE_BACK_MIN_DELAY;
  891. u32 maxholdq;
  892. int q;
  893. if (!(eicr & FM10K_EICR_MAXHOLDTIME))
  894. return;
  895. maxholdq = fm10k_read_reg(hw, FM10K_MAXHOLDQ(7));
  896. if (maxholdq)
  897. fm10k_write_reg(hw, FM10K_MAXHOLDQ(7), maxholdq);
  898. for (q = 255;;) {
  899. if (maxholdq & BIT(31)) {
  900. if (q < FM10K_MAX_QUEUES_PF) {
  901. interface->rx_overrun_pf++;
  902. fm10k_write_reg(hw, FM10K_RXDCTL(q), rxdctl);
  903. } else {
  904. interface->rx_overrun_vf++;
  905. }
  906. }
  907. maxholdq *= 2;
  908. if (!maxholdq)
  909. q &= ~(32 - 1);
  910. if (!q)
  911. break;
  912. if (q-- % 32)
  913. continue;
  914. maxholdq = fm10k_read_reg(hw, FM10K_MAXHOLDQ(q / 32));
  915. if (maxholdq)
  916. fm10k_write_reg(hw, FM10K_MAXHOLDQ(q / 32), maxholdq);
  917. }
  918. }
  919. static irqreturn_t fm10k_msix_mbx_pf(int __always_unused irq, void *data)
  920. {
  921. struct fm10k_intfc *interface = data;
  922. struct fm10k_hw *hw = &interface->hw;
  923. struct fm10k_mbx_info *mbx = &hw->mbx;
  924. u32 eicr;
  925. /* unmask any set bits related to this interrupt */
  926. eicr = fm10k_read_reg(hw, FM10K_EICR);
  927. fm10k_write_reg(hw, FM10K_EICR, eicr & (FM10K_EICR_MAILBOX |
  928. FM10K_EICR_SWITCHREADY |
  929. FM10K_EICR_SWITCHNOTREADY));
  930. /* report any faults found to the message log */
  931. fm10k_report_fault(interface, eicr);
  932. /* reset any queues disabled due to receiver overrun */
  933. fm10k_reset_drop_on_empty(interface, eicr);
  934. /* service mailboxes */
  935. if (fm10k_mbx_trylock(interface)) {
  936. mbx->ops.process(hw, mbx);
  937. /* handle VFLRE events */
  938. fm10k_iov_event(interface);
  939. fm10k_mbx_unlock(interface);
  940. }
  941. /* if switch toggled state we should reset GLORTs */
  942. if (eicr & FM10K_EICR_SWITCHNOTREADY) {
  943. /* force link down for at least 4 seconds */
  944. interface->link_down_event = jiffies + (4 * HZ);
  945. set_bit(__FM10K_LINK_DOWN, &interface->state);
  946. /* reset dglort_map back to no config */
  947. hw->mac.dglort_map = FM10K_DGLORTMAP_NONE;
  948. }
  949. /* we should validate host state after interrupt event */
  950. hw->mac.get_host_state = true;
  951. /* validate host state, and handle VF mailboxes in the service task */
  952. fm10k_service_event_schedule(interface);
  953. /* re-enable mailbox interrupt and indicate 20us delay */
  954. fm10k_write_reg(hw, FM10K_ITR(FM10K_MBX_VECTOR),
  955. (FM10K_MBX_INT_DELAY >> hw->mac.itr_scale) |
  956. FM10K_ITR_ENABLE);
  957. return IRQ_HANDLED;
  958. }
  959. void fm10k_mbx_free_irq(struct fm10k_intfc *interface)
  960. {
  961. struct fm10k_hw *hw = &interface->hw;
  962. struct msix_entry *entry;
  963. int itr_reg;
  964. /* no mailbox IRQ to free if MSI-X is not enabled */
  965. if (!interface->msix_entries)
  966. return;
  967. entry = &interface->msix_entries[FM10K_MBX_VECTOR];
  968. /* disconnect the mailbox */
  969. hw->mbx.ops.disconnect(hw, &hw->mbx);
  970. /* disable Mailbox cause */
  971. if (hw->mac.type == fm10k_mac_pf) {
  972. fm10k_write_reg(hw, FM10K_EIMR,
  973. FM10K_EIMR_DISABLE(PCA_FAULT) |
  974. FM10K_EIMR_DISABLE(FUM_FAULT) |
  975. FM10K_EIMR_DISABLE(MAILBOX) |
  976. FM10K_EIMR_DISABLE(SWITCHREADY) |
  977. FM10K_EIMR_DISABLE(SWITCHNOTREADY) |
  978. FM10K_EIMR_DISABLE(SRAMERROR) |
  979. FM10K_EIMR_DISABLE(VFLR) |
  980. FM10K_EIMR_DISABLE(MAXHOLDTIME));
  981. itr_reg = FM10K_ITR(FM10K_MBX_VECTOR);
  982. } else {
  983. itr_reg = FM10K_VFITR(FM10K_MBX_VECTOR);
  984. }
  985. fm10k_write_reg(hw, itr_reg, FM10K_ITR_MASK_SET);
  986. free_irq(entry->vector, interface);
  987. }
  988. static s32 fm10k_mbx_mac_addr(struct fm10k_hw *hw, u32 **results,
  989. struct fm10k_mbx_info *mbx)
  990. {
  991. bool vlan_override = hw->mac.vlan_override;
  992. u16 default_vid = hw->mac.default_vid;
  993. struct fm10k_intfc *interface;
  994. s32 err;
  995. err = fm10k_msg_mac_vlan_vf(hw, results, mbx);
  996. if (err)
  997. return err;
  998. interface = container_of(hw, struct fm10k_intfc, hw);
  999. /* MAC was changed so we need reset */
  1000. if (is_valid_ether_addr(hw->mac.perm_addr) &&
  1001. !ether_addr_equal(hw->mac.perm_addr, hw->mac.addr))
  1002. interface->flags |= FM10K_FLAG_RESET_REQUESTED;
  1003. /* VLAN override was changed, or default VLAN changed */
  1004. if ((vlan_override != hw->mac.vlan_override) ||
  1005. (default_vid != hw->mac.default_vid))
  1006. interface->flags |= FM10K_FLAG_RESET_REQUESTED;
  1007. return 0;
  1008. }
  1009. /* generic error handler for mailbox issues */
  1010. static s32 fm10k_mbx_error(struct fm10k_hw *hw, u32 **results,
  1011. struct fm10k_mbx_info __always_unused *mbx)
  1012. {
  1013. struct fm10k_intfc *interface;
  1014. struct pci_dev *pdev;
  1015. interface = container_of(hw, struct fm10k_intfc, hw);
  1016. pdev = interface->pdev;
  1017. dev_err(&pdev->dev, "Unknown message ID %u\n",
  1018. **results & FM10K_TLV_ID_MASK);
  1019. return 0;
  1020. }
  1021. static const struct fm10k_msg_data vf_mbx_data[] = {
  1022. FM10K_TLV_MSG_TEST_HANDLER(fm10k_tlv_msg_test),
  1023. FM10K_VF_MSG_MAC_VLAN_HANDLER(fm10k_mbx_mac_addr),
  1024. FM10K_VF_MSG_LPORT_STATE_HANDLER(fm10k_msg_lport_state_vf),
  1025. FM10K_TLV_MSG_ERROR_HANDLER(fm10k_mbx_error),
  1026. };
  1027. static int fm10k_mbx_request_irq_vf(struct fm10k_intfc *interface)
  1028. {
  1029. struct msix_entry *entry = &interface->msix_entries[FM10K_MBX_VECTOR];
  1030. struct net_device *dev = interface->netdev;
  1031. struct fm10k_hw *hw = &interface->hw;
  1032. int err;
  1033. /* Use timer0 for interrupt moderation on the mailbox */
  1034. u32 itr = entry->entry | FM10K_INT_MAP_TIMER0;
  1035. /* register mailbox handlers */
  1036. err = hw->mbx.ops.register_handlers(&hw->mbx, vf_mbx_data);
  1037. if (err)
  1038. return err;
  1039. /* request the IRQ */
  1040. err = request_irq(entry->vector, fm10k_msix_mbx_vf, 0,
  1041. dev->name, interface);
  1042. if (err) {
  1043. netif_err(interface, probe, dev,
  1044. "request_irq for msix_mbx failed: %d\n", err);
  1045. return err;
  1046. }
  1047. /* map all of the interrupt sources */
  1048. fm10k_write_reg(hw, FM10K_VFINT_MAP, itr);
  1049. /* enable interrupt */
  1050. fm10k_write_reg(hw, FM10K_VFITR(entry->entry), FM10K_ITR_ENABLE);
  1051. return 0;
  1052. }
  1053. static s32 fm10k_lport_map(struct fm10k_hw *hw, u32 **results,
  1054. struct fm10k_mbx_info *mbx)
  1055. {
  1056. struct fm10k_intfc *interface;
  1057. u32 dglort_map = hw->mac.dglort_map;
  1058. s32 err;
  1059. interface = container_of(hw, struct fm10k_intfc, hw);
  1060. err = fm10k_msg_err_pf(hw, results, mbx);
  1061. if (!err && hw->swapi.status) {
  1062. /* force link down for a reasonable delay */
  1063. interface->link_down_event = jiffies + (2 * HZ);
  1064. set_bit(__FM10K_LINK_DOWN, &interface->state);
  1065. /* reset dglort_map back to no config */
  1066. hw->mac.dglort_map = FM10K_DGLORTMAP_NONE;
  1067. fm10k_service_event_schedule(interface);
  1068. /* prevent overloading kernel message buffer */
  1069. if (interface->lport_map_failed)
  1070. return 0;
  1071. interface->lport_map_failed = true;
  1072. if (hw->swapi.status == FM10K_MSG_ERR_PEP_NOT_SCHEDULED)
  1073. dev_warn(&interface->pdev->dev,
  1074. "cannot obtain link because the host interface is configured for a PCIe host interface bandwidth of zero\n");
  1075. dev_warn(&interface->pdev->dev,
  1076. "request logical port map failed: %d\n",
  1077. hw->swapi.status);
  1078. return 0;
  1079. }
  1080. err = fm10k_msg_lport_map_pf(hw, results, mbx);
  1081. if (err)
  1082. return err;
  1083. interface->lport_map_failed = false;
  1084. /* we need to reset if port count was just updated */
  1085. if (dglort_map != hw->mac.dglort_map)
  1086. interface->flags |= FM10K_FLAG_RESET_REQUESTED;
  1087. return 0;
  1088. }
  1089. static s32 fm10k_update_pvid(struct fm10k_hw *hw, u32 **results,
  1090. struct fm10k_mbx_info __always_unused *mbx)
  1091. {
  1092. struct fm10k_intfc *interface;
  1093. u16 glort, pvid;
  1094. u32 pvid_update;
  1095. s32 err;
  1096. err = fm10k_tlv_attr_get_u32(results[FM10K_PF_ATTR_ID_UPDATE_PVID],
  1097. &pvid_update);
  1098. if (err)
  1099. return err;
  1100. /* extract values from the pvid update */
  1101. glort = FM10K_MSG_HDR_FIELD_GET(pvid_update, UPDATE_PVID_GLORT);
  1102. pvid = FM10K_MSG_HDR_FIELD_GET(pvid_update, UPDATE_PVID_PVID);
  1103. /* if glort is not valid return error */
  1104. if (!fm10k_glort_valid_pf(hw, glort))
  1105. return FM10K_ERR_PARAM;
  1106. /* verify VLAN ID is valid */
  1107. if (pvid >= FM10K_VLAN_TABLE_VID_MAX)
  1108. return FM10K_ERR_PARAM;
  1109. interface = container_of(hw, struct fm10k_intfc, hw);
  1110. /* check to see if this belongs to one of the VFs */
  1111. err = fm10k_iov_update_pvid(interface, glort, pvid);
  1112. if (!err)
  1113. return 0;
  1114. /* we need to reset if default VLAN was just updated */
  1115. if (pvid != hw->mac.default_vid)
  1116. interface->flags |= FM10K_FLAG_RESET_REQUESTED;
  1117. hw->mac.default_vid = pvid;
  1118. return 0;
  1119. }
  1120. static const struct fm10k_msg_data pf_mbx_data[] = {
  1121. FM10K_PF_MSG_ERR_HANDLER(XCAST_MODES, fm10k_msg_err_pf),
  1122. FM10K_PF_MSG_ERR_HANDLER(UPDATE_MAC_FWD_RULE, fm10k_msg_err_pf),
  1123. FM10K_PF_MSG_LPORT_MAP_HANDLER(fm10k_lport_map),
  1124. FM10K_PF_MSG_ERR_HANDLER(LPORT_CREATE, fm10k_msg_err_pf),
  1125. FM10K_PF_MSG_ERR_HANDLER(LPORT_DELETE, fm10k_msg_err_pf),
  1126. FM10K_PF_MSG_UPDATE_PVID_HANDLER(fm10k_update_pvid),
  1127. FM10K_TLV_MSG_ERROR_HANDLER(fm10k_mbx_error),
  1128. };
  1129. static int fm10k_mbx_request_irq_pf(struct fm10k_intfc *interface)
  1130. {
  1131. struct msix_entry *entry = &interface->msix_entries[FM10K_MBX_VECTOR];
  1132. struct net_device *dev = interface->netdev;
  1133. struct fm10k_hw *hw = &interface->hw;
  1134. int err;
  1135. /* Use timer0 for interrupt moderation on the mailbox */
  1136. u32 mbx_itr = entry->entry | FM10K_INT_MAP_TIMER0;
  1137. u32 other_itr = entry->entry | FM10K_INT_MAP_IMMEDIATE;
  1138. /* register mailbox handlers */
  1139. err = hw->mbx.ops.register_handlers(&hw->mbx, pf_mbx_data);
  1140. if (err)
  1141. return err;
  1142. /* request the IRQ */
  1143. err = request_irq(entry->vector, fm10k_msix_mbx_pf, 0,
  1144. dev->name, interface);
  1145. if (err) {
  1146. netif_err(interface, probe, dev,
  1147. "request_irq for msix_mbx failed: %d\n", err);
  1148. return err;
  1149. }
  1150. /* Enable interrupts w/ no moderation for "other" interrupts */
  1151. fm10k_write_reg(hw, FM10K_INT_MAP(fm10k_int_pcie_fault), other_itr);
  1152. fm10k_write_reg(hw, FM10K_INT_MAP(fm10k_int_switch_up_down), other_itr);
  1153. fm10k_write_reg(hw, FM10K_INT_MAP(fm10k_int_sram), other_itr);
  1154. fm10k_write_reg(hw, FM10K_INT_MAP(fm10k_int_max_hold_time), other_itr);
  1155. fm10k_write_reg(hw, FM10K_INT_MAP(fm10k_int_vflr), other_itr);
  1156. /* Enable interrupts w/ moderation for mailbox */
  1157. fm10k_write_reg(hw, FM10K_INT_MAP(fm10k_int_mailbox), mbx_itr);
  1158. /* Enable individual interrupt causes */
  1159. fm10k_write_reg(hw, FM10K_EIMR, FM10K_EIMR_ENABLE(PCA_FAULT) |
  1160. FM10K_EIMR_ENABLE(FUM_FAULT) |
  1161. FM10K_EIMR_ENABLE(MAILBOX) |
  1162. FM10K_EIMR_ENABLE(SWITCHREADY) |
  1163. FM10K_EIMR_ENABLE(SWITCHNOTREADY) |
  1164. FM10K_EIMR_ENABLE(SRAMERROR) |
  1165. FM10K_EIMR_ENABLE(VFLR) |
  1166. FM10K_EIMR_ENABLE(MAXHOLDTIME));
  1167. /* enable interrupt */
  1168. fm10k_write_reg(hw, FM10K_ITR(entry->entry), FM10K_ITR_ENABLE);
  1169. return 0;
  1170. }
  1171. int fm10k_mbx_request_irq(struct fm10k_intfc *interface)
  1172. {
  1173. struct fm10k_hw *hw = &interface->hw;
  1174. int err;
  1175. /* enable Mailbox cause */
  1176. if (hw->mac.type == fm10k_mac_pf)
  1177. err = fm10k_mbx_request_irq_pf(interface);
  1178. else
  1179. err = fm10k_mbx_request_irq_vf(interface);
  1180. if (err)
  1181. return err;
  1182. /* connect mailbox */
  1183. err = hw->mbx.ops.connect(hw, &hw->mbx);
  1184. /* if the mailbox failed to connect, then free IRQ */
  1185. if (err)
  1186. fm10k_mbx_free_irq(interface);
  1187. return err;
  1188. }
  1189. /**
  1190. * fm10k_qv_free_irq - release interrupts associated with queue vectors
  1191. * @interface: board private structure
  1192. *
  1193. * Release all interrupts associated with this interface
  1194. **/
  1195. void fm10k_qv_free_irq(struct fm10k_intfc *interface)
  1196. {
  1197. int vector = interface->num_q_vectors;
  1198. struct fm10k_hw *hw = &interface->hw;
  1199. struct msix_entry *entry;
  1200. entry = &interface->msix_entries[NON_Q_VECTORS(hw) + vector];
  1201. while (vector) {
  1202. struct fm10k_q_vector *q_vector;
  1203. vector--;
  1204. entry--;
  1205. q_vector = interface->q_vector[vector];
  1206. if (!q_vector->tx.count && !q_vector->rx.count)
  1207. continue;
  1208. /* clear the affinity_mask in the IRQ descriptor */
  1209. irq_set_affinity_hint(entry->vector, NULL);
  1210. /* disable interrupts */
  1211. writel(FM10K_ITR_MASK_SET, q_vector->itr);
  1212. free_irq(entry->vector, q_vector);
  1213. }
  1214. }
  1215. /**
  1216. * fm10k_qv_request_irq - initialize interrupts for queue vectors
  1217. * @interface: board private structure
  1218. *
  1219. * Attempts to configure interrupts using the best available
  1220. * capabilities of the hardware and kernel.
  1221. **/
  1222. int fm10k_qv_request_irq(struct fm10k_intfc *interface)
  1223. {
  1224. struct net_device *dev = interface->netdev;
  1225. struct fm10k_hw *hw = &interface->hw;
  1226. struct msix_entry *entry;
  1227. int ri = 0, ti = 0;
  1228. int vector, err;
  1229. entry = &interface->msix_entries[NON_Q_VECTORS(hw)];
  1230. for (vector = 0; vector < interface->num_q_vectors; vector++) {
  1231. struct fm10k_q_vector *q_vector = interface->q_vector[vector];
  1232. /* name the vector */
  1233. if (q_vector->tx.count && q_vector->rx.count) {
  1234. snprintf(q_vector->name, sizeof(q_vector->name) - 1,
  1235. "%s-TxRx-%d", dev->name, ri++);
  1236. ti++;
  1237. } else if (q_vector->rx.count) {
  1238. snprintf(q_vector->name, sizeof(q_vector->name) - 1,
  1239. "%s-rx-%d", dev->name, ri++);
  1240. } else if (q_vector->tx.count) {
  1241. snprintf(q_vector->name, sizeof(q_vector->name) - 1,
  1242. "%s-tx-%d", dev->name, ti++);
  1243. } else {
  1244. /* skip this unused q_vector */
  1245. continue;
  1246. }
  1247. /* Assign ITR register to q_vector */
  1248. q_vector->itr = (hw->mac.type == fm10k_mac_pf) ?
  1249. &interface->uc_addr[FM10K_ITR(entry->entry)] :
  1250. &interface->uc_addr[FM10K_VFITR(entry->entry)];
  1251. /* request the IRQ */
  1252. err = request_irq(entry->vector, &fm10k_msix_clean_rings, 0,
  1253. q_vector->name, q_vector);
  1254. if (err) {
  1255. netif_err(interface, probe, dev,
  1256. "request_irq failed for MSIX interrupt Error: %d\n",
  1257. err);
  1258. goto err_out;
  1259. }
  1260. /* assign the mask for this irq */
  1261. irq_set_affinity_hint(entry->vector, &q_vector->affinity_mask);
  1262. /* Enable q_vector */
  1263. writel(FM10K_ITR_ENABLE, q_vector->itr);
  1264. entry++;
  1265. }
  1266. return 0;
  1267. err_out:
  1268. /* wind through the ring freeing all entries and vectors */
  1269. while (vector) {
  1270. struct fm10k_q_vector *q_vector;
  1271. entry--;
  1272. vector--;
  1273. q_vector = interface->q_vector[vector];
  1274. if (!q_vector->tx.count && !q_vector->rx.count)
  1275. continue;
  1276. /* clear the affinity_mask in the IRQ descriptor */
  1277. irq_set_affinity_hint(entry->vector, NULL);
  1278. /* disable interrupts */
  1279. writel(FM10K_ITR_MASK_SET, q_vector->itr);
  1280. free_irq(entry->vector, q_vector);
  1281. }
  1282. return err;
  1283. }
  1284. void fm10k_up(struct fm10k_intfc *interface)
  1285. {
  1286. struct fm10k_hw *hw = &interface->hw;
  1287. /* Enable Tx/Rx DMA */
  1288. hw->mac.ops.start_hw(hw);
  1289. /* configure Tx descriptor rings */
  1290. fm10k_configure_tx(interface);
  1291. /* configure Rx descriptor rings */
  1292. fm10k_configure_rx(interface);
  1293. /* configure interrupts */
  1294. hw->mac.ops.update_int_moderator(hw);
  1295. /* enable statistics capture again */
  1296. clear_bit(__FM10K_UPDATING_STATS, &interface->state);
  1297. /* clear down bit to indicate we are ready to go */
  1298. clear_bit(__FM10K_DOWN, &interface->state);
  1299. /* enable polling cleanups */
  1300. fm10k_napi_enable_all(interface);
  1301. /* re-establish Rx filters */
  1302. fm10k_restore_rx_state(interface);
  1303. /* enable transmits */
  1304. netif_tx_start_all_queues(interface->netdev);
  1305. /* kick off the service timer now */
  1306. hw->mac.get_host_state = true;
  1307. mod_timer(&interface->service_timer, jiffies);
  1308. }
  1309. static void fm10k_napi_disable_all(struct fm10k_intfc *interface)
  1310. {
  1311. struct fm10k_q_vector *q_vector;
  1312. int q_idx;
  1313. for (q_idx = 0; q_idx < interface->num_q_vectors; q_idx++) {
  1314. q_vector = interface->q_vector[q_idx];
  1315. napi_disable(&q_vector->napi);
  1316. }
  1317. }
  1318. void fm10k_down(struct fm10k_intfc *interface)
  1319. {
  1320. struct net_device *netdev = interface->netdev;
  1321. struct fm10k_hw *hw = &interface->hw;
  1322. int err, i = 0, count = 0;
  1323. /* signal that we are down to the interrupt handler and service task */
  1324. if (test_and_set_bit(__FM10K_DOWN, &interface->state))
  1325. return;
  1326. /* call carrier off first to avoid false dev_watchdog timeouts */
  1327. netif_carrier_off(netdev);
  1328. /* disable transmits */
  1329. netif_tx_stop_all_queues(netdev);
  1330. netif_tx_disable(netdev);
  1331. /* reset Rx filters */
  1332. fm10k_reset_rx_state(interface);
  1333. /* disable polling routines */
  1334. fm10k_napi_disable_all(interface);
  1335. /* capture stats one last time before stopping interface */
  1336. fm10k_update_stats(interface);
  1337. /* prevent updating statistics while we're down */
  1338. while (test_and_set_bit(__FM10K_UPDATING_STATS, &interface->state))
  1339. usleep_range(1000, 2000);
  1340. /* skip waiting for TX DMA if we lost PCIe link */
  1341. if (FM10K_REMOVED(hw->hw_addr))
  1342. goto skip_tx_dma_drain;
  1343. /* In some rare circumstances it can take a while for Tx queues to
  1344. * quiesce and be fully disabled. Attempt to .stop_hw() first, and
  1345. * then if we get ERR_REQUESTS_PENDING, go ahead and wait in a loop
  1346. * until the Tx queues have emptied, or until a number of retries. If
  1347. * we fail to clear within the retry loop, we will issue a warning
  1348. * indicating that Tx DMA is probably hung. Note this means we call
  1349. * .stop_hw() twice but this shouldn't cause any problems.
  1350. */
  1351. err = hw->mac.ops.stop_hw(hw);
  1352. if (err != FM10K_ERR_REQUESTS_PENDING)
  1353. goto skip_tx_dma_drain;
  1354. #define TX_DMA_DRAIN_RETRIES 25
  1355. for (count = 0; count < TX_DMA_DRAIN_RETRIES; count++) {
  1356. usleep_range(10000, 20000);
  1357. /* start checking at the last ring to have pending Tx */
  1358. for (; i < interface->num_tx_queues; i++)
  1359. if (fm10k_get_tx_pending(interface->tx_ring[i]))
  1360. break;
  1361. /* if all the queues are drained, we can break now */
  1362. if (i == interface->num_tx_queues)
  1363. break;
  1364. }
  1365. if (count >= TX_DMA_DRAIN_RETRIES)
  1366. dev_err(&interface->pdev->dev,
  1367. "Tx queues failed to drain after %d tries. Tx DMA is probably hung.\n",
  1368. count);
  1369. skip_tx_dma_drain:
  1370. /* Disable DMA engine for Tx/Rx */
  1371. err = hw->mac.ops.stop_hw(hw);
  1372. if (err == FM10K_ERR_REQUESTS_PENDING)
  1373. dev_err(&interface->pdev->dev,
  1374. "due to pending requests hw was not shut down gracefully\n");
  1375. else if (err)
  1376. dev_err(&interface->pdev->dev, "stop_hw failed: %d\n", err);
  1377. /* free any buffers still on the rings */
  1378. fm10k_clean_all_tx_rings(interface);
  1379. fm10k_clean_all_rx_rings(interface);
  1380. }
  1381. /**
  1382. * fm10k_sw_init - Initialize general software structures
  1383. * @interface: host interface private structure to initialize
  1384. *
  1385. * fm10k_sw_init initializes the interface private data structure.
  1386. * Fields are initialized based on PCI device information and
  1387. * OS network device settings (MTU size).
  1388. **/
  1389. static int fm10k_sw_init(struct fm10k_intfc *interface,
  1390. const struct pci_device_id *ent)
  1391. {
  1392. const struct fm10k_info *fi = fm10k_info_tbl[ent->driver_data];
  1393. struct fm10k_hw *hw = &interface->hw;
  1394. struct pci_dev *pdev = interface->pdev;
  1395. struct net_device *netdev = interface->netdev;
  1396. u32 rss_key[FM10K_RSSRK_SIZE];
  1397. unsigned int rss;
  1398. int err;
  1399. /* initialize back pointer */
  1400. hw->back = interface;
  1401. hw->hw_addr = interface->uc_addr;
  1402. /* PCI config space info */
  1403. hw->vendor_id = pdev->vendor;
  1404. hw->device_id = pdev->device;
  1405. hw->revision_id = pdev->revision;
  1406. hw->subsystem_vendor_id = pdev->subsystem_vendor;
  1407. hw->subsystem_device_id = pdev->subsystem_device;
  1408. /* Setup hw api */
  1409. memcpy(&hw->mac.ops, fi->mac_ops, sizeof(hw->mac.ops));
  1410. hw->mac.type = fi->mac;
  1411. /* Setup IOV handlers */
  1412. if (fi->iov_ops)
  1413. memcpy(&hw->iov.ops, fi->iov_ops, sizeof(hw->iov.ops));
  1414. /* Set common capability flags and settings */
  1415. rss = min_t(int, FM10K_MAX_RSS_INDICES, num_online_cpus());
  1416. interface->ring_feature[RING_F_RSS].limit = rss;
  1417. fi->get_invariants(hw);
  1418. /* pick up the PCIe bus settings for reporting later */
  1419. if (hw->mac.ops.get_bus_info)
  1420. hw->mac.ops.get_bus_info(hw);
  1421. /* limit the usable DMA range */
  1422. if (hw->mac.ops.set_dma_mask)
  1423. hw->mac.ops.set_dma_mask(hw, dma_get_mask(&pdev->dev));
  1424. /* update netdev with DMA restrictions */
  1425. if (dma_get_mask(&pdev->dev) > DMA_BIT_MASK(32)) {
  1426. netdev->features |= NETIF_F_HIGHDMA;
  1427. netdev->vlan_features |= NETIF_F_HIGHDMA;
  1428. }
  1429. /* delay any future reset requests */
  1430. interface->last_reset = jiffies + (10 * HZ);
  1431. /* reset and initialize the hardware so it is in a known state */
  1432. err = hw->mac.ops.reset_hw(hw);
  1433. if (err) {
  1434. dev_err(&pdev->dev, "reset_hw failed: %d\n", err);
  1435. return err;
  1436. }
  1437. err = hw->mac.ops.init_hw(hw);
  1438. if (err) {
  1439. dev_err(&pdev->dev, "init_hw failed: %d\n", err);
  1440. return err;
  1441. }
  1442. /* initialize hardware statistics */
  1443. hw->mac.ops.update_hw_stats(hw, &interface->stats);
  1444. /* Set upper limit on IOV VFs that can be allocated */
  1445. pci_sriov_set_totalvfs(pdev, hw->iov.total_vfs);
  1446. /* Start with random Ethernet address */
  1447. eth_random_addr(hw->mac.addr);
  1448. /* Initialize MAC address from hardware */
  1449. err = hw->mac.ops.read_mac_addr(hw);
  1450. if (err) {
  1451. dev_warn(&pdev->dev,
  1452. "Failed to obtain MAC address defaulting to random\n");
  1453. /* tag address assignment as random */
  1454. netdev->addr_assign_type |= NET_ADDR_RANDOM;
  1455. }
  1456. ether_addr_copy(netdev->dev_addr, hw->mac.addr);
  1457. ether_addr_copy(netdev->perm_addr, hw->mac.addr);
  1458. if (!is_valid_ether_addr(netdev->perm_addr)) {
  1459. dev_err(&pdev->dev, "Invalid MAC Address\n");
  1460. return -EIO;
  1461. }
  1462. /* initialize DCBNL interface */
  1463. fm10k_dcbnl_set_ops(netdev);
  1464. /* set default ring sizes */
  1465. interface->tx_ring_count = FM10K_DEFAULT_TXD;
  1466. interface->rx_ring_count = FM10K_DEFAULT_RXD;
  1467. /* set default interrupt moderation */
  1468. interface->tx_itr = FM10K_TX_ITR_DEFAULT;
  1469. interface->rx_itr = FM10K_ITR_ADAPTIVE | FM10K_RX_ITR_DEFAULT;
  1470. /* initialize vxlan_port list */
  1471. INIT_LIST_HEAD(&interface->vxlan_port);
  1472. netdev_rss_key_fill(rss_key, sizeof(rss_key));
  1473. memcpy(interface->rssrk, rss_key, sizeof(rss_key));
  1474. /* Start off interface as being down */
  1475. set_bit(__FM10K_DOWN, &interface->state);
  1476. set_bit(__FM10K_UPDATING_STATS, &interface->state);
  1477. return 0;
  1478. }
  1479. static void fm10k_slot_warn(struct fm10k_intfc *interface)
  1480. {
  1481. enum pcie_link_width width = PCIE_LNK_WIDTH_UNKNOWN;
  1482. enum pci_bus_speed speed = PCI_SPEED_UNKNOWN;
  1483. struct fm10k_hw *hw = &interface->hw;
  1484. int max_gts = 0, expected_gts = 0;
  1485. if (pcie_get_minimum_link(interface->pdev, &speed, &width) ||
  1486. speed == PCI_SPEED_UNKNOWN || width == PCIE_LNK_WIDTH_UNKNOWN) {
  1487. dev_warn(&interface->pdev->dev,
  1488. "Unable to determine PCI Express bandwidth.\n");
  1489. return;
  1490. }
  1491. switch (speed) {
  1492. case PCIE_SPEED_2_5GT:
  1493. /* 8b/10b encoding reduces max throughput by 20% */
  1494. max_gts = 2 * width;
  1495. break;
  1496. case PCIE_SPEED_5_0GT:
  1497. /* 8b/10b encoding reduces max throughput by 20% */
  1498. max_gts = 4 * width;
  1499. break;
  1500. case PCIE_SPEED_8_0GT:
  1501. /* 128b/130b encoding has less than 2% impact on throughput */
  1502. max_gts = 8 * width;
  1503. break;
  1504. default:
  1505. dev_warn(&interface->pdev->dev,
  1506. "Unable to determine PCI Express bandwidth.\n");
  1507. return;
  1508. }
  1509. dev_info(&interface->pdev->dev,
  1510. "PCI Express bandwidth of %dGT/s available\n",
  1511. max_gts);
  1512. dev_info(&interface->pdev->dev,
  1513. "(Speed:%s, Width: x%d, Encoding Loss:%s, Payload:%s)\n",
  1514. (speed == PCIE_SPEED_8_0GT ? "8.0GT/s" :
  1515. speed == PCIE_SPEED_5_0GT ? "5.0GT/s" :
  1516. speed == PCIE_SPEED_2_5GT ? "2.5GT/s" :
  1517. "Unknown"),
  1518. hw->bus.width,
  1519. (speed == PCIE_SPEED_2_5GT ? "20%" :
  1520. speed == PCIE_SPEED_5_0GT ? "20%" :
  1521. speed == PCIE_SPEED_8_0GT ? "<2%" :
  1522. "Unknown"),
  1523. (hw->bus.payload == fm10k_bus_payload_128 ? "128B" :
  1524. hw->bus.payload == fm10k_bus_payload_256 ? "256B" :
  1525. hw->bus.payload == fm10k_bus_payload_512 ? "512B" :
  1526. "Unknown"));
  1527. switch (hw->bus_caps.speed) {
  1528. case fm10k_bus_speed_2500:
  1529. /* 8b/10b encoding reduces max throughput by 20% */
  1530. expected_gts = 2 * hw->bus_caps.width;
  1531. break;
  1532. case fm10k_bus_speed_5000:
  1533. /* 8b/10b encoding reduces max throughput by 20% */
  1534. expected_gts = 4 * hw->bus_caps.width;
  1535. break;
  1536. case fm10k_bus_speed_8000:
  1537. /* 128b/130b encoding has less than 2% impact on throughput */
  1538. expected_gts = 8 * hw->bus_caps.width;
  1539. break;
  1540. default:
  1541. dev_warn(&interface->pdev->dev,
  1542. "Unable to determine expected PCI Express bandwidth.\n");
  1543. return;
  1544. }
  1545. if (max_gts >= expected_gts)
  1546. return;
  1547. dev_warn(&interface->pdev->dev,
  1548. "This device requires %dGT/s of bandwidth for optimal performance.\n",
  1549. expected_gts);
  1550. dev_warn(&interface->pdev->dev,
  1551. "A %sslot with x%d lanes is suggested.\n",
  1552. (hw->bus_caps.speed == fm10k_bus_speed_2500 ? "2.5GT/s " :
  1553. hw->bus_caps.speed == fm10k_bus_speed_5000 ? "5.0GT/s " :
  1554. hw->bus_caps.speed == fm10k_bus_speed_8000 ? "8.0GT/s " : ""),
  1555. hw->bus_caps.width);
  1556. }
  1557. /**
  1558. * fm10k_probe - Device Initialization Routine
  1559. * @pdev: PCI device information struct
  1560. * @ent: entry in fm10k_pci_tbl
  1561. *
  1562. * Returns 0 on success, negative on failure
  1563. *
  1564. * fm10k_probe initializes an interface identified by a pci_dev structure.
  1565. * The OS initialization, configuring of the interface private structure,
  1566. * and a hardware reset occur.
  1567. **/
  1568. static int fm10k_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
  1569. {
  1570. struct net_device *netdev;
  1571. struct fm10k_intfc *interface;
  1572. int err;
  1573. err = pci_enable_device_mem(pdev);
  1574. if (err)
  1575. return err;
  1576. err = dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(48));
  1577. if (err)
  1578. err = dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(32));
  1579. if (err) {
  1580. dev_err(&pdev->dev,
  1581. "DMA configuration failed: %d\n", err);
  1582. goto err_dma;
  1583. }
  1584. err = pci_request_selected_regions(pdev,
  1585. pci_select_bars(pdev,
  1586. IORESOURCE_MEM),
  1587. fm10k_driver_name);
  1588. if (err) {
  1589. dev_err(&pdev->dev,
  1590. "pci_request_selected_regions failed: %d\n", err);
  1591. goto err_pci_reg;
  1592. }
  1593. pci_enable_pcie_error_reporting(pdev);
  1594. pci_set_master(pdev);
  1595. pci_save_state(pdev);
  1596. netdev = fm10k_alloc_netdev(fm10k_info_tbl[ent->driver_data]);
  1597. if (!netdev) {
  1598. err = -ENOMEM;
  1599. goto err_alloc_netdev;
  1600. }
  1601. SET_NETDEV_DEV(netdev, &pdev->dev);
  1602. interface = netdev_priv(netdev);
  1603. pci_set_drvdata(pdev, interface);
  1604. interface->netdev = netdev;
  1605. interface->pdev = pdev;
  1606. interface->uc_addr = ioremap(pci_resource_start(pdev, 0),
  1607. FM10K_UC_ADDR_SIZE);
  1608. if (!interface->uc_addr) {
  1609. err = -EIO;
  1610. goto err_ioremap;
  1611. }
  1612. err = fm10k_sw_init(interface, ent);
  1613. if (err)
  1614. goto err_sw_init;
  1615. /* enable debugfs support */
  1616. fm10k_dbg_intfc_init(interface);
  1617. err = fm10k_init_queueing_scheme(interface);
  1618. if (err)
  1619. goto err_sw_init;
  1620. /* the mbx interrupt might attempt to schedule the service task, so we
  1621. * must ensure it is disabled since we haven't yet requested the timer
  1622. * or work item.
  1623. */
  1624. set_bit(__FM10K_SERVICE_DISABLE, &interface->state);
  1625. err = fm10k_mbx_request_irq(interface);
  1626. if (err)
  1627. goto err_mbx_interrupt;
  1628. /* final check of hardware state before registering the interface */
  1629. err = fm10k_hw_ready(interface);
  1630. if (err)
  1631. goto err_register;
  1632. err = register_netdev(netdev);
  1633. if (err)
  1634. goto err_register;
  1635. /* carrier off reporting is important to ethtool even BEFORE open */
  1636. netif_carrier_off(netdev);
  1637. /* stop all the transmit queues from transmitting until link is up */
  1638. netif_tx_stop_all_queues(netdev);
  1639. /* Initialize service timer and service task late in order to avoid
  1640. * cleanup issues.
  1641. */
  1642. setup_timer(&interface->service_timer, &fm10k_service_timer,
  1643. (unsigned long)interface);
  1644. INIT_WORK(&interface->service_task, fm10k_service_task);
  1645. /* kick off service timer now, even when interface is down */
  1646. mod_timer(&interface->service_timer, (HZ * 2) + jiffies);
  1647. /* print warning for non-optimal configurations */
  1648. fm10k_slot_warn(interface);
  1649. /* report MAC address for logging */
  1650. dev_info(&pdev->dev, "%pM\n", netdev->dev_addr);
  1651. /* enable SR-IOV after registering netdev to enforce PF/VF ordering */
  1652. fm10k_iov_configure(pdev, 0);
  1653. /* clear the service task disable bit to allow service task to start */
  1654. clear_bit(__FM10K_SERVICE_DISABLE, &interface->state);
  1655. return 0;
  1656. err_register:
  1657. fm10k_mbx_free_irq(interface);
  1658. err_mbx_interrupt:
  1659. fm10k_clear_queueing_scheme(interface);
  1660. err_sw_init:
  1661. if (interface->sw_addr)
  1662. iounmap(interface->sw_addr);
  1663. iounmap(interface->uc_addr);
  1664. err_ioremap:
  1665. free_netdev(netdev);
  1666. err_alloc_netdev:
  1667. pci_release_selected_regions(pdev,
  1668. pci_select_bars(pdev, IORESOURCE_MEM));
  1669. err_pci_reg:
  1670. err_dma:
  1671. pci_disable_device(pdev);
  1672. return err;
  1673. }
  1674. /**
  1675. * fm10k_remove - Device Removal Routine
  1676. * @pdev: PCI device information struct
  1677. *
  1678. * fm10k_remove is called by the PCI subsystem to alert the driver
  1679. * that it should release a PCI device. The could be caused by a
  1680. * Hot-Plug event, or because the driver is going to be removed from
  1681. * memory.
  1682. **/
  1683. static void fm10k_remove(struct pci_dev *pdev)
  1684. {
  1685. struct fm10k_intfc *interface = pci_get_drvdata(pdev);
  1686. struct net_device *netdev = interface->netdev;
  1687. del_timer_sync(&interface->service_timer);
  1688. set_bit(__FM10K_SERVICE_DISABLE, &interface->state);
  1689. cancel_work_sync(&interface->service_task);
  1690. /* free netdev, this may bounce the interrupts due to setup_tc */
  1691. if (netdev->reg_state == NETREG_REGISTERED)
  1692. unregister_netdev(netdev);
  1693. /* release VFs */
  1694. fm10k_iov_disable(pdev);
  1695. /* disable mailbox interrupt */
  1696. fm10k_mbx_free_irq(interface);
  1697. /* free interrupts */
  1698. fm10k_clear_queueing_scheme(interface);
  1699. /* remove any debugfs interfaces */
  1700. fm10k_dbg_intfc_exit(interface);
  1701. if (interface->sw_addr)
  1702. iounmap(interface->sw_addr);
  1703. iounmap(interface->uc_addr);
  1704. free_netdev(netdev);
  1705. pci_release_selected_regions(pdev,
  1706. pci_select_bars(pdev, IORESOURCE_MEM));
  1707. pci_disable_pcie_error_reporting(pdev);
  1708. pci_disable_device(pdev);
  1709. }
  1710. static void fm10k_prepare_suspend(struct fm10k_intfc *interface)
  1711. {
  1712. /* the watchdog task reads from registers, which might appear like
  1713. * a surprise remove if the PCIe device is disabled while we're
  1714. * stopped. We stop the watchdog task until after we resume software
  1715. * activity.
  1716. */
  1717. set_bit(__FM10K_SERVICE_DISABLE, &interface->state);
  1718. cancel_work_sync(&interface->service_task);
  1719. fm10k_prepare_for_reset(interface);
  1720. }
  1721. static int fm10k_handle_resume(struct fm10k_intfc *interface)
  1722. {
  1723. struct fm10k_hw *hw = &interface->hw;
  1724. int err;
  1725. /* reset statistics starting values */
  1726. hw->mac.ops.rebind_hw_stats(hw, &interface->stats);
  1727. err = fm10k_handle_reset(interface);
  1728. if (err)
  1729. return err;
  1730. /* assume host is not ready, to prevent race with watchdog in case we
  1731. * actually don't have connection to the switch
  1732. */
  1733. interface->host_ready = false;
  1734. fm10k_watchdog_host_not_ready(interface);
  1735. /* clear the service task disable bit to allow service task to start */
  1736. clear_bit(__FM10K_SERVICE_DISABLE, &interface->state);
  1737. fm10k_service_event_schedule(interface);
  1738. return err;
  1739. }
  1740. #ifdef CONFIG_PM
  1741. /**
  1742. * fm10k_resume - Restore device to pre-sleep state
  1743. * @pdev: PCI device information struct
  1744. *
  1745. * fm10k_resume is called after the system has powered back up from a sleep
  1746. * state and is ready to resume operation. This function is meant to restore
  1747. * the device back to its pre-sleep state.
  1748. **/
  1749. static int fm10k_resume(struct pci_dev *pdev)
  1750. {
  1751. struct fm10k_intfc *interface = pci_get_drvdata(pdev);
  1752. struct net_device *netdev = interface->netdev;
  1753. struct fm10k_hw *hw = &interface->hw;
  1754. u32 err;
  1755. pci_set_power_state(pdev, PCI_D0);
  1756. pci_restore_state(pdev);
  1757. /* pci_restore_state clears dev->state_saved so call
  1758. * pci_save_state to restore it.
  1759. */
  1760. pci_save_state(pdev);
  1761. err = pci_enable_device_mem(pdev);
  1762. if (err) {
  1763. dev_err(&pdev->dev, "Cannot enable PCI device from suspend\n");
  1764. return err;
  1765. }
  1766. pci_set_master(pdev);
  1767. pci_wake_from_d3(pdev, false);
  1768. /* refresh hw_addr in case it was dropped */
  1769. hw->hw_addr = interface->uc_addr;
  1770. /* reset hardware to known state */
  1771. err = hw->mac.ops.init_hw(&interface->hw);
  1772. if (err) {
  1773. dev_err(&pdev->dev, "init_hw failed: %d\n", err);
  1774. return err;
  1775. }
  1776. /* reset statistics starting values */
  1777. hw->mac.ops.rebind_hw_stats(hw, &interface->stats);
  1778. rtnl_lock();
  1779. err = fm10k_init_queueing_scheme(interface);
  1780. if (err)
  1781. goto err_queueing_scheme;
  1782. err = fm10k_mbx_request_irq(interface);
  1783. if (err)
  1784. goto err_mbx_irq;
  1785. err = fm10k_hw_ready(interface);
  1786. if (err)
  1787. goto err_open;
  1788. err = netif_running(netdev) ? fm10k_open(netdev) : 0;
  1789. if (err)
  1790. goto err_open;
  1791. rtnl_unlock();
  1792. /* assume host is not ready, to prevent race with watchdog in case we
  1793. * actually don't have connection to the switch
  1794. */
  1795. interface->host_ready = false;
  1796. fm10k_watchdog_host_not_ready(interface);
  1797. /* clear the service task disable bit to allow service task to start */
  1798. clear_bit(__FM10K_SERVICE_DISABLE, &interface->state);
  1799. fm10k_service_event_schedule(interface);
  1800. /* restore SR-IOV interface */
  1801. fm10k_iov_resume(pdev);
  1802. netif_device_attach(netdev);
  1803. return 0;
  1804. err_open:
  1805. fm10k_mbx_free_irq(interface);
  1806. err_mbx_irq:
  1807. fm10k_clear_queueing_scheme(interface);
  1808. err_queueing_scheme:
  1809. rtnl_unlock();
  1810. return err;
  1811. }
  1812. /**
  1813. * fm10k_suspend - Prepare the device for a system sleep state
  1814. * @pdev: PCI device information struct
  1815. *
  1816. * fm10k_suspend is meant to shutdown the device prior to the system entering
  1817. * a sleep state. The fm10k hardware does not support wake on lan so the
  1818. * driver simply needs to shut down the device so it is in a low power state.
  1819. **/
  1820. static int fm10k_suspend(struct pci_dev *pdev,
  1821. pm_message_t __always_unused state)
  1822. {
  1823. struct fm10k_intfc *interface = pci_get_drvdata(pdev);
  1824. struct net_device *netdev = interface->netdev;
  1825. int err = 0;
  1826. netif_device_detach(netdev);
  1827. fm10k_iov_suspend(pdev);
  1828. /* the watchdog tasks may read registers, which will appear like a
  1829. * surprise-remove event once the PCI device is disabled. This will
  1830. * cause us to close the netdevice, so we don't retain the open/closed
  1831. * state post-resume. Prevent this by disabling the service task while
  1832. * suspended, until we actually resume.
  1833. */
  1834. set_bit(__FM10K_SERVICE_DISABLE, &interface->state);
  1835. cancel_work_sync(&interface->service_task);
  1836. rtnl_lock();
  1837. if (netif_running(netdev))
  1838. fm10k_close(netdev);
  1839. fm10k_mbx_free_irq(interface);
  1840. fm10k_clear_queueing_scheme(interface);
  1841. rtnl_unlock();
  1842. err = pci_save_state(pdev);
  1843. if (err)
  1844. return err;
  1845. pci_disable_device(pdev);
  1846. pci_wake_from_d3(pdev, false);
  1847. pci_set_power_state(pdev, PCI_D3hot);
  1848. return 0;
  1849. }
  1850. #endif /* CONFIG_PM */
  1851. /**
  1852. * fm10k_io_error_detected - called when PCI error is detected
  1853. * @pdev: Pointer to PCI device
  1854. * @state: The current pci connection state
  1855. *
  1856. * This function is called after a PCI bus error affecting
  1857. * this device has been detected.
  1858. */
  1859. static pci_ers_result_t fm10k_io_error_detected(struct pci_dev *pdev,
  1860. pci_channel_state_t state)
  1861. {
  1862. struct fm10k_intfc *interface = pci_get_drvdata(pdev);
  1863. struct net_device *netdev = interface->netdev;
  1864. netif_device_detach(netdev);
  1865. if (state == pci_channel_io_perm_failure)
  1866. return PCI_ERS_RESULT_DISCONNECT;
  1867. fm10k_prepare_suspend(interface);
  1868. /* Request a slot reset. */
  1869. return PCI_ERS_RESULT_NEED_RESET;
  1870. }
  1871. /**
  1872. * fm10k_io_slot_reset - called after the pci bus has been reset.
  1873. * @pdev: Pointer to PCI device
  1874. *
  1875. * Restart the card from scratch, as if from a cold-boot.
  1876. */
  1877. static pci_ers_result_t fm10k_io_slot_reset(struct pci_dev *pdev)
  1878. {
  1879. pci_ers_result_t result;
  1880. if (pci_enable_device_mem(pdev)) {
  1881. dev_err(&pdev->dev,
  1882. "Cannot re-enable PCI device after reset.\n");
  1883. result = PCI_ERS_RESULT_DISCONNECT;
  1884. } else {
  1885. pci_set_master(pdev);
  1886. pci_restore_state(pdev);
  1887. /* After second error pci->state_saved is false, this
  1888. * resets it so EEH doesn't break.
  1889. */
  1890. pci_save_state(pdev);
  1891. pci_wake_from_d3(pdev, false);
  1892. result = PCI_ERS_RESULT_RECOVERED;
  1893. }
  1894. pci_cleanup_aer_uncorrect_error_status(pdev);
  1895. return result;
  1896. }
  1897. /**
  1898. * fm10k_io_resume - called when traffic can start flowing again.
  1899. * @pdev: Pointer to PCI device
  1900. *
  1901. * This callback is called when the error recovery driver tells us that
  1902. * its OK to resume normal operation.
  1903. */
  1904. static void fm10k_io_resume(struct pci_dev *pdev)
  1905. {
  1906. struct fm10k_intfc *interface = pci_get_drvdata(pdev);
  1907. struct net_device *netdev = interface->netdev;
  1908. int err;
  1909. err = fm10k_handle_resume(interface);
  1910. if (err)
  1911. dev_warn(&pdev->dev,
  1912. "fm10k_io_resume failed: %d\n", err);
  1913. else
  1914. netif_device_attach(netdev);
  1915. }
  1916. static const struct pci_error_handlers fm10k_err_handler = {
  1917. .error_detected = fm10k_io_error_detected,
  1918. .slot_reset = fm10k_io_slot_reset,
  1919. .resume = fm10k_io_resume,
  1920. };
  1921. static struct pci_driver fm10k_driver = {
  1922. .name = fm10k_driver_name,
  1923. .id_table = fm10k_pci_tbl,
  1924. .probe = fm10k_probe,
  1925. .remove = fm10k_remove,
  1926. #ifdef CONFIG_PM
  1927. .suspend = fm10k_suspend,
  1928. .resume = fm10k_resume,
  1929. #endif
  1930. .sriov_configure = fm10k_iov_configure,
  1931. .err_handler = &fm10k_err_handler
  1932. };
  1933. /**
  1934. * fm10k_register_pci_driver - register driver interface
  1935. *
  1936. * This function is called on module load in order to register the driver.
  1937. **/
  1938. int fm10k_register_pci_driver(void)
  1939. {
  1940. return pci_register_driver(&fm10k_driver);
  1941. }
  1942. /**
  1943. * fm10k_unregister_pci_driver - unregister driver interface
  1944. *
  1945. * This function is called on module unload in order to remove the driver.
  1946. **/
  1947. void fm10k_unregister_pci_driver(void)
  1948. {
  1949. pci_unregister_driver(&fm10k_driver);
  1950. }