fm10k_pci.c 57 KB

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