atl1e_main.c 70 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264226522662267226822692270227122722273227422752276227722782279228022812282228322842285228622872288228922902291229222932294229522962297229822992300230123022303230423052306230723082309231023112312231323142315231623172318231923202321232223232324232523262327232823292330233123322333233423352336233723382339234023412342234323442345234623472348234923502351235223532354235523562357235823592360236123622363236423652366236723682369237023712372237323742375237623772378237923802381238223832384238523862387238823892390239123922393239423952396239723982399240024012402240324042405240624072408240924102411241224132414241524162417241824192420242124222423242424252426242724282429243024312432243324342435243624372438243924402441244224432444244524462447244824492450245124522453245424552456245724582459246024612462246324642465246624672468246924702471247224732474247524762477247824792480248124822483248424852486248724882489249024912492249324942495249624972498249925002501250225032504250525062507250825092510251125122513251425152516251725182519252025212522252325242525252625272528252925302531253225332534253525362537253825392540254125422543254425452546254725482549255025512552255325542555255625572558255925602561256225632564256525662567256825692570257125722573257425752576257725782579258025812582258325842585258625872588258925902591259225932594259525962597259825992600260126022603
  1. /*
  2. * Copyright(c) 2007 Atheros Corporation. All rights reserved.
  3. *
  4. * Derived from Intel e1000 driver
  5. * Copyright(c) 1999 - 2005 Intel Corporation. All rights reserved.
  6. *
  7. * This program is free software; you can redistribute it and/or modify it
  8. * under the terms of the GNU General Public License as published by the Free
  9. * Software Foundation; either version 2 of the License, or (at your option)
  10. * any later version.
  11. *
  12. * This program is distributed in the hope that it will be useful, but WITHOUT
  13. * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  14. * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
  15. * more details.
  16. *
  17. * You should have received a copy of the GNU General Public License along with
  18. * this program; if not, write to the Free Software Foundation, Inc., 59
  19. * Temple Place - Suite 330, Boston, MA 02111-1307, USA.
  20. */
  21. #include "atl1e.h"
  22. #define DRV_VERSION "1.0.0.7-NAPI"
  23. char atl1e_driver_name[] = "ATL1E";
  24. char atl1e_driver_version[] = DRV_VERSION;
  25. #define PCI_DEVICE_ID_ATTANSIC_L1E 0x1026
  26. /*
  27. * atl1e_pci_tbl - PCI Device ID Table
  28. *
  29. * Wildcard entries (PCI_ANY_ID) should come last
  30. * Last entry must be all 0s
  31. *
  32. * { Vendor ID, Device ID, SubVendor ID, SubDevice ID,
  33. * Class, Class Mask, private data (not used) }
  34. */
  35. static struct pci_device_id atl1e_pci_tbl[] = {
  36. {PCI_DEVICE(PCI_VENDOR_ID_ATTANSIC, PCI_DEVICE_ID_ATTANSIC_L1E)},
  37. {PCI_DEVICE(PCI_VENDOR_ID_ATTANSIC, 0x1066)},
  38. /* required last entry */
  39. { 0 }
  40. };
  41. MODULE_DEVICE_TABLE(pci, atl1e_pci_tbl);
  42. MODULE_AUTHOR("Atheros Corporation, <xiong.huang@atheros.com>, Jie Yang <jie.yang@atheros.com>");
  43. MODULE_DESCRIPTION("Atheros 1000M Ethernet Network Driver");
  44. MODULE_LICENSE("GPL");
  45. MODULE_VERSION(DRV_VERSION);
  46. static void atl1e_setup_mac_ctrl(struct atl1e_adapter *adapter);
  47. static const u16
  48. atl1e_rx_page_vld_regs[AT_MAX_RECEIVE_QUEUE][AT_PAGE_NUM_PER_QUEUE] =
  49. {
  50. {REG_HOST_RXF0_PAGE0_VLD, REG_HOST_RXF0_PAGE1_VLD},
  51. {REG_HOST_RXF1_PAGE0_VLD, REG_HOST_RXF1_PAGE1_VLD},
  52. {REG_HOST_RXF2_PAGE0_VLD, REG_HOST_RXF2_PAGE1_VLD},
  53. {REG_HOST_RXF3_PAGE0_VLD, REG_HOST_RXF3_PAGE1_VLD}
  54. };
  55. static const u16 atl1e_rx_page_hi_addr_regs[AT_MAX_RECEIVE_QUEUE] =
  56. {
  57. REG_RXF0_BASE_ADDR_HI,
  58. REG_RXF1_BASE_ADDR_HI,
  59. REG_RXF2_BASE_ADDR_HI,
  60. REG_RXF3_BASE_ADDR_HI
  61. };
  62. static const u16
  63. atl1e_rx_page_lo_addr_regs[AT_MAX_RECEIVE_QUEUE][AT_PAGE_NUM_PER_QUEUE] =
  64. {
  65. {REG_HOST_RXF0_PAGE0_LO, REG_HOST_RXF0_PAGE1_LO},
  66. {REG_HOST_RXF1_PAGE0_LO, REG_HOST_RXF1_PAGE1_LO},
  67. {REG_HOST_RXF2_PAGE0_LO, REG_HOST_RXF2_PAGE1_LO},
  68. {REG_HOST_RXF3_PAGE0_LO, REG_HOST_RXF3_PAGE1_LO}
  69. };
  70. static const u16
  71. atl1e_rx_page_write_offset_regs[AT_MAX_RECEIVE_QUEUE][AT_PAGE_NUM_PER_QUEUE] =
  72. {
  73. {REG_HOST_RXF0_MB0_LO, REG_HOST_RXF0_MB1_LO},
  74. {REG_HOST_RXF1_MB0_LO, REG_HOST_RXF1_MB1_LO},
  75. {REG_HOST_RXF2_MB0_LO, REG_HOST_RXF2_MB1_LO},
  76. {REG_HOST_RXF3_MB0_LO, REG_HOST_RXF3_MB1_LO}
  77. };
  78. static const u16 atl1e_pay_load_size[] = {
  79. 128, 256, 512, 1024, 2048, 4096,
  80. };
  81. /*
  82. * atl1e_irq_enable - Enable default interrupt generation settings
  83. * @adapter: board private structure
  84. */
  85. static inline void atl1e_irq_enable(struct atl1e_adapter *adapter)
  86. {
  87. if (likely(atomic_dec_and_test(&adapter->irq_sem))) {
  88. AT_WRITE_REG(&adapter->hw, REG_ISR, 0);
  89. AT_WRITE_REG(&adapter->hw, REG_IMR, IMR_NORMAL_MASK);
  90. AT_WRITE_FLUSH(&adapter->hw);
  91. }
  92. }
  93. /*
  94. * atl1e_irq_disable - Mask off interrupt generation on the NIC
  95. * @adapter: board private structure
  96. */
  97. static inline void atl1e_irq_disable(struct atl1e_adapter *adapter)
  98. {
  99. atomic_inc(&adapter->irq_sem);
  100. AT_WRITE_REG(&adapter->hw, REG_IMR, 0);
  101. AT_WRITE_FLUSH(&adapter->hw);
  102. synchronize_irq(adapter->pdev->irq);
  103. }
  104. /*
  105. * atl1e_irq_reset - reset interrupt confiure on the NIC
  106. * @adapter: board private structure
  107. */
  108. static inline void atl1e_irq_reset(struct atl1e_adapter *adapter)
  109. {
  110. atomic_set(&adapter->irq_sem, 0);
  111. AT_WRITE_REG(&adapter->hw, REG_ISR, 0);
  112. AT_WRITE_REG(&adapter->hw, REG_IMR, 0);
  113. AT_WRITE_FLUSH(&adapter->hw);
  114. }
  115. /*
  116. * atl1e_phy_config - Timer Call-back
  117. * @data: pointer to netdev cast into an unsigned long
  118. */
  119. static void atl1e_phy_config(unsigned long data)
  120. {
  121. struct atl1e_adapter *adapter = (struct atl1e_adapter *) data;
  122. struct atl1e_hw *hw = &adapter->hw;
  123. unsigned long flags;
  124. spin_lock_irqsave(&adapter->mdio_lock, flags);
  125. atl1e_restart_autoneg(hw);
  126. spin_unlock_irqrestore(&adapter->mdio_lock, flags);
  127. }
  128. void atl1e_reinit_locked(struct atl1e_adapter *adapter)
  129. {
  130. WARN_ON(in_interrupt());
  131. while (test_and_set_bit(__AT_RESETTING, &adapter->flags))
  132. msleep(1);
  133. atl1e_down(adapter);
  134. atl1e_up(adapter);
  135. clear_bit(__AT_RESETTING, &adapter->flags);
  136. }
  137. static void atl1e_reset_task(struct work_struct *work)
  138. {
  139. struct atl1e_adapter *adapter;
  140. adapter = container_of(work, struct atl1e_adapter, reset_task);
  141. atl1e_reinit_locked(adapter);
  142. }
  143. static int atl1e_check_link(struct atl1e_adapter *adapter)
  144. {
  145. struct atl1e_hw *hw = &adapter->hw;
  146. struct net_device *netdev = adapter->netdev;
  147. struct pci_dev *pdev = adapter->pdev;
  148. int err = 0;
  149. u16 speed, duplex, phy_data;
  150. /* MII_BMSR must read twise */
  151. atl1e_read_phy_reg(hw, MII_BMSR, &phy_data);
  152. atl1e_read_phy_reg(hw, MII_BMSR, &phy_data);
  153. if ((phy_data & BMSR_LSTATUS) == 0) {
  154. /* link down */
  155. if (netif_carrier_ok(netdev)) { /* old link state: Up */
  156. u32 value;
  157. /* disable rx */
  158. value = AT_READ_REG(hw, REG_MAC_CTRL);
  159. value &= ~MAC_CTRL_RX_EN;
  160. AT_WRITE_REG(hw, REG_MAC_CTRL, value);
  161. adapter->link_speed = SPEED_0;
  162. netif_carrier_off(netdev);
  163. netif_stop_queue(netdev);
  164. }
  165. } else {
  166. /* Link Up */
  167. err = atl1e_get_speed_and_duplex(hw, &speed, &duplex);
  168. if (unlikely(err))
  169. return err;
  170. /* link result is our setting */
  171. if (adapter->link_speed != speed ||
  172. adapter->link_duplex != duplex) {
  173. adapter->link_speed = speed;
  174. adapter->link_duplex = duplex;
  175. atl1e_setup_mac_ctrl(adapter);
  176. dev_info(&pdev->dev,
  177. "%s: %s NIC Link is Up<%d Mbps %s>\n",
  178. atl1e_driver_name, netdev->name,
  179. adapter->link_speed,
  180. adapter->link_duplex == FULL_DUPLEX ?
  181. "Full Duplex" : "Half Duplex");
  182. }
  183. if (!netif_carrier_ok(netdev)) {
  184. /* Link down -> Up */
  185. netif_carrier_on(netdev);
  186. netif_wake_queue(netdev);
  187. }
  188. }
  189. return 0;
  190. }
  191. /*
  192. * atl1e_link_chg_task - deal with link change event Out of interrupt context
  193. * @netdev: network interface device structure
  194. */
  195. static void atl1e_link_chg_task(struct work_struct *work)
  196. {
  197. struct atl1e_adapter *adapter;
  198. unsigned long flags;
  199. adapter = container_of(work, struct atl1e_adapter, link_chg_task);
  200. spin_lock_irqsave(&adapter->mdio_lock, flags);
  201. atl1e_check_link(adapter);
  202. spin_unlock_irqrestore(&adapter->mdio_lock, flags);
  203. }
  204. static void atl1e_link_chg_event(struct atl1e_adapter *adapter)
  205. {
  206. struct net_device *netdev = adapter->netdev;
  207. struct pci_dev *pdev = adapter->pdev;
  208. u16 phy_data = 0;
  209. u16 link_up = 0;
  210. spin_lock(&adapter->mdio_lock);
  211. atl1e_read_phy_reg(&adapter->hw, MII_BMSR, &phy_data);
  212. atl1e_read_phy_reg(&adapter->hw, MII_BMSR, &phy_data);
  213. spin_unlock(&adapter->mdio_lock);
  214. link_up = phy_data & BMSR_LSTATUS;
  215. /* notify upper layer link down ASAP */
  216. if (!link_up) {
  217. if (netif_carrier_ok(netdev)) {
  218. /* old link state: Up */
  219. dev_info(&pdev->dev, "%s: %s NIC Link is Down\n",
  220. atl1e_driver_name, netdev->name);
  221. adapter->link_speed = SPEED_0;
  222. netif_stop_queue(netdev);
  223. }
  224. }
  225. schedule_work(&adapter->link_chg_task);
  226. }
  227. static void atl1e_del_timer(struct atl1e_adapter *adapter)
  228. {
  229. del_timer_sync(&adapter->phy_config_timer);
  230. }
  231. static void atl1e_cancel_work(struct atl1e_adapter *adapter)
  232. {
  233. cancel_work_sync(&adapter->reset_task);
  234. cancel_work_sync(&adapter->link_chg_task);
  235. }
  236. /*
  237. * atl1e_tx_timeout - Respond to a Tx Hang
  238. * @netdev: network interface device structure
  239. */
  240. static void atl1e_tx_timeout(struct net_device *netdev)
  241. {
  242. struct atl1e_adapter *adapter = netdev_priv(netdev);
  243. /* Do the reset outside of interrupt context */
  244. schedule_work(&adapter->reset_task);
  245. }
  246. /*
  247. * atl1e_set_multi - Multicast and Promiscuous mode set
  248. * @netdev: network interface device structure
  249. *
  250. * The set_multi entry point is called whenever the multicast address
  251. * list or the network interface flags are updated. This routine is
  252. * responsible for configuring the hardware for proper multicast,
  253. * promiscuous mode, and all-multi behavior.
  254. */
  255. static void atl1e_set_multi(struct net_device *netdev)
  256. {
  257. struct atl1e_adapter *adapter = netdev_priv(netdev);
  258. struct atl1e_hw *hw = &adapter->hw;
  259. struct dev_mc_list *mc_ptr;
  260. u32 mac_ctrl_data = 0;
  261. u32 hash_value;
  262. /* Check for Promiscuous and All Multicast modes */
  263. mac_ctrl_data = AT_READ_REG(hw, REG_MAC_CTRL);
  264. if (netdev->flags & IFF_PROMISC) {
  265. mac_ctrl_data |= MAC_CTRL_PROMIS_EN;
  266. } else if (netdev->flags & IFF_ALLMULTI) {
  267. mac_ctrl_data |= MAC_CTRL_MC_ALL_EN;
  268. mac_ctrl_data &= ~MAC_CTRL_PROMIS_EN;
  269. } else {
  270. mac_ctrl_data &= ~(MAC_CTRL_PROMIS_EN | MAC_CTRL_MC_ALL_EN);
  271. }
  272. AT_WRITE_REG(hw, REG_MAC_CTRL, mac_ctrl_data);
  273. /* clear the old settings from the multicast hash table */
  274. AT_WRITE_REG(hw, REG_RX_HASH_TABLE, 0);
  275. AT_WRITE_REG_ARRAY(hw, REG_RX_HASH_TABLE, 1, 0);
  276. /* comoute mc addresses' hash value ,and put it into hash table */
  277. for (mc_ptr = netdev->mc_list; mc_ptr; mc_ptr = mc_ptr->next) {
  278. hash_value = atl1e_hash_mc_addr(hw, mc_ptr->dmi_addr);
  279. atl1e_hash_set(hw, hash_value);
  280. }
  281. }
  282. static void atl1e_vlan_rx_register(struct net_device *netdev,
  283. struct vlan_group *grp)
  284. {
  285. struct atl1e_adapter *adapter = netdev_priv(netdev);
  286. struct pci_dev *pdev = adapter->pdev;
  287. u32 mac_ctrl_data = 0;
  288. dev_dbg(&pdev->dev, "atl1e_vlan_rx_register\n");
  289. atl1e_irq_disable(adapter);
  290. adapter->vlgrp = grp;
  291. mac_ctrl_data = AT_READ_REG(&adapter->hw, REG_MAC_CTRL);
  292. if (grp) {
  293. /* enable VLAN tag insert/strip */
  294. mac_ctrl_data |= MAC_CTRL_RMV_VLAN;
  295. } else {
  296. /* disable VLAN tag insert/strip */
  297. mac_ctrl_data &= ~MAC_CTRL_RMV_VLAN;
  298. }
  299. AT_WRITE_REG(&adapter->hw, REG_MAC_CTRL, mac_ctrl_data);
  300. atl1e_irq_enable(adapter);
  301. }
  302. static void atl1e_restore_vlan(struct atl1e_adapter *adapter)
  303. {
  304. struct pci_dev *pdev = adapter->pdev;
  305. dev_dbg(&pdev->dev, "atl1e_restore_vlan !");
  306. atl1e_vlan_rx_register(adapter->netdev, adapter->vlgrp);
  307. }
  308. /*
  309. * atl1e_set_mac - Change the Ethernet Address of the NIC
  310. * @netdev: network interface device structure
  311. * @p: pointer to an address structure
  312. *
  313. * Returns 0 on success, negative on failure
  314. */
  315. static int atl1e_set_mac_addr(struct net_device *netdev, void *p)
  316. {
  317. struct atl1e_adapter *adapter = netdev_priv(netdev);
  318. struct sockaddr *addr = p;
  319. if (!is_valid_ether_addr(addr->sa_data))
  320. return -EADDRNOTAVAIL;
  321. if (netif_running(netdev))
  322. return -EBUSY;
  323. memcpy(netdev->dev_addr, addr->sa_data, netdev->addr_len);
  324. memcpy(adapter->hw.mac_addr, addr->sa_data, netdev->addr_len);
  325. atl1e_hw_set_mac_addr(&adapter->hw);
  326. return 0;
  327. }
  328. /*
  329. * atl1e_change_mtu - Change the Maximum Transfer Unit
  330. * @netdev: network interface device structure
  331. * @new_mtu: new value for maximum frame size
  332. *
  333. * Returns 0 on success, negative on failure
  334. */
  335. static int atl1e_change_mtu(struct net_device *netdev, int new_mtu)
  336. {
  337. struct atl1e_adapter *adapter = netdev_priv(netdev);
  338. int old_mtu = netdev->mtu;
  339. int max_frame = new_mtu + ETH_HLEN + ETH_FCS_LEN + VLAN_HLEN;
  340. if ((max_frame < ETH_ZLEN + ETH_FCS_LEN) ||
  341. (max_frame > MAX_JUMBO_FRAME_SIZE)) {
  342. dev_warn(&adapter->pdev->dev, "invalid MTU setting\n");
  343. return -EINVAL;
  344. }
  345. /* set MTU */
  346. if (old_mtu != new_mtu && netif_running(netdev)) {
  347. while (test_and_set_bit(__AT_RESETTING, &adapter->flags))
  348. msleep(1);
  349. netdev->mtu = new_mtu;
  350. adapter->hw.max_frame_size = new_mtu;
  351. adapter->hw.rx_jumbo_th = (max_frame + 7) >> 3;
  352. atl1e_down(adapter);
  353. atl1e_up(adapter);
  354. clear_bit(__AT_RESETTING, &adapter->flags);
  355. }
  356. return 0;
  357. }
  358. /*
  359. * caller should hold mdio_lock
  360. */
  361. static int atl1e_mdio_read(struct net_device *netdev, int phy_id, int reg_num)
  362. {
  363. struct atl1e_adapter *adapter = netdev_priv(netdev);
  364. u16 result;
  365. atl1e_read_phy_reg(&adapter->hw, reg_num & MDIO_REG_ADDR_MASK, &result);
  366. return result;
  367. }
  368. static void atl1e_mdio_write(struct net_device *netdev, int phy_id,
  369. int reg_num, int val)
  370. {
  371. struct atl1e_adapter *adapter = netdev_priv(netdev);
  372. atl1e_write_phy_reg(&adapter->hw, reg_num & MDIO_REG_ADDR_MASK, val);
  373. }
  374. /*
  375. * atl1e_mii_ioctl -
  376. * @netdev:
  377. * @ifreq:
  378. * @cmd:
  379. */
  380. static int atl1e_mii_ioctl(struct net_device *netdev,
  381. struct ifreq *ifr, int cmd)
  382. {
  383. struct atl1e_adapter *adapter = netdev_priv(netdev);
  384. struct pci_dev *pdev = adapter->pdev;
  385. struct mii_ioctl_data *data = if_mii(ifr);
  386. unsigned long flags;
  387. int retval = 0;
  388. if (!netif_running(netdev))
  389. return -EINVAL;
  390. spin_lock_irqsave(&adapter->mdio_lock, flags);
  391. switch (cmd) {
  392. case SIOCGMIIPHY:
  393. data->phy_id = 0;
  394. break;
  395. case SIOCGMIIREG:
  396. if (!capable(CAP_NET_ADMIN)) {
  397. retval = -EPERM;
  398. goto out;
  399. }
  400. if (atl1e_read_phy_reg(&adapter->hw, data->reg_num & 0x1F,
  401. &data->val_out)) {
  402. retval = -EIO;
  403. goto out;
  404. }
  405. break;
  406. case SIOCSMIIREG:
  407. if (!capable(CAP_NET_ADMIN)) {
  408. retval = -EPERM;
  409. goto out;
  410. }
  411. if (data->reg_num & ~(0x1F)) {
  412. retval = -EFAULT;
  413. goto out;
  414. }
  415. dev_dbg(&pdev->dev, "<atl1e_mii_ioctl> write %x %x",
  416. data->reg_num, data->val_in);
  417. if (atl1e_write_phy_reg(&adapter->hw,
  418. data->reg_num, data->val_in)) {
  419. retval = -EIO;
  420. goto out;
  421. }
  422. break;
  423. default:
  424. retval = -EOPNOTSUPP;
  425. break;
  426. }
  427. out:
  428. spin_unlock_irqrestore(&adapter->mdio_lock, flags);
  429. return retval;
  430. }
  431. /*
  432. * atl1e_ioctl -
  433. * @netdev:
  434. * @ifreq:
  435. * @cmd:
  436. */
  437. static int atl1e_ioctl(struct net_device *netdev, struct ifreq *ifr, int cmd)
  438. {
  439. switch (cmd) {
  440. case SIOCGMIIPHY:
  441. case SIOCGMIIREG:
  442. case SIOCSMIIREG:
  443. return atl1e_mii_ioctl(netdev, ifr, cmd);
  444. default:
  445. return -EOPNOTSUPP;
  446. }
  447. }
  448. static void atl1e_setup_pcicmd(struct pci_dev *pdev)
  449. {
  450. u16 cmd;
  451. pci_read_config_word(pdev, PCI_COMMAND, &cmd);
  452. cmd &= ~(PCI_COMMAND_INTX_DISABLE | PCI_COMMAND_IO);
  453. cmd |= (PCI_COMMAND_MEMORY | PCI_COMMAND_MASTER);
  454. pci_write_config_word(pdev, PCI_COMMAND, cmd);
  455. /*
  456. * some motherboards BIOS(PXE/EFI) driver may set PME
  457. * while they transfer control to OS (Windows/Linux)
  458. * so we should clear this bit before NIC work normally
  459. */
  460. pci_write_config_dword(pdev, REG_PM_CTRLSTAT, 0);
  461. msleep(1);
  462. }
  463. /*
  464. * atl1e_alloc_queues - Allocate memory for all rings
  465. * @adapter: board private structure to initialize
  466. *
  467. */
  468. static int __devinit atl1e_alloc_queues(struct atl1e_adapter *adapter)
  469. {
  470. return 0;
  471. }
  472. /*
  473. * atl1e_sw_init - Initialize general software structures (struct atl1e_adapter)
  474. * @adapter: board private structure to initialize
  475. *
  476. * atl1e_sw_init initializes the Adapter private data structure.
  477. * Fields are initialized based on PCI device information and
  478. * OS network device settings (MTU size).
  479. */
  480. static int __devinit atl1e_sw_init(struct atl1e_adapter *adapter)
  481. {
  482. struct atl1e_hw *hw = &adapter->hw;
  483. struct pci_dev *pdev = adapter->pdev;
  484. u32 phy_status_data = 0;
  485. adapter->wol = 0;
  486. adapter->link_speed = SPEED_0; /* hardware init */
  487. adapter->link_duplex = FULL_DUPLEX;
  488. adapter->num_rx_queues = 1;
  489. /* PCI config space info */
  490. hw->vendor_id = pdev->vendor;
  491. hw->device_id = pdev->device;
  492. hw->subsystem_vendor_id = pdev->subsystem_vendor;
  493. hw->subsystem_id = pdev->subsystem_device;
  494. pci_read_config_byte(pdev, PCI_REVISION_ID, &hw->revision_id);
  495. pci_read_config_word(pdev, PCI_COMMAND, &hw->pci_cmd_word);
  496. phy_status_data = AT_READ_REG(hw, REG_PHY_STATUS);
  497. /* nic type */
  498. if (hw->revision_id >= 0xF0) {
  499. hw->nic_type = athr_l2e_revB;
  500. } else {
  501. if (phy_status_data & PHY_STATUS_100M)
  502. hw->nic_type = athr_l1e;
  503. else
  504. hw->nic_type = athr_l2e_revA;
  505. }
  506. phy_status_data = AT_READ_REG(hw, REG_PHY_STATUS);
  507. if (phy_status_data & PHY_STATUS_EMI_CA)
  508. hw->emi_ca = true;
  509. else
  510. hw->emi_ca = false;
  511. hw->phy_configured = false;
  512. hw->preamble_len = 7;
  513. hw->max_frame_size = adapter->netdev->mtu;
  514. hw->rx_jumbo_th = (hw->max_frame_size + ETH_HLEN +
  515. VLAN_HLEN + ETH_FCS_LEN + 7) >> 3;
  516. hw->rrs_type = atl1e_rrs_disable;
  517. hw->indirect_tab = 0;
  518. hw->base_cpu = 0;
  519. /* need confirm */
  520. hw->ict = 50000; /* 100ms */
  521. hw->smb_timer = 200000; /* 200ms */
  522. hw->tpd_burst = 5;
  523. hw->rrd_thresh = 1;
  524. hw->tpd_thresh = adapter->tx_ring.count / 2;
  525. hw->rx_count_down = 4; /* 2us resolution */
  526. hw->tx_count_down = hw->imt * 4 / 3;
  527. hw->dmar_block = atl1e_dma_req_1024;
  528. hw->dmaw_block = atl1e_dma_req_1024;
  529. hw->dmar_dly_cnt = 15;
  530. hw->dmaw_dly_cnt = 4;
  531. if (atl1e_alloc_queues(adapter)) {
  532. dev_err(&pdev->dev, "Unable to allocate memory for queues\n");
  533. return -ENOMEM;
  534. }
  535. atomic_set(&adapter->irq_sem, 1);
  536. spin_lock_init(&adapter->mdio_lock);
  537. spin_lock_init(&adapter->tx_lock);
  538. set_bit(__AT_DOWN, &adapter->flags);
  539. return 0;
  540. }
  541. /*
  542. * atl1e_clean_tx_ring - Free Tx-skb
  543. * @adapter: board private structure
  544. */
  545. static void atl1e_clean_tx_ring(struct atl1e_adapter *adapter)
  546. {
  547. struct atl1e_tx_ring *tx_ring = (struct atl1e_tx_ring *)
  548. &adapter->tx_ring;
  549. struct atl1e_tx_buffer *tx_buffer = NULL;
  550. struct pci_dev *pdev = adapter->pdev;
  551. u16 index, ring_count;
  552. if (tx_ring->desc == NULL || tx_ring->tx_buffer == NULL)
  553. return;
  554. ring_count = tx_ring->count;
  555. /* first unmmap dma */
  556. for (index = 0; index < ring_count; index++) {
  557. tx_buffer = &tx_ring->tx_buffer[index];
  558. if (tx_buffer->dma) {
  559. pci_unmap_page(pdev, tx_buffer->dma,
  560. tx_buffer->length, PCI_DMA_TODEVICE);
  561. tx_buffer->dma = 0;
  562. }
  563. }
  564. /* second free skb */
  565. for (index = 0; index < ring_count; index++) {
  566. tx_buffer = &tx_ring->tx_buffer[index];
  567. if (tx_buffer->skb) {
  568. dev_kfree_skb_any(tx_buffer->skb);
  569. tx_buffer->skb = NULL;
  570. }
  571. }
  572. /* Zero out Tx-buffers */
  573. memset(tx_ring->desc, 0, sizeof(struct atl1e_tpd_desc) *
  574. ring_count);
  575. memset(tx_ring->tx_buffer, 0, sizeof(struct atl1e_tx_buffer) *
  576. ring_count);
  577. }
  578. /*
  579. * atl1e_clean_rx_ring - Free rx-reservation skbs
  580. * @adapter: board private structure
  581. */
  582. static void atl1e_clean_rx_ring(struct atl1e_adapter *adapter)
  583. {
  584. struct atl1e_rx_ring *rx_ring =
  585. (struct atl1e_rx_ring *)&adapter->rx_ring;
  586. struct atl1e_rx_page_desc *rx_page_desc = rx_ring->rx_page_desc;
  587. u16 i, j;
  588. if (adapter->ring_vir_addr == NULL)
  589. return;
  590. /* Zero out the descriptor ring */
  591. for (i = 0; i < adapter->num_rx_queues; i++) {
  592. for (j = 0; j < AT_PAGE_NUM_PER_QUEUE; j++) {
  593. if (rx_page_desc[i].rx_page[j].addr != NULL) {
  594. memset(rx_page_desc[i].rx_page[j].addr, 0,
  595. rx_ring->real_page_size);
  596. }
  597. }
  598. }
  599. }
  600. static void atl1e_cal_ring_size(struct atl1e_adapter *adapter, u32 *ring_size)
  601. {
  602. *ring_size = ((u32)(adapter->tx_ring.count *
  603. sizeof(struct atl1e_tpd_desc) + 7
  604. /* tx ring, qword align */
  605. + adapter->rx_ring.real_page_size * AT_PAGE_NUM_PER_QUEUE *
  606. adapter->num_rx_queues + 31
  607. /* rx ring, 32 bytes align */
  608. + (1 + AT_PAGE_NUM_PER_QUEUE * adapter->num_rx_queues) *
  609. sizeof(u32) + 3));
  610. /* tx, rx cmd, dword align */
  611. }
  612. static void atl1e_init_ring_resources(struct atl1e_adapter *adapter)
  613. {
  614. struct atl1e_tx_ring *tx_ring = NULL;
  615. struct atl1e_rx_ring *rx_ring = NULL;
  616. tx_ring = &adapter->tx_ring;
  617. rx_ring = &adapter->rx_ring;
  618. rx_ring->real_page_size = adapter->rx_ring.page_size
  619. + adapter->hw.max_frame_size
  620. + ETH_HLEN + VLAN_HLEN
  621. + ETH_FCS_LEN;
  622. rx_ring->real_page_size = roundup(rx_ring->real_page_size, 32);
  623. atl1e_cal_ring_size(adapter, &adapter->ring_size);
  624. adapter->ring_vir_addr = NULL;
  625. adapter->rx_ring.desc = NULL;
  626. rwlock_init(&adapter->tx_ring.tx_lock);
  627. return;
  628. }
  629. /*
  630. * Read / Write Ptr Initialize:
  631. */
  632. static void atl1e_init_ring_ptrs(struct atl1e_adapter *adapter)
  633. {
  634. struct atl1e_tx_ring *tx_ring = NULL;
  635. struct atl1e_rx_ring *rx_ring = NULL;
  636. struct atl1e_rx_page_desc *rx_page_desc = NULL;
  637. int i, j;
  638. tx_ring = &adapter->tx_ring;
  639. rx_ring = &adapter->rx_ring;
  640. rx_page_desc = rx_ring->rx_page_desc;
  641. tx_ring->next_to_use = 0;
  642. atomic_set(&tx_ring->next_to_clean, 0);
  643. for (i = 0; i < adapter->num_rx_queues; i++) {
  644. rx_page_desc[i].rx_using = 0;
  645. rx_page_desc[i].rx_nxseq = 0;
  646. for (j = 0; j < AT_PAGE_NUM_PER_QUEUE; j++) {
  647. *rx_page_desc[i].rx_page[j].write_offset_addr = 0;
  648. rx_page_desc[i].rx_page[j].read_offset = 0;
  649. }
  650. }
  651. }
  652. /*
  653. * atl1e_free_ring_resources - Free Tx / RX descriptor Resources
  654. * @adapter: board private structure
  655. *
  656. * Free all transmit software resources
  657. */
  658. static void atl1e_free_ring_resources(struct atl1e_adapter *adapter)
  659. {
  660. struct pci_dev *pdev = adapter->pdev;
  661. atl1e_clean_tx_ring(adapter);
  662. atl1e_clean_rx_ring(adapter);
  663. if (adapter->ring_vir_addr) {
  664. pci_free_consistent(pdev, adapter->ring_size,
  665. adapter->ring_vir_addr, adapter->ring_dma);
  666. adapter->ring_vir_addr = NULL;
  667. }
  668. if (adapter->tx_ring.tx_buffer) {
  669. kfree(adapter->tx_ring.tx_buffer);
  670. adapter->tx_ring.tx_buffer = NULL;
  671. }
  672. }
  673. /*
  674. * atl1e_setup_mem_resources - allocate Tx / RX descriptor resources
  675. * @adapter: board private structure
  676. *
  677. * Return 0 on success, negative on failure
  678. */
  679. static int atl1e_setup_ring_resources(struct atl1e_adapter *adapter)
  680. {
  681. struct pci_dev *pdev = adapter->pdev;
  682. struct atl1e_tx_ring *tx_ring;
  683. struct atl1e_rx_ring *rx_ring;
  684. struct atl1e_rx_page_desc *rx_page_desc;
  685. int size, i, j;
  686. u32 offset = 0;
  687. int err = 0;
  688. if (adapter->ring_vir_addr != NULL)
  689. return 0; /* alloced already */
  690. tx_ring = &adapter->tx_ring;
  691. rx_ring = &adapter->rx_ring;
  692. /* real ring DMA buffer */
  693. size = adapter->ring_size;
  694. adapter->ring_vir_addr = pci_alloc_consistent(pdev,
  695. adapter->ring_size, &adapter->ring_dma);
  696. if (adapter->ring_vir_addr == NULL) {
  697. dev_err(&pdev->dev, "pci_alloc_consistent failed, "
  698. "size = D%d", size);
  699. return -ENOMEM;
  700. }
  701. memset(adapter->ring_vir_addr, 0, adapter->ring_size);
  702. rx_page_desc = rx_ring->rx_page_desc;
  703. /* Init TPD Ring */
  704. tx_ring->dma = roundup(adapter->ring_dma, 8);
  705. offset = tx_ring->dma - adapter->ring_dma;
  706. tx_ring->desc = (struct atl1e_tpd_desc *)
  707. (adapter->ring_vir_addr + offset);
  708. size = sizeof(struct atl1e_tx_buffer) * (tx_ring->count);
  709. tx_ring->tx_buffer = kzalloc(size, GFP_KERNEL);
  710. if (tx_ring->tx_buffer == NULL) {
  711. dev_err(&pdev->dev, "kzalloc failed , size = D%d", size);
  712. err = -ENOMEM;
  713. goto failed;
  714. }
  715. /* Init RXF-Pages */
  716. offset += (sizeof(struct atl1e_tpd_desc) * tx_ring->count);
  717. offset = roundup(offset, 32);
  718. for (i = 0; i < adapter->num_rx_queues; i++) {
  719. for (j = 0; j < AT_PAGE_NUM_PER_QUEUE; j++) {
  720. rx_page_desc[i].rx_page[j].dma =
  721. adapter->ring_dma + offset;
  722. rx_page_desc[i].rx_page[j].addr =
  723. adapter->ring_vir_addr + offset;
  724. offset += rx_ring->real_page_size;
  725. }
  726. }
  727. /* Init CMB dma address */
  728. tx_ring->cmb_dma = adapter->ring_dma + offset;
  729. tx_ring->cmb = (u32 *)(adapter->ring_vir_addr + offset);
  730. offset += sizeof(u32);
  731. for (i = 0; i < adapter->num_rx_queues; i++) {
  732. for (j = 0; j < AT_PAGE_NUM_PER_QUEUE; j++) {
  733. rx_page_desc[i].rx_page[j].write_offset_dma =
  734. adapter->ring_dma + offset;
  735. rx_page_desc[i].rx_page[j].write_offset_addr =
  736. adapter->ring_vir_addr + offset;
  737. offset += sizeof(u32);
  738. }
  739. }
  740. if (unlikely(offset > adapter->ring_size)) {
  741. dev_err(&pdev->dev, "offset(%d) > ring size(%d) !!\n",
  742. offset, adapter->ring_size);
  743. err = -1;
  744. goto failed;
  745. }
  746. return 0;
  747. failed:
  748. if (adapter->ring_vir_addr != NULL) {
  749. pci_free_consistent(pdev, adapter->ring_size,
  750. adapter->ring_vir_addr, adapter->ring_dma);
  751. adapter->ring_vir_addr = NULL;
  752. }
  753. return err;
  754. }
  755. static inline void atl1e_configure_des_ring(const struct atl1e_adapter *adapter)
  756. {
  757. struct atl1e_hw *hw = (struct atl1e_hw *)&adapter->hw;
  758. struct atl1e_rx_ring *rx_ring =
  759. (struct atl1e_rx_ring *)&adapter->rx_ring;
  760. struct atl1e_tx_ring *tx_ring =
  761. (struct atl1e_tx_ring *)&adapter->tx_ring;
  762. struct atl1e_rx_page_desc *rx_page_desc = NULL;
  763. int i, j;
  764. AT_WRITE_REG(hw, REG_DESC_BASE_ADDR_HI,
  765. (u32)((adapter->ring_dma & AT_DMA_HI_ADDR_MASK) >> 32));
  766. AT_WRITE_REG(hw, REG_TPD_BASE_ADDR_LO,
  767. (u32)((tx_ring->dma) & AT_DMA_LO_ADDR_MASK));
  768. AT_WRITE_REG(hw, REG_TPD_RING_SIZE, (u16)(tx_ring->count));
  769. AT_WRITE_REG(hw, REG_HOST_TX_CMB_LO,
  770. (u32)((tx_ring->cmb_dma) & AT_DMA_LO_ADDR_MASK));
  771. rx_page_desc = rx_ring->rx_page_desc;
  772. /* RXF Page Physical address / Page Length */
  773. for (i = 0; i < AT_MAX_RECEIVE_QUEUE; i++) {
  774. AT_WRITE_REG(hw, atl1e_rx_page_hi_addr_regs[i],
  775. (u32)((adapter->ring_dma &
  776. AT_DMA_HI_ADDR_MASK) >> 32));
  777. for (j = 0; j < AT_PAGE_NUM_PER_QUEUE; j++) {
  778. u32 page_phy_addr;
  779. u32 offset_phy_addr;
  780. page_phy_addr = rx_page_desc[i].rx_page[j].dma;
  781. offset_phy_addr =
  782. rx_page_desc[i].rx_page[j].write_offset_dma;
  783. AT_WRITE_REG(hw, atl1e_rx_page_lo_addr_regs[i][j],
  784. page_phy_addr & AT_DMA_LO_ADDR_MASK);
  785. AT_WRITE_REG(hw, atl1e_rx_page_write_offset_regs[i][j],
  786. offset_phy_addr & AT_DMA_LO_ADDR_MASK);
  787. AT_WRITE_REGB(hw, atl1e_rx_page_vld_regs[i][j], 1);
  788. }
  789. }
  790. /* Page Length */
  791. AT_WRITE_REG(hw, REG_HOST_RXFPAGE_SIZE, rx_ring->page_size);
  792. /* Load all of base address above */
  793. AT_WRITE_REG(hw, REG_LOAD_PTR, 1);
  794. return;
  795. }
  796. static inline void atl1e_configure_tx(struct atl1e_adapter *adapter)
  797. {
  798. struct atl1e_hw *hw = (struct atl1e_hw *)&adapter->hw;
  799. u32 dev_ctrl_data = 0;
  800. u32 max_pay_load = 0;
  801. u32 jumbo_thresh = 0;
  802. u32 extra_size = 0; /* Jumbo frame threshold in QWORD unit */
  803. /* configure TXQ param */
  804. if (hw->nic_type != athr_l2e_revB) {
  805. extra_size = ETH_HLEN + VLAN_HLEN + ETH_FCS_LEN;
  806. if (hw->max_frame_size <= 1500) {
  807. jumbo_thresh = hw->max_frame_size + extra_size;
  808. } else if (hw->max_frame_size < 6*1024) {
  809. jumbo_thresh =
  810. (hw->max_frame_size + extra_size) * 2 / 3;
  811. } else {
  812. jumbo_thresh = (hw->max_frame_size + extra_size) / 2;
  813. }
  814. AT_WRITE_REG(hw, REG_TX_EARLY_TH, (jumbo_thresh + 7) >> 3);
  815. }
  816. dev_ctrl_data = AT_READ_REG(hw, REG_DEVICE_CTRL);
  817. max_pay_load = ((dev_ctrl_data >> DEVICE_CTRL_MAX_PAYLOAD_SHIFT)) &
  818. DEVICE_CTRL_MAX_PAYLOAD_MASK;
  819. hw->dmaw_block = min(max_pay_load, hw->dmaw_block);
  820. max_pay_load = ((dev_ctrl_data >> DEVICE_CTRL_MAX_RREQ_SZ_SHIFT)) &
  821. DEVICE_CTRL_MAX_RREQ_SZ_MASK;
  822. hw->dmar_block = min(max_pay_load, hw->dmar_block);
  823. if (hw->nic_type != athr_l2e_revB)
  824. AT_WRITE_REGW(hw, REG_TXQ_CTRL + 2,
  825. atl1e_pay_load_size[hw->dmar_block]);
  826. /* enable TXQ */
  827. AT_WRITE_REGW(hw, REG_TXQ_CTRL,
  828. (((u16)hw->tpd_burst & TXQ_CTRL_NUM_TPD_BURST_MASK)
  829. << TXQ_CTRL_NUM_TPD_BURST_SHIFT)
  830. | TXQ_CTRL_ENH_MODE | TXQ_CTRL_EN);
  831. return;
  832. }
  833. static inline void atl1e_configure_rx(struct atl1e_adapter *adapter)
  834. {
  835. struct atl1e_hw *hw = (struct atl1e_hw *)&adapter->hw;
  836. u32 rxf_len = 0;
  837. u32 rxf_low = 0;
  838. u32 rxf_high = 0;
  839. u32 rxf_thresh_data = 0;
  840. u32 rxq_ctrl_data = 0;
  841. if (hw->nic_type != athr_l2e_revB) {
  842. AT_WRITE_REGW(hw, REG_RXQ_JMBOSZ_RRDTIM,
  843. (u16)((hw->rx_jumbo_th & RXQ_JMBOSZ_TH_MASK) <<
  844. RXQ_JMBOSZ_TH_SHIFT |
  845. (1 & RXQ_JMBO_LKAH_MASK) <<
  846. RXQ_JMBO_LKAH_SHIFT));
  847. rxf_len = AT_READ_REG(hw, REG_SRAM_RXF_LEN);
  848. rxf_high = rxf_len * 4 / 5;
  849. rxf_low = rxf_len / 5;
  850. rxf_thresh_data = ((rxf_high & RXQ_RXF_PAUSE_TH_HI_MASK)
  851. << RXQ_RXF_PAUSE_TH_HI_SHIFT) |
  852. ((rxf_low & RXQ_RXF_PAUSE_TH_LO_MASK)
  853. << RXQ_RXF_PAUSE_TH_LO_SHIFT);
  854. AT_WRITE_REG(hw, REG_RXQ_RXF_PAUSE_THRESH, rxf_thresh_data);
  855. }
  856. /* RRS */
  857. AT_WRITE_REG(hw, REG_IDT_TABLE, hw->indirect_tab);
  858. AT_WRITE_REG(hw, REG_BASE_CPU_NUMBER, hw->base_cpu);
  859. if (hw->rrs_type & atl1e_rrs_ipv4)
  860. rxq_ctrl_data |= RXQ_CTRL_HASH_TYPE_IPV4;
  861. if (hw->rrs_type & atl1e_rrs_ipv4_tcp)
  862. rxq_ctrl_data |= RXQ_CTRL_HASH_TYPE_IPV4_TCP;
  863. if (hw->rrs_type & atl1e_rrs_ipv6)
  864. rxq_ctrl_data |= RXQ_CTRL_HASH_TYPE_IPV6;
  865. if (hw->rrs_type & atl1e_rrs_ipv6_tcp)
  866. rxq_ctrl_data |= RXQ_CTRL_HASH_TYPE_IPV6_TCP;
  867. if (hw->rrs_type != atl1e_rrs_disable)
  868. rxq_ctrl_data |=
  869. (RXQ_CTRL_HASH_ENABLE | RXQ_CTRL_RSS_MODE_MQUESINT);
  870. rxq_ctrl_data |= RXQ_CTRL_IPV6_XSUM_VERIFY_EN | RXQ_CTRL_PBA_ALIGN_32 |
  871. RXQ_CTRL_CUT_THRU_EN | RXQ_CTRL_EN;
  872. AT_WRITE_REG(hw, REG_RXQ_CTRL, rxq_ctrl_data);
  873. return;
  874. }
  875. static inline void atl1e_configure_dma(struct atl1e_adapter *adapter)
  876. {
  877. struct atl1e_hw *hw = &adapter->hw;
  878. u32 dma_ctrl_data = 0;
  879. dma_ctrl_data = DMA_CTRL_RXCMB_EN;
  880. dma_ctrl_data |= (((u32)hw->dmar_block) & DMA_CTRL_DMAR_BURST_LEN_MASK)
  881. << DMA_CTRL_DMAR_BURST_LEN_SHIFT;
  882. dma_ctrl_data |= (((u32)hw->dmaw_block) & DMA_CTRL_DMAW_BURST_LEN_MASK)
  883. << DMA_CTRL_DMAW_BURST_LEN_SHIFT;
  884. dma_ctrl_data |= DMA_CTRL_DMAR_REQ_PRI | DMA_CTRL_DMAR_OUT_ORDER;
  885. dma_ctrl_data |= (((u32)hw->dmar_dly_cnt) & DMA_CTRL_DMAR_DLY_CNT_MASK)
  886. << DMA_CTRL_DMAR_DLY_CNT_SHIFT;
  887. dma_ctrl_data |= (((u32)hw->dmaw_dly_cnt) & DMA_CTRL_DMAW_DLY_CNT_MASK)
  888. << DMA_CTRL_DMAW_DLY_CNT_SHIFT;
  889. AT_WRITE_REG(hw, REG_DMA_CTRL, dma_ctrl_data);
  890. return;
  891. }
  892. static void atl1e_setup_mac_ctrl(struct atl1e_adapter *adapter)
  893. {
  894. u32 value;
  895. struct atl1e_hw *hw = &adapter->hw;
  896. struct net_device *netdev = adapter->netdev;
  897. /* Config MAC CTRL Register */
  898. value = MAC_CTRL_TX_EN |
  899. MAC_CTRL_RX_EN ;
  900. if (FULL_DUPLEX == adapter->link_duplex)
  901. value |= MAC_CTRL_DUPLX;
  902. value |= ((u32)((SPEED_1000 == adapter->link_speed) ?
  903. MAC_CTRL_SPEED_1000 : MAC_CTRL_SPEED_10_100) <<
  904. MAC_CTRL_SPEED_SHIFT);
  905. value |= (MAC_CTRL_TX_FLOW | MAC_CTRL_RX_FLOW);
  906. value |= (MAC_CTRL_ADD_CRC | MAC_CTRL_PAD);
  907. value |= (((u32)adapter->hw.preamble_len &
  908. MAC_CTRL_PRMLEN_MASK) << MAC_CTRL_PRMLEN_SHIFT);
  909. if (adapter->vlgrp)
  910. value |= MAC_CTRL_RMV_VLAN;
  911. value |= MAC_CTRL_BC_EN;
  912. if (netdev->flags & IFF_PROMISC)
  913. value |= MAC_CTRL_PROMIS_EN;
  914. if (netdev->flags & IFF_ALLMULTI)
  915. value |= MAC_CTRL_MC_ALL_EN;
  916. AT_WRITE_REG(hw, REG_MAC_CTRL, value);
  917. }
  918. /*
  919. * atl1e_configure - Configure Transmit&Receive Unit after Reset
  920. * @adapter: board private structure
  921. *
  922. * Configure the Tx /Rx unit of the MAC after a reset.
  923. */
  924. static int atl1e_configure(struct atl1e_adapter *adapter)
  925. {
  926. struct atl1e_hw *hw = &adapter->hw;
  927. struct pci_dev *pdev = adapter->pdev;
  928. u32 intr_status_data = 0;
  929. /* clear interrupt status */
  930. AT_WRITE_REG(hw, REG_ISR, ~0);
  931. /* 1. set MAC Address */
  932. atl1e_hw_set_mac_addr(hw);
  933. /* 2. Init the Multicast HASH table done by set_muti */
  934. /* 3. Clear any WOL status */
  935. AT_WRITE_REG(hw, REG_WOL_CTRL, 0);
  936. /* 4. Descripter Ring BaseMem/Length/Read ptr/Write ptr
  937. * TPD Ring/SMB/RXF0 Page CMBs, they use the same
  938. * High 32bits memory */
  939. atl1e_configure_des_ring(adapter);
  940. /* 5. set Interrupt Moderator Timer */
  941. AT_WRITE_REGW(hw, REG_IRQ_MODU_TIMER_INIT, hw->imt);
  942. AT_WRITE_REGW(hw, REG_IRQ_MODU_TIMER2_INIT, hw->imt);
  943. AT_WRITE_REG(hw, REG_MASTER_CTRL, MASTER_CTRL_LED_MODE |
  944. MASTER_CTRL_ITIMER_EN | MASTER_CTRL_ITIMER2_EN);
  945. /* 6. rx/tx threshold to trig interrupt */
  946. AT_WRITE_REGW(hw, REG_TRIG_RRD_THRESH, hw->rrd_thresh);
  947. AT_WRITE_REGW(hw, REG_TRIG_TPD_THRESH, hw->tpd_thresh);
  948. AT_WRITE_REGW(hw, REG_TRIG_RXTIMER, hw->rx_count_down);
  949. AT_WRITE_REGW(hw, REG_TRIG_TXTIMER, hw->tx_count_down);
  950. /* 7. set Interrupt Clear Timer */
  951. AT_WRITE_REGW(hw, REG_CMBDISDMA_TIMER, hw->ict);
  952. /* 8. set MTU */
  953. AT_WRITE_REG(hw, REG_MTU, hw->max_frame_size + ETH_HLEN +
  954. VLAN_HLEN + ETH_FCS_LEN);
  955. /* 9. config TXQ early tx threshold */
  956. atl1e_configure_tx(adapter);
  957. /* 10. config RXQ */
  958. atl1e_configure_rx(adapter);
  959. /* 11. config DMA Engine */
  960. atl1e_configure_dma(adapter);
  961. /* 12. smb timer to trig interrupt */
  962. AT_WRITE_REG(hw, REG_SMB_STAT_TIMER, hw->smb_timer);
  963. intr_status_data = AT_READ_REG(hw, REG_ISR);
  964. if (unlikely((intr_status_data & ISR_PHY_LINKDOWN) != 0)) {
  965. dev_err(&pdev->dev, "atl1e_configure failed,"
  966. "PCIE phy link down\n");
  967. return -1;
  968. }
  969. AT_WRITE_REG(hw, REG_ISR, 0x7fffffff);
  970. return 0;
  971. }
  972. /*
  973. * atl1e_get_stats - Get System Network Statistics
  974. * @netdev: network interface device structure
  975. *
  976. * Returns the address of the device statistics structure.
  977. * The statistics are actually updated from the timer callback.
  978. */
  979. static struct net_device_stats *atl1e_get_stats(struct net_device *netdev)
  980. {
  981. struct atl1e_adapter *adapter = netdev_priv(netdev);
  982. struct atl1e_hw_stats *hw_stats = &adapter->hw_stats;
  983. struct net_device_stats *net_stats = &netdev->stats;
  984. net_stats->rx_packets = hw_stats->rx_ok;
  985. net_stats->tx_packets = hw_stats->tx_ok;
  986. net_stats->rx_bytes = hw_stats->rx_byte_cnt;
  987. net_stats->tx_bytes = hw_stats->tx_byte_cnt;
  988. net_stats->multicast = hw_stats->rx_mcast;
  989. net_stats->collisions = hw_stats->tx_1_col +
  990. hw_stats->tx_2_col * 2 +
  991. hw_stats->tx_late_col + hw_stats->tx_abort_col;
  992. net_stats->rx_errors = hw_stats->rx_frag + hw_stats->rx_fcs_err +
  993. hw_stats->rx_len_err + hw_stats->rx_sz_ov +
  994. hw_stats->rx_rrd_ov + hw_stats->rx_align_err;
  995. net_stats->rx_fifo_errors = hw_stats->rx_rxf_ov;
  996. net_stats->rx_length_errors = hw_stats->rx_len_err;
  997. net_stats->rx_crc_errors = hw_stats->rx_fcs_err;
  998. net_stats->rx_frame_errors = hw_stats->rx_align_err;
  999. net_stats->rx_over_errors = hw_stats->rx_rrd_ov + hw_stats->rx_rxf_ov;
  1000. net_stats->rx_missed_errors = hw_stats->rx_rrd_ov + hw_stats->rx_rxf_ov;
  1001. net_stats->tx_errors = hw_stats->tx_late_col + hw_stats->tx_abort_col +
  1002. hw_stats->tx_underrun + hw_stats->tx_trunc;
  1003. net_stats->tx_fifo_errors = hw_stats->tx_underrun;
  1004. net_stats->tx_aborted_errors = hw_stats->tx_abort_col;
  1005. net_stats->tx_window_errors = hw_stats->tx_late_col;
  1006. return net_stats;
  1007. }
  1008. static void atl1e_update_hw_stats(struct atl1e_adapter *adapter)
  1009. {
  1010. u16 hw_reg_addr = 0;
  1011. unsigned long *stats_item = NULL;
  1012. /* update rx status */
  1013. hw_reg_addr = REG_MAC_RX_STATUS_BIN;
  1014. stats_item = &adapter->hw_stats.rx_ok;
  1015. while (hw_reg_addr <= REG_MAC_RX_STATUS_END) {
  1016. *stats_item += AT_READ_REG(&adapter->hw, hw_reg_addr);
  1017. stats_item++;
  1018. hw_reg_addr += 4;
  1019. }
  1020. /* update tx status */
  1021. hw_reg_addr = REG_MAC_TX_STATUS_BIN;
  1022. stats_item = &adapter->hw_stats.tx_ok;
  1023. while (hw_reg_addr <= REG_MAC_TX_STATUS_END) {
  1024. *stats_item += AT_READ_REG(&adapter->hw, hw_reg_addr);
  1025. stats_item++;
  1026. hw_reg_addr += 4;
  1027. }
  1028. }
  1029. static inline void atl1e_clear_phy_int(struct atl1e_adapter *adapter)
  1030. {
  1031. u16 phy_data;
  1032. spin_lock(&adapter->mdio_lock);
  1033. atl1e_read_phy_reg(&adapter->hw, MII_INT_STATUS, &phy_data);
  1034. spin_unlock(&adapter->mdio_lock);
  1035. }
  1036. static bool atl1e_clean_tx_irq(struct atl1e_adapter *adapter)
  1037. {
  1038. struct atl1e_tx_ring *tx_ring = (struct atl1e_tx_ring *)
  1039. &adapter->tx_ring;
  1040. struct atl1e_tx_buffer *tx_buffer = NULL;
  1041. u16 hw_next_to_clean = AT_READ_REGW(&adapter->hw, REG_TPD_CONS_IDX);
  1042. u16 next_to_clean = atomic_read(&tx_ring->next_to_clean);
  1043. while (next_to_clean != hw_next_to_clean) {
  1044. tx_buffer = &tx_ring->tx_buffer[next_to_clean];
  1045. if (tx_buffer->dma) {
  1046. pci_unmap_page(adapter->pdev, tx_buffer->dma,
  1047. tx_buffer->length, PCI_DMA_TODEVICE);
  1048. tx_buffer->dma = 0;
  1049. }
  1050. if (tx_buffer->skb) {
  1051. dev_kfree_skb_irq(tx_buffer->skb);
  1052. tx_buffer->skb = NULL;
  1053. }
  1054. if (++next_to_clean == tx_ring->count)
  1055. next_to_clean = 0;
  1056. }
  1057. atomic_set(&tx_ring->next_to_clean, next_to_clean);
  1058. if (netif_queue_stopped(adapter->netdev) &&
  1059. netif_carrier_ok(adapter->netdev)) {
  1060. netif_wake_queue(adapter->netdev);
  1061. }
  1062. return true;
  1063. }
  1064. /*
  1065. * atl1e_intr - Interrupt Handler
  1066. * @irq: interrupt number
  1067. * @data: pointer to a network interface device structure
  1068. * @pt_regs: CPU registers structure
  1069. */
  1070. static irqreturn_t atl1e_intr(int irq, void *data)
  1071. {
  1072. struct net_device *netdev = data;
  1073. struct atl1e_adapter *adapter = netdev_priv(netdev);
  1074. struct pci_dev *pdev = adapter->pdev;
  1075. struct atl1e_hw *hw = &adapter->hw;
  1076. int max_ints = AT_MAX_INT_WORK;
  1077. int handled = IRQ_NONE;
  1078. u32 status;
  1079. do {
  1080. status = AT_READ_REG(hw, REG_ISR);
  1081. if ((status & IMR_NORMAL_MASK) == 0 ||
  1082. (status & ISR_DIS_INT) != 0) {
  1083. if (max_ints != AT_MAX_INT_WORK)
  1084. handled = IRQ_HANDLED;
  1085. break;
  1086. }
  1087. /* link event */
  1088. if (status & ISR_GPHY)
  1089. atl1e_clear_phy_int(adapter);
  1090. /* Ack ISR */
  1091. AT_WRITE_REG(hw, REG_ISR, status | ISR_DIS_INT);
  1092. handled = IRQ_HANDLED;
  1093. /* check if PCIE PHY Link down */
  1094. if (status & ISR_PHY_LINKDOWN) {
  1095. dev_err(&pdev->dev,
  1096. "pcie phy linkdown %x\n", status);
  1097. if (netif_running(adapter->netdev)) {
  1098. /* reset MAC */
  1099. atl1e_irq_reset(adapter);
  1100. schedule_work(&adapter->reset_task);
  1101. break;
  1102. }
  1103. }
  1104. /* check if DMA read/write error */
  1105. if (status & (ISR_DMAR_TO_RST | ISR_DMAW_TO_RST)) {
  1106. dev_err(&pdev->dev,
  1107. "PCIE DMA RW error (status = 0x%x)\n",
  1108. status);
  1109. atl1e_irq_reset(adapter);
  1110. schedule_work(&adapter->reset_task);
  1111. break;
  1112. }
  1113. if (status & ISR_SMB)
  1114. atl1e_update_hw_stats(adapter);
  1115. /* link event */
  1116. if (status & (ISR_GPHY | ISR_MANUAL)) {
  1117. netdev->stats.tx_carrier_errors++;
  1118. atl1e_link_chg_event(adapter);
  1119. break;
  1120. }
  1121. /* transmit event */
  1122. if (status & ISR_TX_EVENT)
  1123. atl1e_clean_tx_irq(adapter);
  1124. if (status & ISR_RX_EVENT) {
  1125. /*
  1126. * disable rx interrupts, without
  1127. * the synchronize_irq bit
  1128. */
  1129. AT_WRITE_REG(hw, REG_IMR,
  1130. IMR_NORMAL_MASK & ~ISR_RX_EVENT);
  1131. AT_WRITE_FLUSH(hw);
  1132. if (likely(napi_schedule_prep(
  1133. &adapter->napi)))
  1134. __napi_schedule(&adapter->napi);
  1135. }
  1136. } while (--max_ints > 0);
  1137. /* re-enable Interrupt*/
  1138. AT_WRITE_REG(&adapter->hw, REG_ISR, 0);
  1139. return handled;
  1140. }
  1141. static inline void atl1e_rx_checksum(struct atl1e_adapter *adapter,
  1142. struct sk_buff *skb, struct atl1e_recv_ret_status *prrs)
  1143. {
  1144. u8 *packet = (u8 *)(prrs + 1);
  1145. struct iphdr *iph;
  1146. u16 head_len = ETH_HLEN;
  1147. u16 pkt_flags;
  1148. u16 err_flags;
  1149. skb->ip_summed = CHECKSUM_NONE;
  1150. pkt_flags = prrs->pkt_flag;
  1151. err_flags = prrs->err_flag;
  1152. if (((pkt_flags & RRS_IS_IPV4) || (pkt_flags & RRS_IS_IPV6)) &&
  1153. ((pkt_flags & RRS_IS_TCP) || (pkt_flags & RRS_IS_UDP))) {
  1154. if (pkt_flags & RRS_IS_IPV4) {
  1155. if (pkt_flags & RRS_IS_802_3)
  1156. head_len += 8;
  1157. iph = (struct iphdr *) (packet + head_len);
  1158. if (iph->frag_off != 0 && !(pkt_flags & RRS_IS_IP_DF))
  1159. goto hw_xsum;
  1160. }
  1161. if (!(err_flags & (RRS_ERR_IP_CSUM | RRS_ERR_L4_CSUM))) {
  1162. skb->ip_summed = CHECKSUM_UNNECESSARY;
  1163. return;
  1164. }
  1165. }
  1166. hw_xsum :
  1167. return;
  1168. }
  1169. static struct atl1e_rx_page *atl1e_get_rx_page(struct atl1e_adapter *adapter,
  1170. u8 que)
  1171. {
  1172. struct atl1e_rx_page_desc *rx_page_desc =
  1173. (struct atl1e_rx_page_desc *) adapter->rx_ring.rx_page_desc;
  1174. u8 rx_using = rx_page_desc[que].rx_using;
  1175. return (struct atl1e_rx_page *)&(rx_page_desc[que].rx_page[rx_using]);
  1176. }
  1177. static void atl1e_clean_rx_irq(struct atl1e_adapter *adapter, u8 que,
  1178. int *work_done, int work_to_do)
  1179. {
  1180. struct pci_dev *pdev = adapter->pdev;
  1181. struct net_device *netdev = adapter->netdev;
  1182. struct atl1e_rx_ring *rx_ring = (struct atl1e_rx_ring *)
  1183. &adapter->rx_ring;
  1184. struct atl1e_rx_page_desc *rx_page_desc =
  1185. (struct atl1e_rx_page_desc *) rx_ring->rx_page_desc;
  1186. struct sk_buff *skb = NULL;
  1187. struct atl1e_rx_page *rx_page = atl1e_get_rx_page(adapter, que);
  1188. u32 packet_size, write_offset;
  1189. struct atl1e_recv_ret_status *prrs;
  1190. write_offset = *(rx_page->write_offset_addr);
  1191. if (likely(rx_page->read_offset < write_offset)) {
  1192. do {
  1193. if (*work_done >= work_to_do)
  1194. break;
  1195. (*work_done)++;
  1196. /* get new packet's rrs */
  1197. prrs = (struct atl1e_recv_ret_status *) (rx_page->addr +
  1198. rx_page->read_offset);
  1199. /* check sequence number */
  1200. if (prrs->seq_num != rx_page_desc[que].rx_nxseq) {
  1201. dev_err(&pdev->dev,
  1202. "rx sequence number"
  1203. " error (rx=%d) (expect=%d)\n",
  1204. prrs->seq_num,
  1205. rx_page_desc[que].rx_nxseq);
  1206. rx_page_desc[que].rx_nxseq++;
  1207. /* just for debug use */
  1208. AT_WRITE_REG(&adapter->hw, REG_DEBUG_DATA0,
  1209. (((u32)prrs->seq_num) << 16) |
  1210. rx_page_desc[que].rx_nxseq);
  1211. goto fatal_err;
  1212. }
  1213. rx_page_desc[que].rx_nxseq++;
  1214. /* error packet */
  1215. if (prrs->pkt_flag & RRS_IS_ERR_FRAME) {
  1216. if (prrs->err_flag & (RRS_ERR_BAD_CRC |
  1217. RRS_ERR_DRIBBLE | RRS_ERR_CODE |
  1218. RRS_ERR_TRUNC)) {
  1219. /* hardware error, discard this packet*/
  1220. dev_err(&pdev->dev,
  1221. "rx packet desc error %x\n",
  1222. *((u32 *)prrs + 1));
  1223. goto skip_pkt;
  1224. }
  1225. }
  1226. packet_size = ((prrs->word1 >> RRS_PKT_SIZE_SHIFT) &
  1227. RRS_PKT_SIZE_MASK) - 4; /* CRC */
  1228. skb = netdev_alloc_skb(netdev,
  1229. packet_size + NET_IP_ALIGN);
  1230. if (skb == NULL) {
  1231. dev_warn(&pdev->dev, "%s: Memory squeeze,"
  1232. "deferring packet.\n", netdev->name);
  1233. goto skip_pkt;
  1234. }
  1235. skb_reserve(skb, NET_IP_ALIGN);
  1236. skb->dev = netdev;
  1237. memcpy(skb->data, (u8 *)(prrs + 1), packet_size);
  1238. skb_put(skb, packet_size);
  1239. skb->protocol = eth_type_trans(skb, netdev);
  1240. atl1e_rx_checksum(adapter, skb, prrs);
  1241. if (unlikely(adapter->vlgrp &&
  1242. (prrs->pkt_flag & RRS_IS_VLAN_TAG))) {
  1243. u16 vlan_tag = (prrs->vtag >> 4) |
  1244. ((prrs->vtag & 7) << 13) |
  1245. ((prrs->vtag & 8) << 9);
  1246. dev_dbg(&pdev->dev,
  1247. "RXD VLAN TAG<RRD>=0x%04x\n",
  1248. prrs->vtag);
  1249. vlan_hwaccel_receive_skb(skb, adapter->vlgrp,
  1250. vlan_tag);
  1251. } else {
  1252. netif_receive_skb(skb);
  1253. }
  1254. skip_pkt:
  1255. /* skip current packet whether it's ok or not. */
  1256. rx_page->read_offset +=
  1257. (((u32)((prrs->word1 >> RRS_PKT_SIZE_SHIFT) &
  1258. RRS_PKT_SIZE_MASK) +
  1259. sizeof(struct atl1e_recv_ret_status) + 31) &
  1260. 0xFFFFFFE0);
  1261. if (rx_page->read_offset >= rx_ring->page_size) {
  1262. /* mark this page clean */
  1263. u16 reg_addr;
  1264. u8 rx_using;
  1265. rx_page->read_offset =
  1266. *(rx_page->write_offset_addr) = 0;
  1267. rx_using = rx_page_desc[que].rx_using;
  1268. reg_addr =
  1269. atl1e_rx_page_vld_regs[que][rx_using];
  1270. AT_WRITE_REGB(&adapter->hw, reg_addr, 1);
  1271. rx_page_desc[que].rx_using ^= 1;
  1272. rx_page = atl1e_get_rx_page(adapter, que);
  1273. }
  1274. write_offset = *(rx_page->write_offset_addr);
  1275. } while (rx_page->read_offset < write_offset);
  1276. }
  1277. return;
  1278. fatal_err:
  1279. if (!test_bit(__AT_DOWN, &adapter->flags))
  1280. schedule_work(&adapter->reset_task);
  1281. }
  1282. /*
  1283. * atl1e_clean - NAPI Rx polling callback
  1284. * @adapter: board private structure
  1285. */
  1286. static int atl1e_clean(struct napi_struct *napi, int budget)
  1287. {
  1288. struct atl1e_adapter *adapter =
  1289. container_of(napi, struct atl1e_adapter, napi);
  1290. struct pci_dev *pdev = adapter->pdev;
  1291. u32 imr_data;
  1292. int work_done = 0;
  1293. /* Keep link state information with original netdev */
  1294. if (!netif_carrier_ok(adapter->netdev))
  1295. goto quit_polling;
  1296. atl1e_clean_rx_irq(adapter, 0, &work_done, budget);
  1297. /* If no Tx and not enough Rx work done, exit the polling mode */
  1298. if (work_done < budget) {
  1299. quit_polling:
  1300. napi_complete(napi);
  1301. imr_data = AT_READ_REG(&adapter->hw, REG_IMR);
  1302. AT_WRITE_REG(&adapter->hw, REG_IMR, imr_data | ISR_RX_EVENT);
  1303. /* test debug */
  1304. if (test_bit(__AT_DOWN, &adapter->flags)) {
  1305. atomic_dec(&adapter->irq_sem);
  1306. dev_err(&pdev->dev,
  1307. "atl1e_clean is called when AT_DOWN\n");
  1308. }
  1309. /* reenable RX intr */
  1310. /*atl1e_irq_enable(adapter); */
  1311. }
  1312. return work_done;
  1313. }
  1314. #ifdef CONFIG_NET_POLL_CONTROLLER
  1315. /*
  1316. * Polling 'interrupt' - used by things like netconsole to send skbs
  1317. * without having to re-enable interrupts. It's not called while
  1318. * the interrupt routine is executing.
  1319. */
  1320. static void atl1e_netpoll(struct net_device *netdev)
  1321. {
  1322. struct atl1e_adapter *adapter = netdev_priv(netdev);
  1323. disable_irq(adapter->pdev->irq);
  1324. atl1e_intr(adapter->pdev->irq, netdev);
  1325. enable_irq(adapter->pdev->irq);
  1326. }
  1327. #endif
  1328. static inline u16 atl1e_tpd_avail(struct atl1e_adapter *adapter)
  1329. {
  1330. struct atl1e_tx_ring *tx_ring = &adapter->tx_ring;
  1331. u16 next_to_use = 0;
  1332. u16 next_to_clean = 0;
  1333. next_to_clean = atomic_read(&tx_ring->next_to_clean);
  1334. next_to_use = tx_ring->next_to_use;
  1335. return (u16)(next_to_clean > next_to_use) ?
  1336. (next_to_clean - next_to_use - 1) :
  1337. (tx_ring->count + next_to_clean - next_to_use - 1);
  1338. }
  1339. /*
  1340. * get next usable tpd
  1341. * Note: should call atl1e_tdp_avail to make sure
  1342. * there is enough tpd to use
  1343. */
  1344. static struct atl1e_tpd_desc *atl1e_get_tpd(struct atl1e_adapter *adapter)
  1345. {
  1346. struct atl1e_tx_ring *tx_ring = &adapter->tx_ring;
  1347. u16 next_to_use = 0;
  1348. next_to_use = tx_ring->next_to_use;
  1349. if (++tx_ring->next_to_use == tx_ring->count)
  1350. tx_ring->next_to_use = 0;
  1351. memset(&tx_ring->desc[next_to_use], 0, sizeof(struct atl1e_tpd_desc));
  1352. return (struct atl1e_tpd_desc *)&tx_ring->desc[next_to_use];
  1353. }
  1354. static struct atl1e_tx_buffer *
  1355. atl1e_get_tx_buffer(struct atl1e_adapter *adapter, struct atl1e_tpd_desc *tpd)
  1356. {
  1357. struct atl1e_tx_ring *tx_ring = &adapter->tx_ring;
  1358. return &tx_ring->tx_buffer[tpd - tx_ring->desc];
  1359. }
  1360. /* Calculate the transmit packet descript needed*/
  1361. static u16 atl1e_cal_tdp_req(const struct sk_buff *skb)
  1362. {
  1363. int i = 0;
  1364. u16 tpd_req = 1;
  1365. u16 fg_size = 0;
  1366. u16 proto_hdr_len = 0;
  1367. for (i = 0; i < skb_shinfo(skb)->nr_frags; i++) {
  1368. fg_size = skb_shinfo(skb)->frags[i].size;
  1369. tpd_req += ((fg_size + MAX_TX_BUF_LEN - 1) >> MAX_TX_BUF_SHIFT);
  1370. }
  1371. if (skb_is_gso(skb)) {
  1372. if (skb->protocol == htons(ETH_P_IP) ||
  1373. (skb_shinfo(skb)->gso_type == SKB_GSO_TCPV6)) {
  1374. proto_hdr_len = skb_transport_offset(skb) +
  1375. tcp_hdrlen(skb);
  1376. if (proto_hdr_len < skb_headlen(skb)) {
  1377. tpd_req += ((skb_headlen(skb) - proto_hdr_len +
  1378. MAX_TX_BUF_LEN - 1) >>
  1379. MAX_TX_BUF_SHIFT);
  1380. }
  1381. }
  1382. }
  1383. return tpd_req;
  1384. }
  1385. static int atl1e_tso_csum(struct atl1e_adapter *adapter,
  1386. struct sk_buff *skb, struct atl1e_tpd_desc *tpd)
  1387. {
  1388. struct pci_dev *pdev = adapter->pdev;
  1389. u8 hdr_len;
  1390. u32 real_len;
  1391. unsigned short offload_type;
  1392. int err;
  1393. if (skb_is_gso(skb)) {
  1394. if (skb_header_cloned(skb)) {
  1395. err = pskb_expand_head(skb, 0, 0, GFP_ATOMIC);
  1396. if (unlikely(err))
  1397. return -1;
  1398. }
  1399. offload_type = skb_shinfo(skb)->gso_type;
  1400. if (offload_type & SKB_GSO_TCPV4) {
  1401. real_len = (((unsigned char *)ip_hdr(skb) - skb->data)
  1402. + ntohs(ip_hdr(skb)->tot_len));
  1403. if (real_len < skb->len)
  1404. pskb_trim(skb, real_len);
  1405. hdr_len = (skb_transport_offset(skb) + tcp_hdrlen(skb));
  1406. if (unlikely(skb->len == hdr_len)) {
  1407. /* only xsum need */
  1408. dev_warn(&pdev->dev,
  1409. "IPV4 tso with zero data??\n");
  1410. goto check_sum;
  1411. } else {
  1412. ip_hdr(skb)->check = 0;
  1413. ip_hdr(skb)->tot_len = 0;
  1414. tcp_hdr(skb)->check = ~csum_tcpudp_magic(
  1415. ip_hdr(skb)->saddr,
  1416. ip_hdr(skb)->daddr,
  1417. 0, IPPROTO_TCP, 0);
  1418. tpd->word3 |= (ip_hdr(skb)->ihl &
  1419. TDP_V4_IPHL_MASK) <<
  1420. TPD_V4_IPHL_SHIFT;
  1421. tpd->word3 |= ((tcp_hdrlen(skb) >> 2) &
  1422. TPD_TCPHDRLEN_MASK) <<
  1423. TPD_TCPHDRLEN_SHIFT;
  1424. tpd->word3 |= ((skb_shinfo(skb)->gso_size) &
  1425. TPD_MSS_MASK) << TPD_MSS_SHIFT;
  1426. tpd->word3 |= 1 << TPD_SEGMENT_EN_SHIFT;
  1427. }
  1428. return 0;
  1429. }
  1430. if (offload_type & SKB_GSO_TCPV6) {
  1431. real_len = (((unsigned char *)ipv6_hdr(skb) - skb->data)
  1432. + ntohs(ipv6_hdr(skb)->payload_len));
  1433. if (real_len < skb->len)
  1434. pskb_trim(skb, real_len);
  1435. /* check payload == 0 byte ? */
  1436. hdr_len = (skb_transport_offset(skb) + tcp_hdrlen(skb));
  1437. if (unlikely(skb->len == hdr_len)) {
  1438. /* only xsum need */
  1439. dev_warn(&pdev->dev,
  1440. "IPV6 tso with zero data??\n");
  1441. goto check_sum;
  1442. } else {
  1443. tcp_hdr(skb)->check = ~csum_ipv6_magic(
  1444. &ipv6_hdr(skb)->saddr,
  1445. &ipv6_hdr(skb)->daddr,
  1446. 0, IPPROTO_TCP, 0);
  1447. tpd->word3 |= 1 << TPD_IP_VERSION_SHIFT;
  1448. hdr_len >>= 1;
  1449. tpd->word3 |= (hdr_len & TPD_V6_IPHLLO_MASK) <<
  1450. TPD_V6_IPHLLO_SHIFT;
  1451. tpd->word3 |= ((hdr_len >> 3) &
  1452. TPD_V6_IPHLHI_MASK) <<
  1453. TPD_V6_IPHLHI_SHIFT;
  1454. tpd->word3 |= (tcp_hdrlen(skb) >> 2 &
  1455. TPD_TCPHDRLEN_MASK) <<
  1456. TPD_TCPHDRLEN_SHIFT;
  1457. tpd->word3 |= ((skb_shinfo(skb)->gso_size) &
  1458. TPD_MSS_MASK) << TPD_MSS_SHIFT;
  1459. tpd->word3 |= 1 << TPD_SEGMENT_EN_SHIFT;
  1460. }
  1461. }
  1462. return 0;
  1463. }
  1464. check_sum:
  1465. if (likely(skb->ip_summed == CHECKSUM_PARTIAL)) {
  1466. u8 css, cso;
  1467. cso = skb_transport_offset(skb);
  1468. if (unlikely(cso & 0x1)) {
  1469. dev_err(&adapter->pdev->dev,
  1470. "pay load offset should not ant event number\n");
  1471. return -1;
  1472. } else {
  1473. css = cso + skb->csum_offset;
  1474. tpd->word3 |= (cso & TPD_PLOADOFFSET_MASK) <<
  1475. TPD_PLOADOFFSET_SHIFT;
  1476. tpd->word3 |= (css & TPD_CCSUMOFFSET_MASK) <<
  1477. TPD_CCSUMOFFSET_SHIFT;
  1478. tpd->word3 |= 1 << TPD_CC_SEGMENT_EN_SHIFT;
  1479. }
  1480. }
  1481. return 0;
  1482. }
  1483. static void atl1e_tx_map(struct atl1e_adapter *adapter,
  1484. struct sk_buff *skb, struct atl1e_tpd_desc *tpd)
  1485. {
  1486. struct atl1e_tpd_desc *use_tpd = NULL;
  1487. struct atl1e_tx_buffer *tx_buffer = NULL;
  1488. u16 buf_len = skb->len - skb->data_len;
  1489. u16 map_len = 0;
  1490. u16 mapped_len = 0;
  1491. u16 hdr_len = 0;
  1492. u16 nr_frags;
  1493. u16 f;
  1494. int segment;
  1495. nr_frags = skb_shinfo(skb)->nr_frags;
  1496. segment = (tpd->word3 >> TPD_SEGMENT_EN_SHIFT) & TPD_SEGMENT_EN_MASK;
  1497. if (segment) {
  1498. /* TSO */
  1499. map_len = hdr_len = skb_transport_offset(skb) + tcp_hdrlen(skb);
  1500. use_tpd = tpd;
  1501. tx_buffer = atl1e_get_tx_buffer(adapter, use_tpd);
  1502. tx_buffer->length = map_len;
  1503. tx_buffer->dma = pci_map_single(adapter->pdev,
  1504. skb->data, hdr_len, PCI_DMA_TODEVICE);
  1505. mapped_len += map_len;
  1506. use_tpd->buffer_addr = cpu_to_le64(tx_buffer->dma);
  1507. use_tpd->word2 = (use_tpd->word2 & (~TPD_BUFLEN_MASK)) |
  1508. ((cpu_to_le32(tx_buffer->length) &
  1509. TPD_BUFLEN_MASK) << TPD_BUFLEN_SHIFT);
  1510. }
  1511. while (mapped_len < buf_len) {
  1512. /* mapped_len == 0, means we should use the first tpd,
  1513. which is given by caller */
  1514. if (mapped_len == 0) {
  1515. use_tpd = tpd;
  1516. } else {
  1517. use_tpd = atl1e_get_tpd(adapter);
  1518. memcpy(use_tpd, tpd, sizeof(struct atl1e_tpd_desc));
  1519. }
  1520. tx_buffer = atl1e_get_tx_buffer(adapter, use_tpd);
  1521. tx_buffer->skb = NULL;
  1522. tx_buffer->length = map_len =
  1523. ((buf_len - mapped_len) >= MAX_TX_BUF_LEN) ?
  1524. MAX_TX_BUF_LEN : (buf_len - mapped_len);
  1525. tx_buffer->dma =
  1526. pci_map_single(adapter->pdev, skb->data + mapped_len,
  1527. map_len, PCI_DMA_TODEVICE);
  1528. mapped_len += map_len;
  1529. use_tpd->buffer_addr = cpu_to_le64(tx_buffer->dma);
  1530. use_tpd->word2 = (use_tpd->word2 & (~TPD_BUFLEN_MASK)) |
  1531. ((cpu_to_le32(tx_buffer->length) &
  1532. TPD_BUFLEN_MASK) << TPD_BUFLEN_SHIFT);
  1533. }
  1534. for (f = 0; f < nr_frags; f++) {
  1535. struct skb_frag_struct *frag;
  1536. u16 i;
  1537. u16 seg_num;
  1538. frag = &skb_shinfo(skb)->frags[f];
  1539. buf_len = frag->size;
  1540. seg_num = (buf_len + MAX_TX_BUF_LEN - 1) / MAX_TX_BUF_LEN;
  1541. for (i = 0; i < seg_num; i++) {
  1542. use_tpd = atl1e_get_tpd(adapter);
  1543. memcpy(use_tpd, tpd, sizeof(struct atl1e_tpd_desc));
  1544. tx_buffer = atl1e_get_tx_buffer(adapter, use_tpd);
  1545. BUG_ON(tx_buffer->skb);
  1546. tx_buffer->skb = NULL;
  1547. tx_buffer->length =
  1548. (buf_len > MAX_TX_BUF_LEN) ?
  1549. MAX_TX_BUF_LEN : buf_len;
  1550. buf_len -= tx_buffer->length;
  1551. tx_buffer->dma =
  1552. pci_map_page(adapter->pdev, frag->page,
  1553. frag->page_offset +
  1554. (i * MAX_TX_BUF_LEN),
  1555. tx_buffer->length,
  1556. PCI_DMA_TODEVICE);
  1557. use_tpd->buffer_addr = cpu_to_le64(tx_buffer->dma);
  1558. use_tpd->word2 = (use_tpd->word2 & (~TPD_BUFLEN_MASK)) |
  1559. ((cpu_to_le32(tx_buffer->length) &
  1560. TPD_BUFLEN_MASK) << TPD_BUFLEN_SHIFT);
  1561. }
  1562. }
  1563. if ((tpd->word3 >> TPD_SEGMENT_EN_SHIFT) & TPD_SEGMENT_EN_MASK)
  1564. /* note this one is a tcp header */
  1565. tpd->word3 |= 1 << TPD_HDRFLAG_SHIFT;
  1566. /* The last tpd */
  1567. use_tpd->word3 |= 1 << TPD_EOP_SHIFT;
  1568. /* The last buffer info contain the skb address,
  1569. so it will be free after unmap */
  1570. tx_buffer->skb = skb;
  1571. }
  1572. static void atl1e_tx_queue(struct atl1e_adapter *adapter, u16 count,
  1573. struct atl1e_tpd_desc *tpd)
  1574. {
  1575. struct atl1e_tx_ring *tx_ring = &adapter->tx_ring;
  1576. /* Force memory writes to complete before letting h/w
  1577. * know there are new descriptors to fetch. (Only
  1578. * applicable for weak-ordered memory model archs,
  1579. * such as IA-64). */
  1580. wmb();
  1581. AT_WRITE_REG(&adapter->hw, REG_MB_TPD_PROD_IDX, tx_ring->next_to_use);
  1582. }
  1583. static int atl1e_xmit_frame(struct sk_buff *skb, struct net_device *netdev)
  1584. {
  1585. struct atl1e_adapter *adapter = netdev_priv(netdev);
  1586. unsigned long flags;
  1587. u16 tpd_req = 1;
  1588. struct atl1e_tpd_desc *tpd;
  1589. if (test_bit(__AT_DOWN, &adapter->flags)) {
  1590. dev_kfree_skb_any(skb);
  1591. return NETDEV_TX_OK;
  1592. }
  1593. if (unlikely(skb->len <= 0)) {
  1594. dev_kfree_skb_any(skb);
  1595. return NETDEV_TX_OK;
  1596. }
  1597. tpd_req = atl1e_cal_tdp_req(skb);
  1598. if (!spin_trylock_irqsave(&adapter->tx_lock, flags))
  1599. return NETDEV_TX_LOCKED;
  1600. if (atl1e_tpd_avail(adapter) < tpd_req) {
  1601. /* no enough descriptor, just stop queue */
  1602. netif_stop_queue(netdev);
  1603. spin_unlock_irqrestore(&adapter->tx_lock, flags);
  1604. return NETDEV_TX_BUSY;
  1605. }
  1606. tpd = atl1e_get_tpd(adapter);
  1607. if (unlikely(adapter->vlgrp && vlan_tx_tag_present(skb))) {
  1608. u16 vlan_tag = vlan_tx_tag_get(skb);
  1609. u16 atl1e_vlan_tag;
  1610. tpd->word3 |= 1 << TPD_INS_VL_TAG_SHIFT;
  1611. AT_VLAN_TAG_TO_TPD_TAG(vlan_tag, atl1e_vlan_tag);
  1612. tpd->word2 |= (atl1e_vlan_tag & TPD_VLANTAG_MASK) <<
  1613. TPD_VLAN_SHIFT;
  1614. }
  1615. if (skb->protocol == htons(ETH_P_8021Q))
  1616. tpd->word3 |= 1 << TPD_VL_TAGGED_SHIFT;
  1617. if (skb_network_offset(skb) != ETH_HLEN)
  1618. tpd->word3 |= 1 << TPD_ETHTYPE_SHIFT; /* 802.3 frame */
  1619. /* do TSO and check sum */
  1620. if (atl1e_tso_csum(adapter, skb, tpd) != 0) {
  1621. spin_unlock_irqrestore(&adapter->tx_lock, flags);
  1622. dev_kfree_skb_any(skb);
  1623. return NETDEV_TX_OK;
  1624. }
  1625. atl1e_tx_map(adapter, skb, tpd);
  1626. atl1e_tx_queue(adapter, tpd_req, tpd);
  1627. netdev->trans_start = jiffies; /* NETIF_F_LLTX driver :( */
  1628. spin_unlock_irqrestore(&adapter->tx_lock, flags);
  1629. return NETDEV_TX_OK;
  1630. }
  1631. static void atl1e_free_irq(struct atl1e_adapter *adapter)
  1632. {
  1633. struct net_device *netdev = adapter->netdev;
  1634. free_irq(adapter->pdev->irq, netdev);
  1635. if (adapter->have_msi)
  1636. pci_disable_msi(adapter->pdev);
  1637. }
  1638. static int atl1e_request_irq(struct atl1e_adapter *adapter)
  1639. {
  1640. struct pci_dev *pdev = adapter->pdev;
  1641. struct net_device *netdev = adapter->netdev;
  1642. int flags = 0;
  1643. int err = 0;
  1644. adapter->have_msi = true;
  1645. err = pci_enable_msi(adapter->pdev);
  1646. if (err) {
  1647. dev_dbg(&pdev->dev,
  1648. "Unable to allocate MSI interrupt Error: %d\n", err);
  1649. adapter->have_msi = false;
  1650. } else
  1651. netdev->irq = pdev->irq;
  1652. if (!adapter->have_msi)
  1653. flags |= IRQF_SHARED;
  1654. err = request_irq(adapter->pdev->irq, &atl1e_intr, flags,
  1655. netdev->name, netdev);
  1656. if (err) {
  1657. dev_dbg(&pdev->dev,
  1658. "Unable to allocate interrupt Error: %d\n", err);
  1659. if (adapter->have_msi)
  1660. pci_disable_msi(adapter->pdev);
  1661. return err;
  1662. }
  1663. dev_dbg(&pdev->dev, "atl1e_request_irq OK\n");
  1664. return err;
  1665. }
  1666. int atl1e_up(struct atl1e_adapter *adapter)
  1667. {
  1668. struct net_device *netdev = adapter->netdev;
  1669. int err = 0;
  1670. u32 val;
  1671. /* hardware has been reset, we need to reload some things */
  1672. err = atl1e_init_hw(&adapter->hw);
  1673. if (err) {
  1674. err = -EIO;
  1675. return err;
  1676. }
  1677. atl1e_init_ring_ptrs(adapter);
  1678. atl1e_set_multi(netdev);
  1679. atl1e_restore_vlan(adapter);
  1680. if (atl1e_configure(adapter)) {
  1681. err = -EIO;
  1682. goto err_up;
  1683. }
  1684. clear_bit(__AT_DOWN, &adapter->flags);
  1685. napi_enable(&adapter->napi);
  1686. atl1e_irq_enable(adapter);
  1687. val = AT_READ_REG(&adapter->hw, REG_MASTER_CTRL);
  1688. AT_WRITE_REG(&adapter->hw, REG_MASTER_CTRL,
  1689. val | MASTER_CTRL_MANUAL_INT);
  1690. err_up:
  1691. return err;
  1692. }
  1693. void atl1e_down(struct atl1e_adapter *adapter)
  1694. {
  1695. struct net_device *netdev = adapter->netdev;
  1696. /* signal that we're down so the interrupt handler does not
  1697. * reschedule our watchdog timer */
  1698. set_bit(__AT_DOWN, &adapter->flags);
  1699. #ifdef NETIF_F_LLTX
  1700. netif_stop_queue(netdev);
  1701. #else
  1702. netif_tx_disable(netdev);
  1703. #endif
  1704. /* reset MAC to disable all RX/TX */
  1705. atl1e_reset_hw(&adapter->hw);
  1706. msleep(1);
  1707. napi_disable(&adapter->napi);
  1708. atl1e_del_timer(adapter);
  1709. atl1e_irq_disable(adapter);
  1710. netif_carrier_off(netdev);
  1711. adapter->link_speed = SPEED_0;
  1712. adapter->link_duplex = -1;
  1713. atl1e_clean_tx_ring(adapter);
  1714. atl1e_clean_rx_ring(adapter);
  1715. }
  1716. /*
  1717. * atl1e_open - Called when a network interface is made active
  1718. * @netdev: network interface device structure
  1719. *
  1720. * Returns 0 on success, negative value on failure
  1721. *
  1722. * The open entry point is called when a network interface is made
  1723. * active by the system (IFF_UP). At this point all resources needed
  1724. * for transmit and receive operations are allocated, the interrupt
  1725. * handler is registered with the OS, the watchdog timer is started,
  1726. * and the stack is notified that the interface is ready.
  1727. */
  1728. static int atl1e_open(struct net_device *netdev)
  1729. {
  1730. struct atl1e_adapter *adapter = netdev_priv(netdev);
  1731. int err;
  1732. /* disallow open during test */
  1733. if (test_bit(__AT_TESTING, &adapter->flags))
  1734. return -EBUSY;
  1735. /* allocate rx/tx dma buffer & descriptors */
  1736. atl1e_init_ring_resources(adapter);
  1737. err = atl1e_setup_ring_resources(adapter);
  1738. if (unlikely(err))
  1739. return err;
  1740. err = atl1e_request_irq(adapter);
  1741. if (unlikely(err))
  1742. goto err_req_irq;
  1743. err = atl1e_up(adapter);
  1744. if (unlikely(err))
  1745. goto err_up;
  1746. return 0;
  1747. err_up:
  1748. atl1e_free_irq(adapter);
  1749. err_req_irq:
  1750. atl1e_free_ring_resources(adapter);
  1751. atl1e_reset_hw(&adapter->hw);
  1752. return err;
  1753. }
  1754. /*
  1755. * atl1e_close - Disables a network interface
  1756. * @netdev: network interface device structure
  1757. *
  1758. * Returns 0, this is not allowed to fail
  1759. *
  1760. * The close entry point is called when an interface is de-activated
  1761. * by the OS. The hardware is still under the drivers control, but
  1762. * needs to be disabled. A global MAC reset is issued to stop the
  1763. * hardware, and all transmit and receive resources are freed.
  1764. */
  1765. static int atl1e_close(struct net_device *netdev)
  1766. {
  1767. struct atl1e_adapter *adapter = netdev_priv(netdev);
  1768. WARN_ON(test_bit(__AT_RESETTING, &adapter->flags));
  1769. atl1e_down(adapter);
  1770. atl1e_free_irq(adapter);
  1771. atl1e_free_ring_resources(adapter);
  1772. return 0;
  1773. }
  1774. static int atl1e_suspend(struct pci_dev *pdev, pm_message_t state)
  1775. {
  1776. struct net_device *netdev = pci_get_drvdata(pdev);
  1777. struct atl1e_adapter *adapter = netdev_priv(netdev);
  1778. struct atl1e_hw *hw = &adapter->hw;
  1779. u32 ctrl = 0;
  1780. u32 mac_ctrl_data = 0;
  1781. u32 wol_ctrl_data = 0;
  1782. u16 mii_advertise_data = 0;
  1783. u16 mii_bmsr_data = 0;
  1784. u16 mii_intr_status_data = 0;
  1785. u32 wufc = adapter->wol;
  1786. u32 i;
  1787. #ifdef CONFIG_PM
  1788. int retval = 0;
  1789. #endif
  1790. if (netif_running(netdev)) {
  1791. WARN_ON(test_bit(__AT_RESETTING, &adapter->flags));
  1792. atl1e_down(adapter);
  1793. }
  1794. netif_device_detach(netdev);
  1795. #ifdef CONFIG_PM
  1796. retval = pci_save_state(pdev);
  1797. if (retval)
  1798. return retval;
  1799. #endif
  1800. if (wufc) {
  1801. /* get link status */
  1802. atl1e_read_phy_reg(hw, MII_BMSR, (u16 *)&mii_bmsr_data);
  1803. atl1e_read_phy_reg(hw, MII_BMSR, (u16 *)&mii_bmsr_data);
  1804. mii_advertise_data = MII_AR_10T_HD_CAPS;
  1805. if ((atl1e_write_phy_reg(hw, MII_AT001_CR, 0) != 0) ||
  1806. (atl1e_write_phy_reg(hw,
  1807. MII_ADVERTISE, mii_advertise_data) != 0) ||
  1808. (atl1e_phy_commit(hw)) != 0) {
  1809. dev_dbg(&pdev->dev, "set phy register failed\n");
  1810. goto wol_dis;
  1811. }
  1812. hw->phy_configured = false; /* re-init PHY when resume */
  1813. /* turn on magic packet wol */
  1814. if (wufc & AT_WUFC_MAG)
  1815. wol_ctrl_data |= WOL_MAGIC_EN | WOL_MAGIC_PME_EN;
  1816. if (wufc & AT_WUFC_LNKC) {
  1817. /* if orignal link status is link, just wait for retrive link */
  1818. if (mii_bmsr_data & BMSR_LSTATUS) {
  1819. for (i = 0; i < AT_SUSPEND_LINK_TIMEOUT; i++) {
  1820. msleep(100);
  1821. atl1e_read_phy_reg(hw, MII_BMSR,
  1822. (u16 *)&mii_bmsr_data);
  1823. if (mii_bmsr_data & BMSR_LSTATUS)
  1824. break;
  1825. }
  1826. if ((mii_bmsr_data & BMSR_LSTATUS) == 0)
  1827. dev_dbg(&pdev->dev,
  1828. "%s: Link may change"
  1829. "when suspend\n",
  1830. atl1e_driver_name);
  1831. }
  1832. wol_ctrl_data |= WOL_LINK_CHG_EN | WOL_LINK_CHG_PME_EN;
  1833. /* only link up can wake up */
  1834. if (atl1e_write_phy_reg(hw, MII_INT_CTRL, 0x400) != 0) {
  1835. dev_dbg(&pdev->dev, "%s: read write phy "
  1836. "register failed.\n",
  1837. atl1e_driver_name);
  1838. goto wol_dis;
  1839. }
  1840. }
  1841. /* clear phy interrupt */
  1842. atl1e_read_phy_reg(hw, MII_INT_STATUS, &mii_intr_status_data);
  1843. /* Config MAC Ctrl register */
  1844. mac_ctrl_data = MAC_CTRL_RX_EN;
  1845. /* set to 10/100M halt duplex */
  1846. mac_ctrl_data |= MAC_CTRL_SPEED_10_100 << MAC_CTRL_SPEED_SHIFT;
  1847. mac_ctrl_data |= (((u32)adapter->hw.preamble_len &
  1848. MAC_CTRL_PRMLEN_MASK) <<
  1849. MAC_CTRL_PRMLEN_SHIFT);
  1850. if (adapter->vlgrp)
  1851. mac_ctrl_data |= MAC_CTRL_RMV_VLAN;
  1852. /* magic packet maybe Broadcast&multicast&Unicast frame */
  1853. if (wufc & AT_WUFC_MAG)
  1854. mac_ctrl_data |= MAC_CTRL_BC_EN;
  1855. dev_dbg(&pdev->dev,
  1856. "%s: suspend MAC=0x%x\n",
  1857. atl1e_driver_name, mac_ctrl_data);
  1858. AT_WRITE_REG(hw, REG_WOL_CTRL, wol_ctrl_data);
  1859. AT_WRITE_REG(hw, REG_MAC_CTRL, mac_ctrl_data);
  1860. /* pcie patch */
  1861. ctrl = AT_READ_REG(hw, REG_PCIE_PHYMISC);
  1862. ctrl |= PCIE_PHYMISC_FORCE_RCV_DET;
  1863. AT_WRITE_REG(hw, REG_PCIE_PHYMISC, ctrl);
  1864. pci_enable_wake(pdev, pci_choose_state(pdev, state), 1);
  1865. goto suspend_exit;
  1866. }
  1867. wol_dis:
  1868. /* WOL disabled */
  1869. AT_WRITE_REG(hw, REG_WOL_CTRL, 0);
  1870. /* pcie patch */
  1871. ctrl = AT_READ_REG(hw, REG_PCIE_PHYMISC);
  1872. ctrl |= PCIE_PHYMISC_FORCE_RCV_DET;
  1873. AT_WRITE_REG(hw, REG_PCIE_PHYMISC, ctrl);
  1874. atl1e_force_ps(hw);
  1875. hw->phy_configured = false; /* re-init PHY when resume */
  1876. pci_enable_wake(pdev, pci_choose_state(pdev, state), 0);
  1877. suspend_exit:
  1878. if (netif_running(netdev))
  1879. atl1e_free_irq(adapter);
  1880. pci_disable_device(pdev);
  1881. pci_set_power_state(pdev, pci_choose_state(pdev, state));
  1882. return 0;
  1883. }
  1884. #ifdef CONFIG_PM
  1885. static int atl1e_resume(struct pci_dev *pdev)
  1886. {
  1887. struct net_device *netdev = pci_get_drvdata(pdev);
  1888. struct atl1e_adapter *adapter = netdev_priv(netdev);
  1889. u32 err;
  1890. pci_set_power_state(pdev, PCI_D0);
  1891. pci_restore_state(pdev);
  1892. err = pci_enable_device(pdev);
  1893. if (err) {
  1894. dev_err(&pdev->dev, "ATL1e: Cannot enable PCI"
  1895. " device from suspend\n");
  1896. return err;
  1897. }
  1898. pci_set_master(pdev);
  1899. AT_READ_REG(&adapter->hw, REG_WOL_CTRL); /* clear WOL status */
  1900. pci_enable_wake(pdev, PCI_D3hot, 0);
  1901. pci_enable_wake(pdev, PCI_D3cold, 0);
  1902. AT_WRITE_REG(&adapter->hw, REG_WOL_CTRL, 0);
  1903. if (netif_running(netdev)) {
  1904. err = atl1e_request_irq(adapter);
  1905. if (err)
  1906. return err;
  1907. }
  1908. atl1e_reset_hw(&adapter->hw);
  1909. if (netif_running(netdev))
  1910. atl1e_up(adapter);
  1911. netif_device_attach(netdev);
  1912. return 0;
  1913. }
  1914. #endif
  1915. static void atl1e_shutdown(struct pci_dev *pdev)
  1916. {
  1917. atl1e_suspend(pdev, PMSG_SUSPEND);
  1918. }
  1919. static const struct net_device_ops atl1e_netdev_ops = {
  1920. .ndo_open = atl1e_open,
  1921. .ndo_stop = atl1e_close,
  1922. .ndo_start_xmit = atl1e_xmit_frame,
  1923. .ndo_get_stats = atl1e_get_stats,
  1924. .ndo_set_multicast_list = atl1e_set_multi,
  1925. .ndo_validate_addr = eth_validate_addr,
  1926. .ndo_set_mac_address = atl1e_set_mac_addr,
  1927. .ndo_change_mtu = atl1e_change_mtu,
  1928. .ndo_do_ioctl = atl1e_ioctl,
  1929. .ndo_tx_timeout = atl1e_tx_timeout,
  1930. .ndo_vlan_rx_register = atl1e_vlan_rx_register,
  1931. #ifdef CONFIG_NET_POLL_CONTROLLER
  1932. .ndo_poll_controller = atl1e_netpoll,
  1933. #endif
  1934. };
  1935. static int atl1e_init_netdev(struct net_device *netdev, struct pci_dev *pdev)
  1936. {
  1937. SET_NETDEV_DEV(netdev, &pdev->dev);
  1938. pci_set_drvdata(pdev, netdev);
  1939. netdev->irq = pdev->irq;
  1940. netdev->netdev_ops = &atl1e_netdev_ops;
  1941. netdev->watchdog_timeo = AT_TX_WATCHDOG;
  1942. atl1e_set_ethtool_ops(netdev);
  1943. netdev->features = NETIF_F_SG | NETIF_F_HW_CSUM |
  1944. NETIF_F_HW_VLAN_TX | NETIF_F_HW_VLAN_RX;
  1945. netdev->features |= NETIF_F_LLTX;
  1946. netdev->features |= NETIF_F_TSO;
  1947. netdev->features |= NETIF_F_TSO6;
  1948. return 0;
  1949. }
  1950. /*
  1951. * atl1e_probe - Device Initialization Routine
  1952. * @pdev: PCI device information struct
  1953. * @ent: entry in atl1e_pci_tbl
  1954. *
  1955. * Returns 0 on success, negative on failure
  1956. *
  1957. * atl1e_probe initializes an adapter identified by a pci_dev structure.
  1958. * The OS initialization, configuring of the adapter private structure,
  1959. * and a hardware reset occur.
  1960. */
  1961. static int __devinit atl1e_probe(struct pci_dev *pdev,
  1962. const struct pci_device_id *ent)
  1963. {
  1964. struct net_device *netdev;
  1965. struct atl1e_adapter *adapter = NULL;
  1966. static int cards_found;
  1967. int err = 0;
  1968. err = pci_enable_device(pdev);
  1969. if (err) {
  1970. dev_err(&pdev->dev, "cannot enable PCI device\n");
  1971. return err;
  1972. }
  1973. /*
  1974. * The atl1e chip can DMA to 64-bit addresses, but it uses a single
  1975. * shared register for the high 32 bits, so only a single, aligned,
  1976. * 4 GB physical address range can be used at a time.
  1977. *
  1978. * Supporting 64-bit DMA on this hardware is more trouble than it's
  1979. * worth. It is far easier to limit to 32-bit DMA than update
  1980. * various kernel subsystems to support the mechanics required by a
  1981. * fixed-high-32-bit system.
  1982. */
  1983. if ((pci_set_dma_mask(pdev, DMA_BIT_MASK(32)) != 0) ||
  1984. (pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(32)) != 0)) {
  1985. dev_err(&pdev->dev, "No usable DMA configuration,aborting\n");
  1986. goto err_dma;
  1987. }
  1988. err = pci_request_regions(pdev, atl1e_driver_name);
  1989. if (err) {
  1990. dev_err(&pdev->dev, "cannot obtain PCI resources\n");
  1991. goto err_pci_reg;
  1992. }
  1993. pci_set_master(pdev);
  1994. netdev = alloc_etherdev(sizeof(struct atl1e_adapter));
  1995. if (netdev == NULL) {
  1996. err = -ENOMEM;
  1997. dev_err(&pdev->dev, "etherdev alloc failed\n");
  1998. goto err_alloc_etherdev;
  1999. }
  2000. err = atl1e_init_netdev(netdev, pdev);
  2001. if (err) {
  2002. dev_err(&pdev->dev, "init netdevice failed\n");
  2003. goto err_init_netdev;
  2004. }
  2005. adapter = netdev_priv(netdev);
  2006. adapter->bd_number = cards_found;
  2007. adapter->netdev = netdev;
  2008. adapter->pdev = pdev;
  2009. adapter->hw.adapter = adapter;
  2010. adapter->hw.hw_addr = pci_iomap(pdev, BAR_0, 0);
  2011. if (!adapter->hw.hw_addr) {
  2012. err = -EIO;
  2013. dev_err(&pdev->dev, "cannot map device registers\n");
  2014. goto err_ioremap;
  2015. }
  2016. netdev->base_addr = (unsigned long)adapter->hw.hw_addr;
  2017. /* init mii data */
  2018. adapter->mii.dev = netdev;
  2019. adapter->mii.mdio_read = atl1e_mdio_read;
  2020. adapter->mii.mdio_write = atl1e_mdio_write;
  2021. adapter->mii.phy_id_mask = 0x1f;
  2022. adapter->mii.reg_num_mask = MDIO_REG_ADDR_MASK;
  2023. netif_napi_add(netdev, &adapter->napi, atl1e_clean, 64);
  2024. init_timer(&adapter->phy_config_timer);
  2025. adapter->phy_config_timer.function = &atl1e_phy_config;
  2026. adapter->phy_config_timer.data = (unsigned long) adapter;
  2027. /* get user settings */
  2028. atl1e_check_options(adapter);
  2029. /*
  2030. * Mark all PCI regions associated with PCI device
  2031. * pdev as being reserved by owner atl1e_driver_name
  2032. * Enables bus-mastering on the device and calls
  2033. * pcibios_set_master to do the needed arch specific settings
  2034. */
  2035. atl1e_setup_pcicmd(pdev);
  2036. /* setup the private structure */
  2037. err = atl1e_sw_init(adapter);
  2038. if (err) {
  2039. dev_err(&pdev->dev, "net device private data init failed\n");
  2040. goto err_sw_init;
  2041. }
  2042. /* Init GPHY as early as possible due to power saving issue */
  2043. atl1e_phy_init(&adapter->hw);
  2044. /* reset the controller to
  2045. * put the device in a known good starting state */
  2046. err = atl1e_reset_hw(&adapter->hw);
  2047. if (err) {
  2048. err = -EIO;
  2049. goto err_reset;
  2050. }
  2051. if (atl1e_read_mac_addr(&adapter->hw) != 0) {
  2052. err = -EIO;
  2053. dev_err(&pdev->dev, "get mac address failed\n");
  2054. goto err_eeprom;
  2055. }
  2056. memcpy(netdev->dev_addr, adapter->hw.mac_addr, netdev->addr_len);
  2057. memcpy(netdev->perm_addr, adapter->hw.mac_addr, netdev->addr_len);
  2058. dev_dbg(&pdev->dev, "mac address : %02x-%02x-%02x-%02x-%02x-%02x\n",
  2059. adapter->hw.mac_addr[0], adapter->hw.mac_addr[1],
  2060. adapter->hw.mac_addr[2], adapter->hw.mac_addr[3],
  2061. adapter->hw.mac_addr[4], adapter->hw.mac_addr[5]);
  2062. INIT_WORK(&adapter->reset_task, atl1e_reset_task);
  2063. INIT_WORK(&adapter->link_chg_task, atl1e_link_chg_task);
  2064. err = register_netdev(netdev);
  2065. if (err) {
  2066. dev_err(&pdev->dev, "register netdevice failed\n");
  2067. goto err_register;
  2068. }
  2069. /* assume we have no link for now */
  2070. netif_stop_queue(netdev);
  2071. netif_carrier_off(netdev);
  2072. cards_found++;
  2073. return 0;
  2074. err_reset:
  2075. err_register:
  2076. err_sw_init:
  2077. err_eeprom:
  2078. iounmap(adapter->hw.hw_addr);
  2079. err_init_netdev:
  2080. err_ioremap:
  2081. free_netdev(netdev);
  2082. err_alloc_etherdev:
  2083. pci_release_regions(pdev);
  2084. err_pci_reg:
  2085. err_dma:
  2086. pci_disable_device(pdev);
  2087. return err;
  2088. }
  2089. /*
  2090. * atl1e_remove - Device Removal Routine
  2091. * @pdev: PCI device information struct
  2092. *
  2093. * atl1e_remove is called by the PCI subsystem to alert the driver
  2094. * that it should release a PCI device. The could be caused by a
  2095. * Hot-Plug event, or because the driver is going to be removed from
  2096. * memory.
  2097. */
  2098. static void __devexit atl1e_remove(struct pci_dev *pdev)
  2099. {
  2100. struct net_device *netdev = pci_get_drvdata(pdev);
  2101. struct atl1e_adapter *adapter = netdev_priv(netdev);
  2102. /*
  2103. * flush_scheduled work may reschedule our watchdog task, so
  2104. * explicitly disable watchdog tasks from being rescheduled
  2105. */
  2106. set_bit(__AT_DOWN, &adapter->flags);
  2107. atl1e_del_timer(adapter);
  2108. atl1e_cancel_work(adapter);
  2109. unregister_netdev(netdev);
  2110. atl1e_free_ring_resources(adapter);
  2111. atl1e_force_ps(&adapter->hw);
  2112. iounmap(adapter->hw.hw_addr);
  2113. pci_release_regions(pdev);
  2114. free_netdev(netdev);
  2115. pci_disable_device(pdev);
  2116. }
  2117. /*
  2118. * atl1e_io_error_detected - called when PCI error is detected
  2119. * @pdev: Pointer to PCI device
  2120. * @state: The current pci connection state
  2121. *
  2122. * This function is called after a PCI bus error affecting
  2123. * this device has been detected.
  2124. */
  2125. static pci_ers_result_t
  2126. atl1e_io_error_detected(struct pci_dev *pdev, pci_channel_state_t state)
  2127. {
  2128. struct net_device *netdev = pci_get_drvdata(pdev);
  2129. struct atl1e_adapter *adapter = netdev_priv(netdev);
  2130. netif_device_detach(netdev);
  2131. if (netif_running(netdev))
  2132. atl1e_down(adapter);
  2133. pci_disable_device(pdev);
  2134. /* Request a slot slot reset. */
  2135. return PCI_ERS_RESULT_NEED_RESET;
  2136. }
  2137. /*
  2138. * atl1e_io_slot_reset - called after the pci bus has been reset.
  2139. * @pdev: Pointer to PCI device
  2140. *
  2141. * Restart the card from scratch, as if from a cold-boot. Implementation
  2142. * resembles the first-half of the e1000_resume routine.
  2143. */
  2144. static pci_ers_result_t atl1e_io_slot_reset(struct pci_dev *pdev)
  2145. {
  2146. struct net_device *netdev = pci_get_drvdata(pdev);
  2147. struct atl1e_adapter *adapter = netdev_priv(netdev);
  2148. if (pci_enable_device(pdev)) {
  2149. dev_err(&pdev->dev,
  2150. "ATL1e: Cannot re-enable PCI device after reset.\n");
  2151. return PCI_ERS_RESULT_DISCONNECT;
  2152. }
  2153. pci_set_master(pdev);
  2154. pci_enable_wake(pdev, PCI_D3hot, 0);
  2155. pci_enable_wake(pdev, PCI_D3cold, 0);
  2156. atl1e_reset_hw(&adapter->hw);
  2157. return PCI_ERS_RESULT_RECOVERED;
  2158. }
  2159. /*
  2160. * atl1e_io_resume - called when traffic can start flowing again.
  2161. * @pdev: Pointer to PCI device
  2162. *
  2163. * This callback is called when the error recovery driver tells us that
  2164. * its OK to resume normal operation. Implementation resembles the
  2165. * second-half of the atl1e_resume routine.
  2166. */
  2167. static void atl1e_io_resume(struct pci_dev *pdev)
  2168. {
  2169. struct net_device *netdev = pci_get_drvdata(pdev);
  2170. struct atl1e_adapter *adapter = netdev_priv(netdev);
  2171. if (netif_running(netdev)) {
  2172. if (atl1e_up(adapter)) {
  2173. dev_err(&pdev->dev,
  2174. "ATL1e: can't bring device back up after reset\n");
  2175. return;
  2176. }
  2177. }
  2178. netif_device_attach(netdev);
  2179. }
  2180. static struct pci_error_handlers atl1e_err_handler = {
  2181. .error_detected = atl1e_io_error_detected,
  2182. .slot_reset = atl1e_io_slot_reset,
  2183. .resume = atl1e_io_resume,
  2184. };
  2185. static struct pci_driver atl1e_driver = {
  2186. .name = atl1e_driver_name,
  2187. .id_table = atl1e_pci_tbl,
  2188. .probe = atl1e_probe,
  2189. .remove = __devexit_p(atl1e_remove),
  2190. /* Power Managment Hooks */
  2191. #ifdef CONFIG_PM
  2192. .suspend = atl1e_suspend,
  2193. .resume = atl1e_resume,
  2194. #endif
  2195. .shutdown = atl1e_shutdown,
  2196. .err_handler = &atl1e_err_handler
  2197. };
  2198. /*
  2199. * atl1e_init_module - Driver Registration Routine
  2200. *
  2201. * atl1e_init_module is the first routine called when the driver is
  2202. * loaded. All it does is register with the PCI subsystem.
  2203. */
  2204. static int __init atl1e_init_module(void)
  2205. {
  2206. return pci_register_driver(&atl1e_driver);
  2207. }
  2208. /*
  2209. * atl1e_exit_module - Driver Exit Cleanup Routine
  2210. *
  2211. * atl1e_exit_module is called just before the driver is removed
  2212. * from memory.
  2213. */
  2214. static void __exit atl1e_exit_module(void)
  2215. {
  2216. pci_unregister_driver(&atl1e_driver);
  2217. }
  2218. module_init(atl1e_init_module);
  2219. module_exit(atl1e_exit_module);