atl1e_main.c 70 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412241324142415241624172418241924202421242224232424242524262427242824292430243124322433243424352436243724382439244024412442244324442445244624472448244924502451245224532454245524562457245824592460246124622463246424652466246724682469247024712472247324742475247624772478247924802481248224832484248524862487248824892490249124922493249424952496249724982499250025012502250325042505250625072508250925102511251225132514251525162517251825192520252125222523252425252526252725282529253025312532253325342535253625372538253925402541254225432544254525462547254825492550255125522553255425552556255725582559256025612562256325642565256625672568256925702571257225732574257525762577257825792580258125822583258425852586258725882589259025912592259325942595259625972598259926002601260226032604260526062607260826092610
  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 (atl1e_read_phy_reg(&adapter->hw, data->reg_num & 0x1F,
  397. &data->val_out)) {
  398. retval = -EIO;
  399. goto out;
  400. }
  401. break;
  402. case SIOCSMIIREG:
  403. if (data->reg_num & ~(0x1F)) {
  404. retval = -EFAULT;
  405. goto out;
  406. }
  407. dev_dbg(&pdev->dev, "<atl1e_mii_ioctl> write %x %x",
  408. data->reg_num, data->val_in);
  409. if (atl1e_write_phy_reg(&adapter->hw,
  410. data->reg_num, data->val_in)) {
  411. retval = -EIO;
  412. goto out;
  413. }
  414. break;
  415. default:
  416. retval = -EOPNOTSUPP;
  417. break;
  418. }
  419. out:
  420. spin_unlock_irqrestore(&adapter->mdio_lock, flags);
  421. return retval;
  422. }
  423. /*
  424. * atl1e_ioctl -
  425. * @netdev:
  426. * @ifreq:
  427. * @cmd:
  428. */
  429. static int atl1e_ioctl(struct net_device *netdev, struct ifreq *ifr, int cmd)
  430. {
  431. switch (cmd) {
  432. case SIOCGMIIPHY:
  433. case SIOCGMIIREG:
  434. case SIOCSMIIREG:
  435. return atl1e_mii_ioctl(netdev, ifr, cmd);
  436. default:
  437. return -EOPNOTSUPP;
  438. }
  439. }
  440. static void atl1e_setup_pcicmd(struct pci_dev *pdev)
  441. {
  442. u16 cmd;
  443. pci_read_config_word(pdev, PCI_COMMAND, &cmd);
  444. cmd &= ~(PCI_COMMAND_INTX_DISABLE | PCI_COMMAND_IO);
  445. cmd |= (PCI_COMMAND_MEMORY | PCI_COMMAND_MASTER);
  446. pci_write_config_word(pdev, PCI_COMMAND, cmd);
  447. /*
  448. * some motherboards BIOS(PXE/EFI) driver may set PME
  449. * while they transfer control to OS (Windows/Linux)
  450. * so we should clear this bit before NIC work normally
  451. */
  452. pci_write_config_dword(pdev, REG_PM_CTRLSTAT, 0);
  453. msleep(1);
  454. }
  455. /*
  456. * atl1e_alloc_queues - Allocate memory for all rings
  457. * @adapter: board private structure to initialize
  458. *
  459. */
  460. static int __devinit atl1e_alloc_queues(struct atl1e_adapter *adapter)
  461. {
  462. return 0;
  463. }
  464. /*
  465. * atl1e_sw_init - Initialize general software structures (struct atl1e_adapter)
  466. * @adapter: board private structure to initialize
  467. *
  468. * atl1e_sw_init initializes the Adapter private data structure.
  469. * Fields are initialized based on PCI device information and
  470. * OS network device settings (MTU size).
  471. */
  472. static int __devinit atl1e_sw_init(struct atl1e_adapter *adapter)
  473. {
  474. struct atl1e_hw *hw = &adapter->hw;
  475. struct pci_dev *pdev = adapter->pdev;
  476. u32 phy_status_data = 0;
  477. adapter->wol = 0;
  478. adapter->link_speed = SPEED_0; /* hardware init */
  479. adapter->link_duplex = FULL_DUPLEX;
  480. adapter->num_rx_queues = 1;
  481. /* PCI config space info */
  482. hw->vendor_id = pdev->vendor;
  483. hw->device_id = pdev->device;
  484. hw->subsystem_vendor_id = pdev->subsystem_vendor;
  485. hw->subsystem_id = pdev->subsystem_device;
  486. pci_read_config_byte(pdev, PCI_REVISION_ID, &hw->revision_id);
  487. pci_read_config_word(pdev, PCI_COMMAND, &hw->pci_cmd_word);
  488. phy_status_data = AT_READ_REG(hw, REG_PHY_STATUS);
  489. /* nic type */
  490. if (hw->revision_id >= 0xF0) {
  491. hw->nic_type = athr_l2e_revB;
  492. } else {
  493. if (phy_status_data & PHY_STATUS_100M)
  494. hw->nic_type = athr_l1e;
  495. else
  496. hw->nic_type = athr_l2e_revA;
  497. }
  498. phy_status_data = AT_READ_REG(hw, REG_PHY_STATUS);
  499. if (phy_status_data & PHY_STATUS_EMI_CA)
  500. hw->emi_ca = true;
  501. else
  502. hw->emi_ca = false;
  503. hw->phy_configured = false;
  504. hw->preamble_len = 7;
  505. hw->max_frame_size = adapter->netdev->mtu;
  506. hw->rx_jumbo_th = (hw->max_frame_size + ETH_HLEN +
  507. VLAN_HLEN + ETH_FCS_LEN + 7) >> 3;
  508. hw->rrs_type = atl1e_rrs_disable;
  509. hw->indirect_tab = 0;
  510. hw->base_cpu = 0;
  511. /* need confirm */
  512. hw->ict = 50000; /* 100ms */
  513. hw->smb_timer = 200000; /* 200ms */
  514. hw->tpd_burst = 5;
  515. hw->rrd_thresh = 1;
  516. hw->tpd_thresh = adapter->tx_ring.count / 2;
  517. hw->rx_count_down = 4; /* 2us resolution */
  518. hw->tx_count_down = hw->imt * 4 / 3;
  519. hw->dmar_block = atl1e_dma_req_1024;
  520. hw->dmaw_block = atl1e_dma_req_1024;
  521. hw->dmar_dly_cnt = 15;
  522. hw->dmaw_dly_cnt = 4;
  523. if (atl1e_alloc_queues(adapter)) {
  524. dev_err(&pdev->dev, "Unable to allocate memory for queues\n");
  525. return -ENOMEM;
  526. }
  527. atomic_set(&adapter->irq_sem, 1);
  528. spin_lock_init(&adapter->mdio_lock);
  529. spin_lock_init(&adapter->tx_lock);
  530. set_bit(__AT_DOWN, &adapter->flags);
  531. return 0;
  532. }
  533. /*
  534. * atl1e_clean_tx_ring - Free Tx-skb
  535. * @adapter: board private structure
  536. */
  537. static void atl1e_clean_tx_ring(struct atl1e_adapter *adapter)
  538. {
  539. struct atl1e_tx_ring *tx_ring = (struct atl1e_tx_ring *)
  540. &adapter->tx_ring;
  541. struct atl1e_tx_buffer *tx_buffer = NULL;
  542. struct pci_dev *pdev = adapter->pdev;
  543. u16 index, ring_count;
  544. if (tx_ring->desc == NULL || tx_ring->tx_buffer == NULL)
  545. return;
  546. ring_count = tx_ring->count;
  547. /* first unmmap dma */
  548. for (index = 0; index < ring_count; index++) {
  549. tx_buffer = &tx_ring->tx_buffer[index];
  550. if (tx_buffer->dma) {
  551. if (tx_buffer->flags & ATL1E_TX_PCIMAP_SINGLE)
  552. pci_unmap_single(pdev, tx_buffer->dma,
  553. tx_buffer->length, PCI_DMA_TODEVICE);
  554. else if (tx_buffer->flags & ATL1E_TX_PCIMAP_PAGE)
  555. pci_unmap_page(pdev, tx_buffer->dma,
  556. tx_buffer->length, PCI_DMA_TODEVICE);
  557. tx_buffer->dma = 0;
  558. }
  559. }
  560. /* second free skb */
  561. for (index = 0; index < ring_count; index++) {
  562. tx_buffer = &tx_ring->tx_buffer[index];
  563. if (tx_buffer->skb) {
  564. dev_kfree_skb_any(tx_buffer->skb);
  565. tx_buffer->skb = NULL;
  566. }
  567. }
  568. /* Zero out Tx-buffers */
  569. memset(tx_ring->desc, 0, sizeof(struct atl1e_tpd_desc) *
  570. ring_count);
  571. memset(tx_ring->tx_buffer, 0, sizeof(struct atl1e_tx_buffer) *
  572. ring_count);
  573. }
  574. /*
  575. * atl1e_clean_rx_ring - Free rx-reservation skbs
  576. * @adapter: board private structure
  577. */
  578. static void atl1e_clean_rx_ring(struct atl1e_adapter *adapter)
  579. {
  580. struct atl1e_rx_ring *rx_ring =
  581. (struct atl1e_rx_ring *)&adapter->rx_ring;
  582. struct atl1e_rx_page_desc *rx_page_desc = rx_ring->rx_page_desc;
  583. u16 i, j;
  584. if (adapter->ring_vir_addr == NULL)
  585. return;
  586. /* Zero out the descriptor ring */
  587. for (i = 0; i < adapter->num_rx_queues; i++) {
  588. for (j = 0; j < AT_PAGE_NUM_PER_QUEUE; j++) {
  589. if (rx_page_desc[i].rx_page[j].addr != NULL) {
  590. memset(rx_page_desc[i].rx_page[j].addr, 0,
  591. rx_ring->real_page_size);
  592. }
  593. }
  594. }
  595. }
  596. static void atl1e_cal_ring_size(struct atl1e_adapter *adapter, u32 *ring_size)
  597. {
  598. *ring_size = ((u32)(adapter->tx_ring.count *
  599. sizeof(struct atl1e_tpd_desc) + 7
  600. /* tx ring, qword align */
  601. + adapter->rx_ring.real_page_size * AT_PAGE_NUM_PER_QUEUE *
  602. adapter->num_rx_queues + 31
  603. /* rx ring, 32 bytes align */
  604. + (1 + AT_PAGE_NUM_PER_QUEUE * adapter->num_rx_queues) *
  605. sizeof(u32) + 3));
  606. /* tx, rx cmd, dword align */
  607. }
  608. static void atl1e_init_ring_resources(struct atl1e_adapter *adapter)
  609. {
  610. struct atl1e_tx_ring *tx_ring = NULL;
  611. struct atl1e_rx_ring *rx_ring = NULL;
  612. tx_ring = &adapter->tx_ring;
  613. rx_ring = &adapter->rx_ring;
  614. rx_ring->real_page_size = adapter->rx_ring.page_size
  615. + adapter->hw.max_frame_size
  616. + ETH_HLEN + VLAN_HLEN
  617. + ETH_FCS_LEN;
  618. rx_ring->real_page_size = roundup(rx_ring->real_page_size, 32);
  619. atl1e_cal_ring_size(adapter, &adapter->ring_size);
  620. adapter->ring_vir_addr = NULL;
  621. adapter->rx_ring.desc = NULL;
  622. rwlock_init(&adapter->tx_ring.tx_lock);
  623. return;
  624. }
  625. /*
  626. * Read / Write Ptr Initialize:
  627. */
  628. static void atl1e_init_ring_ptrs(struct atl1e_adapter *adapter)
  629. {
  630. struct atl1e_tx_ring *tx_ring = NULL;
  631. struct atl1e_rx_ring *rx_ring = NULL;
  632. struct atl1e_rx_page_desc *rx_page_desc = NULL;
  633. int i, j;
  634. tx_ring = &adapter->tx_ring;
  635. rx_ring = &adapter->rx_ring;
  636. rx_page_desc = rx_ring->rx_page_desc;
  637. tx_ring->next_to_use = 0;
  638. atomic_set(&tx_ring->next_to_clean, 0);
  639. for (i = 0; i < adapter->num_rx_queues; i++) {
  640. rx_page_desc[i].rx_using = 0;
  641. rx_page_desc[i].rx_nxseq = 0;
  642. for (j = 0; j < AT_PAGE_NUM_PER_QUEUE; j++) {
  643. *rx_page_desc[i].rx_page[j].write_offset_addr = 0;
  644. rx_page_desc[i].rx_page[j].read_offset = 0;
  645. }
  646. }
  647. }
  648. /*
  649. * atl1e_free_ring_resources - Free Tx / RX descriptor Resources
  650. * @adapter: board private structure
  651. *
  652. * Free all transmit software resources
  653. */
  654. static void atl1e_free_ring_resources(struct atl1e_adapter *adapter)
  655. {
  656. struct pci_dev *pdev = adapter->pdev;
  657. atl1e_clean_tx_ring(adapter);
  658. atl1e_clean_rx_ring(adapter);
  659. if (adapter->ring_vir_addr) {
  660. pci_free_consistent(pdev, adapter->ring_size,
  661. adapter->ring_vir_addr, adapter->ring_dma);
  662. adapter->ring_vir_addr = NULL;
  663. }
  664. if (adapter->tx_ring.tx_buffer) {
  665. kfree(adapter->tx_ring.tx_buffer);
  666. adapter->tx_ring.tx_buffer = NULL;
  667. }
  668. }
  669. /*
  670. * atl1e_setup_mem_resources - allocate Tx / RX descriptor resources
  671. * @adapter: board private structure
  672. *
  673. * Return 0 on success, negative on failure
  674. */
  675. static int atl1e_setup_ring_resources(struct atl1e_adapter *adapter)
  676. {
  677. struct pci_dev *pdev = adapter->pdev;
  678. struct atl1e_tx_ring *tx_ring;
  679. struct atl1e_rx_ring *rx_ring;
  680. struct atl1e_rx_page_desc *rx_page_desc;
  681. int size, i, j;
  682. u32 offset = 0;
  683. int err = 0;
  684. if (adapter->ring_vir_addr != NULL)
  685. return 0; /* alloced already */
  686. tx_ring = &adapter->tx_ring;
  687. rx_ring = &adapter->rx_ring;
  688. /* real ring DMA buffer */
  689. size = adapter->ring_size;
  690. adapter->ring_vir_addr = pci_alloc_consistent(pdev,
  691. adapter->ring_size, &adapter->ring_dma);
  692. if (adapter->ring_vir_addr == NULL) {
  693. dev_err(&pdev->dev, "pci_alloc_consistent failed, "
  694. "size = D%d", size);
  695. return -ENOMEM;
  696. }
  697. memset(adapter->ring_vir_addr, 0, adapter->ring_size);
  698. rx_page_desc = rx_ring->rx_page_desc;
  699. /* Init TPD Ring */
  700. tx_ring->dma = roundup(adapter->ring_dma, 8);
  701. offset = tx_ring->dma - adapter->ring_dma;
  702. tx_ring->desc = (struct atl1e_tpd_desc *)
  703. (adapter->ring_vir_addr + offset);
  704. size = sizeof(struct atl1e_tx_buffer) * (tx_ring->count);
  705. tx_ring->tx_buffer = kzalloc(size, GFP_KERNEL);
  706. if (tx_ring->tx_buffer == NULL) {
  707. dev_err(&pdev->dev, "kzalloc failed , size = D%d", size);
  708. err = -ENOMEM;
  709. goto failed;
  710. }
  711. /* Init RXF-Pages */
  712. offset += (sizeof(struct atl1e_tpd_desc) * tx_ring->count);
  713. offset = roundup(offset, 32);
  714. for (i = 0; i < adapter->num_rx_queues; i++) {
  715. for (j = 0; j < AT_PAGE_NUM_PER_QUEUE; j++) {
  716. rx_page_desc[i].rx_page[j].dma =
  717. adapter->ring_dma + offset;
  718. rx_page_desc[i].rx_page[j].addr =
  719. adapter->ring_vir_addr + offset;
  720. offset += rx_ring->real_page_size;
  721. }
  722. }
  723. /* Init CMB dma address */
  724. tx_ring->cmb_dma = adapter->ring_dma + offset;
  725. tx_ring->cmb = (u32 *)(adapter->ring_vir_addr + offset);
  726. offset += sizeof(u32);
  727. for (i = 0; i < adapter->num_rx_queues; i++) {
  728. for (j = 0; j < AT_PAGE_NUM_PER_QUEUE; j++) {
  729. rx_page_desc[i].rx_page[j].write_offset_dma =
  730. adapter->ring_dma + offset;
  731. rx_page_desc[i].rx_page[j].write_offset_addr =
  732. adapter->ring_vir_addr + offset;
  733. offset += sizeof(u32);
  734. }
  735. }
  736. if (unlikely(offset > adapter->ring_size)) {
  737. dev_err(&pdev->dev, "offset(%d) > ring size(%d) !!\n",
  738. offset, adapter->ring_size);
  739. err = -1;
  740. goto failed;
  741. }
  742. return 0;
  743. failed:
  744. if (adapter->ring_vir_addr != NULL) {
  745. pci_free_consistent(pdev, adapter->ring_size,
  746. adapter->ring_vir_addr, adapter->ring_dma);
  747. adapter->ring_vir_addr = NULL;
  748. }
  749. return err;
  750. }
  751. static inline void atl1e_configure_des_ring(const struct atl1e_adapter *adapter)
  752. {
  753. struct atl1e_hw *hw = (struct atl1e_hw *)&adapter->hw;
  754. struct atl1e_rx_ring *rx_ring =
  755. (struct atl1e_rx_ring *)&adapter->rx_ring;
  756. struct atl1e_tx_ring *tx_ring =
  757. (struct atl1e_tx_ring *)&adapter->tx_ring;
  758. struct atl1e_rx_page_desc *rx_page_desc = NULL;
  759. int i, j;
  760. AT_WRITE_REG(hw, REG_DESC_BASE_ADDR_HI,
  761. (u32)((adapter->ring_dma & AT_DMA_HI_ADDR_MASK) >> 32));
  762. AT_WRITE_REG(hw, REG_TPD_BASE_ADDR_LO,
  763. (u32)((tx_ring->dma) & AT_DMA_LO_ADDR_MASK));
  764. AT_WRITE_REG(hw, REG_TPD_RING_SIZE, (u16)(tx_ring->count));
  765. AT_WRITE_REG(hw, REG_HOST_TX_CMB_LO,
  766. (u32)((tx_ring->cmb_dma) & AT_DMA_LO_ADDR_MASK));
  767. rx_page_desc = rx_ring->rx_page_desc;
  768. /* RXF Page Physical address / Page Length */
  769. for (i = 0; i < AT_MAX_RECEIVE_QUEUE; i++) {
  770. AT_WRITE_REG(hw, atl1e_rx_page_hi_addr_regs[i],
  771. (u32)((adapter->ring_dma &
  772. AT_DMA_HI_ADDR_MASK) >> 32));
  773. for (j = 0; j < AT_PAGE_NUM_PER_QUEUE; j++) {
  774. u32 page_phy_addr;
  775. u32 offset_phy_addr;
  776. page_phy_addr = rx_page_desc[i].rx_page[j].dma;
  777. offset_phy_addr =
  778. rx_page_desc[i].rx_page[j].write_offset_dma;
  779. AT_WRITE_REG(hw, atl1e_rx_page_lo_addr_regs[i][j],
  780. page_phy_addr & AT_DMA_LO_ADDR_MASK);
  781. AT_WRITE_REG(hw, atl1e_rx_page_write_offset_regs[i][j],
  782. offset_phy_addr & AT_DMA_LO_ADDR_MASK);
  783. AT_WRITE_REGB(hw, atl1e_rx_page_vld_regs[i][j], 1);
  784. }
  785. }
  786. /* Page Length */
  787. AT_WRITE_REG(hw, REG_HOST_RXFPAGE_SIZE, rx_ring->page_size);
  788. /* Load all of base address above */
  789. AT_WRITE_REG(hw, REG_LOAD_PTR, 1);
  790. return;
  791. }
  792. static inline void atl1e_configure_tx(struct atl1e_adapter *adapter)
  793. {
  794. struct atl1e_hw *hw = (struct atl1e_hw *)&adapter->hw;
  795. u32 dev_ctrl_data = 0;
  796. u32 max_pay_load = 0;
  797. u32 jumbo_thresh = 0;
  798. u32 extra_size = 0; /* Jumbo frame threshold in QWORD unit */
  799. /* configure TXQ param */
  800. if (hw->nic_type != athr_l2e_revB) {
  801. extra_size = ETH_HLEN + VLAN_HLEN + ETH_FCS_LEN;
  802. if (hw->max_frame_size <= 1500) {
  803. jumbo_thresh = hw->max_frame_size + extra_size;
  804. } else if (hw->max_frame_size < 6*1024) {
  805. jumbo_thresh =
  806. (hw->max_frame_size + extra_size) * 2 / 3;
  807. } else {
  808. jumbo_thresh = (hw->max_frame_size + extra_size) / 2;
  809. }
  810. AT_WRITE_REG(hw, REG_TX_EARLY_TH, (jumbo_thresh + 7) >> 3);
  811. }
  812. dev_ctrl_data = AT_READ_REG(hw, REG_DEVICE_CTRL);
  813. max_pay_load = ((dev_ctrl_data >> DEVICE_CTRL_MAX_PAYLOAD_SHIFT)) &
  814. DEVICE_CTRL_MAX_PAYLOAD_MASK;
  815. hw->dmaw_block = min(max_pay_load, hw->dmaw_block);
  816. max_pay_load = ((dev_ctrl_data >> DEVICE_CTRL_MAX_RREQ_SZ_SHIFT)) &
  817. DEVICE_CTRL_MAX_RREQ_SZ_MASK;
  818. hw->dmar_block = min(max_pay_load, hw->dmar_block);
  819. if (hw->nic_type != athr_l2e_revB)
  820. AT_WRITE_REGW(hw, REG_TXQ_CTRL + 2,
  821. atl1e_pay_load_size[hw->dmar_block]);
  822. /* enable TXQ */
  823. AT_WRITE_REGW(hw, REG_TXQ_CTRL,
  824. (((u16)hw->tpd_burst & TXQ_CTRL_NUM_TPD_BURST_MASK)
  825. << TXQ_CTRL_NUM_TPD_BURST_SHIFT)
  826. | TXQ_CTRL_ENH_MODE | TXQ_CTRL_EN);
  827. return;
  828. }
  829. static inline void atl1e_configure_rx(struct atl1e_adapter *adapter)
  830. {
  831. struct atl1e_hw *hw = (struct atl1e_hw *)&adapter->hw;
  832. u32 rxf_len = 0;
  833. u32 rxf_low = 0;
  834. u32 rxf_high = 0;
  835. u32 rxf_thresh_data = 0;
  836. u32 rxq_ctrl_data = 0;
  837. if (hw->nic_type != athr_l2e_revB) {
  838. AT_WRITE_REGW(hw, REG_RXQ_JMBOSZ_RRDTIM,
  839. (u16)((hw->rx_jumbo_th & RXQ_JMBOSZ_TH_MASK) <<
  840. RXQ_JMBOSZ_TH_SHIFT |
  841. (1 & RXQ_JMBO_LKAH_MASK) <<
  842. RXQ_JMBO_LKAH_SHIFT));
  843. rxf_len = AT_READ_REG(hw, REG_SRAM_RXF_LEN);
  844. rxf_high = rxf_len * 4 / 5;
  845. rxf_low = rxf_len / 5;
  846. rxf_thresh_data = ((rxf_high & RXQ_RXF_PAUSE_TH_HI_MASK)
  847. << RXQ_RXF_PAUSE_TH_HI_SHIFT) |
  848. ((rxf_low & RXQ_RXF_PAUSE_TH_LO_MASK)
  849. << RXQ_RXF_PAUSE_TH_LO_SHIFT);
  850. AT_WRITE_REG(hw, REG_RXQ_RXF_PAUSE_THRESH, rxf_thresh_data);
  851. }
  852. /* RRS */
  853. AT_WRITE_REG(hw, REG_IDT_TABLE, hw->indirect_tab);
  854. AT_WRITE_REG(hw, REG_BASE_CPU_NUMBER, hw->base_cpu);
  855. if (hw->rrs_type & atl1e_rrs_ipv4)
  856. rxq_ctrl_data |= RXQ_CTRL_HASH_TYPE_IPV4;
  857. if (hw->rrs_type & atl1e_rrs_ipv4_tcp)
  858. rxq_ctrl_data |= RXQ_CTRL_HASH_TYPE_IPV4_TCP;
  859. if (hw->rrs_type & atl1e_rrs_ipv6)
  860. rxq_ctrl_data |= RXQ_CTRL_HASH_TYPE_IPV6;
  861. if (hw->rrs_type & atl1e_rrs_ipv6_tcp)
  862. rxq_ctrl_data |= RXQ_CTRL_HASH_TYPE_IPV6_TCP;
  863. if (hw->rrs_type != atl1e_rrs_disable)
  864. rxq_ctrl_data |=
  865. (RXQ_CTRL_HASH_ENABLE | RXQ_CTRL_RSS_MODE_MQUESINT);
  866. rxq_ctrl_data |= RXQ_CTRL_IPV6_XSUM_VERIFY_EN | RXQ_CTRL_PBA_ALIGN_32 |
  867. RXQ_CTRL_CUT_THRU_EN | RXQ_CTRL_EN;
  868. AT_WRITE_REG(hw, REG_RXQ_CTRL, rxq_ctrl_data);
  869. return;
  870. }
  871. static inline void atl1e_configure_dma(struct atl1e_adapter *adapter)
  872. {
  873. struct atl1e_hw *hw = &adapter->hw;
  874. u32 dma_ctrl_data = 0;
  875. dma_ctrl_data = DMA_CTRL_RXCMB_EN;
  876. dma_ctrl_data |= (((u32)hw->dmar_block) & DMA_CTRL_DMAR_BURST_LEN_MASK)
  877. << DMA_CTRL_DMAR_BURST_LEN_SHIFT;
  878. dma_ctrl_data |= (((u32)hw->dmaw_block) & DMA_CTRL_DMAW_BURST_LEN_MASK)
  879. << DMA_CTRL_DMAW_BURST_LEN_SHIFT;
  880. dma_ctrl_data |= DMA_CTRL_DMAR_REQ_PRI | DMA_CTRL_DMAR_OUT_ORDER;
  881. dma_ctrl_data |= (((u32)hw->dmar_dly_cnt) & DMA_CTRL_DMAR_DLY_CNT_MASK)
  882. << DMA_CTRL_DMAR_DLY_CNT_SHIFT;
  883. dma_ctrl_data |= (((u32)hw->dmaw_dly_cnt) & DMA_CTRL_DMAW_DLY_CNT_MASK)
  884. << DMA_CTRL_DMAW_DLY_CNT_SHIFT;
  885. AT_WRITE_REG(hw, REG_DMA_CTRL, dma_ctrl_data);
  886. return;
  887. }
  888. static void atl1e_setup_mac_ctrl(struct atl1e_adapter *adapter)
  889. {
  890. u32 value;
  891. struct atl1e_hw *hw = &adapter->hw;
  892. struct net_device *netdev = adapter->netdev;
  893. /* Config MAC CTRL Register */
  894. value = MAC_CTRL_TX_EN |
  895. MAC_CTRL_RX_EN ;
  896. if (FULL_DUPLEX == adapter->link_duplex)
  897. value |= MAC_CTRL_DUPLX;
  898. value |= ((u32)((SPEED_1000 == adapter->link_speed) ?
  899. MAC_CTRL_SPEED_1000 : MAC_CTRL_SPEED_10_100) <<
  900. MAC_CTRL_SPEED_SHIFT);
  901. value |= (MAC_CTRL_TX_FLOW | MAC_CTRL_RX_FLOW);
  902. value |= (MAC_CTRL_ADD_CRC | MAC_CTRL_PAD);
  903. value |= (((u32)adapter->hw.preamble_len &
  904. MAC_CTRL_PRMLEN_MASK) << MAC_CTRL_PRMLEN_SHIFT);
  905. if (adapter->vlgrp)
  906. value |= MAC_CTRL_RMV_VLAN;
  907. value |= MAC_CTRL_BC_EN;
  908. if (netdev->flags & IFF_PROMISC)
  909. value |= MAC_CTRL_PROMIS_EN;
  910. if (netdev->flags & IFF_ALLMULTI)
  911. value |= MAC_CTRL_MC_ALL_EN;
  912. AT_WRITE_REG(hw, REG_MAC_CTRL, value);
  913. }
  914. /*
  915. * atl1e_configure - Configure Transmit&Receive Unit after Reset
  916. * @adapter: board private structure
  917. *
  918. * Configure the Tx /Rx unit of the MAC after a reset.
  919. */
  920. static int atl1e_configure(struct atl1e_adapter *adapter)
  921. {
  922. struct atl1e_hw *hw = &adapter->hw;
  923. struct pci_dev *pdev = adapter->pdev;
  924. u32 intr_status_data = 0;
  925. /* clear interrupt status */
  926. AT_WRITE_REG(hw, REG_ISR, ~0);
  927. /* 1. set MAC Address */
  928. atl1e_hw_set_mac_addr(hw);
  929. /* 2. Init the Multicast HASH table done by set_muti */
  930. /* 3. Clear any WOL status */
  931. AT_WRITE_REG(hw, REG_WOL_CTRL, 0);
  932. /* 4. Descripter Ring BaseMem/Length/Read ptr/Write ptr
  933. * TPD Ring/SMB/RXF0 Page CMBs, they use the same
  934. * High 32bits memory */
  935. atl1e_configure_des_ring(adapter);
  936. /* 5. set Interrupt Moderator Timer */
  937. AT_WRITE_REGW(hw, REG_IRQ_MODU_TIMER_INIT, hw->imt);
  938. AT_WRITE_REGW(hw, REG_IRQ_MODU_TIMER2_INIT, hw->imt);
  939. AT_WRITE_REG(hw, REG_MASTER_CTRL, MASTER_CTRL_LED_MODE |
  940. MASTER_CTRL_ITIMER_EN | MASTER_CTRL_ITIMER2_EN);
  941. /* 6. rx/tx threshold to trig interrupt */
  942. AT_WRITE_REGW(hw, REG_TRIG_RRD_THRESH, hw->rrd_thresh);
  943. AT_WRITE_REGW(hw, REG_TRIG_TPD_THRESH, hw->tpd_thresh);
  944. AT_WRITE_REGW(hw, REG_TRIG_RXTIMER, hw->rx_count_down);
  945. AT_WRITE_REGW(hw, REG_TRIG_TXTIMER, hw->tx_count_down);
  946. /* 7. set Interrupt Clear Timer */
  947. AT_WRITE_REGW(hw, REG_CMBDISDMA_TIMER, hw->ict);
  948. /* 8. set MTU */
  949. AT_WRITE_REG(hw, REG_MTU, hw->max_frame_size + ETH_HLEN +
  950. VLAN_HLEN + ETH_FCS_LEN);
  951. /* 9. config TXQ early tx threshold */
  952. atl1e_configure_tx(adapter);
  953. /* 10. config RXQ */
  954. atl1e_configure_rx(adapter);
  955. /* 11. config DMA Engine */
  956. atl1e_configure_dma(adapter);
  957. /* 12. smb timer to trig interrupt */
  958. AT_WRITE_REG(hw, REG_SMB_STAT_TIMER, hw->smb_timer);
  959. intr_status_data = AT_READ_REG(hw, REG_ISR);
  960. if (unlikely((intr_status_data & ISR_PHY_LINKDOWN) != 0)) {
  961. dev_err(&pdev->dev, "atl1e_configure failed,"
  962. "PCIE phy link down\n");
  963. return -1;
  964. }
  965. AT_WRITE_REG(hw, REG_ISR, 0x7fffffff);
  966. return 0;
  967. }
  968. /*
  969. * atl1e_get_stats - Get System Network Statistics
  970. * @netdev: network interface device structure
  971. *
  972. * Returns the address of the device statistics structure.
  973. * The statistics are actually updated from the timer callback.
  974. */
  975. static struct net_device_stats *atl1e_get_stats(struct net_device *netdev)
  976. {
  977. struct atl1e_adapter *adapter = netdev_priv(netdev);
  978. struct atl1e_hw_stats *hw_stats = &adapter->hw_stats;
  979. struct net_device_stats *net_stats = &netdev->stats;
  980. net_stats->rx_packets = hw_stats->rx_ok;
  981. net_stats->tx_packets = hw_stats->tx_ok;
  982. net_stats->rx_bytes = hw_stats->rx_byte_cnt;
  983. net_stats->tx_bytes = hw_stats->tx_byte_cnt;
  984. net_stats->multicast = hw_stats->rx_mcast;
  985. net_stats->collisions = hw_stats->tx_1_col +
  986. hw_stats->tx_2_col * 2 +
  987. hw_stats->tx_late_col + hw_stats->tx_abort_col;
  988. net_stats->rx_errors = hw_stats->rx_frag + hw_stats->rx_fcs_err +
  989. hw_stats->rx_len_err + hw_stats->rx_sz_ov +
  990. hw_stats->rx_rrd_ov + hw_stats->rx_align_err;
  991. net_stats->rx_fifo_errors = hw_stats->rx_rxf_ov;
  992. net_stats->rx_length_errors = hw_stats->rx_len_err;
  993. net_stats->rx_crc_errors = hw_stats->rx_fcs_err;
  994. net_stats->rx_frame_errors = hw_stats->rx_align_err;
  995. net_stats->rx_over_errors = hw_stats->rx_rrd_ov + hw_stats->rx_rxf_ov;
  996. net_stats->rx_missed_errors = hw_stats->rx_rrd_ov + hw_stats->rx_rxf_ov;
  997. net_stats->tx_errors = hw_stats->tx_late_col + hw_stats->tx_abort_col +
  998. hw_stats->tx_underrun + hw_stats->tx_trunc;
  999. net_stats->tx_fifo_errors = hw_stats->tx_underrun;
  1000. net_stats->tx_aborted_errors = hw_stats->tx_abort_col;
  1001. net_stats->tx_window_errors = hw_stats->tx_late_col;
  1002. return net_stats;
  1003. }
  1004. static void atl1e_update_hw_stats(struct atl1e_adapter *adapter)
  1005. {
  1006. u16 hw_reg_addr = 0;
  1007. unsigned long *stats_item = NULL;
  1008. /* update rx status */
  1009. hw_reg_addr = REG_MAC_RX_STATUS_BIN;
  1010. stats_item = &adapter->hw_stats.rx_ok;
  1011. while (hw_reg_addr <= REG_MAC_RX_STATUS_END) {
  1012. *stats_item += AT_READ_REG(&adapter->hw, hw_reg_addr);
  1013. stats_item++;
  1014. hw_reg_addr += 4;
  1015. }
  1016. /* update tx status */
  1017. hw_reg_addr = REG_MAC_TX_STATUS_BIN;
  1018. stats_item = &adapter->hw_stats.tx_ok;
  1019. while (hw_reg_addr <= REG_MAC_TX_STATUS_END) {
  1020. *stats_item += AT_READ_REG(&adapter->hw, hw_reg_addr);
  1021. stats_item++;
  1022. hw_reg_addr += 4;
  1023. }
  1024. }
  1025. static inline void atl1e_clear_phy_int(struct atl1e_adapter *adapter)
  1026. {
  1027. u16 phy_data;
  1028. spin_lock(&adapter->mdio_lock);
  1029. atl1e_read_phy_reg(&adapter->hw, MII_INT_STATUS, &phy_data);
  1030. spin_unlock(&adapter->mdio_lock);
  1031. }
  1032. static bool atl1e_clean_tx_irq(struct atl1e_adapter *adapter)
  1033. {
  1034. struct atl1e_tx_ring *tx_ring = (struct atl1e_tx_ring *)
  1035. &adapter->tx_ring;
  1036. struct atl1e_tx_buffer *tx_buffer = NULL;
  1037. u16 hw_next_to_clean = AT_READ_REGW(&adapter->hw, REG_TPD_CONS_IDX);
  1038. u16 next_to_clean = atomic_read(&tx_ring->next_to_clean);
  1039. while (next_to_clean != hw_next_to_clean) {
  1040. tx_buffer = &tx_ring->tx_buffer[next_to_clean];
  1041. if (tx_buffer->dma) {
  1042. if (tx_buffer->flags & ATL1E_TX_PCIMAP_SINGLE)
  1043. pci_unmap_single(adapter->pdev, tx_buffer->dma,
  1044. tx_buffer->length, PCI_DMA_TODEVICE);
  1045. else if (tx_buffer->flags & ATL1E_TX_PCIMAP_PAGE)
  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. ATL1E_SET_PCIMAP_TYPE(tx_buffer, ATL1E_TX_PCIMAP_SINGLE);
  1506. mapped_len += map_len;
  1507. use_tpd->buffer_addr = cpu_to_le64(tx_buffer->dma);
  1508. use_tpd->word2 = (use_tpd->word2 & (~TPD_BUFLEN_MASK)) |
  1509. ((cpu_to_le32(tx_buffer->length) &
  1510. TPD_BUFLEN_MASK) << TPD_BUFLEN_SHIFT);
  1511. }
  1512. while (mapped_len < buf_len) {
  1513. /* mapped_len == 0, means we should use the first tpd,
  1514. which is given by caller */
  1515. if (mapped_len == 0) {
  1516. use_tpd = tpd;
  1517. } else {
  1518. use_tpd = atl1e_get_tpd(adapter);
  1519. memcpy(use_tpd, tpd, sizeof(struct atl1e_tpd_desc));
  1520. }
  1521. tx_buffer = atl1e_get_tx_buffer(adapter, use_tpd);
  1522. tx_buffer->skb = NULL;
  1523. tx_buffer->length = map_len =
  1524. ((buf_len - mapped_len) >= MAX_TX_BUF_LEN) ?
  1525. MAX_TX_BUF_LEN : (buf_len - mapped_len);
  1526. tx_buffer->dma =
  1527. pci_map_single(adapter->pdev, skb->data + mapped_len,
  1528. map_len, PCI_DMA_TODEVICE);
  1529. ATL1E_SET_PCIMAP_TYPE(tx_buffer, ATL1E_TX_PCIMAP_SINGLE);
  1530. mapped_len += map_len;
  1531. use_tpd->buffer_addr = cpu_to_le64(tx_buffer->dma);
  1532. use_tpd->word2 = (use_tpd->word2 & (~TPD_BUFLEN_MASK)) |
  1533. ((cpu_to_le32(tx_buffer->length) &
  1534. TPD_BUFLEN_MASK) << TPD_BUFLEN_SHIFT);
  1535. }
  1536. for (f = 0; f < nr_frags; f++) {
  1537. struct skb_frag_struct *frag;
  1538. u16 i;
  1539. u16 seg_num;
  1540. frag = &skb_shinfo(skb)->frags[f];
  1541. buf_len = frag->size;
  1542. seg_num = (buf_len + MAX_TX_BUF_LEN - 1) / MAX_TX_BUF_LEN;
  1543. for (i = 0; i < seg_num; i++) {
  1544. use_tpd = atl1e_get_tpd(adapter);
  1545. memcpy(use_tpd, tpd, sizeof(struct atl1e_tpd_desc));
  1546. tx_buffer = atl1e_get_tx_buffer(adapter, use_tpd);
  1547. BUG_ON(tx_buffer->skb);
  1548. tx_buffer->skb = NULL;
  1549. tx_buffer->length =
  1550. (buf_len > MAX_TX_BUF_LEN) ?
  1551. MAX_TX_BUF_LEN : buf_len;
  1552. buf_len -= tx_buffer->length;
  1553. tx_buffer->dma =
  1554. pci_map_page(adapter->pdev, frag->page,
  1555. frag->page_offset +
  1556. (i * MAX_TX_BUF_LEN),
  1557. tx_buffer->length,
  1558. PCI_DMA_TODEVICE);
  1559. ATL1E_SET_PCIMAP_TYPE(tx_buffer, ATL1E_TX_PCIMAP_PAGE);
  1560. use_tpd->buffer_addr = cpu_to_le64(tx_buffer->dma);
  1561. use_tpd->word2 = (use_tpd->word2 & (~TPD_BUFLEN_MASK)) |
  1562. ((cpu_to_le32(tx_buffer->length) &
  1563. TPD_BUFLEN_MASK) << TPD_BUFLEN_SHIFT);
  1564. }
  1565. }
  1566. if ((tpd->word3 >> TPD_SEGMENT_EN_SHIFT) & TPD_SEGMENT_EN_MASK)
  1567. /* note this one is a tcp header */
  1568. tpd->word3 |= 1 << TPD_HDRFLAG_SHIFT;
  1569. /* The last tpd */
  1570. use_tpd->word3 |= 1 << TPD_EOP_SHIFT;
  1571. /* The last buffer info contain the skb address,
  1572. so it will be free after unmap */
  1573. tx_buffer->skb = skb;
  1574. }
  1575. static void atl1e_tx_queue(struct atl1e_adapter *adapter, u16 count,
  1576. struct atl1e_tpd_desc *tpd)
  1577. {
  1578. struct atl1e_tx_ring *tx_ring = &adapter->tx_ring;
  1579. /* Force memory writes to complete before letting h/w
  1580. * know there are new descriptors to fetch. (Only
  1581. * applicable for weak-ordered memory model archs,
  1582. * such as IA-64). */
  1583. wmb();
  1584. AT_WRITE_REG(&adapter->hw, REG_MB_TPD_PROD_IDX, tx_ring->next_to_use);
  1585. }
  1586. static netdev_tx_t atl1e_xmit_frame(struct sk_buff *skb,
  1587. struct net_device *netdev)
  1588. {
  1589. struct atl1e_adapter *adapter = netdev_priv(netdev);
  1590. unsigned long flags;
  1591. u16 tpd_req = 1;
  1592. struct atl1e_tpd_desc *tpd;
  1593. if (test_bit(__AT_DOWN, &adapter->flags)) {
  1594. dev_kfree_skb_any(skb);
  1595. return NETDEV_TX_OK;
  1596. }
  1597. if (unlikely(skb->len <= 0)) {
  1598. dev_kfree_skb_any(skb);
  1599. return NETDEV_TX_OK;
  1600. }
  1601. tpd_req = atl1e_cal_tdp_req(skb);
  1602. if (!spin_trylock_irqsave(&adapter->tx_lock, flags))
  1603. return NETDEV_TX_LOCKED;
  1604. if (atl1e_tpd_avail(adapter) < tpd_req) {
  1605. /* no enough descriptor, just stop queue */
  1606. netif_stop_queue(netdev);
  1607. spin_unlock_irqrestore(&adapter->tx_lock, flags);
  1608. return NETDEV_TX_BUSY;
  1609. }
  1610. tpd = atl1e_get_tpd(adapter);
  1611. if (unlikely(adapter->vlgrp && vlan_tx_tag_present(skb))) {
  1612. u16 vlan_tag = vlan_tx_tag_get(skb);
  1613. u16 atl1e_vlan_tag;
  1614. tpd->word3 |= 1 << TPD_INS_VL_TAG_SHIFT;
  1615. AT_VLAN_TAG_TO_TPD_TAG(vlan_tag, atl1e_vlan_tag);
  1616. tpd->word2 |= (atl1e_vlan_tag & TPD_VLANTAG_MASK) <<
  1617. TPD_VLAN_SHIFT;
  1618. }
  1619. if (skb->protocol == htons(ETH_P_8021Q))
  1620. tpd->word3 |= 1 << TPD_VL_TAGGED_SHIFT;
  1621. if (skb_network_offset(skb) != ETH_HLEN)
  1622. tpd->word3 |= 1 << TPD_ETHTYPE_SHIFT; /* 802.3 frame */
  1623. /* do TSO and check sum */
  1624. if (atl1e_tso_csum(adapter, skb, tpd) != 0) {
  1625. spin_unlock_irqrestore(&adapter->tx_lock, flags);
  1626. dev_kfree_skb_any(skb);
  1627. return NETDEV_TX_OK;
  1628. }
  1629. atl1e_tx_map(adapter, skb, tpd);
  1630. atl1e_tx_queue(adapter, tpd_req, tpd);
  1631. netdev->trans_start = jiffies; /* NETIF_F_LLTX driver :( */
  1632. spin_unlock_irqrestore(&adapter->tx_lock, flags);
  1633. return NETDEV_TX_OK;
  1634. }
  1635. static void atl1e_free_irq(struct atl1e_adapter *adapter)
  1636. {
  1637. struct net_device *netdev = adapter->netdev;
  1638. free_irq(adapter->pdev->irq, netdev);
  1639. if (adapter->have_msi)
  1640. pci_disable_msi(adapter->pdev);
  1641. }
  1642. static int atl1e_request_irq(struct atl1e_adapter *adapter)
  1643. {
  1644. struct pci_dev *pdev = adapter->pdev;
  1645. struct net_device *netdev = adapter->netdev;
  1646. int flags = 0;
  1647. int err = 0;
  1648. adapter->have_msi = true;
  1649. err = pci_enable_msi(adapter->pdev);
  1650. if (err) {
  1651. dev_dbg(&pdev->dev,
  1652. "Unable to allocate MSI interrupt Error: %d\n", err);
  1653. adapter->have_msi = false;
  1654. } else
  1655. netdev->irq = pdev->irq;
  1656. if (!adapter->have_msi)
  1657. flags |= IRQF_SHARED;
  1658. err = request_irq(adapter->pdev->irq, &atl1e_intr, flags,
  1659. netdev->name, netdev);
  1660. if (err) {
  1661. dev_dbg(&pdev->dev,
  1662. "Unable to allocate interrupt Error: %d\n", err);
  1663. if (adapter->have_msi)
  1664. pci_disable_msi(adapter->pdev);
  1665. return err;
  1666. }
  1667. dev_dbg(&pdev->dev, "atl1e_request_irq OK\n");
  1668. return err;
  1669. }
  1670. int atl1e_up(struct atl1e_adapter *adapter)
  1671. {
  1672. struct net_device *netdev = adapter->netdev;
  1673. int err = 0;
  1674. u32 val;
  1675. /* hardware has been reset, we need to reload some things */
  1676. err = atl1e_init_hw(&adapter->hw);
  1677. if (err) {
  1678. err = -EIO;
  1679. return err;
  1680. }
  1681. atl1e_init_ring_ptrs(adapter);
  1682. atl1e_set_multi(netdev);
  1683. atl1e_restore_vlan(adapter);
  1684. if (atl1e_configure(adapter)) {
  1685. err = -EIO;
  1686. goto err_up;
  1687. }
  1688. clear_bit(__AT_DOWN, &adapter->flags);
  1689. napi_enable(&adapter->napi);
  1690. atl1e_irq_enable(adapter);
  1691. val = AT_READ_REG(&adapter->hw, REG_MASTER_CTRL);
  1692. AT_WRITE_REG(&adapter->hw, REG_MASTER_CTRL,
  1693. val | MASTER_CTRL_MANUAL_INT);
  1694. err_up:
  1695. return err;
  1696. }
  1697. void atl1e_down(struct atl1e_adapter *adapter)
  1698. {
  1699. struct net_device *netdev = adapter->netdev;
  1700. /* signal that we're down so the interrupt handler does not
  1701. * reschedule our watchdog timer */
  1702. set_bit(__AT_DOWN, &adapter->flags);
  1703. #ifdef NETIF_F_LLTX
  1704. netif_stop_queue(netdev);
  1705. #else
  1706. netif_tx_disable(netdev);
  1707. #endif
  1708. /* reset MAC to disable all RX/TX */
  1709. atl1e_reset_hw(&adapter->hw);
  1710. msleep(1);
  1711. napi_disable(&adapter->napi);
  1712. atl1e_del_timer(adapter);
  1713. atl1e_irq_disable(adapter);
  1714. netif_carrier_off(netdev);
  1715. adapter->link_speed = SPEED_0;
  1716. adapter->link_duplex = -1;
  1717. atl1e_clean_tx_ring(adapter);
  1718. atl1e_clean_rx_ring(adapter);
  1719. }
  1720. /*
  1721. * atl1e_open - Called when a network interface is made active
  1722. * @netdev: network interface device structure
  1723. *
  1724. * Returns 0 on success, negative value on failure
  1725. *
  1726. * The open entry point is called when a network interface is made
  1727. * active by the system (IFF_UP). At this point all resources needed
  1728. * for transmit and receive operations are allocated, the interrupt
  1729. * handler is registered with the OS, the watchdog timer is started,
  1730. * and the stack is notified that the interface is ready.
  1731. */
  1732. static int atl1e_open(struct net_device *netdev)
  1733. {
  1734. struct atl1e_adapter *adapter = netdev_priv(netdev);
  1735. int err;
  1736. /* disallow open during test */
  1737. if (test_bit(__AT_TESTING, &adapter->flags))
  1738. return -EBUSY;
  1739. /* allocate rx/tx dma buffer & descriptors */
  1740. atl1e_init_ring_resources(adapter);
  1741. err = atl1e_setup_ring_resources(adapter);
  1742. if (unlikely(err))
  1743. return err;
  1744. err = atl1e_request_irq(adapter);
  1745. if (unlikely(err))
  1746. goto err_req_irq;
  1747. err = atl1e_up(adapter);
  1748. if (unlikely(err))
  1749. goto err_up;
  1750. return 0;
  1751. err_up:
  1752. atl1e_free_irq(adapter);
  1753. err_req_irq:
  1754. atl1e_free_ring_resources(adapter);
  1755. atl1e_reset_hw(&adapter->hw);
  1756. return err;
  1757. }
  1758. /*
  1759. * atl1e_close - Disables a network interface
  1760. * @netdev: network interface device structure
  1761. *
  1762. * Returns 0, this is not allowed to fail
  1763. *
  1764. * The close entry point is called when an interface is de-activated
  1765. * by the OS. The hardware is still under the drivers control, but
  1766. * needs to be disabled. A global MAC reset is issued to stop the
  1767. * hardware, and all transmit and receive resources are freed.
  1768. */
  1769. static int atl1e_close(struct net_device *netdev)
  1770. {
  1771. struct atl1e_adapter *adapter = netdev_priv(netdev);
  1772. WARN_ON(test_bit(__AT_RESETTING, &adapter->flags));
  1773. atl1e_down(adapter);
  1774. atl1e_free_irq(adapter);
  1775. atl1e_free_ring_resources(adapter);
  1776. return 0;
  1777. }
  1778. static int atl1e_suspend(struct pci_dev *pdev, pm_message_t state)
  1779. {
  1780. struct net_device *netdev = pci_get_drvdata(pdev);
  1781. struct atl1e_adapter *adapter = netdev_priv(netdev);
  1782. struct atl1e_hw *hw = &adapter->hw;
  1783. u32 ctrl = 0;
  1784. u32 mac_ctrl_data = 0;
  1785. u32 wol_ctrl_data = 0;
  1786. u16 mii_advertise_data = 0;
  1787. u16 mii_bmsr_data = 0;
  1788. u16 mii_intr_status_data = 0;
  1789. u32 wufc = adapter->wol;
  1790. u32 i;
  1791. #ifdef CONFIG_PM
  1792. int retval = 0;
  1793. #endif
  1794. if (netif_running(netdev)) {
  1795. WARN_ON(test_bit(__AT_RESETTING, &adapter->flags));
  1796. atl1e_down(adapter);
  1797. }
  1798. netif_device_detach(netdev);
  1799. #ifdef CONFIG_PM
  1800. retval = pci_save_state(pdev);
  1801. if (retval)
  1802. return retval;
  1803. #endif
  1804. if (wufc) {
  1805. /* get link status */
  1806. atl1e_read_phy_reg(hw, MII_BMSR, (u16 *)&mii_bmsr_data);
  1807. atl1e_read_phy_reg(hw, MII_BMSR, (u16 *)&mii_bmsr_data);
  1808. mii_advertise_data = MII_AR_10T_HD_CAPS;
  1809. if ((atl1e_write_phy_reg(hw, MII_AT001_CR, 0) != 0) ||
  1810. (atl1e_write_phy_reg(hw,
  1811. MII_ADVERTISE, mii_advertise_data) != 0) ||
  1812. (atl1e_phy_commit(hw)) != 0) {
  1813. dev_dbg(&pdev->dev, "set phy register failed\n");
  1814. goto wol_dis;
  1815. }
  1816. hw->phy_configured = false; /* re-init PHY when resume */
  1817. /* turn on magic packet wol */
  1818. if (wufc & AT_WUFC_MAG)
  1819. wol_ctrl_data |= WOL_MAGIC_EN | WOL_MAGIC_PME_EN;
  1820. if (wufc & AT_WUFC_LNKC) {
  1821. /* if orignal link status is link, just wait for retrive link */
  1822. if (mii_bmsr_data & BMSR_LSTATUS) {
  1823. for (i = 0; i < AT_SUSPEND_LINK_TIMEOUT; i++) {
  1824. msleep(100);
  1825. atl1e_read_phy_reg(hw, MII_BMSR,
  1826. (u16 *)&mii_bmsr_data);
  1827. if (mii_bmsr_data & BMSR_LSTATUS)
  1828. break;
  1829. }
  1830. if ((mii_bmsr_data & BMSR_LSTATUS) == 0)
  1831. dev_dbg(&pdev->dev,
  1832. "%s: Link may change"
  1833. "when suspend\n",
  1834. atl1e_driver_name);
  1835. }
  1836. wol_ctrl_data |= WOL_LINK_CHG_EN | WOL_LINK_CHG_PME_EN;
  1837. /* only link up can wake up */
  1838. if (atl1e_write_phy_reg(hw, MII_INT_CTRL, 0x400) != 0) {
  1839. dev_dbg(&pdev->dev, "%s: read write phy "
  1840. "register failed.\n",
  1841. atl1e_driver_name);
  1842. goto wol_dis;
  1843. }
  1844. }
  1845. /* clear phy interrupt */
  1846. atl1e_read_phy_reg(hw, MII_INT_STATUS, &mii_intr_status_data);
  1847. /* Config MAC Ctrl register */
  1848. mac_ctrl_data = MAC_CTRL_RX_EN;
  1849. /* set to 10/100M halt duplex */
  1850. mac_ctrl_data |= MAC_CTRL_SPEED_10_100 << MAC_CTRL_SPEED_SHIFT;
  1851. mac_ctrl_data |= (((u32)adapter->hw.preamble_len &
  1852. MAC_CTRL_PRMLEN_MASK) <<
  1853. MAC_CTRL_PRMLEN_SHIFT);
  1854. if (adapter->vlgrp)
  1855. mac_ctrl_data |= MAC_CTRL_RMV_VLAN;
  1856. /* magic packet maybe Broadcast&multicast&Unicast frame */
  1857. if (wufc & AT_WUFC_MAG)
  1858. mac_ctrl_data |= MAC_CTRL_BC_EN;
  1859. dev_dbg(&pdev->dev,
  1860. "%s: suspend MAC=0x%x\n",
  1861. atl1e_driver_name, mac_ctrl_data);
  1862. AT_WRITE_REG(hw, REG_WOL_CTRL, wol_ctrl_data);
  1863. AT_WRITE_REG(hw, REG_MAC_CTRL, mac_ctrl_data);
  1864. /* pcie patch */
  1865. ctrl = AT_READ_REG(hw, REG_PCIE_PHYMISC);
  1866. ctrl |= PCIE_PHYMISC_FORCE_RCV_DET;
  1867. AT_WRITE_REG(hw, REG_PCIE_PHYMISC, ctrl);
  1868. pci_enable_wake(pdev, pci_choose_state(pdev, state), 1);
  1869. goto suspend_exit;
  1870. }
  1871. wol_dis:
  1872. /* WOL disabled */
  1873. AT_WRITE_REG(hw, REG_WOL_CTRL, 0);
  1874. /* pcie patch */
  1875. ctrl = AT_READ_REG(hw, REG_PCIE_PHYMISC);
  1876. ctrl |= PCIE_PHYMISC_FORCE_RCV_DET;
  1877. AT_WRITE_REG(hw, REG_PCIE_PHYMISC, ctrl);
  1878. atl1e_force_ps(hw);
  1879. hw->phy_configured = false; /* re-init PHY when resume */
  1880. pci_enable_wake(pdev, pci_choose_state(pdev, state), 0);
  1881. suspend_exit:
  1882. if (netif_running(netdev))
  1883. atl1e_free_irq(adapter);
  1884. pci_disable_device(pdev);
  1885. pci_set_power_state(pdev, pci_choose_state(pdev, state));
  1886. return 0;
  1887. }
  1888. #ifdef CONFIG_PM
  1889. static int atl1e_resume(struct pci_dev *pdev)
  1890. {
  1891. struct net_device *netdev = pci_get_drvdata(pdev);
  1892. struct atl1e_adapter *adapter = netdev_priv(netdev);
  1893. u32 err;
  1894. pci_set_power_state(pdev, PCI_D0);
  1895. pci_restore_state(pdev);
  1896. err = pci_enable_device(pdev);
  1897. if (err) {
  1898. dev_err(&pdev->dev, "ATL1e: Cannot enable PCI"
  1899. " device from suspend\n");
  1900. return err;
  1901. }
  1902. pci_set_master(pdev);
  1903. AT_READ_REG(&adapter->hw, REG_WOL_CTRL); /* clear WOL status */
  1904. pci_enable_wake(pdev, PCI_D3hot, 0);
  1905. pci_enable_wake(pdev, PCI_D3cold, 0);
  1906. AT_WRITE_REG(&adapter->hw, REG_WOL_CTRL, 0);
  1907. if (netif_running(netdev)) {
  1908. err = atl1e_request_irq(adapter);
  1909. if (err)
  1910. return err;
  1911. }
  1912. atl1e_reset_hw(&adapter->hw);
  1913. if (netif_running(netdev))
  1914. atl1e_up(adapter);
  1915. netif_device_attach(netdev);
  1916. return 0;
  1917. }
  1918. #endif
  1919. static void atl1e_shutdown(struct pci_dev *pdev)
  1920. {
  1921. atl1e_suspend(pdev, PMSG_SUSPEND);
  1922. }
  1923. static const struct net_device_ops atl1e_netdev_ops = {
  1924. .ndo_open = atl1e_open,
  1925. .ndo_stop = atl1e_close,
  1926. .ndo_start_xmit = atl1e_xmit_frame,
  1927. .ndo_get_stats = atl1e_get_stats,
  1928. .ndo_set_multicast_list = atl1e_set_multi,
  1929. .ndo_validate_addr = eth_validate_addr,
  1930. .ndo_set_mac_address = atl1e_set_mac_addr,
  1931. .ndo_change_mtu = atl1e_change_mtu,
  1932. .ndo_do_ioctl = atl1e_ioctl,
  1933. .ndo_tx_timeout = atl1e_tx_timeout,
  1934. .ndo_vlan_rx_register = atl1e_vlan_rx_register,
  1935. #ifdef CONFIG_NET_POLL_CONTROLLER
  1936. .ndo_poll_controller = atl1e_netpoll,
  1937. #endif
  1938. };
  1939. static int atl1e_init_netdev(struct net_device *netdev, struct pci_dev *pdev)
  1940. {
  1941. SET_NETDEV_DEV(netdev, &pdev->dev);
  1942. pci_set_drvdata(pdev, netdev);
  1943. netdev->irq = pdev->irq;
  1944. netdev->netdev_ops = &atl1e_netdev_ops;
  1945. netdev->watchdog_timeo = AT_TX_WATCHDOG;
  1946. atl1e_set_ethtool_ops(netdev);
  1947. netdev->features = NETIF_F_SG | NETIF_F_HW_CSUM |
  1948. NETIF_F_HW_VLAN_TX | NETIF_F_HW_VLAN_RX;
  1949. netdev->features |= NETIF_F_LLTX;
  1950. netdev->features |= NETIF_F_TSO;
  1951. netdev->features |= NETIF_F_TSO6;
  1952. return 0;
  1953. }
  1954. /*
  1955. * atl1e_probe - Device Initialization Routine
  1956. * @pdev: PCI device information struct
  1957. * @ent: entry in atl1e_pci_tbl
  1958. *
  1959. * Returns 0 on success, negative on failure
  1960. *
  1961. * atl1e_probe initializes an adapter identified by a pci_dev structure.
  1962. * The OS initialization, configuring of the adapter private structure,
  1963. * and a hardware reset occur.
  1964. */
  1965. static int __devinit atl1e_probe(struct pci_dev *pdev,
  1966. const struct pci_device_id *ent)
  1967. {
  1968. struct net_device *netdev;
  1969. struct atl1e_adapter *adapter = NULL;
  1970. static int cards_found;
  1971. int err = 0;
  1972. err = pci_enable_device(pdev);
  1973. if (err) {
  1974. dev_err(&pdev->dev, "cannot enable PCI device\n");
  1975. return err;
  1976. }
  1977. /*
  1978. * The atl1e chip can DMA to 64-bit addresses, but it uses a single
  1979. * shared register for the high 32 bits, so only a single, aligned,
  1980. * 4 GB physical address range can be used at a time.
  1981. *
  1982. * Supporting 64-bit DMA on this hardware is more trouble than it's
  1983. * worth. It is far easier to limit to 32-bit DMA than update
  1984. * various kernel subsystems to support the mechanics required by a
  1985. * fixed-high-32-bit system.
  1986. */
  1987. if ((pci_set_dma_mask(pdev, DMA_BIT_MASK(32)) != 0) ||
  1988. (pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(32)) != 0)) {
  1989. dev_err(&pdev->dev, "No usable DMA configuration,aborting\n");
  1990. goto err_dma;
  1991. }
  1992. err = pci_request_regions(pdev, atl1e_driver_name);
  1993. if (err) {
  1994. dev_err(&pdev->dev, "cannot obtain PCI resources\n");
  1995. goto err_pci_reg;
  1996. }
  1997. pci_set_master(pdev);
  1998. netdev = alloc_etherdev(sizeof(struct atl1e_adapter));
  1999. if (netdev == NULL) {
  2000. err = -ENOMEM;
  2001. dev_err(&pdev->dev, "etherdev alloc failed\n");
  2002. goto err_alloc_etherdev;
  2003. }
  2004. err = atl1e_init_netdev(netdev, pdev);
  2005. if (err) {
  2006. dev_err(&pdev->dev, "init netdevice failed\n");
  2007. goto err_init_netdev;
  2008. }
  2009. adapter = netdev_priv(netdev);
  2010. adapter->bd_number = cards_found;
  2011. adapter->netdev = netdev;
  2012. adapter->pdev = pdev;
  2013. adapter->hw.adapter = adapter;
  2014. adapter->hw.hw_addr = pci_iomap(pdev, BAR_0, 0);
  2015. if (!adapter->hw.hw_addr) {
  2016. err = -EIO;
  2017. dev_err(&pdev->dev, "cannot map device registers\n");
  2018. goto err_ioremap;
  2019. }
  2020. netdev->base_addr = (unsigned long)adapter->hw.hw_addr;
  2021. /* init mii data */
  2022. adapter->mii.dev = netdev;
  2023. adapter->mii.mdio_read = atl1e_mdio_read;
  2024. adapter->mii.mdio_write = atl1e_mdio_write;
  2025. adapter->mii.phy_id_mask = 0x1f;
  2026. adapter->mii.reg_num_mask = MDIO_REG_ADDR_MASK;
  2027. netif_napi_add(netdev, &adapter->napi, atl1e_clean, 64);
  2028. init_timer(&adapter->phy_config_timer);
  2029. adapter->phy_config_timer.function = &atl1e_phy_config;
  2030. adapter->phy_config_timer.data = (unsigned long) adapter;
  2031. /* get user settings */
  2032. atl1e_check_options(adapter);
  2033. /*
  2034. * Mark all PCI regions associated with PCI device
  2035. * pdev as being reserved by owner atl1e_driver_name
  2036. * Enables bus-mastering on the device and calls
  2037. * pcibios_set_master to do the needed arch specific settings
  2038. */
  2039. atl1e_setup_pcicmd(pdev);
  2040. /* setup the private structure */
  2041. err = atl1e_sw_init(adapter);
  2042. if (err) {
  2043. dev_err(&pdev->dev, "net device private data init failed\n");
  2044. goto err_sw_init;
  2045. }
  2046. /* Init GPHY as early as possible due to power saving issue */
  2047. atl1e_phy_init(&adapter->hw);
  2048. /* reset the controller to
  2049. * put the device in a known good starting state */
  2050. err = atl1e_reset_hw(&adapter->hw);
  2051. if (err) {
  2052. err = -EIO;
  2053. goto err_reset;
  2054. }
  2055. if (atl1e_read_mac_addr(&adapter->hw) != 0) {
  2056. err = -EIO;
  2057. dev_err(&pdev->dev, "get mac address failed\n");
  2058. goto err_eeprom;
  2059. }
  2060. memcpy(netdev->dev_addr, adapter->hw.mac_addr, netdev->addr_len);
  2061. memcpy(netdev->perm_addr, adapter->hw.mac_addr, netdev->addr_len);
  2062. dev_dbg(&pdev->dev, "mac address : %02x-%02x-%02x-%02x-%02x-%02x\n",
  2063. adapter->hw.mac_addr[0], adapter->hw.mac_addr[1],
  2064. adapter->hw.mac_addr[2], adapter->hw.mac_addr[3],
  2065. adapter->hw.mac_addr[4], adapter->hw.mac_addr[5]);
  2066. INIT_WORK(&adapter->reset_task, atl1e_reset_task);
  2067. INIT_WORK(&adapter->link_chg_task, atl1e_link_chg_task);
  2068. err = register_netdev(netdev);
  2069. if (err) {
  2070. dev_err(&pdev->dev, "register netdevice failed\n");
  2071. goto err_register;
  2072. }
  2073. /* assume we have no link for now */
  2074. netif_stop_queue(netdev);
  2075. netif_carrier_off(netdev);
  2076. cards_found++;
  2077. return 0;
  2078. err_reset:
  2079. err_register:
  2080. err_sw_init:
  2081. err_eeprom:
  2082. iounmap(adapter->hw.hw_addr);
  2083. err_init_netdev:
  2084. err_ioremap:
  2085. free_netdev(netdev);
  2086. err_alloc_etherdev:
  2087. pci_release_regions(pdev);
  2088. err_pci_reg:
  2089. err_dma:
  2090. pci_disable_device(pdev);
  2091. return err;
  2092. }
  2093. /*
  2094. * atl1e_remove - Device Removal Routine
  2095. * @pdev: PCI device information struct
  2096. *
  2097. * atl1e_remove is called by the PCI subsystem to alert the driver
  2098. * that it should release a PCI device. The could be caused by a
  2099. * Hot-Plug event, or because the driver is going to be removed from
  2100. * memory.
  2101. */
  2102. static void __devexit atl1e_remove(struct pci_dev *pdev)
  2103. {
  2104. struct net_device *netdev = pci_get_drvdata(pdev);
  2105. struct atl1e_adapter *adapter = netdev_priv(netdev);
  2106. /*
  2107. * flush_scheduled work may reschedule our watchdog task, so
  2108. * explicitly disable watchdog tasks from being rescheduled
  2109. */
  2110. set_bit(__AT_DOWN, &adapter->flags);
  2111. atl1e_del_timer(adapter);
  2112. atl1e_cancel_work(adapter);
  2113. unregister_netdev(netdev);
  2114. atl1e_free_ring_resources(adapter);
  2115. atl1e_force_ps(&adapter->hw);
  2116. iounmap(adapter->hw.hw_addr);
  2117. pci_release_regions(pdev);
  2118. free_netdev(netdev);
  2119. pci_disable_device(pdev);
  2120. }
  2121. /*
  2122. * atl1e_io_error_detected - called when PCI error is detected
  2123. * @pdev: Pointer to PCI device
  2124. * @state: The current pci connection state
  2125. *
  2126. * This function is called after a PCI bus error affecting
  2127. * this device has been detected.
  2128. */
  2129. static pci_ers_result_t
  2130. atl1e_io_error_detected(struct pci_dev *pdev, pci_channel_state_t state)
  2131. {
  2132. struct net_device *netdev = pci_get_drvdata(pdev);
  2133. struct atl1e_adapter *adapter = netdev_priv(netdev);
  2134. netif_device_detach(netdev);
  2135. if (state == pci_channel_io_perm_failure)
  2136. return PCI_ERS_RESULT_DISCONNECT;
  2137. if (netif_running(netdev))
  2138. atl1e_down(adapter);
  2139. pci_disable_device(pdev);
  2140. /* Request a slot slot reset. */
  2141. return PCI_ERS_RESULT_NEED_RESET;
  2142. }
  2143. /*
  2144. * atl1e_io_slot_reset - called after the pci bus has been reset.
  2145. * @pdev: Pointer to PCI device
  2146. *
  2147. * Restart the card from scratch, as if from a cold-boot. Implementation
  2148. * resembles the first-half of the e1000_resume routine.
  2149. */
  2150. static pci_ers_result_t atl1e_io_slot_reset(struct pci_dev *pdev)
  2151. {
  2152. struct net_device *netdev = pci_get_drvdata(pdev);
  2153. struct atl1e_adapter *adapter = netdev_priv(netdev);
  2154. if (pci_enable_device(pdev)) {
  2155. dev_err(&pdev->dev,
  2156. "ATL1e: Cannot re-enable PCI device after reset.\n");
  2157. return PCI_ERS_RESULT_DISCONNECT;
  2158. }
  2159. pci_set_master(pdev);
  2160. pci_enable_wake(pdev, PCI_D3hot, 0);
  2161. pci_enable_wake(pdev, PCI_D3cold, 0);
  2162. atl1e_reset_hw(&adapter->hw);
  2163. return PCI_ERS_RESULT_RECOVERED;
  2164. }
  2165. /*
  2166. * atl1e_io_resume - called when traffic can start flowing again.
  2167. * @pdev: Pointer to PCI device
  2168. *
  2169. * This callback is called when the error recovery driver tells us that
  2170. * its OK to resume normal operation. Implementation resembles the
  2171. * second-half of the atl1e_resume routine.
  2172. */
  2173. static void atl1e_io_resume(struct pci_dev *pdev)
  2174. {
  2175. struct net_device *netdev = pci_get_drvdata(pdev);
  2176. struct atl1e_adapter *adapter = netdev_priv(netdev);
  2177. if (netif_running(netdev)) {
  2178. if (atl1e_up(adapter)) {
  2179. dev_err(&pdev->dev,
  2180. "ATL1e: can't bring device back up after reset\n");
  2181. return;
  2182. }
  2183. }
  2184. netif_device_attach(netdev);
  2185. }
  2186. static struct pci_error_handlers atl1e_err_handler = {
  2187. .error_detected = atl1e_io_error_detected,
  2188. .slot_reset = atl1e_io_slot_reset,
  2189. .resume = atl1e_io_resume,
  2190. };
  2191. static struct pci_driver atl1e_driver = {
  2192. .name = atl1e_driver_name,
  2193. .id_table = atl1e_pci_tbl,
  2194. .probe = atl1e_probe,
  2195. .remove = __devexit_p(atl1e_remove),
  2196. /* Power Managment Hooks */
  2197. #ifdef CONFIG_PM
  2198. .suspend = atl1e_suspend,
  2199. .resume = atl1e_resume,
  2200. #endif
  2201. .shutdown = atl1e_shutdown,
  2202. .err_handler = &atl1e_err_handler
  2203. };
  2204. /*
  2205. * atl1e_init_module - Driver Registration Routine
  2206. *
  2207. * atl1e_init_module is the first routine called when the driver is
  2208. * loaded. All it does is register with the PCI subsystem.
  2209. */
  2210. static int __init atl1e_init_module(void)
  2211. {
  2212. return pci_register_driver(&atl1e_driver);
  2213. }
  2214. /*
  2215. * atl1e_exit_module - Driver Exit Cleanup Routine
  2216. *
  2217. * atl1e_exit_module is called just before the driver is removed
  2218. * from memory.
  2219. */
  2220. static void __exit atl1e_exit_module(void)
  2221. {
  2222. pci_unregister_driver(&atl1e_driver);
  2223. }
  2224. module_init(atl1e_init_module);
  2225. module_exit(atl1e_exit_module);