fm10k_pci.c 64 KB

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