slicoss.c 47 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870
  1. /*
  2. * Driver for Gigabit Ethernet adapters based on the Session Layer
  3. * Interface (SLIC) technology by Alacritech. The driver does not
  4. * support the hardware acceleration features provided by these cards.
  5. *
  6. * Copyright (C) 2016 Lino Sanfilippo <LinoSanfilippo@gmx.de>
  7. *
  8. * This program is free software; you can redistribute it and/or modify
  9. * it under the terms of the GNU General Public License as published by
  10. * the Free Software Foundation; either version 2 of the License.
  11. *
  12. * This program is distributed in the hope that it will be useful,
  13. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  14. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  15. * GNU General Public License for more details.
  16. *
  17. */
  18. #include <linux/kernel.h>
  19. #include <linux/module.h>
  20. #include <linux/pci.h>
  21. #include <linux/netdevice.h>
  22. #include <linux/etherdevice.h>
  23. #include <linux/if_ether.h>
  24. #include <linux/crc32.h>
  25. #include <linux/dma-mapping.h>
  26. #include <linux/ethtool.h>
  27. #include <linux/mii.h>
  28. #include <linux/interrupt.h>
  29. #include <linux/delay.h>
  30. #include <linux/firmware.h>
  31. #include <linux/list.h>
  32. #include <linux/u64_stats_sync.h>
  33. #include "slic.h"
  34. #define DRV_NAME "slicoss"
  35. #define DRV_VERSION "1.0"
  36. static const struct pci_device_id slic_id_tbl[] = {
  37. { PCI_DEVICE(PCI_VENDOR_ID_ALACRITECH,
  38. PCI_DEVICE_ID_ALACRITECH_MOJAVE) },
  39. { PCI_DEVICE(PCI_VENDOR_ID_ALACRITECH,
  40. PCI_DEVICE_ID_ALACRITECH_OASIS) },
  41. { 0 }
  42. };
  43. static const char slic_stats_strings[][ETH_GSTRING_LEN] = {
  44. "rx_packets",
  45. "rx_bytes",
  46. "rx_multicasts",
  47. "rx_errors",
  48. "rx_buff_miss",
  49. "rx_tp_csum",
  50. "rx_tp_oflow",
  51. "rx_tp_hlen",
  52. "rx_ip_csum",
  53. "rx_ip_len",
  54. "rx_ip_hdr_len",
  55. "rx_early",
  56. "rx_buff_oflow",
  57. "rx_lcode",
  58. "rx_drbl",
  59. "rx_crc",
  60. "rx_oflow_802",
  61. "rx_uflow_802",
  62. "tx_packets",
  63. "tx_bytes",
  64. "tx_carrier",
  65. "tx_dropped",
  66. "irq_errs",
  67. };
  68. static inline int slic_next_queue_idx(unsigned int idx, unsigned int qlen)
  69. {
  70. return (idx + 1) & (qlen - 1);
  71. }
  72. static inline int slic_get_free_queue_descs(unsigned int put_idx,
  73. unsigned int done_idx,
  74. unsigned int qlen)
  75. {
  76. if (put_idx >= done_idx)
  77. return (qlen - (put_idx - done_idx) - 1);
  78. return (done_idx - put_idx - 1);
  79. }
  80. static unsigned int slic_next_compl_idx(struct slic_device *sdev)
  81. {
  82. struct slic_stat_queue *stq = &sdev->stq;
  83. unsigned int active = stq->active_array;
  84. struct slic_stat_desc *descs;
  85. struct slic_stat_desc *stat;
  86. unsigned int idx;
  87. descs = stq->descs[active];
  88. stat = &descs[stq->done_idx];
  89. if (!stat->status)
  90. return SLIC_INVALID_STAT_DESC_IDX;
  91. idx = (le32_to_cpu(stat->hnd) & 0xffff) - 1;
  92. /* reset desc */
  93. stat->hnd = 0;
  94. stat->status = 0;
  95. stq->done_idx = slic_next_queue_idx(stq->done_idx, stq->len);
  96. /* check for wraparound */
  97. if (!stq->done_idx) {
  98. dma_addr_t paddr = stq->paddr[active];
  99. slic_write(sdev, SLIC_REG_RBAR, lower_32_bits(paddr) |
  100. stq->len);
  101. /* make sure new status descriptors are immediately available */
  102. slic_flush_write(sdev);
  103. active++;
  104. active &= (SLIC_NUM_STAT_DESC_ARRAYS - 1);
  105. stq->active_array = active;
  106. }
  107. return idx;
  108. }
  109. static unsigned int slic_get_free_tx_descs(struct slic_tx_queue *txq)
  110. {
  111. /* ensure tail idx is updated */
  112. smp_mb();
  113. return slic_get_free_queue_descs(txq->put_idx, txq->done_idx, txq->len);
  114. }
  115. static unsigned int slic_get_free_rx_descs(struct slic_rx_queue *rxq)
  116. {
  117. return slic_get_free_queue_descs(rxq->put_idx, rxq->done_idx, rxq->len);
  118. }
  119. static void slic_clear_upr_list(struct slic_upr_list *upr_list)
  120. {
  121. struct slic_upr *upr;
  122. struct slic_upr *tmp;
  123. spin_lock_bh(&upr_list->lock);
  124. list_for_each_entry_safe(upr, tmp, &upr_list->list, list) {
  125. list_del(&upr->list);
  126. kfree(upr);
  127. }
  128. upr_list->pending = false;
  129. spin_unlock_bh(&upr_list->lock);
  130. }
  131. static void slic_start_upr(struct slic_device *sdev, struct slic_upr *upr)
  132. {
  133. u32 reg;
  134. reg = (upr->type == SLIC_UPR_CONFIG) ? SLIC_REG_RCONFIG :
  135. SLIC_REG_LSTAT;
  136. slic_write(sdev, reg, lower_32_bits(upr->paddr));
  137. slic_flush_write(sdev);
  138. }
  139. static void slic_queue_upr(struct slic_device *sdev, struct slic_upr *upr)
  140. {
  141. struct slic_upr_list *upr_list = &sdev->upr_list;
  142. bool pending;
  143. spin_lock_bh(&upr_list->lock);
  144. pending = upr_list->pending;
  145. INIT_LIST_HEAD(&upr->list);
  146. list_add_tail(&upr->list, &upr_list->list);
  147. upr_list->pending = true;
  148. spin_unlock_bh(&upr_list->lock);
  149. if (!pending)
  150. slic_start_upr(sdev, upr);
  151. }
  152. static struct slic_upr *slic_dequeue_upr(struct slic_device *sdev)
  153. {
  154. struct slic_upr_list *upr_list = &sdev->upr_list;
  155. struct slic_upr *next_upr = NULL;
  156. struct slic_upr *upr = NULL;
  157. spin_lock_bh(&upr_list->lock);
  158. if (!list_empty(&upr_list->list)) {
  159. upr = list_first_entry(&upr_list->list, struct slic_upr, list);
  160. list_del(&upr->list);
  161. if (list_empty(&upr_list->list))
  162. upr_list->pending = false;
  163. else
  164. next_upr = list_first_entry(&upr_list->list,
  165. struct slic_upr, list);
  166. }
  167. spin_unlock_bh(&upr_list->lock);
  168. /* trigger processing of the next upr in list */
  169. if (next_upr)
  170. slic_start_upr(sdev, next_upr);
  171. return upr;
  172. }
  173. static int slic_new_upr(struct slic_device *sdev, unsigned int type,
  174. dma_addr_t paddr)
  175. {
  176. struct slic_upr *upr;
  177. upr = kmalloc(sizeof(*upr), GFP_ATOMIC);
  178. if (!upr)
  179. return -ENOMEM;
  180. upr->type = type;
  181. upr->paddr = paddr;
  182. slic_queue_upr(sdev, upr);
  183. return 0;
  184. }
  185. static void slic_set_mcast_bit(u64 *mcmask, unsigned char const *addr)
  186. {
  187. u64 mask = *mcmask;
  188. u8 crc;
  189. /* Get the CRC polynomial for the mac address: we use bits 1-8 (lsb),
  190. * bitwise reversed, msb (= lsb bit 0 before bitrev) is automatically
  191. * discarded.
  192. */
  193. crc = ether_crc(ETH_ALEN, addr) >> 23;
  194. /* we only have space on the SLIC for 64 entries */
  195. crc &= 0x3F;
  196. mask |= (u64)1 << crc;
  197. *mcmask = mask;
  198. }
  199. /* must be called with link_lock held */
  200. static void slic_configure_rcv(struct slic_device *sdev)
  201. {
  202. u32 val;
  203. val = SLIC_GRCR_RESET | SLIC_GRCR_ADDRAEN | SLIC_GRCR_RCVEN |
  204. SLIC_GRCR_HASHSIZE << SLIC_GRCR_HASHSIZE_SHIFT | SLIC_GRCR_RCVBAD;
  205. if (sdev->duplex == DUPLEX_FULL)
  206. val |= SLIC_GRCR_CTLEN;
  207. if (sdev->promisc)
  208. val |= SLIC_GRCR_RCVALL;
  209. slic_write(sdev, SLIC_REG_WRCFG, val);
  210. }
  211. /* must be called with link_lock held */
  212. static void slic_configure_xmt(struct slic_device *sdev)
  213. {
  214. u32 val;
  215. val = SLIC_GXCR_RESET | SLIC_GXCR_XMTEN;
  216. if (sdev->duplex == DUPLEX_FULL)
  217. val |= SLIC_GXCR_PAUSEEN;
  218. slic_write(sdev, SLIC_REG_WXCFG, val);
  219. }
  220. /* must be called with link_lock held */
  221. static void slic_configure_mac(struct slic_device *sdev)
  222. {
  223. u32 val;
  224. if (sdev->speed == SPEED_1000) {
  225. val = SLIC_GMCR_GAPBB_1000 << SLIC_GMCR_GAPBB_SHIFT |
  226. SLIC_GMCR_GAPR1_1000 << SLIC_GMCR_GAPR1_SHIFT |
  227. SLIC_GMCR_GAPR2_1000 << SLIC_GMCR_GAPR2_SHIFT |
  228. SLIC_GMCR_GBIT; /* enable GMII */
  229. } else {
  230. val = SLIC_GMCR_GAPBB_100 << SLIC_GMCR_GAPBB_SHIFT |
  231. SLIC_GMCR_GAPR1_100 << SLIC_GMCR_GAPR1_SHIFT |
  232. SLIC_GMCR_GAPR2_100 << SLIC_GMCR_GAPR2_SHIFT;
  233. }
  234. if (sdev->duplex == DUPLEX_FULL)
  235. val |= SLIC_GMCR_FULLD;
  236. slic_write(sdev, SLIC_REG_WMCFG, val);
  237. }
  238. static void slic_configure_link_locked(struct slic_device *sdev, int speed,
  239. unsigned int duplex)
  240. {
  241. struct net_device *dev = sdev->netdev;
  242. if (sdev->speed == speed && sdev->duplex == duplex)
  243. return;
  244. sdev->speed = speed;
  245. sdev->duplex = duplex;
  246. if (sdev->speed == SPEED_UNKNOWN) {
  247. if (netif_carrier_ok(dev))
  248. netif_carrier_off(dev);
  249. } else {
  250. /* (re)configure link settings */
  251. slic_configure_mac(sdev);
  252. slic_configure_xmt(sdev);
  253. slic_configure_rcv(sdev);
  254. slic_flush_write(sdev);
  255. if (!netif_carrier_ok(dev))
  256. netif_carrier_on(dev);
  257. }
  258. }
  259. static void slic_configure_link(struct slic_device *sdev, int speed,
  260. unsigned int duplex)
  261. {
  262. spin_lock_bh(&sdev->link_lock);
  263. slic_configure_link_locked(sdev, speed, duplex);
  264. spin_unlock_bh(&sdev->link_lock);
  265. }
  266. static void slic_set_rx_mode(struct net_device *dev)
  267. {
  268. struct slic_device *sdev = netdev_priv(dev);
  269. struct netdev_hw_addr *hwaddr;
  270. bool set_promisc;
  271. u64 mcmask;
  272. if (dev->flags & (IFF_PROMISC | IFF_ALLMULTI)) {
  273. /* Turn on all multicast addresses. We have to do this for
  274. * promiscuous mode as well as ALLMCAST mode (it saves the
  275. * microcode from having to keep state about the MAC
  276. * configuration).
  277. */
  278. mcmask = ~(u64)0;
  279. } else {
  280. mcmask = 0;
  281. netdev_for_each_mc_addr(hwaddr, dev) {
  282. slic_set_mcast_bit(&mcmask, hwaddr->addr);
  283. }
  284. }
  285. slic_write(sdev, SLIC_REG_MCASTLOW, lower_32_bits(mcmask));
  286. slic_write(sdev, SLIC_REG_MCASTHIGH, upper_32_bits(mcmask));
  287. set_promisc = !!(dev->flags & IFF_PROMISC);
  288. spin_lock_bh(&sdev->link_lock);
  289. if (sdev->promisc != set_promisc) {
  290. sdev->promisc = set_promisc;
  291. slic_configure_rcv(sdev);
  292. /* make sure writes to receiver cant leak out of the lock */
  293. mmiowb();
  294. }
  295. spin_unlock_bh(&sdev->link_lock);
  296. }
  297. static void slic_xmit_complete(struct slic_device *sdev)
  298. {
  299. struct slic_tx_queue *txq = &sdev->txq;
  300. struct net_device *dev = sdev->netdev;
  301. unsigned int idx = txq->done_idx;
  302. struct slic_tx_buffer *buff;
  303. unsigned int frames = 0;
  304. unsigned int bytes = 0;
  305. /* Limit processing to SLIC_MAX_TX_COMPLETIONS frames to avoid that new
  306. * completions during processing keeps the loop running endlessly.
  307. */
  308. do {
  309. idx = slic_next_compl_idx(sdev);
  310. if (idx == SLIC_INVALID_STAT_DESC_IDX)
  311. break;
  312. txq->done_idx = idx;
  313. buff = &txq->txbuffs[idx];
  314. if (unlikely(!buff->skb)) {
  315. netdev_warn(dev,
  316. "no skb found for desc idx %i\n", idx);
  317. continue;
  318. }
  319. dma_unmap_single(&sdev->pdev->dev,
  320. dma_unmap_addr(buff, map_addr),
  321. dma_unmap_len(buff, map_len), DMA_TO_DEVICE);
  322. bytes += buff->skb->len;
  323. frames++;
  324. dev_kfree_skb_any(buff->skb);
  325. buff->skb = NULL;
  326. } while (frames < SLIC_MAX_TX_COMPLETIONS);
  327. /* make sure xmit sees the new value for done_idx */
  328. smp_wmb();
  329. u64_stats_update_begin(&sdev->stats.syncp);
  330. sdev->stats.tx_bytes += bytes;
  331. sdev->stats.tx_packets += frames;
  332. u64_stats_update_end(&sdev->stats.syncp);
  333. netif_tx_lock(dev);
  334. if (netif_queue_stopped(dev) &&
  335. (slic_get_free_tx_descs(txq) >= SLIC_MIN_TX_WAKEUP_DESCS))
  336. netif_wake_queue(dev);
  337. netif_tx_unlock(dev);
  338. }
  339. static void slic_refill_rx_queue(struct slic_device *sdev, gfp_t gfp)
  340. {
  341. const unsigned int ALIGN_MASK = SLIC_RX_BUFF_ALIGN - 1;
  342. unsigned int maplen = SLIC_RX_BUFF_SIZE;
  343. struct slic_rx_queue *rxq = &sdev->rxq;
  344. struct net_device *dev = sdev->netdev;
  345. struct slic_rx_buffer *buff;
  346. struct slic_rx_desc *desc;
  347. unsigned int misalign;
  348. unsigned int offset;
  349. struct sk_buff *skb;
  350. dma_addr_t paddr;
  351. while (slic_get_free_rx_descs(rxq) > SLIC_MAX_REQ_RX_DESCS) {
  352. skb = alloc_skb(maplen + ALIGN_MASK, gfp);
  353. if (!skb)
  354. break;
  355. paddr = dma_map_single(&sdev->pdev->dev, skb->data, maplen,
  356. DMA_FROM_DEVICE);
  357. if (dma_mapping_error(&sdev->pdev->dev, paddr)) {
  358. netdev_err(dev, "mapping rx packet failed\n");
  359. /* drop skb */
  360. dev_kfree_skb_any(skb);
  361. break;
  362. }
  363. /* ensure head buffer descriptors are 256 byte aligned */
  364. offset = 0;
  365. misalign = paddr & ALIGN_MASK;
  366. if (misalign) {
  367. offset = SLIC_RX_BUFF_ALIGN - misalign;
  368. skb_reserve(skb, offset);
  369. }
  370. /* the HW expects dma chunks for descriptor + frame data */
  371. desc = (struct slic_rx_desc *)skb->data;
  372. /* temporarily sync descriptor for CPU to clear status */
  373. dma_sync_single_for_cpu(&sdev->pdev->dev, paddr,
  374. offset + sizeof(*desc),
  375. DMA_FROM_DEVICE);
  376. desc->status = 0;
  377. /* return it to HW again */
  378. dma_sync_single_for_device(&sdev->pdev->dev, paddr,
  379. offset + sizeof(*desc),
  380. DMA_FROM_DEVICE);
  381. buff = &rxq->rxbuffs[rxq->put_idx];
  382. buff->skb = skb;
  383. dma_unmap_addr_set(buff, map_addr, paddr);
  384. dma_unmap_len_set(buff, map_len, maplen);
  385. buff->addr_offset = offset;
  386. /* complete write to descriptor before it is handed to HW */
  387. wmb();
  388. /* head buffer descriptors are placed immediately before skb */
  389. slic_write(sdev, SLIC_REG_HBAR, lower_32_bits(paddr) + offset);
  390. rxq->put_idx = slic_next_queue_idx(rxq->put_idx, rxq->len);
  391. }
  392. }
  393. static void slic_handle_frame_error(struct slic_device *sdev,
  394. struct sk_buff *skb)
  395. {
  396. struct slic_stats *stats = &sdev->stats;
  397. if (sdev->model == SLIC_MODEL_OASIS) {
  398. struct slic_rx_info_oasis *info;
  399. u32 status_b;
  400. u32 status;
  401. info = (struct slic_rx_info_oasis *)skb->data;
  402. status = le32_to_cpu(info->frame_status);
  403. status_b = le32_to_cpu(info->frame_status_b);
  404. /* transport layer */
  405. if (status_b & SLIC_VRHSTATB_TPCSUM)
  406. SLIC_INC_STATS_COUNTER(stats, rx_tpcsum);
  407. if (status & SLIC_VRHSTAT_TPOFLO)
  408. SLIC_INC_STATS_COUNTER(stats, rx_tpoflow);
  409. if (status_b & SLIC_VRHSTATB_TPHLEN)
  410. SLIC_INC_STATS_COUNTER(stats, rx_tphlen);
  411. /* ip layer */
  412. if (status_b & SLIC_VRHSTATB_IPCSUM)
  413. SLIC_INC_STATS_COUNTER(stats, rx_ipcsum);
  414. if (status_b & SLIC_VRHSTATB_IPLERR)
  415. SLIC_INC_STATS_COUNTER(stats, rx_iplen);
  416. if (status_b & SLIC_VRHSTATB_IPHERR)
  417. SLIC_INC_STATS_COUNTER(stats, rx_iphlen);
  418. /* link layer */
  419. if (status_b & SLIC_VRHSTATB_RCVE)
  420. SLIC_INC_STATS_COUNTER(stats, rx_early);
  421. if (status_b & SLIC_VRHSTATB_BUFF)
  422. SLIC_INC_STATS_COUNTER(stats, rx_buffoflow);
  423. if (status_b & SLIC_VRHSTATB_CODE)
  424. SLIC_INC_STATS_COUNTER(stats, rx_lcode);
  425. if (status_b & SLIC_VRHSTATB_DRBL)
  426. SLIC_INC_STATS_COUNTER(stats, rx_drbl);
  427. if (status_b & SLIC_VRHSTATB_CRC)
  428. SLIC_INC_STATS_COUNTER(stats, rx_crc);
  429. if (status & SLIC_VRHSTAT_802OE)
  430. SLIC_INC_STATS_COUNTER(stats, rx_oflow802);
  431. if (status_b & SLIC_VRHSTATB_802UE)
  432. SLIC_INC_STATS_COUNTER(stats, rx_uflow802);
  433. if (status_b & SLIC_VRHSTATB_CARRE)
  434. SLIC_INC_STATS_COUNTER(stats, tx_carrier);
  435. } else { /* mojave */
  436. struct slic_rx_info_mojave *info;
  437. u32 status;
  438. info = (struct slic_rx_info_mojave *)skb->data;
  439. status = le32_to_cpu(info->frame_status);
  440. /* transport layer */
  441. if (status & SLIC_VGBSTAT_XPERR) {
  442. u32 xerr = status >> SLIC_VGBSTAT_XERRSHFT;
  443. if (xerr == SLIC_VGBSTAT_XCSERR)
  444. SLIC_INC_STATS_COUNTER(stats, rx_tpcsum);
  445. if (xerr == SLIC_VGBSTAT_XUFLOW)
  446. SLIC_INC_STATS_COUNTER(stats, rx_tpoflow);
  447. if (xerr == SLIC_VGBSTAT_XHLEN)
  448. SLIC_INC_STATS_COUNTER(stats, rx_tphlen);
  449. }
  450. /* ip layer */
  451. if (status & SLIC_VGBSTAT_NETERR) {
  452. u32 nerr = status >> SLIC_VGBSTAT_NERRSHFT &
  453. SLIC_VGBSTAT_NERRMSK;
  454. if (nerr == SLIC_VGBSTAT_NCSERR)
  455. SLIC_INC_STATS_COUNTER(stats, rx_ipcsum);
  456. if (nerr == SLIC_VGBSTAT_NUFLOW)
  457. SLIC_INC_STATS_COUNTER(stats, rx_iplen);
  458. if (nerr == SLIC_VGBSTAT_NHLEN)
  459. SLIC_INC_STATS_COUNTER(stats, rx_iphlen);
  460. }
  461. /* link layer */
  462. if (status & SLIC_VGBSTAT_LNKERR) {
  463. u32 lerr = status & SLIC_VGBSTAT_LERRMSK;
  464. if (lerr == SLIC_VGBSTAT_LDEARLY)
  465. SLIC_INC_STATS_COUNTER(stats, rx_early);
  466. if (lerr == SLIC_VGBSTAT_LBOFLO)
  467. SLIC_INC_STATS_COUNTER(stats, rx_buffoflow);
  468. if (lerr == SLIC_VGBSTAT_LCODERR)
  469. SLIC_INC_STATS_COUNTER(stats, rx_lcode);
  470. if (lerr == SLIC_VGBSTAT_LDBLNBL)
  471. SLIC_INC_STATS_COUNTER(stats, rx_drbl);
  472. if (lerr == SLIC_VGBSTAT_LCRCERR)
  473. SLIC_INC_STATS_COUNTER(stats, rx_crc);
  474. if (lerr == SLIC_VGBSTAT_LOFLO)
  475. SLIC_INC_STATS_COUNTER(stats, rx_oflow802);
  476. if (lerr == SLIC_VGBSTAT_LUFLO)
  477. SLIC_INC_STATS_COUNTER(stats, rx_uflow802);
  478. }
  479. }
  480. SLIC_INC_STATS_COUNTER(stats, rx_errors);
  481. }
  482. static void slic_handle_receive(struct slic_device *sdev, unsigned int todo,
  483. unsigned int *done)
  484. {
  485. struct slic_rx_queue *rxq = &sdev->rxq;
  486. struct net_device *dev = sdev->netdev;
  487. struct slic_rx_buffer *buff;
  488. struct slic_rx_desc *desc;
  489. unsigned int frames = 0;
  490. unsigned int bytes = 0;
  491. struct sk_buff *skb;
  492. u32 status;
  493. u32 len;
  494. while (todo && (rxq->done_idx != rxq->put_idx)) {
  495. buff = &rxq->rxbuffs[rxq->done_idx];
  496. skb = buff->skb;
  497. if (!skb)
  498. break;
  499. desc = (struct slic_rx_desc *)skb->data;
  500. dma_sync_single_for_cpu(&sdev->pdev->dev,
  501. dma_unmap_addr(buff, map_addr),
  502. buff->addr_offset + sizeof(*desc),
  503. DMA_FROM_DEVICE);
  504. status = le32_to_cpu(desc->status);
  505. if (!(status & SLIC_IRHDDR_SVALID)) {
  506. dma_sync_single_for_device(&sdev->pdev->dev,
  507. dma_unmap_addr(buff,
  508. map_addr),
  509. buff->addr_offset +
  510. sizeof(*desc),
  511. DMA_FROM_DEVICE);
  512. break;
  513. }
  514. buff->skb = NULL;
  515. dma_unmap_single(&sdev->pdev->dev,
  516. dma_unmap_addr(buff, map_addr),
  517. dma_unmap_len(buff, map_len),
  518. DMA_FROM_DEVICE);
  519. /* skip rx descriptor that is placed before the frame data */
  520. skb_reserve(skb, SLIC_RX_BUFF_HDR_SIZE);
  521. if (unlikely(status & SLIC_IRHDDR_ERR)) {
  522. slic_handle_frame_error(sdev, skb);
  523. dev_kfree_skb_any(skb);
  524. } else {
  525. struct ethhdr *eh = (struct ethhdr *)skb->data;
  526. if (is_multicast_ether_addr(eh->h_dest))
  527. SLIC_INC_STATS_COUNTER(&sdev->stats, rx_mcasts);
  528. len = le32_to_cpu(desc->length) & SLIC_IRHDDR_FLEN_MSK;
  529. skb_put(skb, len);
  530. skb->protocol = eth_type_trans(skb, dev);
  531. skb->ip_summed = CHECKSUM_UNNECESSARY;
  532. napi_gro_receive(&sdev->napi, skb);
  533. bytes += len;
  534. frames++;
  535. }
  536. rxq->done_idx = slic_next_queue_idx(rxq->done_idx, rxq->len);
  537. todo--;
  538. }
  539. u64_stats_update_begin(&sdev->stats.syncp);
  540. sdev->stats.rx_bytes += bytes;
  541. sdev->stats.rx_packets += frames;
  542. u64_stats_update_end(&sdev->stats.syncp);
  543. slic_refill_rx_queue(sdev, GFP_ATOMIC);
  544. }
  545. static void slic_handle_link_irq(struct slic_device *sdev)
  546. {
  547. struct slic_shmem *sm = &sdev->shmem;
  548. struct slic_shmem_data *sm_data = sm->shmem_data;
  549. unsigned int duplex;
  550. int speed;
  551. u32 link;
  552. link = le32_to_cpu(sm_data->link);
  553. if (link & SLIC_GIG_LINKUP) {
  554. if (link & SLIC_GIG_SPEED_1000)
  555. speed = SPEED_1000;
  556. else if (link & SLIC_GIG_SPEED_100)
  557. speed = SPEED_100;
  558. else
  559. speed = SPEED_10;
  560. duplex = (link & SLIC_GIG_FULLDUPLEX) ? DUPLEX_FULL :
  561. DUPLEX_HALF;
  562. } else {
  563. duplex = DUPLEX_UNKNOWN;
  564. speed = SPEED_UNKNOWN;
  565. }
  566. slic_configure_link(sdev, speed, duplex);
  567. }
  568. static void slic_handle_upr_irq(struct slic_device *sdev, u32 irqs)
  569. {
  570. struct slic_upr *upr;
  571. /* remove upr that caused this irq (always the first entry in list) */
  572. upr = slic_dequeue_upr(sdev);
  573. if (!upr) {
  574. netdev_warn(sdev->netdev, "no upr found on list\n");
  575. return;
  576. }
  577. if (upr->type == SLIC_UPR_LSTAT) {
  578. if (unlikely(irqs & SLIC_ISR_UPCERR_MASK)) {
  579. /* try again */
  580. slic_queue_upr(sdev, upr);
  581. return;
  582. }
  583. slic_handle_link_irq(sdev);
  584. }
  585. kfree(upr);
  586. }
  587. static int slic_handle_link_change(struct slic_device *sdev)
  588. {
  589. return slic_new_upr(sdev, SLIC_UPR_LSTAT, sdev->shmem.link_paddr);
  590. }
  591. static void slic_handle_err_irq(struct slic_device *sdev, u32 isr)
  592. {
  593. struct slic_stats *stats = &sdev->stats;
  594. if (isr & SLIC_ISR_RMISS)
  595. SLIC_INC_STATS_COUNTER(stats, rx_buff_miss);
  596. if (isr & SLIC_ISR_XDROP)
  597. SLIC_INC_STATS_COUNTER(stats, tx_dropped);
  598. if (!(isr & (SLIC_ISR_RMISS | SLIC_ISR_XDROP)))
  599. SLIC_INC_STATS_COUNTER(stats, irq_errs);
  600. }
  601. static void slic_handle_irq(struct slic_device *sdev, u32 isr,
  602. unsigned int todo, unsigned int *done)
  603. {
  604. if (isr & SLIC_ISR_ERR)
  605. slic_handle_err_irq(sdev, isr);
  606. if (isr & SLIC_ISR_LEVENT)
  607. slic_handle_link_change(sdev);
  608. if (isr & SLIC_ISR_UPC_MASK)
  609. slic_handle_upr_irq(sdev, isr);
  610. if (isr & SLIC_ISR_RCV)
  611. slic_handle_receive(sdev, todo, done);
  612. if (isr & SLIC_ISR_CMD)
  613. slic_xmit_complete(sdev);
  614. }
  615. static int slic_poll(struct napi_struct *napi, int todo)
  616. {
  617. struct slic_device *sdev = container_of(napi, struct slic_device, napi);
  618. struct slic_shmem *sm = &sdev->shmem;
  619. struct slic_shmem_data *sm_data = sm->shmem_data;
  620. u32 isr = le32_to_cpu(sm_data->isr);
  621. int done = 0;
  622. slic_handle_irq(sdev, isr, todo, &done);
  623. if (done < todo) {
  624. napi_complete_done(napi, done);
  625. /* reenable irqs */
  626. sm_data->isr = 0;
  627. /* make sure sm_data->isr is cleard before irqs are reenabled */
  628. wmb();
  629. slic_write(sdev, SLIC_REG_ISR, 0);
  630. slic_flush_write(sdev);
  631. }
  632. return done;
  633. }
  634. static irqreturn_t slic_irq(int irq, void *dev_id)
  635. {
  636. struct slic_device *sdev = dev_id;
  637. struct slic_shmem *sm = &sdev->shmem;
  638. struct slic_shmem_data *sm_data = sm->shmem_data;
  639. slic_write(sdev, SLIC_REG_ICR, SLIC_ICR_INT_MASK);
  640. slic_flush_write(sdev);
  641. /* make sure sm_data->isr is read after ICR_INT_MASK is set */
  642. wmb();
  643. if (!sm_data->isr) {
  644. dma_rmb();
  645. /* spurious interrupt */
  646. slic_write(sdev, SLIC_REG_ISR, 0);
  647. slic_flush_write(sdev);
  648. return IRQ_NONE;
  649. }
  650. napi_schedule_irqoff(&sdev->napi);
  651. return IRQ_HANDLED;
  652. }
  653. static void slic_card_reset(struct slic_device *sdev)
  654. {
  655. u16 cmd;
  656. slic_write(sdev, SLIC_REG_RESET, SLIC_RESET_MAGIC);
  657. /* flush write by means of config space */
  658. pci_read_config_word(sdev->pdev, PCI_COMMAND, &cmd);
  659. mdelay(1);
  660. }
  661. static int slic_init_stat_queue(struct slic_device *sdev)
  662. {
  663. const unsigned int DESC_ALIGN_MASK = SLIC_STATS_DESC_ALIGN - 1;
  664. struct slic_stat_queue *stq = &sdev->stq;
  665. struct slic_stat_desc *descs;
  666. unsigned int misalign;
  667. unsigned int offset;
  668. dma_addr_t paddr;
  669. size_t size;
  670. int err;
  671. int i;
  672. stq->len = SLIC_NUM_STAT_DESCS;
  673. stq->active_array = 0;
  674. stq->done_idx = 0;
  675. size = stq->len * sizeof(*descs) + DESC_ALIGN_MASK;
  676. for (i = 0; i < SLIC_NUM_STAT_DESC_ARRAYS; i++) {
  677. descs = dma_zalloc_coherent(&sdev->pdev->dev, size, &paddr,
  678. GFP_KERNEL);
  679. if (!descs) {
  680. netdev_err(sdev->netdev,
  681. "failed to allocate status descriptors\n");
  682. err = -ENOMEM;
  683. goto free_descs;
  684. }
  685. /* ensure correct alignment */
  686. offset = 0;
  687. misalign = paddr & DESC_ALIGN_MASK;
  688. if (misalign) {
  689. offset = SLIC_STATS_DESC_ALIGN - misalign;
  690. descs += offset;
  691. paddr += offset;
  692. }
  693. slic_write(sdev, SLIC_REG_RBAR, lower_32_bits(paddr) |
  694. stq->len);
  695. stq->descs[i] = descs;
  696. stq->paddr[i] = paddr;
  697. stq->addr_offset[i] = offset;
  698. }
  699. stq->mem_size = size;
  700. return 0;
  701. free_descs:
  702. while (i--) {
  703. dma_free_coherent(&sdev->pdev->dev, stq->mem_size,
  704. stq->descs[i] - stq->addr_offset[i],
  705. stq->paddr[i] - stq->addr_offset[i]);
  706. }
  707. return err;
  708. }
  709. static void slic_free_stat_queue(struct slic_device *sdev)
  710. {
  711. struct slic_stat_queue *stq = &sdev->stq;
  712. int i;
  713. for (i = 0; i < SLIC_NUM_STAT_DESC_ARRAYS; i++) {
  714. dma_free_coherent(&sdev->pdev->dev, stq->mem_size,
  715. stq->descs[i] - stq->addr_offset[i],
  716. stq->paddr[i] - stq->addr_offset[i]);
  717. }
  718. }
  719. static int slic_init_tx_queue(struct slic_device *sdev)
  720. {
  721. struct slic_tx_queue *txq = &sdev->txq;
  722. struct slic_tx_buffer *buff;
  723. struct slic_tx_desc *desc;
  724. unsigned int i;
  725. int err;
  726. txq->len = SLIC_NUM_TX_DESCS;
  727. txq->put_idx = 0;
  728. txq->done_idx = 0;
  729. txq->txbuffs = kcalloc(txq->len, sizeof(*buff), GFP_KERNEL);
  730. if (!txq->txbuffs)
  731. return -ENOMEM;
  732. txq->dma_pool = dma_pool_create("slic_pool", &sdev->pdev->dev,
  733. sizeof(*desc), SLIC_TX_DESC_ALIGN,
  734. 4096);
  735. if (!txq->dma_pool) {
  736. err = -ENOMEM;
  737. netdev_err(sdev->netdev, "failed to create dma pool\n");
  738. goto free_buffs;
  739. }
  740. for (i = 0; i < txq->len; i++) {
  741. buff = &txq->txbuffs[i];
  742. desc = dma_pool_zalloc(txq->dma_pool, GFP_KERNEL,
  743. &buff->desc_paddr);
  744. if (!desc) {
  745. netdev_err(sdev->netdev,
  746. "failed to alloc pool chunk (%i)\n", i);
  747. err = -ENOMEM;
  748. goto free_descs;
  749. }
  750. desc->hnd = cpu_to_le32((u32)(i + 1));
  751. desc->cmd = SLIC_CMD_XMT_REQ;
  752. desc->flags = 0;
  753. desc->type = cpu_to_le32(SLIC_CMD_TYPE_DUMB);
  754. buff->desc = desc;
  755. }
  756. return 0;
  757. free_descs:
  758. while (i--) {
  759. buff = &txq->txbuffs[i];
  760. dma_pool_free(txq->dma_pool, buff->desc, buff->desc_paddr);
  761. }
  762. dma_pool_destroy(txq->dma_pool);
  763. free_buffs:
  764. kfree(txq->txbuffs);
  765. return err;
  766. }
  767. static void slic_free_tx_queue(struct slic_device *sdev)
  768. {
  769. struct slic_tx_queue *txq = &sdev->txq;
  770. struct slic_tx_buffer *buff;
  771. unsigned int i;
  772. for (i = 0; i < txq->len; i++) {
  773. buff = &txq->txbuffs[i];
  774. dma_pool_free(txq->dma_pool, buff->desc, buff->desc_paddr);
  775. if (!buff->skb)
  776. continue;
  777. dma_unmap_single(&sdev->pdev->dev,
  778. dma_unmap_addr(buff, map_addr),
  779. dma_unmap_len(buff, map_len), DMA_TO_DEVICE);
  780. consume_skb(buff->skb);
  781. }
  782. dma_pool_destroy(txq->dma_pool);
  783. kfree(txq->txbuffs);
  784. }
  785. static int slic_init_rx_queue(struct slic_device *sdev)
  786. {
  787. struct slic_rx_queue *rxq = &sdev->rxq;
  788. struct slic_rx_buffer *buff;
  789. rxq->len = SLIC_NUM_RX_LES;
  790. rxq->done_idx = 0;
  791. rxq->put_idx = 0;
  792. buff = kcalloc(rxq->len, sizeof(*buff), GFP_KERNEL);
  793. if (!buff)
  794. return -ENOMEM;
  795. rxq->rxbuffs = buff;
  796. slic_refill_rx_queue(sdev, GFP_KERNEL);
  797. return 0;
  798. }
  799. static void slic_free_rx_queue(struct slic_device *sdev)
  800. {
  801. struct slic_rx_queue *rxq = &sdev->rxq;
  802. struct slic_rx_buffer *buff;
  803. unsigned int i;
  804. /* free rx buffers */
  805. for (i = 0; i < rxq->len; i++) {
  806. buff = &rxq->rxbuffs[i];
  807. if (!buff->skb)
  808. continue;
  809. dma_unmap_single(&sdev->pdev->dev,
  810. dma_unmap_addr(buff, map_addr),
  811. dma_unmap_len(buff, map_len),
  812. DMA_FROM_DEVICE);
  813. consume_skb(buff->skb);
  814. }
  815. kfree(rxq->rxbuffs);
  816. }
  817. static void slic_set_link_autoneg(struct slic_device *sdev)
  818. {
  819. unsigned int subid = sdev->pdev->subsystem_device;
  820. u32 val;
  821. if (sdev->is_fiber) {
  822. /* We've got a fiber gigabit interface, and register 4 is
  823. * different in fiber mode than in copper mode.
  824. */
  825. /* advertise FD only @1000 Mb */
  826. val = MII_ADVERTISE << 16 | ADVERTISE_1000XFULL |
  827. ADVERTISE_1000XPAUSE | ADVERTISE_1000XPSE_ASYM;
  828. /* enable PAUSE frames */
  829. slic_write(sdev, SLIC_REG_WPHY, val);
  830. /* reset phy, enable auto-neg */
  831. val = MII_BMCR << 16 | BMCR_RESET | BMCR_ANENABLE |
  832. BMCR_ANRESTART;
  833. slic_write(sdev, SLIC_REG_WPHY, val);
  834. } else { /* copper gigabit */
  835. /* We've got a copper gigabit interface, and register 4 is
  836. * different in copper mode than in fiber mode.
  837. */
  838. /* advertise 10/100 Mb modes */
  839. val = MII_ADVERTISE << 16 | ADVERTISE_100FULL |
  840. ADVERTISE_100HALF | ADVERTISE_10FULL | ADVERTISE_10HALF;
  841. /* enable PAUSE frames */
  842. val |= ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM;
  843. /* required by the Cicada PHY */
  844. val |= ADVERTISE_CSMA;
  845. slic_write(sdev, SLIC_REG_WPHY, val);
  846. /* advertise FD only @1000 Mb */
  847. val = MII_CTRL1000 << 16 | ADVERTISE_1000FULL;
  848. slic_write(sdev, SLIC_REG_WPHY, val);
  849. if (subid != PCI_SUBDEVICE_ID_ALACRITECH_CICADA) {
  850. /* if a Marvell PHY enable auto crossover */
  851. val = SLIC_MIICR_REG_16 | SLIC_MRV_REG16_XOVERON;
  852. slic_write(sdev, SLIC_REG_WPHY, val);
  853. /* reset phy, enable auto-neg */
  854. val = MII_BMCR << 16 | BMCR_RESET | BMCR_ANENABLE |
  855. BMCR_ANRESTART;
  856. slic_write(sdev, SLIC_REG_WPHY, val);
  857. } else {
  858. /* enable and restart auto-neg (don't reset) */
  859. val = MII_BMCR << 16 | BMCR_ANENABLE | BMCR_ANRESTART;
  860. slic_write(sdev, SLIC_REG_WPHY, val);
  861. }
  862. }
  863. }
  864. static void slic_set_mac_address(struct slic_device *sdev)
  865. {
  866. u8 *addr = sdev->netdev->dev_addr;
  867. u32 val;
  868. val = addr[5] | addr[4] << 8 | addr[3] << 16 | addr[2] << 24;
  869. slic_write(sdev, SLIC_REG_WRADDRAL, val);
  870. slic_write(sdev, SLIC_REG_WRADDRBL, val);
  871. val = addr[0] << 8 | addr[1];
  872. slic_write(sdev, SLIC_REG_WRADDRAH, val);
  873. slic_write(sdev, SLIC_REG_WRADDRBH, val);
  874. slic_flush_write(sdev);
  875. }
  876. static u32 slic_read_dword_from_firmware(const struct firmware *fw, int *offset)
  877. {
  878. int idx = *offset;
  879. __le32 val;
  880. memcpy(&val, fw->data + *offset, sizeof(val));
  881. idx += 4;
  882. *offset = idx;
  883. return le32_to_cpu(val);
  884. }
  885. MODULE_FIRMWARE(SLIC_RCV_FIRMWARE_MOJAVE);
  886. MODULE_FIRMWARE(SLIC_RCV_FIRMWARE_OASIS);
  887. static int slic_load_rcvseq_firmware(struct slic_device *sdev)
  888. {
  889. const struct firmware *fw;
  890. const char *file;
  891. u32 codelen;
  892. int idx = 0;
  893. u32 instr;
  894. u32 addr;
  895. int err;
  896. file = (sdev->model == SLIC_MODEL_OASIS) ? SLIC_RCV_FIRMWARE_OASIS :
  897. SLIC_RCV_FIRMWARE_MOJAVE;
  898. err = request_firmware(&fw, file, &sdev->pdev->dev);
  899. if (err) {
  900. dev_err(&sdev->pdev->dev,
  901. "failed to load receive sequencer firmware %s\n", file);
  902. return err;
  903. }
  904. /* Do an initial sanity check concerning firmware size now. A further
  905. * check follows below.
  906. */
  907. if (fw->size < SLIC_FIRMWARE_MIN_SIZE) {
  908. dev_err(&sdev->pdev->dev,
  909. "invalid firmware size %zu (min %u expected)\n",
  910. fw->size, SLIC_FIRMWARE_MIN_SIZE);
  911. err = -EINVAL;
  912. goto release;
  913. }
  914. codelen = slic_read_dword_from_firmware(fw, &idx);
  915. /* do another sanity check against firmware size */
  916. if ((codelen + 4) > fw->size) {
  917. dev_err(&sdev->pdev->dev,
  918. "invalid rcv-sequencer firmware size %zu\n", fw->size);
  919. err = -EINVAL;
  920. goto release;
  921. }
  922. /* download sequencer code to card */
  923. slic_write(sdev, SLIC_REG_RCV_WCS, SLIC_RCVWCS_BEGIN);
  924. for (addr = 0; addr < codelen; addr++) {
  925. __le32 val;
  926. /* write out instruction address */
  927. slic_write(sdev, SLIC_REG_RCV_WCS, addr);
  928. instr = slic_read_dword_from_firmware(fw, &idx);
  929. /* write out the instruction data low addr */
  930. slic_write(sdev, SLIC_REG_RCV_WCS, instr);
  931. val = (__le32)fw->data[idx];
  932. instr = le32_to_cpu(val);
  933. idx++;
  934. /* write out the instruction data high addr */
  935. slic_write(sdev, SLIC_REG_RCV_WCS, instr);
  936. }
  937. /* finish download */
  938. slic_write(sdev, SLIC_REG_RCV_WCS, SLIC_RCVWCS_FINISH);
  939. slic_flush_write(sdev);
  940. release:
  941. release_firmware(fw);
  942. return err;
  943. }
  944. MODULE_FIRMWARE(SLIC_FIRMWARE_MOJAVE);
  945. MODULE_FIRMWARE(SLIC_FIRMWARE_OASIS);
  946. static int slic_load_firmware(struct slic_device *sdev)
  947. {
  948. u32 sectstart[SLIC_FIRMWARE_MAX_SECTIONS];
  949. u32 sectsize[SLIC_FIRMWARE_MAX_SECTIONS];
  950. const struct firmware *fw;
  951. unsigned int datalen;
  952. const char *file;
  953. int code_start;
  954. unsigned int i;
  955. u32 numsects;
  956. int idx = 0;
  957. u32 sect;
  958. u32 instr;
  959. u32 addr;
  960. u32 base;
  961. int err;
  962. file = (sdev->model == SLIC_MODEL_OASIS) ? SLIC_FIRMWARE_OASIS :
  963. SLIC_FIRMWARE_MOJAVE;
  964. err = request_firmware(&fw, file, &sdev->pdev->dev);
  965. if (err) {
  966. dev_err(&sdev->pdev->dev, "failed to load firmware %s\n", file);
  967. return err;
  968. }
  969. /* Do an initial sanity check concerning firmware size now. A further
  970. * check follows below.
  971. */
  972. if (fw->size < SLIC_FIRMWARE_MIN_SIZE) {
  973. dev_err(&sdev->pdev->dev,
  974. "invalid firmware size %zu (min is %u)\n", fw->size,
  975. SLIC_FIRMWARE_MIN_SIZE);
  976. err = -EINVAL;
  977. goto release;
  978. }
  979. numsects = slic_read_dword_from_firmware(fw, &idx);
  980. if (numsects == 0 || numsects > SLIC_FIRMWARE_MAX_SECTIONS) {
  981. dev_err(&sdev->pdev->dev,
  982. "invalid number of sections in firmware: %u", numsects);
  983. err = -EINVAL;
  984. goto release;
  985. }
  986. datalen = numsects * 8 + 4;
  987. for (i = 0; i < numsects; i++) {
  988. sectsize[i] = slic_read_dword_from_firmware(fw, &idx);
  989. datalen += sectsize[i];
  990. }
  991. /* do another sanity check against firmware size */
  992. if (datalen > fw->size) {
  993. dev_err(&sdev->pdev->dev,
  994. "invalid firmware size %zu (expected >= %u)\n",
  995. fw->size, datalen);
  996. err = -EINVAL;
  997. goto release;
  998. }
  999. /* get sections */
  1000. for (i = 0; i < numsects; i++)
  1001. sectstart[i] = slic_read_dword_from_firmware(fw, &idx);
  1002. code_start = idx;
  1003. instr = slic_read_dword_from_firmware(fw, &idx);
  1004. for (sect = 0; sect < numsects; sect++) {
  1005. unsigned int ssize = sectsize[sect] >> 3;
  1006. base = sectstart[sect];
  1007. for (addr = 0; addr < ssize; addr++) {
  1008. /* write out instruction address */
  1009. slic_write(sdev, SLIC_REG_WCS, base + addr);
  1010. /* write out instruction to low addr */
  1011. slic_write(sdev, SLIC_REG_WCS, instr);
  1012. instr = slic_read_dword_from_firmware(fw, &idx);
  1013. /* write out instruction to high addr */
  1014. slic_write(sdev, SLIC_REG_WCS, instr);
  1015. instr = slic_read_dword_from_firmware(fw, &idx);
  1016. }
  1017. }
  1018. idx = code_start;
  1019. for (sect = 0; sect < numsects; sect++) {
  1020. unsigned int ssize = sectsize[sect] >> 3;
  1021. instr = slic_read_dword_from_firmware(fw, &idx);
  1022. base = sectstart[sect];
  1023. if (base < 0x8000)
  1024. continue;
  1025. for (addr = 0; addr < ssize; addr++) {
  1026. /* write out instruction address */
  1027. slic_write(sdev, SLIC_REG_WCS,
  1028. SLIC_WCS_COMPARE | (base + addr));
  1029. /* write out instruction to low addr */
  1030. slic_write(sdev, SLIC_REG_WCS, instr);
  1031. instr = slic_read_dword_from_firmware(fw, &idx);
  1032. /* write out instruction to high addr */
  1033. slic_write(sdev, SLIC_REG_WCS, instr);
  1034. instr = slic_read_dword_from_firmware(fw, &idx);
  1035. }
  1036. }
  1037. slic_flush_write(sdev);
  1038. mdelay(10);
  1039. /* everything OK, kick off the card */
  1040. slic_write(sdev, SLIC_REG_WCS, SLIC_WCS_START);
  1041. slic_flush_write(sdev);
  1042. /* wait long enough for ucode to init card and reach the mainloop */
  1043. mdelay(20);
  1044. release:
  1045. release_firmware(fw);
  1046. return err;
  1047. }
  1048. static int slic_init_shmem(struct slic_device *sdev)
  1049. {
  1050. struct slic_shmem *sm = &sdev->shmem;
  1051. struct slic_shmem_data *sm_data;
  1052. dma_addr_t paddr;
  1053. sm_data = dma_zalloc_coherent(&sdev->pdev->dev, sizeof(*sm_data),
  1054. &paddr, GFP_KERNEL);
  1055. if (!sm_data) {
  1056. dev_err(&sdev->pdev->dev, "failed to allocate shared memory\n");
  1057. return -ENOMEM;
  1058. }
  1059. sm->shmem_data = sm_data;
  1060. sm->isr_paddr = paddr;
  1061. sm->link_paddr = paddr + offsetof(struct slic_shmem_data, link);
  1062. return 0;
  1063. }
  1064. static void slic_free_shmem(struct slic_device *sdev)
  1065. {
  1066. struct slic_shmem *sm = &sdev->shmem;
  1067. struct slic_shmem_data *sm_data = sm->shmem_data;
  1068. dma_free_coherent(&sdev->pdev->dev, sizeof(*sm_data), sm_data,
  1069. sm->isr_paddr);
  1070. }
  1071. static int slic_init_iface(struct slic_device *sdev)
  1072. {
  1073. struct slic_shmem *sm = &sdev->shmem;
  1074. int err;
  1075. sdev->upr_list.pending = false;
  1076. err = slic_init_shmem(sdev);
  1077. if (err) {
  1078. netdev_err(sdev->netdev, "failed to init shared memory\n");
  1079. return err;
  1080. }
  1081. err = slic_load_firmware(sdev);
  1082. if (err) {
  1083. netdev_err(sdev->netdev, "failed to load firmware\n");
  1084. goto free_sm;
  1085. }
  1086. err = slic_load_rcvseq_firmware(sdev);
  1087. if (err) {
  1088. netdev_err(sdev->netdev,
  1089. "failed to load firmware for receive sequencer\n");
  1090. goto free_sm;
  1091. }
  1092. slic_write(sdev, SLIC_REG_ICR, SLIC_ICR_INT_OFF);
  1093. slic_flush_write(sdev);
  1094. mdelay(1);
  1095. err = slic_init_rx_queue(sdev);
  1096. if (err) {
  1097. netdev_err(sdev->netdev, "failed to init rx queue: %u\n", err);
  1098. goto free_sm;
  1099. }
  1100. err = slic_init_tx_queue(sdev);
  1101. if (err) {
  1102. netdev_err(sdev->netdev, "failed to init tx queue: %u\n", err);
  1103. goto free_rxq;
  1104. }
  1105. err = slic_init_stat_queue(sdev);
  1106. if (err) {
  1107. netdev_err(sdev->netdev, "failed to init status queue: %u\n",
  1108. err);
  1109. goto free_txq;
  1110. }
  1111. slic_write(sdev, SLIC_REG_ISP, lower_32_bits(sm->isr_paddr));
  1112. napi_enable(&sdev->napi);
  1113. /* disable irq mitigation */
  1114. slic_write(sdev, SLIC_REG_INTAGG, 0);
  1115. slic_write(sdev, SLIC_REG_ISR, 0);
  1116. slic_flush_write(sdev);
  1117. slic_set_mac_address(sdev);
  1118. spin_lock_bh(&sdev->link_lock);
  1119. sdev->duplex = DUPLEX_UNKNOWN;
  1120. sdev->speed = SPEED_UNKNOWN;
  1121. spin_unlock_bh(&sdev->link_lock);
  1122. slic_set_link_autoneg(sdev);
  1123. err = request_irq(sdev->pdev->irq, slic_irq, IRQF_SHARED, DRV_NAME,
  1124. sdev);
  1125. if (err) {
  1126. netdev_err(sdev->netdev, "failed to request irq: %u\n", err);
  1127. goto disable_napi;
  1128. }
  1129. slic_write(sdev, SLIC_REG_ICR, SLIC_ICR_INT_ON);
  1130. slic_flush_write(sdev);
  1131. /* request initial link status */
  1132. err = slic_handle_link_change(sdev);
  1133. if (err)
  1134. netdev_warn(sdev->netdev,
  1135. "failed to set initial link state: %u\n", err);
  1136. return 0;
  1137. disable_napi:
  1138. napi_disable(&sdev->napi);
  1139. slic_free_stat_queue(sdev);
  1140. free_txq:
  1141. slic_free_tx_queue(sdev);
  1142. free_rxq:
  1143. slic_free_rx_queue(sdev);
  1144. free_sm:
  1145. slic_free_shmem(sdev);
  1146. slic_card_reset(sdev);
  1147. return err;
  1148. }
  1149. static int slic_open(struct net_device *dev)
  1150. {
  1151. struct slic_device *sdev = netdev_priv(dev);
  1152. int err;
  1153. netif_carrier_off(dev);
  1154. err = slic_init_iface(sdev);
  1155. if (err) {
  1156. netdev_err(dev, "failed to initialize interface: %i\n", err);
  1157. return err;
  1158. }
  1159. netif_start_queue(dev);
  1160. return 0;
  1161. }
  1162. static int slic_close(struct net_device *dev)
  1163. {
  1164. struct slic_device *sdev = netdev_priv(dev);
  1165. u32 val;
  1166. netif_stop_queue(dev);
  1167. /* stop irq handling */
  1168. napi_disable(&sdev->napi);
  1169. slic_write(sdev, SLIC_REG_ICR, SLIC_ICR_INT_OFF);
  1170. slic_write(sdev, SLIC_REG_ISR, 0);
  1171. slic_flush_write(sdev);
  1172. free_irq(sdev->pdev->irq, sdev);
  1173. /* turn off RCV and XMT and power down PHY */
  1174. val = SLIC_GXCR_RESET | SLIC_GXCR_PAUSEEN;
  1175. slic_write(sdev, SLIC_REG_WXCFG, val);
  1176. val = SLIC_GRCR_RESET | SLIC_GRCR_CTLEN | SLIC_GRCR_ADDRAEN |
  1177. SLIC_GRCR_HASHSIZE << SLIC_GRCR_HASHSIZE_SHIFT;
  1178. slic_write(sdev, SLIC_REG_WRCFG, val);
  1179. val = MII_BMCR << 16 | BMCR_PDOWN;
  1180. slic_write(sdev, SLIC_REG_WPHY, val);
  1181. slic_flush_write(sdev);
  1182. slic_clear_upr_list(&sdev->upr_list);
  1183. slic_write(sdev, SLIC_REG_QUIESCE, 0);
  1184. slic_free_stat_queue(sdev);
  1185. slic_free_tx_queue(sdev);
  1186. slic_free_rx_queue(sdev);
  1187. slic_free_shmem(sdev);
  1188. slic_card_reset(sdev);
  1189. netif_carrier_off(dev);
  1190. return 0;
  1191. }
  1192. static netdev_tx_t slic_xmit(struct sk_buff *skb, struct net_device *dev)
  1193. {
  1194. struct slic_device *sdev = netdev_priv(dev);
  1195. struct slic_tx_queue *txq = &sdev->txq;
  1196. struct slic_tx_buffer *buff;
  1197. struct slic_tx_desc *desc;
  1198. dma_addr_t paddr;
  1199. u32 cbar_val;
  1200. u32 maplen;
  1201. if (unlikely(slic_get_free_tx_descs(txq) < SLIC_MAX_REQ_TX_DESCS)) {
  1202. netdev_err(dev, "BUG! not enough tx LEs left: %u\n",
  1203. slic_get_free_tx_descs(txq));
  1204. return NETDEV_TX_BUSY;
  1205. }
  1206. maplen = skb_headlen(skb);
  1207. paddr = dma_map_single(&sdev->pdev->dev, skb->data, maplen,
  1208. DMA_TO_DEVICE);
  1209. if (dma_mapping_error(&sdev->pdev->dev, paddr)) {
  1210. netdev_err(dev, "failed to map tx buffer\n");
  1211. goto drop_skb;
  1212. }
  1213. buff = &txq->txbuffs[txq->put_idx];
  1214. buff->skb = skb;
  1215. dma_unmap_addr_set(buff, map_addr, paddr);
  1216. dma_unmap_len_set(buff, map_len, maplen);
  1217. desc = buff->desc;
  1218. desc->totlen = cpu_to_le32(maplen);
  1219. desc->paddrl = cpu_to_le32(lower_32_bits(paddr));
  1220. desc->paddrh = cpu_to_le32(upper_32_bits(paddr));
  1221. desc->len = cpu_to_le32(maplen);
  1222. txq->put_idx = slic_next_queue_idx(txq->put_idx, txq->len);
  1223. cbar_val = lower_32_bits(buff->desc_paddr) | 1;
  1224. /* complete writes to RAM and DMA before hardware is informed */
  1225. wmb();
  1226. slic_write(sdev, SLIC_REG_CBAR, cbar_val);
  1227. if (slic_get_free_tx_descs(txq) < SLIC_MAX_REQ_TX_DESCS)
  1228. netif_stop_queue(dev);
  1229. /* make sure writes to io-memory cant leak out of tx queue lock */
  1230. mmiowb();
  1231. return NETDEV_TX_OK;
  1232. drop_skb:
  1233. dev_kfree_skb_any(skb);
  1234. return NETDEV_TX_OK;
  1235. }
  1236. static struct rtnl_link_stats64 *slic_get_stats(struct net_device *dev,
  1237. struct rtnl_link_stats64 *lst)
  1238. {
  1239. struct slic_device *sdev = netdev_priv(dev);
  1240. struct slic_stats *stats = &sdev->stats;
  1241. SLIC_GET_STATS_COUNTER(lst->rx_packets, stats, rx_packets);
  1242. SLIC_GET_STATS_COUNTER(lst->tx_packets, stats, tx_packets);
  1243. SLIC_GET_STATS_COUNTER(lst->rx_bytes, stats, rx_bytes);
  1244. SLIC_GET_STATS_COUNTER(lst->tx_bytes, stats, tx_bytes);
  1245. SLIC_GET_STATS_COUNTER(lst->rx_errors, stats, rx_errors);
  1246. SLIC_GET_STATS_COUNTER(lst->rx_dropped, stats, rx_buff_miss);
  1247. SLIC_GET_STATS_COUNTER(lst->tx_dropped, stats, tx_dropped);
  1248. SLIC_GET_STATS_COUNTER(lst->multicast, stats, rx_mcasts);
  1249. SLIC_GET_STATS_COUNTER(lst->rx_over_errors, stats, rx_buffoflow);
  1250. SLIC_GET_STATS_COUNTER(lst->rx_crc_errors, stats, rx_crc);
  1251. SLIC_GET_STATS_COUNTER(lst->rx_fifo_errors, stats, rx_oflow802);
  1252. SLIC_GET_STATS_COUNTER(lst->tx_carrier_errors, stats, tx_carrier);
  1253. return lst;
  1254. }
  1255. static int slic_get_sset_count(struct net_device *dev, int sset)
  1256. {
  1257. switch (sset) {
  1258. case ETH_SS_STATS:
  1259. return ARRAY_SIZE(slic_stats_strings);
  1260. default:
  1261. return -EOPNOTSUPP;
  1262. }
  1263. }
  1264. static void slic_get_ethtool_stats(struct net_device *dev,
  1265. struct ethtool_stats *eth_stats, u64 *data)
  1266. {
  1267. struct slic_device *sdev = netdev_priv(dev);
  1268. struct slic_stats *stats = &sdev->stats;
  1269. SLIC_GET_STATS_COUNTER(data[0], stats, rx_packets);
  1270. SLIC_GET_STATS_COUNTER(data[1], stats, rx_bytes);
  1271. SLIC_GET_STATS_COUNTER(data[2], stats, rx_mcasts);
  1272. SLIC_GET_STATS_COUNTER(data[3], stats, rx_errors);
  1273. SLIC_GET_STATS_COUNTER(data[4], stats, rx_buff_miss);
  1274. SLIC_GET_STATS_COUNTER(data[5], stats, rx_tpcsum);
  1275. SLIC_GET_STATS_COUNTER(data[6], stats, rx_tpoflow);
  1276. SLIC_GET_STATS_COUNTER(data[7], stats, rx_tphlen);
  1277. SLIC_GET_STATS_COUNTER(data[8], stats, rx_ipcsum);
  1278. SLIC_GET_STATS_COUNTER(data[9], stats, rx_iplen);
  1279. SLIC_GET_STATS_COUNTER(data[10], stats, rx_iphlen);
  1280. SLIC_GET_STATS_COUNTER(data[11], stats, rx_early);
  1281. SLIC_GET_STATS_COUNTER(data[12], stats, rx_buffoflow);
  1282. SLIC_GET_STATS_COUNTER(data[13], stats, rx_lcode);
  1283. SLIC_GET_STATS_COUNTER(data[14], stats, rx_drbl);
  1284. SLIC_GET_STATS_COUNTER(data[15], stats, rx_crc);
  1285. SLIC_GET_STATS_COUNTER(data[16], stats, rx_oflow802);
  1286. SLIC_GET_STATS_COUNTER(data[17], stats, rx_uflow802);
  1287. SLIC_GET_STATS_COUNTER(data[18], stats, tx_packets);
  1288. SLIC_GET_STATS_COUNTER(data[19], stats, tx_bytes);
  1289. SLIC_GET_STATS_COUNTER(data[20], stats, tx_carrier);
  1290. SLIC_GET_STATS_COUNTER(data[21], stats, tx_dropped);
  1291. SLIC_GET_STATS_COUNTER(data[22], stats, irq_errs);
  1292. }
  1293. static void slic_get_strings(struct net_device *dev, u32 stringset, u8 *data)
  1294. {
  1295. if (stringset == ETH_SS_STATS) {
  1296. memcpy(data, slic_stats_strings, sizeof(slic_stats_strings));
  1297. data += sizeof(slic_stats_strings);
  1298. }
  1299. }
  1300. static void slic_get_drvinfo(struct net_device *dev,
  1301. struct ethtool_drvinfo *info)
  1302. {
  1303. struct slic_device *sdev = netdev_priv(dev);
  1304. strlcpy(info->driver, DRV_NAME, sizeof(info->driver));
  1305. strlcpy(info->version, DRV_VERSION, sizeof(info->version));
  1306. strlcpy(info->bus_info, pci_name(sdev->pdev), sizeof(info->bus_info));
  1307. }
  1308. static const struct ethtool_ops slic_ethtool_ops = {
  1309. .get_drvinfo = slic_get_drvinfo,
  1310. .get_link = ethtool_op_get_link,
  1311. .get_strings = slic_get_strings,
  1312. .get_ethtool_stats = slic_get_ethtool_stats,
  1313. .get_sset_count = slic_get_sset_count,
  1314. };
  1315. static const struct net_device_ops slic_netdev_ops = {
  1316. .ndo_open = slic_open,
  1317. .ndo_stop = slic_close,
  1318. .ndo_start_xmit = slic_xmit,
  1319. .ndo_set_mac_address = eth_mac_addr,
  1320. .ndo_get_stats64 = slic_get_stats,
  1321. .ndo_set_rx_mode = slic_set_rx_mode,
  1322. .ndo_validate_addr = eth_validate_addr,
  1323. };
  1324. static u16 slic_eeprom_csum(unsigned char *eeprom, unsigned int len)
  1325. {
  1326. unsigned char *ptr = eeprom;
  1327. u32 csum = 0;
  1328. __le16 data;
  1329. while (len > 1) {
  1330. memcpy(&data, ptr, sizeof(data));
  1331. csum += le16_to_cpu(data);
  1332. ptr += 2;
  1333. len -= 2;
  1334. }
  1335. if (len > 0)
  1336. csum += *(u8 *)ptr;
  1337. while (csum >> 16)
  1338. csum = (csum & 0xFFFF) + ((csum >> 16) & 0xFFFF);
  1339. return ~csum;
  1340. }
  1341. /* check eeprom size, magic and checksum */
  1342. static bool slic_eeprom_valid(unsigned char *eeprom, unsigned int size)
  1343. {
  1344. const unsigned int MAX_SIZE = 128;
  1345. const unsigned int MIN_SIZE = 98;
  1346. __le16 magic;
  1347. __le16 csum;
  1348. if (size < MIN_SIZE || size > MAX_SIZE)
  1349. return false;
  1350. memcpy(&magic, eeprom, sizeof(magic));
  1351. if (le16_to_cpu(magic) != SLIC_EEPROM_MAGIC)
  1352. return false;
  1353. /* cut checksum bytes */
  1354. size -= 2;
  1355. memcpy(&csum, eeprom + size, sizeof(csum));
  1356. return (le16_to_cpu(csum) == slic_eeprom_csum(eeprom, size));
  1357. }
  1358. static int slic_read_eeprom(struct slic_device *sdev)
  1359. {
  1360. unsigned int devfn = PCI_FUNC(sdev->pdev->devfn);
  1361. struct slic_shmem *sm = &sdev->shmem;
  1362. struct slic_shmem_data *sm_data = sm->shmem_data;
  1363. const unsigned int MAX_LOOPS = 5000;
  1364. unsigned int codesize;
  1365. unsigned char *eeprom;
  1366. struct slic_upr *upr;
  1367. unsigned int i = 0;
  1368. dma_addr_t paddr;
  1369. int err = 0;
  1370. u8 *mac[2];
  1371. eeprom = dma_zalloc_coherent(&sdev->pdev->dev, SLIC_EEPROM_SIZE,
  1372. &paddr, GFP_KERNEL);
  1373. if (!eeprom)
  1374. return -ENOMEM;
  1375. slic_write(sdev, SLIC_REG_ICR, SLIC_ICR_INT_OFF);
  1376. /* setup ISP temporarily */
  1377. slic_write(sdev, SLIC_REG_ISP, lower_32_bits(sm->isr_paddr));
  1378. err = slic_new_upr(sdev, SLIC_UPR_CONFIG, paddr);
  1379. if (!err) {
  1380. for (i = 0; i < MAX_LOOPS; i++) {
  1381. if (le32_to_cpu(sm_data->isr) & SLIC_ISR_UPC)
  1382. break;
  1383. mdelay(1);
  1384. }
  1385. if (i == MAX_LOOPS) {
  1386. dev_err(&sdev->pdev->dev,
  1387. "timed out while waiting for eeprom data\n");
  1388. err = -ETIMEDOUT;
  1389. }
  1390. upr = slic_dequeue_upr(sdev);
  1391. kfree(upr);
  1392. }
  1393. slic_write(sdev, SLIC_REG_ISP, 0);
  1394. slic_write(sdev, SLIC_REG_ISR, 0);
  1395. slic_flush_write(sdev);
  1396. if (err)
  1397. goto free_eeprom;
  1398. if (sdev->model == SLIC_MODEL_OASIS) {
  1399. struct slic_oasis_eeprom *oee;
  1400. oee = (struct slic_oasis_eeprom *)eeprom;
  1401. mac[0] = oee->mac;
  1402. mac[1] = oee->mac2;
  1403. codesize = le16_to_cpu(oee->eeprom_code_size);
  1404. } else {
  1405. struct slic_mojave_eeprom *mee;
  1406. mee = (struct slic_mojave_eeprom *)eeprom;
  1407. mac[0] = mee->mac;
  1408. mac[1] = mee->mac2;
  1409. codesize = le16_to_cpu(mee->eeprom_code_size);
  1410. }
  1411. if (!slic_eeprom_valid(eeprom, codesize)) {
  1412. dev_err(&sdev->pdev->dev, "invalid checksum in eeprom\n");
  1413. err = -EINVAL;
  1414. goto free_eeprom;
  1415. }
  1416. /* set mac address */
  1417. ether_addr_copy(sdev->netdev->dev_addr, mac[devfn]);
  1418. free_eeprom:
  1419. dma_free_coherent(&sdev->pdev->dev, SLIC_EEPROM_SIZE, eeprom, paddr);
  1420. return err;
  1421. }
  1422. static int slic_init(struct slic_device *sdev)
  1423. {
  1424. int err;
  1425. spin_lock_init(&sdev->upper_lock);
  1426. spin_lock_init(&sdev->link_lock);
  1427. INIT_LIST_HEAD(&sdev->upr_list.list);
  1428. spin_lock_init(&sdev->upr_list.lock);
  1429. u64_stats_init(&sdev->stats.syncp);
  1430. slic_card_reset(sdev);
  1431. err = slic_load_firmware(sdev);
  1432. if (err) {
  1433. dev_err(&sdev->pdev->dev, "failed to load firmware\n");
  1434. return err;
  1435. }
  1436. /* we need the shared memory to read EEPROM so set it up temporarily */
  1437. err = slic_init_shmem(sdev);
  1438. if (err) {
  1439. dev_err(&sdev->pdev->dev, "failed to init shared memory\n");
  1440. return err;
  1441. }
  1442. err = slic_read_eeprom(sdev);
  1443. if (err) {
  1444. dev_err(&sdev->pdev->dev, "failed to read eeprom\n");
  1445. goto free_sm;
  1446. }
  1447. slic_card_reset(sdev);
  1448. slic_free_shmem(sdev);
  1449. return 0;
  1450. free_sm:
  1451. slic_free_shmem(sdev);
  1452. return err;
  1453. }
  1454. static bool slic_is_fiber(unsigned short subdev)
  1455. {
  1456. switch (subdev) {
  1457. /* Mojave */
  1458. case PCI_SUBDEVICE_ID_ALACRITECH_1000X1F: /* fallthrough */
  1459. case PCI_SUBDEVICE_ID_ALACRITECH_SES1001F: /* fallthrough */
  1460. /* Oasis */
  1461. case PCI_SUBDEVICE_ID_ALACRITECH_SEN2002XF: /* fallthrough */
  1462. case PCI_SUBDEVICE_ID_ALACRITECH_SEN2001XF: /* fallthrough */
  1463. case PCI_SUBDEVICE_ID_ALACRITECH_SEN2104EF: /* fallthrough */
  1464. case PCI_SUBDEVICE_ID_ALACRITECH_SEN2102EF: /* fallthrough */
  1465. return true;
  1466. }
  1467. return false;
  1468. }
  1469. static void slic_configure_pci(struct pci_dev *pdev)
  1470. {
  1471. u16 old;
  1472. u16 cmd;
  1473. pci_read_config_word(pdev, PCI_COMMAND, &old);
  1474. cmd = old | PCI_COMMAND_PARITY | PCI_COMMAND_SERR;
  1475. if (old != cmd)
  1476. pci_write_config_word(pdev, PCI_COMMAND, cmd);
  1477. }
  1478. static int slic_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
  1479. {
  1480. struct slic_device *sdev;
  1481. struct net_device *dev;
  1482. int err;
  1483. err = pci_enable_device(pdev);
  1484. if (err) {
  1485. dev_err(&pdev->dev, "failed to enable PCI device\n");
  1486. return err;
  1487. }
  1488. pci_set_master(pdev);
  1489. pci_try_set_mwi(pdev);
  1490. slic_configure_pci(pdev);
  1491. err = dma_set_mask(&pdev->dev, DMA_BIT_MASK(32));
  1492. if (err) {
  1493. dev_err(&pdev->dev, "failed to setup DMA\n");
  1494. goto disable;
  1495. }
  1496. dma_set_coherent_mask(&pdev->dev, DMA_BIT_MASK(32));
  1497. err = pci_request_regions(pdev, DRV_NAME);
  1498. if (err) {
  1499. dev_err(&pdev->dev, "failed to obtain PCI regions\n");
  1500. goto disable;
  1501. }
  1502. dev = alloc_etherdev(sizeof(*sdev));
  1503. if (!dev) {
  1504. dev_err(&pdev->dev, "failed to alloc ethernet device\n");
  1505. err = -ENOMEM;
  1506. goto free_regions;
  1507. }
  1508. SET_NETDEV_DEV(dev, &pdev->dev);
  1509. pci_set_drvdata(pdev, dev);
  1510. dev->irq = pdev->irq;
  1511. dev->netdev_ops = &slic_netdev_ops;
  1512. dev->hw_features = NETIF_F_RXCSUM;
  1513. dev->features |= dev->hw_features;
  1514. dev->ethtool_ops = &slic_ethtool_ops;
  1515. sdev = netdev_priv(dev);
  1516. sdev->model = (pdev->device == PCI_DEVICE_ID_ALACRITECH_OASIS) ?
  1517. SLIC_MODEL_OASIS : SLIC_MODEL_MOJAVE;
  1518. sdev->is_fiber = slic_is_fiber(pdev->subsystem_device);
  1519. sdev->pdev = pdev;
  1520. sdev->netdev = dev;
  1521. sdev->regs = ioremap_nocache(pci_resource_start(pdev, 0),
  1522. pci_resource_len(pdev, 0));
  1523. if (!sdev->regs) {
  1524. dev_err(&pdev->dev, "failed to map registers\n");
  1525. err = -ENOMEM;
  1526. goto free_netdev;
  1527. }
  1528. err = slic_init(sdev);
  1529. if (err) {
  1530. dev_err(&pdev->dev, "failed to initialize driver\n");
  1531. goto unmap;
  1532. }
  1533. netif_napi_add(dev, &sdev->napi, slic_poll, SLIC_NAPI_WEIGHT);
  1534. netif_carrier_off(dev);
  1535. err = register_netdev(dev);
  1536. if (err) {
  1537. dev_err(&pdev->dev, "failed to register net device: %i\n", err);
  1538. goto unmap;
  1539. }
  1540. return 0;
  1541. unmap:
  1542. iounmap(sdev->regs);
  1543. free_netdev:
  1544. free_netdev(dev);
  1545. free_regions:
  1546. pci_release_regions(pdev);
  1547. disable:
  1548. pci_disable_device(pdev);
  1549. return err;
  1550. }
  1551. static void slic_remove(struct pci_dev *pdev)
  1552. {
  1553. struct net_device *dev = pci_get_drvdata(pdev);
  1554. struct slic_device *sdev = netdev_priv(dev);
  1555. unregister_netdev(dev);
  1556. iounmap(sdev->regs);
  1557. free_netdev(dev);
  1558. pci_release_regions(pdev);
  1559. pci_disable_device(pdev);
  1560. }
  1561. static struct pci_driver slic_driver = {
  1562. .name = DRV_NAME,
  1563. .id_table = slic_id_tbl,
  1564. .probe = slic_probe,
  1565. .remove = slic_remove,
  1566. };
  1567. module_pci_driver(slic_driver);
  1568. MODULE_DESCRIPTION("Alacritech non-accelerated SLIC driver");
  1569. MODULE_AUTHOR("Lino Sanfilippo <LinoSanfilippo@gmx.de>");
  1570. MODULE_LICENSE("GPL");
  1571. MODULE_VERSION(DRV_VERSION);