fm10k_pci.c 64 KB

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