jme.c 66 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412241324142415241624172418241924202421242224232424242524262427242824292430243124322433243424352436243724382439244024412442244324442445244624472448244924502451245224532454245524562457245824592460246124622463246424652466246724682469247024712472247324742475247624772478247924802481248224832484248524862487248824892490249124922493249424952496249724982499250025012502250325042505250625072508250925102511251225132514251525162517251825192520252125222523252425252526252725282529253025312532253325342535253625372538253925402541254225432544254525462547254825492550255125522553255425552556255725582559256025612562256325642565256625672568256925702571257225732574257525762577257825792580258125822583258425852586258725882589259025912592259325942595259625972598259926002601260226032604260526062607260826092610261126122613261426152616261726182619262026212622262326242625262626272628262926302631263226332634263526362637263826392640264126422643264426452646264726482649265026512652265326542655265626572658265926602661266226632664266526662667266826692670267126722673267426752676267726782679268026812682268326842685268626872688268926902691269226932694269526962697269826992700270127022703270427052706270727082709271027112712271327142715271627172718271927202721272227232724272527262727272827292730273127322733273427352736273727382739274027412742274327442745274627472748274927502751275227532754275527562757275827592760276127622763276427652766276727682769277027712772277327742775277627772778277927802781278227832784278527862787278827892790279127922793279427952796279727982799280028012802280328042805280628072808280928102811281228132814281528162817281828192820282128222823282428252826282728282829283028312832283328342835283628372838283928402841284228432844284528462847284828492850285128522853285428552856285728582859286028612862286328642865286628672868286928702871287228732874287528762877287828792880288128822883288428852886288728882889289028912892289328942895289628972898289929002901290229032904290529062907290829092910291129122913291429152916291729182919292029212922292329242925292629272928292929302931293229332934293529362937293829392940294129422943294429452946294729482949295029512952295329542955295629572958295929602961296229632964296529662967296829692970297129722973297429752976297729782979298029812982298329842985298629872988298929902991299229932994299529962997299829993000300130023003300430053006300730083009301030113012301330143015301630173018301930203021302230233024
  1. /*
  2. * JMicron JMC2x0 series PCIe Ethernet Linux Device Driver
  3. *
  4. * Copyright 2008 JMicron Technology Corporation
  5. * http://www.jmicron.com/
  6. *
  7. * Author: Guo-Fu Tseng <cooldavid@cooldavid.org>
  8. *
  9. * This program is free software; you can redistribute it and/or modify
  10. * it under the terms of the GNU General Public License as published by
  11. * the Free Software Foundation; either version 2 of the License.
  12. *
  13. * This program is distributed in the hope that it will be useful,
  14. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  16. * GNU General Public License for more details.
  17. *
  18. * You should have received a copy of the GNU General Public License
  19. * along with this program; if not, write to the Free Software
  20. * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  21. *
  22. */
  23. #include <linux/module.h>
  24. #include <linux/kernel.h>
  25. #include <linux/pci.h>
  26. #include <linux/netdevice.h>
  27. #include <linux/etherdevice.h>
  28. #include <linux/ethtool.h>
  29. #include <linux/mii.h>
  30. #include <linux/crc32.h>
  31. #include <linux/delay.h>
  32. #include <linux/spinlock.h>
  33. #include <linux/in.h>
  34. #include <linux/ip.h>
  35. #include <linux/ipv6.h>
  36. #include <linux/tcp.h>
  37. #include <linux/udp.h>
  38. #include <linux/if_vlan.h>
  39. #include <net/ip6_checksum.h>
  40. #include "jme.h"
  41. static int force_pseudohp = -1;
  42. static int no_pseudohp = -1;
  43. static int no_extplug = -1;
  44. module_param(force_pseudohp, int, 0);
  45. MODULE_PARM_DESC(force_pseudohp,
  46. "Enable pseudo hot-plug feature manually by driver instead of BIOS.");
  47. module_param(no_pseudohp, int, 0);
  48. MODULE_PARM_DESC(no_pseudohp, "Disable pseudo hot-plug feature.");
  49. module_param(no_extplug, int, 0);
  50. MODULE_PARM_DESC(no_extplug,
  51. "Do not use external plug signal for pseudo hot-plug.");
  52. static int
  53. jme_mdio_read(struct net_device *netdev, int phy, int reg)
  54. {
  55. struct jme_adapter *jme = netdev_priv(netdev);
  56. int i, val, again = (reg == MII_BMSR) ? 1 : 0;
  57. read_again:
  58. jwrite32(jme, JME_SMI, SMI_OP_REQ |
  59. smi_phy_addr(phy) |
  60. smi_reg_addr(reg));
  61. wmb();
  62. for (i = JME_PHY_TIMEOUT * 50 ; i > 0 ; --i) {
  63. udelay(20);
  64. val = jread32(jme, JME_SMI);
  65. if ((val & SMI_OP_REQ) == 0)
  66. break;
  67. }
  68. if (i == 0) {
  69. jeprintk(jme->pdev, "phy(%d) read timeout : %d\n", phy, reg);
  70. return 0;
  71. }
  72. if (again--)
  73. goto read_again;
  74. return (val & SMI_DATA_MASK) >> SMI_DATA_SHIFT;
  75. }
  76. static void
  77. jme_mdio_write(struct net_device *netdev,
  78. int phy, int reg, int val)
  79. {
  80. struct jme_adapter *jme = netdev_priv(netdev);
  81. int i;
  82. jwrite32(jme, JME_SMI, SMI_OP_WRITE | SMI_OP_REQ |
  83. ((val << SMI_DATA_SHIFT) & SMI_DATA_MASK) |
  84. smi_phy_addr(phy) | smi_reg_addr(reg));
  85. wmb();
  86. for (i = JME_PHY_TIMEOUT * 50 ; i > 0 ; --i) {
  87. udelay(20);
  88. if ((jread32(jme, JME_SMI) & SMI_OP_REQ) == 0)
  89. break;
  90. }
  91. if (i == 0)
  92. jeprintk(jme->pdev, "phy(%d) write timeout : %d\n", phy, reg);
  93. return;
  94. }
  95. static inline void
  96. jme_reset_phy_processor(struct jme_adapter *jme)
  97. {
  98. u32 val;
  99. jme_mdio_write(jme->dev,
  100. jme->mii_if.phy_id,
  101. MII_ADVERTISE, ADVERTISE_ALL |
  102. ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM);
  103. if (jme->pdev->device == PCI_DEVICE_ID_JMICRON_JMC250)
  104. jme_mdio_write(jme->dev,
  105. jme->mii_if.phy_id,
  106. MII_CTRL1000,
  107. ADVERTISE_1000FULL | ADVERTISE_1000HALF);
  108. val = jme_mdio_read(jme->dev,
  109. jme->mii_if.phy_id,
  110. MII_BMCR);
  111. jme_mdio_write(jme->dev,
  112. jme->mii_if.phy_id,
  113. MII_BMCR, val | BMCR_RESET);
  114. return;
  115. }
  116. static void
  117. jme_setup_wakeup_frame(struct jme_adapter *jme,
  118. u32 *mask, u32 crc, int fnr)
  119. {
  120. int i;
  121. /*
  122. * Setup CRC pattern
  123. */
  124. jwrite32(jme, JME_WFOI, WFOI_CRC_SEL | (fnr & WFOI_FRAME_SEL));
  125. wmb();
  126. jwrite32(jme, JME_WFODP, crc);
  127. wmb();
  128. /*
  129. * Setup Mask
  130. */
  131. for (i = 0 ; i < WAKEUP_FRAME_MASK_DWNR ; ++i) {
  132. jwrite32(jme, JME_WFOI,
  133. ((i << WFOI_MASK_SHIFT) & WFOI_MASK_SEL) |
  134. (fnr & WFOI_FRAME_SEL));
  135. wmb();
  136. jwrite32(jme, JME_WFODP, mask[i]);
  137. wmb();
  138. }
  139. }
  140. static inline void
  141. jme_reset_mac_processor(struct jme_adapter *jme)
  142. {
  143. u32 mask[WAKEUP_FRAME_MASK_DWNR] = {0, 0, 0, 0};
  144. u32 crc = 0xCDCDCDCD;
  145. u32 gpreg0;
  146. int i;
  147. jwrite32(jme, JME_GHC, jme->reg_ghc | GHC_SWRST);
  148. udelay(2);
  149. jwrite32(jme, JME_GHC, jme->reg_ghc);
  150. jwrite32(jme, JME_RXDBA_LO, 0x00000000);
  151. jwrite32(jme, JME_RXDBA_HI, 0x00000000);
  152. jwrite32(jme, JME_RXQDC, 0x00000000);
  153. jwrite32(jme, JME_RXNDA, 0x00000000);
  154. jwrite32(jme, JME_TXDBA_LO, 0x00000000);
  155. jwrite32(jme, JME_TXDBA_HI, 0x00000000);
  156. jwrite32(jme, JME_TXQDC, 0x00000000);
  157. jwrite32(jme, JME_TXNDA, 0x00000000);
  158. jwrite32(jme, JME_RXMCHT_LO, 0x00000000);
  159. jwrite32(jme, JME_RXMCHT_HI, 0x00000000);
  160. for (i = 0 ; i < WAKEUP_FRAME_NR ; ++i)
  161. jme_setup_wakeup_frame(jme, mask, crc, i);
  162. if (jme->fpgaver)
  163. gpreg0 = GPREG0_DEFAULT | GPREG0_LNKINTPOLL;
  164. else
  165. gpreg0 = GPREG0_DEFAULT;
  166. jwrite32(jme, JME_GPREG0, gpreg0);
  167. jwrite32(jme, JME_GPREG1, GPREG1_DEFAULT);
  168. }
  169. static inline void
  170. jme_reset_ghc_speed(struct jme_adapter *jme)
  171. {
  172. jme->reg_ghc &= ~(GHC_SPEED_1000M | GHC_DPX);
  173. jwrite32(jme, JME_GHC, jme->reg_ghc);
  174. }
  175. static inline void
  176. jme_clear_pm(struct jme_adapter *jme)
  177. {
  178. jwrite32(jme, JME_PMCS, 0xFFFF0000 | jme->reg_pmcs);
  179. pci_set_power_state(jme->pdev, PCI_D0);
  180. pci_enable_wake(jme->pdev, PCI_D0, false);
  181. }
  182. static int
  183. jme_reload_eeprom(struct jme_adapter *jme)
  184. {
  185. u32 val;
  186. int i;
  187. val = jread32(jme, JME_SMBCSR);
  188. if (val & SMBCSR_EEPROMD) {
  189. val |= SMBCSR_CNACK;
  190. jwrite32(jme, JME_SMBCSR, val);
  191. val |= SMBCSR_RELOAD;
  192. jwrite32(jme, JME_SMBCSR, val);
  193. mdelay(12);
  194. for (i = JME_EEPROM_RELOAD_TIMEOUT; i > 0; --i) {
  195. mdelay(1);
  196. if ((jread32(jme, JME_SMBCSR) & SMBCSR_RELOAD) == 0)
  197. break;
  198. }
  199. if (i == 0) {
  200. jeprintk(jme->pdev, "eeprom reload timeout\n");
  201. return -EIO;
  202. }
  203. }
  204. return 0;
  205. }
  206. static void
  207. jme_load_macaddr(struct net_device *netdev)
  208. {
  209. struct jme_adapter *jme = netdev_priv(netdev);
  210. unsigned char macaddr[6];
  211. u32 val;
  212. spin_lock_bh(&jme->macaddr_lock);
  213. val = jread32(jme, JME_RXUMA_LO);
  214. macaddr[0] = (val >> 0) & 0xFF;
  215. macaddr[1] = (val >> 8) & 0xFF;
  216. macaddr[2] = (val >> 16) & 0xFF;
  217. macaddr[3] = (val >> 24) & 0xFF;
  218. val = jread32(jme, JME_RXUMA_HI);
  219. macaddr[4] = (val >> 0) & 0xFF;
  220. macaddr[5] = (val >> 8) & 0xFF;
  221. memcpy(netdev->dev_addr, macaddr, 6);
  222. spin_unlock_bh(&jme->macaddr_lock);
  223. }
  224. static inline void
  225. jme_set_rx_pcc(struct jme_adapter *jme, int p)
  226. {
  227. switch (p) {
  228. case PCC_OFF:
  229. jwrite32(jme, JME_PCCRX0,
  230. ((PCC_OFF_TO << PCCRXTO_SHIFT) & PCCRXTO_MASK) |
  231. ((PCC_OFF_CNT << PCCRX_SHIFT) & PCCRX_MASK));
  232. break;
  233. case PCC_P1:
  234. jwrite32(jme, JME_PCCRX0,
  235. ((PCC_P1_TO << PCCRXTO_SHIFT) & PCCRXTO_MASK) |
  236. ((PCC_P1_CNT << PCCRX_SHIFT) & PCCRX_MASK));
  237. break;
  238. case PCC_P2:
  239. jwrite32(jme, JME_PCCRX0,
  240. ((PCC_P2_TO << PCCRXTO_SHIFT) & PCCRXTO_MASK) |
  241. ((PCC_P2_CNT << PCCRX_SHIFT) & PCCRX_MASK));
  242. break;
  243. case PCC_P3:
  244. jwrite32(jme, JME_PCCRX0,
  245. ((PCC_P3_TO << PCCRXTO_SHIFT) & PCCRXTO_MASK) |
  246. ((PCC_P3_CNT << PCCRX_SHIFT) & PCCRX_MASK));
  247. break;
  248. default:
  249. break;
  250. }
  251. wmb();
  252. if (!(test_bit(JME_FLAG_POLL, &jme->flags)))
  253. msg_rx_status(jme, "Switched to PCC_P%d\n", p);
  254. }
  255. static void
  256. jme_start_irq(struct jme_adapter *jme)
  257. {
  258. register struct dynpcc_info *dpi = &(jme->dpi);
  259. jme_set_rx_pcc(jme, PCC_P1);
  260. dpi->cur = PCC_P1;
  261. dpi->attempt = PCC_P1;
  262. dpi->cnt = 0;
  263. jwrite32(jme, JME_PCCTX,
  264. ((PCC_TX_TO << PCCTXTO_SHIFT) & PCCTXTO_MASK) |
  265. ((PCC_TX_CNT << PCCTX_SHIFT) & PCCTX_MASK) |
  266. PCCTXQ0_EN
  267. );
  268. /*
  269. * Enable Interrupts
  270. */
  271. jwrite32(jme, JME_IENS, INTR_ENABLE);
  272. }
  273. static inline void
  274. jme_stop_irq(struct jme_adapter *jme)
  275. {
  276. /*
  277. * Disable Interrupts
  278. */
  279. jwrite32f(jme, JME_IENC, INTR_ENABLE);
  280. }
  281. static inline void
  282. jme_enable_shadow(struct jme_adapter *jme)
  283. {
  284. jwrite32(jme,
  285. JME_SHBA_LO,
  286. ((u32)jme->shadow_dma & ~((u32)0x1F)) | SHBA_POSTEN);
  287. }
  288. static inline void
  289. jme_disable_shadow(struct jme_adapter *jme)
  290. {
  291. jwrite32(jme, JME_SHBA_LO, 0x0);
  292. }
  293. static u32
  294. jme_linkstat_from_phy(struct jme_adapter *jme)
  295. {
  296. u32 phylink, bmsr;
  297. phylink = jme_mdio_read(jme->dev, jme->mii_if.phy_id, 17);
  298. bmsr = jme_mdio_read(jme->dev, jme->mii_if.phy_id, MII_BMSR);
  299. if (bmsr & BMSR_ANCOMP)
  300. phylink |= PHY_LINK_AUTONEG_COMPLETE;
  301. return phylink;
  302. }
  303. static inline void
  304. jme_set_phyfifoa(struct jme_adapter *jme)
  305. {
  306. jme_mdio_write(jme->dev, jme->mii_if.phy_id, 27, 0x0004);
  307. }
  308. static inline void
  309. jme_set_phyfifob(struct jme_adapter *jme)
  310. {
  311. jme_mdio_write(jme->dev, jme->mii_if.phy_id, 27, 0x0000);
  312. }
  313. static int
  314. jme_check_link(struct net_device *netdev, int testonly)
  315. {
  316. struct jme_adapter *jme = netdev_priv(netdev);
  317. u32 phylink, ghc, cnt = JME_SPDRSV_TIMEOUT, bmcr, gpreg1;
  318. char linkmsg[64];
  319. int rc = 0;
  320. linkmsg[0] = '\0';
  321. if (jme->fpgaver)
  322. phylink = jme_linkstat_from_phy(jme);
  323. else
  324. phylink = jread32(jme, JME_PHY_LINK);
  325. if (phylink & PHY_LINK_UP) {
  326. if (!(phylink & PHY_LINK_AUTONEG_COMPLETE)) {
  327. /*
  328. * If we did not enable AN
  329. * Speed/Duplex Info should be obtained from SMI
  330. */
  331. phylink = PHY_LINK_UP;
  332. bmcr = jme_mdio_read(jme->dev,
  333. jme->mii_if.phy_id,
  334. MII_BMCR);
  335. phylink |= ((bmcr & BMCR_SPEED1000) &&
  336. (bmcr & BMCR_SPEED100) == 0) ?
  337. PHY_LINK_SPEED_1000M :
  338. (bmcr & BMCR_SPEED100) ?
  339. PHY_LINK_SPEED_100M :
  340. PHY_LINK_SPEED_10M;
  341. phylink |= (bmcr & BMCR_FULLDPLX) ?
  342. PHY_LINK_DUPLEX : 0;
  343. strcat(linkmsg, "Forced: ");
  344. } else {
  345. /*
  346. * Keep polling for speed/duplex resolve complete
  347. */
  348. while (!(phylink & PHY_LINK_SPEEDDPU_RESOLVED) &&
  349. --cnt) {
  350. udelay(1);
  351. if (jme->fpgaver)
  352. phylink = jme_linkstat_from_phy(jme);
  353. else
  354. phylink = jread32(jme, JME_PHY_LINK);
  355. }
  356. if (!cnt)
  357. jeprintk(jme->pdev,
  358. "Waiting speed resolve timeout.\n");
  359. strcat(linkmsg, "ANed: ");
  360. }
  361. if (jme->phylink == phylink) {
  362. rc = 1;
  363. goto out;
  364. }
  365. if (testonly)
  366. goto out;
  367. jme->phylink = phylink;
  368. ghc = jme->reg_ghc & ~(GHC_SPEED_10M |
  369. GHC_SPEED_100M |
  370. GHC_SPEED_1000M |
  371. GHC_DPX);
  372. switch (phylink & PHY_LINK_SPEED_MASK) {
  373. case PHY_LINK_SPEED_10M:
  374. ghc |= GHC_SPEED_10M |
  375. GHC_TO_CLK_PCIE | GHC_TXMAC_CLK_PCIE;
  376. strcat(linkmsg, "10 Mbps, ");
  377. break;
  378. case PHY_LINK_SPEED_100M:
  379. ghc |= GHC_SPEED_100M |
  380. GHC_TO_CLK_PCIE | GHC_TXMAC_CLK_PCIE;
  381. strcat(linkmsg, "100 Mbps, ");
  382. break;
  383. case PHY_LINK_SPEED_1000M:
  384. ghc |= GHC_SPEED_1000M |
  385. GHC_TO_CLK_GPHY | GHC_TXMAC_CLK_GPHY;
  386. strcat(linkmsg, "1000 Mbps, ");
  387. break;
  388. default:
  389. break;
  390. }
  391. if (phylink & PHY_LINK_DUPLEX) {
  392. jwrite32(jme, JME_TXMCS, TXMCS_DEFAULT);
  393. ghc |= GHC_DPX;
  394. } else {
  395. jwrite32(jme, JME_TXMCS, TXMCS_DEFAULT |
  396. TXMCS_BACKOFF |
  397. TXMCS_CARRIERSENSE |
  398. TXMCS_COLLISION);
  399. jwrite32(jme, JME_TXTRHD, TXTRHD_TXPEN |
  400. ((0x2000 << TXTRHD_TXP_SHIFT) & TXTRHD_TXP) |
  401. TXTRHD_TXREN |
  402. ((8 << TXTRHD_TXRL_SHIFT) & TXTRHD_TXRL));
  403. }
  404. gpreg1 = GPREG1_DEFAULT;
  405. if (is_buggy250(jme->pdev->device, jme->chiprev)) {
  406. if (!(phylink & PHY_LINK_DUPLEX))
  407. gpreg1 |= GPREG1_HALFMODEPATCH;
  408. switch (phylink & PHY_LINK_SPEED_MASK) {
  409. case PHY_LINK_SPEED_10M:
  410. jme_set_phyfifoa(jme);
  411. gpreg1 |= GPREG1_RSSPATCH;
  412. break;
  413. case PHY_LINK_SPEED_100M:
  414. jme_set_phyfifob(jme);
  415. gpreg1 |= GPREG1_RSSPATCH;
  416. break;
  417. case PHY_LINK_SPEED_1000M:
  418. jme_set_phyfifoa(jme);
  419. break;
  420. default:
  421. break;
  422. }
  423. }
  424. jwrite32(jme, JME_GPREG1, gpreg1);
  425. jwrite32(jme, JME_GHC, ghc);
  426. jme->reg_ghc = ghc;
  427. strcat(linkmsg, (phylink & PHY_LINK_DUPLEX) ?
  428. "Full-Duplex, " :
  429. "Half-Duplex, ");
  430. strcat(linkmsg, (phylink & PHY_LINK_MDI_STAT) ?
  431. "MDI-X" :
  432. "MDI");
  433. msg_link(jme, "Link is up at %s.\n", linkmsg);
  434. netif_carrier_on(netdev);
  435. } else {
  436. if (testonly)
  437. goto out;
  438. msg_link(jme, "Link is down.\n");
  439. jme->phylink = 0;
  440. netif_carrier_off(netdev);
  441. }
  442. out:
  443. return rc;
  444. }
  445. static int
  446. jme_setup_tx_resources(struct jme_adapter *jme)
  447. {
  448. struct jme_ring *txring = &(jme->txring[0]);
  449. txring->alloc = dma_alloc_coherent(&(jme->pdev->dev),
  450. TX_RING_ALLOC_SIZE(jme->tx_ring_size),
  451. &(txring->dmaalloc),
  452. GFP_ATOMIC);
  453. if (!txring->alloc) {
  454. txring->desc = NULL;
  455. txring->dmaalloc = 0;
  456. txring->dma = 0;
  457. return -ENOMEM;
  458. }
  459. /*
  460. * 16 Bytes align
  461. */
  462. txring->desc = (void *)ALIGN((unsigned long)(txring->alloc),
  463. RING_DESC_ALIGN);
  464. txring->dma = ALIGN(txring->dmaalloc, RING_DESC_ALIGN);
  465. txring->next_to_use = 0;
  466. atomic_set(&txring->next_to_clean, 0);
  467. atomic_set(&txring->nr_free, jme->tx_ring_size);
  468. /*
  469. * Initialize Transmit Descriptors
  470. */
  471. memset(txring->alloc, 0, TX_RING_ALLOC_SIZE(jme->tx_ring_size));
  472. memset(txring->bufinf, 0,
  473. sizeof(struct jme_buffer_info) * jme->tx_ring_size);
  474. return 0;
  475. }
  476. static void
  477. jme_free_tx_resources(struct jme_adapter *jme)
  478. {
  479. int i;
  480. struct jme_ring *txring = &(jme->txring[0]);
  481. struct jme_buffer_info *txbi = txring->bufinf;
  482. if (txring->alloc) {
  483. for (i = 0 ; i < jme->tx_ring_size ; ++i) {
  484. txbi = txring->bufinf + i;
  485. if (txbi->skb) {
  486. dev_kfree_skb(txbi->skb);
  487. txbi->skb = NULL;
  488. }
  489. txbi->mapping = 0;
  490. txbi->len = 0;
  491. txbi->nr_desc = 0;
  492. txbi->start_xmit = 0;
  493. }
  494. dma_free_coherent(&(jme->pdev->dev),
  495. TX_RING_ALLOC_SIZE(jme->tx_ring_size),
  496. txring->alloc,
  497. txring->dmaalloc);
  498. txring->alloc = NULL;
  499. txring->desc = NULL;
  500. txring->dmaalloc = 0;
  501. txring->dma = 0;
  502. }
  503. txring->next_to_use = 0;
  504. atomic_set(&txring->next_to_clean, 0);
  505. atomic_set(&txring->nr_free, 0);
  506. }
  507. static inline void
  508. jme_enable_tx_engine(struct jme_adapter *jme)
  509. {
  510. /*
  511. * Select Queue 0
  512. */
  513. jwrite32(jme, JME_TXCS, TXCS_DEFAULT | TXCS_SELECT_QUEUE0);
  514. wmb();
  515. /*
  516. * Setup TX Queue 0 DMA Bass Address
  517. */
  518. jwrite32(jme, JME_TXDBA_LO, (__u64)jme->txring[0].dma & 0xFFFFFFFFUL);
  519. jwrite32(jme, JME_TXDBA_HI, (__u64)(jme->txring[0].dma) >> 32);
  520. jwrite32(jme, JME_TXNDA, (__u64)jme->txring[0].dma & 0xFFFFFFFFUL);
  521. /*
  522. * Setup TX Descptor Count
  523. */
  524. jwrite32(jme, JME_TXQDC, jme->tx_ring_size);
  525. /*
  526. * Enable TX Engine
  527. */
  528. wmb();
  529. jwrite32(jme, JME_TXCS, jme->reg_txcs |
  530. TXCS_SELECT_QUEUE0 |
  531. TXCS_ENABLE);
  532. }
  533. static inline void
  534. jme_restart_tx_engine(struct jme_adapter *jme)
  535. {
  536. /*
  537. * Restart TX Engine
  538. */
  539. jwrite32(jme, JME_TXCS, jme->reg_txcs |
  540. TXCS_SELECT_QUEUE0 |
  541. TXCS_ENABLE);
  542. }
  543. static inline void
  544. jme_disable_tx_engine(struct jme_adapter *jme)
  545. {
  546. int i;
  547. u32 val;
  548. /*
  549. * Disable TX Engine
  550. */
  551. jwrite32(jme, JME_TXCS, jme->reg_txcs | TXCS_SELECT_QUEUE0);
  552. wmb();
  553. val = jread32(jme, JME_TXCS);
  554. for (i = JME_TX_DISABLE_TIMEOUT ; (val & TXCS_ENABLE) && i > 0 ; --i) {
  555. mdelay(1);
  556. val = jread32(jme, JME_TXCS);
  557. rmb();
  558. }
  559. if (!i)
  560. jeprintk(jme->pdev, "Disable TX engine timeout.\n");
  561. }
  562. static void
  563. jme_set_clean_rxdesc(struct jme_adapter *jme, int i)
  564. {
  565. struct jme_ring *rxring = jme->rxring;
  566. register struct rxdesc *rxdesc = rxring->desc;
  567. struct jme_buffer_info *rxbi = rxring->bufinf;
  568. rxdesc += i;
  569. rxbi += i;
  570. rxdesc->dw[0] = 0;
  571. rxdesc->dw[1] = 0;
  572. rxdesc->desc1.bufaddrh = cpu_to_le32((__u64)rxbi->mapping >> 32);
  573. rxdesc->desc1.bufaddrl = cpu_to_le32(
  574. (__u64)rxbi->mapping & 0xFFFFFFFFUL);
  575. rxdesc->desc1.datalen = cpu_to_le16(rxbi->len);
  576. if (jme->dev->features & NETIF_F_HIGHDMA)
  577. rxdesc->desc1.flags = RXFLAG_64BIT;
  578. wmb();
  579. rxdesc->desc1.flags |= RXFLAG_OWN | RXFLAG_INT;
  580. }
  581. static int
  582. jme_make_new_rx_buf(struct jme_adapter *jme, int i)
  583. {
  584. struct jme_ring *rxring = &(jme->rxring[0]);
  585. struct jme_buffer_info *rxbi = rxring->bufinf + i;
  586. struct sk_buff *skb;
  587. skb = netdev_alloc_skb(jme->dev,
  588. jme->dev->mtu + RX_EXTRA_LEN);
  589. if (unlikely(!skb))
  590. return -ENOMEM;
  591. rxbi->skb = skb;
  592. rxbi->len = skb_tailroom(skb);
  593. rxbi->mapping = pci_map_page(jme->pdev,
  594. virt_to_page(skb->data),
  595. offset_in_page(skb->data),
  596. rxbi->len,
  597. PCI_DMA_FROMDEVICE);
  598. return 0;
  599. }
  600. static void
  601. jme_free_rx_buf(struct jme_adapter *jme, int i)
  602. {
  603. struct jme_ring *rxring = &(jme->rxring[0]);
  604. struct jme_buffer_info *rxbi = rxring->bufinf;
  605. rxbi += i;
  606. if (rxbi->skb) {
  607. pci_unmap_page(jme->pdev,
  608. rxbi->mapping,
  609. rxbi->len,
  610. PCI_DMA_FROMDEVICE);
  611. dev_kfree_skb(rxbi->skb);
  612. rxbi->skb = NULL;
  613. rxbi->mapping = 0;
  614. rxbi->len = 0;
  615. }
  616. }
  617. static void
  618. jme_free_rx_resources(struct jme_adapter *jme)
  619. {
  620. int i;
  621. struct jme_ring *rxring = &(jme->rxring[0]);
  622. if (rxring->alloc) {
  623. for (i = 0 ; i < jme->rx_ring_size ; ++i)
  624. jme_free_rx_buf(jme, i);
  625. dma_free_coherent(&(jme->pdev->dev),
  626. RX_RING_ALLOC_SIZE(jme->rx_ring_size),
  627. rxring->alloc,
  628. rxring->dmaalloc);
  629. rxring->alloc = NULL;
  630. rxring->desc = NULL;
  631. rxring->dmaalloc = 0;
  632. rxring->dma = 0;
  633. }
  634. rxring->next_to_use = 0;
  635. atomic_set(&rxring->next_to_clean, 0);
  636. }
  637. static int
  638. jme_setup_rx_resources(struct jme_adapter *jme)
  639. {
  640. int i;
  641. struct jme_ring *rxring = &(jme->rxring[0]);
  642. rxring->alloc = dma_alloc_coherent(&(jme->pdev->dev),
  643. RX_RING_ALLOC_SIZE(jme->rx_ring_size),
  644. &(rxring->dmaalloc),
  645. GFP_ATOMIC);
  646. if (!rxring->alloc) {
  647. rxring->desc = NULL;
  648. rxring->dmaalloc = 0;
  649. rxring->dma = 0;
  650. return -ENOMEM;
  651. }
  652. /*
  653. * 16 Bytes align
  654. */
  655. rxring->desc = (void *)ALIGN((unsigned long)(rxring->alloc),
  656. RING_DESC_ALIGN);
  657. rxring->dma = ALIGN(rxring->dmaalloc, RING_DESC_ALIGN);
  658. rxring->next_to_use = 0;
  659. atomic_set(&rxring->next_to_clean, 0);
  660. /*
  661. * Initiallize Receive Descriptors
  662. */
  663. for (i = 0 ; i < jme->rx_ring_size ; ++i) {
  664. if (unlikely(jme_make_new_rx_buf(jme, i))) {
  665. jme_free_rx_resources(jme);
  666. return -ENOMEM;
  667. }
  668. jme_set_clean_rxdesc(jme, i);
  669. }
  670. return 0;
  671. }
  672. static inline void
  673. jme_enable_rx_engine(struct jme_adapter *jme)
  674. {
  675. /*
  676. * Select Queue 0
  677. */
  678. jwrite32(jme, JME_RXCS, jme->reg_rxcs |
  679. RXCS_QUEUESEL_Q0);
  680. wmb();
  681. /*
  682. * Setup RX DMA Bass Address
  683. */
  684. jwrite32(jme, JME_RXDBA_LO, (__u64)jme->rxring[0].dma & 0xFFFFFFFFUL);
  685. jwrite32(jme, JME_RXDBA_HI, (__u64)(jme->rxring[0].dma) >> 32);
  686. jwrite32(jme, JME_RXNDA, (__u64)jme->rxring[0].dma & 0xFFFFFFFFUL);
  687. /*
  688. * Setup RX Descriptor Count
  689. */
  690. jwrite32(jme, JME_RXQDC, jme->rx_ring_size);
  691. /*
  692. * Setup Unicast Filter
  693. */
  694. jme_set_multi(jme->dev);
  695. /*
  696. * Enable RX Engine
  697. */
  698. wmb();
  699. jwrite32(jme, JME_RXCS, jme->reg_rxcs |
  700. RXCS_QUEUESEL_Q0 |
  701. RXCS_ENABLE |
  702. RXCS_QST);
  703. }
  704. static inline void
  705. jme_restart_rx_engine(struct jme_adapter *jme)
  706. {
  707. /*
  708. * Start RX Engine
  709. */
  710. jwrite32(jme, JME_RXCS, jme->reg_rxcs |
  711. RXCS_QUEUESEL_Q0 |
  712. RXCS_ENABLE |
  713. RXCS_QST);
  714. }
  715. static inline void
  716. jme_disable_rx_engine(struct jme_adapter *jme)
  717. {
  718. int i;
  719. u32 val;
  720. /*
  721. * Disable RX Engine
  722. */
  723. jwrite32(jme, JME_RXCS, jme->reg_rxcs);
  724. wmb();
  725. val = jread32(jme, JME_RXCS);
  726. for (i = JME_RX_DISABLE_TIMEOUT ; (val & RXCS_ENABLE) && i > 0 ; --i) {
  727. mdelay(1);
  728. val = jread32(jme, JME_RXCS);
  729. rmb();
  730. }
  731. if (!i)
  732. jeprintk(jme->pdev, "Disable RX engine timeout.\n");
  733. }
  734. static int
  735. jme_rxsum_ok(struct jme_adapter *jme, u16 flags)
  736. {
  737. if (!(flags & (RXWBFLAG_TCPON | RXWBFLAG_UDPON | RXWBFLAG_IPV4)))
  738. return false;
  739. if (unlikely(!(flags & RXWBFLAG_MF) &&
  740. (flags & RXWBFLAG_TCPON) && !(flags & RXWBFLAG_TCPCS))) {
  741. msg_rx_err(jme, "TCP Checksum error.\n");
  742. goto out_sumerr;
  743. }
  744. if (unlikely(!(flags & RXWBFLAG_MF) &&
  745. (flags & RXWBFLAG_UDPON) && !(flags & RXWBFLAG_UDPCS))) {
  746. msg_rx_err(jme, "UDP Checksum error.\n");
  747. goto out_sumerr;
  748. }
  749. if (unlikely((flags & RXWBFLAG_IPV4) && !(flags & RXWBFLAG_IPCS))) {
  750. msg_rx_err(jme, "IPv4 Checksum error.\n");
  751. goto out_sumerr;
  752. }
  753. return true;
  754. out_sumerr:
  755. return false;
  756. }
  757. static void
  758. jme_alloc_and_feed_skb(struct jme_adapter *jme, int idx)
  759. {
  760. struct jme_ring *rxring = &(jme->rxring[0]);
  761. struct rxdesc *rxdesc = rxring->desc;
  762. struct jme_buffer_info *rxbi = rxring->bufinf;
  763. struct sk_buff *skb;
  764. int framesize;
  765. rxdesc += idx;
  766. rxbi += idx;
  767. skb = rxbi->skb;
  768. pci_dma_sync_single_for_cpu(jme->pdev,
  769. rxbi->mapping,
  770. rxbi->len,
  771. PCI_DMA_FROMDEVICE);
  772. if (unlikely(jme_make_new_rx_buf(jme, idx))) {
  773. pci_dma_sync_single_for_device(jme->pdev,
  774. rxbi->mapping,
  775. rxbi->len,
  776. PCI_DMA_FROMDEVICE);
  777. ++(NET_STAT(jme).rx_dropped);
  778. } else {
  779. framesize = le16_to_cpu(rxdesc->descwb.framesize)
  780. - RX_PREPAD_SIZE;
  781. skb_reserve(skb, RX_PREPAD_SIZE);
  782. skb_put(skb, framesize);
  783. skb->protocol = eth_type_trans(skb, jme->dev);
  784. if (jme_rxsum_ok(jme, le16_to_cpu(rxdesc->descwb.flags)))
  785. skb->ip_summed = CHECKSUM_UNNECESSARY;
  786. else
  787. skb->ip_summed = CHECKSUM_NONE;
  788. if (rxdesc->descwb.flags & cpu_to_le16(RXWBFLAG_TAGON)) {
  789. if (jme->vlgrp) {
  790. jme->jme_vlan_rx(skb, jme->vlgrp,
  791. le16_to_cpu(rxdesc->descwb.vlan));
  792. NET_STAT(jme).rx_bytes += 4;
  793. }
  794. } else {
  795. jme->jme_rx(skb);
  796. }
  797. if ((rxdesc->descwb.flags & cpu_to_le16(RXWBFLAG_DEST)) ==
  798. cpu_to_le16(RXWBFLAG_DEST_MUL))
  799. ++(NET_STAT(jme).multicast);
  800. NET_STAT(jme).rx_bytes += framesize;
  801. ++(NET_STAT(jme).rx_packets);
  802. }
  803. jme_set_clean_rxdesc(jme, idx);
  804. }
  805. static int
  806. jme_process_receive(struct jme_adapter *jme, int limit)
  807. {
  808. struct jme_ring *rxring = &(jme->rxring[0]);
  809. struct rxdesc *rxdesc = rxring->desc;
  810. int i, j, ccnt, desccnt, mask = jme->rx_ring_mask;
  811. if (unlikely(!atomic_dec_and_test(&jme->rx_cleaning)))
  812. goto out_inc;
  813. if (unlikely(atomic_read(&jme->link_changing) != 1))
  814. goto out_inc;
  815. if (unlikely(!netif_carrier_ok(jme->dev)))
  816. goto out_inc;
  817. i = atomic_read(&rxring->next_to_clean);
  818. while (limit-- > 0) {
  819. rxdesc = rxring->desc;
  820. rxdesc += i;
  821. if ((rxdesc->descwb.flags & cpu_to_le16(RXWBFLAG_OWN)) ||
  822. !(rxdesc->descwb.desccnt & RXWBDCNT_WBCPL))
  823. goto out;
  824. desccnt = rxdesc->descwb.desccnt & RXWBDCNT_DCNT;
  825. if (unlikely(desccnt > 1 ||
  826. rxdesc->descwb.errstat & RXWBERR_ALLERR)) {
  827. if (rxdesc->descwb.errstat & RXWBERR_CRCERR)
  828. ++(NET_STAT(jme).rx_crc_errors);
  829. else if (rxdesc->descwb.errstat & RXWBERR_OVERUN)
  830. ++(NET_STAT(jme).rx_fifo_errors);
  831. else
  832. ++(NET_STAT(jme).rx_errors);
  833. if (desccnt > 1)
  834. limit -= desccnt - 1;
  835. for (j = i, ccnt = desccnt ; ccnt-- ; ) {
  836. jme_set_clean_rxdesc(jme, j);
  837. j = (j + 1) & (mask);
  838. }
  839. } else {
  840. jme_alloc_and_feed_skb(jme, i);
  841. }
  842. i = (i + desccnt) & (mask);
  843. }
  844. out:
  845. atomic_set(&rxring->next_to_clean, i);
  846. out_inc:
  847. atomic_inc(&jme->rx_cleaning);
  848. return limit > 0 ? limit : 0;
  849. }
  850. static void
  851. jme_attempt_pcc(struct dynpcc_info *dpi, int atmp)
  852. {
  853. if (likely(atmp == dpi->cur)) {
  854. dpi->cnt = 0;
  855. return;
  856. }
  857. if (dpi->attempt == atmp) {
  858. ++(dpi->cnt);
  859. } else {
  860. dpi->attempt = atmp;
  861. dpi->cnt = 0;
  862. }
  863. }
  864. static void
  865. jme_dynamic_pcc(struct jme_adapter *jme)
  866. {
  867. register struct dynpcc_info *dpi = &(jme->dpi);
  868. if ((NET_STAT(jme).rx_bytes - dpi->last_bytes) > PCC_P3_THRESHOLD)
  869. jme_attempt_pcc(dpi, PCC_P3);
  870. else if ((NET_STAT(jme).rx_packets - dpi->last_pkts) > PCC_P2_THRESHOLD
  871. || dpi->intr_cnt > PCC_INTR_THRESHOLD)
  872. jme_attempt_pcc(dpi, PCC_P2);
  873. else
  874. jme_attempt_pcc(dpi, PCC_P1);
  875. if (unlikely(dpi->attempt != dpi->cur && dpi->cnt > 5)) {
  876. if (dpi->attempt < dpi->cur)
  877. tasklet_schedule(&jme->rxclean_task);
  878. jme_set_rx_pcc(jme, dpi->attempt);
  879. dpi->cur = dpi->attempt;
  880. dpi->cnt = 0;
  881. }
  882. }
  883. static void
  884. jme_start_pcc_timer(struct jme_adapter *jme)
  885. {
  886. struct dynpcc_info *dpi = &(jme->dpi);
  887. dpi->last_bytes = NET_STAT(jme).rx_bytes;
  888. dpi->last_pkts = NET_STAT(jme).rx_packets;
  889. dpi->intr_cnt = 0;
  890. jwrite32(jme, JME_TMCSR,
  891. TMCSR_EN | ((0xFFFFFF - PCC_INTERVAL_US) & TMCSR_CNT));
  892. }
  893. static inline void
  894. jme_stop_pcc_timer(struct jme_adapter *jme)
  895. {
  896. jwrite32(jme, JME_TMCSR, 0);
  897. }
  898. static void
  899. jme_shutdown_nic(struct jme_adapter *jme)
  900. {
  901. u32 phylink;
  902. phylink = jme_linkstat_from_phy(jme);
  903. if (!(phylink & PHY_LINK_UP)) {
  904. /*
  905. * Disable all interrupt before issue timer
  906. */
  907. jme_stop_irq(jme);
  908. jwrite32(jme, JME_TIMER2, TMCSR_EN | 0xFFFFFE);
  909. }
  910. }
  911. static void
  912. jme_pcc_tasklet(unsigned long arg)
  913. {
  914. struct jme_adapter *jme = (struct jme_adapter *)arg;
  915. struct net_device *netdev = jme->dev;
  916. if (unlikely(test_bit(JME_FLAG_SHUTDOWN, &jme->flags))) {
  917. jme_shutdown_nic(jme);
  918. return;
  919. }
  920. if (unlikely(!netif_carrier_ok(netdev) ||
  921. (atomic_read(&jme->link_changing) != 1)
  922. )) {
  923. jme_stop_pcc_timer(jme);
  924. return;
  925. }
  926. if (!(test_bit(JME_FLAG_POLL, &jme->flags)))
  927. jme_dynamic_pcc(jme);
  928. jme_start_pcc_timer(jme);
  929. }
  930. static inline void
  931. jme_polling_mode(struct jme_adapter *jme)
  932. {
  933. jme_set_rx_pcc(jme, PCC_OFF);
  934. }
  935. static inline void
  936. jme_interrupt_mode(struct jme_adapter *jme)
  937. {
  938. jme_set_rx_pcc(jme, PCC_P1);
  939. }
  940. static inline int
  941. jme_pseudo_hotplug_enabled(struct jme_adapter *jme)
  942. {
  943. u32 apmc;
  944. apmc = jread32(jme, JME_APMC);
  945. return apmc & JME_APMC_PSEUDO_HP_EN;
  946. }
  947. static void
  948. jme_start_shutdown_timer(struct jme_adapter *jme)
  949. {
  950. u32 apmc;
  951. apmc = jread32(jme, JME_APMC) | JME_APMC_PCIE_SD_EN;
  952. apmc &= ~JME_APMC_EPIEN_CTRL;
  953. if (!no_extplug) {
  954. jwrite32f(jme, JME_APMC, apmc | JME_APMC_EPIEN_CTRL_EN);
  955. wmb();
  956. }
  957. jwrite32f(jme, JME_APMC, apmc);
  958. jwrite32f(jme, JME_TIMER2, 0);
  959. set_bit(JME_FLAG_SHUTDOWN, &jme->flags);
  960. jwrite32(jme, JME_TMCSR,
  961. TMCSR_EN | ((0xFFFFFF - APMC_PHP_SHUTDOWN_DELAY) & TMCSR_CNT));
  962. }
  963. static void
  964. jme_stop_shutdown_timer(struct jme_adapter *jme)
  965. {
  966. u32 apmc;
  967. jwrite32f(jme, JME_TMCSR, 0);
  968. jwrite32f(jme, JME_TIMER2, 0);
  969. clear_bit(JME_FLAG_SHUTDOWN, &jme->flags);
  970. apmc = jread32(jme, JME_APMC);
  971. apmc &= ~(JME_APMC_PCIE_SD_EN | JME_APMC_EPIEN_CTRL);
  972. jwrite32f(jme, JME_APMC, apmc | JME_APMC_EPIEN_CTRL_DIS);
  973. wmb();
  974. jwrite32f(jme, JME_APMC, apmc);
  975. }
  976. static void
  977. jme_link_change_tasklet(unsigned long arg)
  978. {
  979. struct jme_adapter *jme = (struct jme_adapter *)arg;
  980. struct net_device *netdev = jme->dev;
  981. int rc;
  982. while (!atomic_dec_and_test(&jme->link_changing)) {
  983. atomic_inc(&jme->link_changing);
  984. msg_intr(jme, "Get link change lock failed.\n");
  985. while (atomic_read(&jme->link_changing) != 1)
  986. msg_intr(jme, "Waiting link change lock.\n");
  987. }
  988. if (jme_check_link(netdev, 1) && jme->old_mtu == netdev->mtu)
  989. goto out;
  990. jme->old_mtu = netdev->mtu;
  991. netif_stop_queue(netdev);
  992. if (jme_pseudo_hotplug_enabled(jme))
  993. jme_stop_shutdown_timer(jme);
  994. jme_stop_pcc_timer(jme);
  995. tasklet_disable(&jme->txclean_task);
  996. tasklet_disable(&jme->rxclean_task);
  997. tasklet_disable(&jme->rxempty_task);
  998. if (netif_carrier_ok(netdev)) {
  999. jme_reset_ghc_speed(jme);
  1000. jme_disable_rx_engine(jme);
  1001. jme_disable_tx_engine(jme);
  1002. jme_reset_mac_processor(jme);
  1003. jme_free_rx_resources(jme);
  1004. jme_free_tx_resources(jme);
  1005. if (test_bit(JME_FLAG_POLL, &jme->flags))
  1006. jme_polling_mode(jme);
  1007. netif_carrier_off(netdev);
  1008. }
  1009. jme_check_link(netdev, 0);
  1010. if (netif_carrier_ok(netdev)) {
  1011. rc = jme_setup_rx_resources(jme);
  1012. if (rc) {
  1013. jeprintk(jme->pdev, "Allocating resources for RX error"
  1014. ", Device STOPPED!\n");
  1015. goto out_enable_tasklet;
  1016. }
  1017. rc = jme_setup_tx_resources(jme);
  1018. if (rc) {
  1019. jeprintk(jme->pdev, "Allocating resources for TX error"
  1020. ", Device STOPPED!\n");
  1021. goto err_out_free_rx_resources;
  1022. }
  1023. jme_enable_rx_engine(jme);
  1024. jme_enable_tx_engine(jme);
  1025. netif_start_queue(netdev);
  1026. if (test_bit(JME_FLAG_POLL, &jme->flags))
  1027. jme_interrupt_mode(jme);
  1028. jme_start_pcc_timer(jme);
  1029. } else if (jme_pseudo_hotplug_enabled(jme)) {
  1030. jme_start_shutdown_timer(jme);
  1031. }
  1032. goto out_enable_tasklet;
  1033. err_out_free_rx_resources:
  1034. jme_free_rx_resources(jme);
  1035. out_enable_tasklet:
  1036. tasklet_enable(&jme->txclean_task);
  1037. tasklet_hi_enable(&jme->rxclean_task);
  1038. tasklet_hi_enable(&jme->rxempty_task);
  1039. out:
  1040. atomic_inc(&jme->link_changing);
  1041. }
  1042. static void
  1043. jme_rx_clean_tasklet(unsigned long arg)
  1044. {
  1045. struct jme_adapter *jme = (struct jme_adapter *)arg;
  1046. struct dynpcc_info *dpi = &(jme->dpi);
  1047. jme_process_receive(jme, jme->rx_ring_size);
  1048. ++(dpi->intr_cnt);
  1049. }
  1050. static int
  1051. jme_poll(JME_NAPI_HOLDER(holder), JME_NAPI_WEIGHT(budget))
  1052. {
  1053. struct jme_adapter *jme = jme_napi_priv(holder);
  1054. int rest;
  1055. rest = jme_process_receive(jme, JME_NAPI_WEIGHT_VAL(budget));
  1056. while (atomic_read(&jme->rx_empty) > 0) {
  1057. atomic_dec(&jme->rx_empty);
  1058. ++(NET_STAT(jme).rx_dropped);
  1059. jme_restart_rx_engine(jme);
  1060. }
  1061. atomic_inc(&jme->rx_empty);
  1062. if (rest) {
  1063. JME_RX_COMPLETE(netdev, holder);
  1064. jme_interrupt_mode(jme);
  1065. }
  1066. JME_NAPI_WEIGHT_SET(budget, rest);
  1067. return JME_NAPI_WEIGHT_VAL(budget) - rest;
  1068. }
  1069. static void
  1070. jme_rx_empty_tasklet(unsigned long arg)
  1071. {
  1072. struct jme_adapter *jme = (struct jme_adapter *)arg;
  1073. if (unlikely(atomic_read(&jme->link_changing) != 1))
  1074. return;
  1075. if (unlikely(!netif_carrier_ok(jme->dev)))
  1076. return;
  1077. msg_rx_status(jme, "RX Queue Full!\n");
  1078. jme_rx_clean_tasklet(arg);
  1079. while (atomic_read(&jme->rx_empty) > 0) {
  1080. atomic_dec(&jme->rx_empty);
  1081. ++(NET_STAT(jme).rx_dropped);
  1082. jme_restart_rx_engine(jme);
  1083. }
  1084. atomic_inc(&jme->rx_empty);
  1085. }
  1086. static void
  1087. jme_wake_queue_if_stopped(struct jme_adapter *jme)
  1088. {
  1089. struct jme_ring *txring = jme->txring;
  1090. smp_wmb();
  1091. if (unlikely(netif_queue_stopped(jme->dev) &&
  1092. atomic_read(&txring->nr_free) >= (jme->tx_wake_threshold))) {
  1093. msg_tx_done(jme, "TX Queue Waked.\n");
  1094. netif_wake_queue(jme->dev);
  1095. }
  1096. }
  1097. static void
  1098. jme_tx_clean_tasklet(unsigned long arg)
  1099. {
  1100. struct jme_adapter *jme = (struct jme_adapter *)arg;
  1101. struct jme_ring *txring = &(jme->txring[0]);
  1102. struct txdesc *txdesc = txring->desc;
  1103. struct jme_buffer_info *txbi = txring->bufinf, *ctxbi, *ttxbi;
  1104. int i, j, cnt = 0, max, err, mask;
  1105. tx_dbg(jme, "Into txclean.\n");
  1106. if (unlikely(!atomic_dec_and_test(&jme->tx_cleaning)))
  1107. goto out;
  1108. if (unlikely(atomic_read(&jme->link_changing) != 1))
  1109. goto out;
  1110. if (unlikely(!netif_carrier_ok(jme->dev)))
  1111. goto out;
  1112. max = jme->tx_ring_size - atomic_read(&txring->nr_free);
  1113. mask = jme->tx_ring_mask;
  1114. for (i = atomic_read(&txring->next_to_clean) ; cnt < max ; ) {
  1115. ctxbi = txbi + i;
  1116. if (likely(ctxbi->skb &&
  1117. !(txdesc[i].descwb.flags & TXWBFLAG_OWN))) {
  1118. tx_dbg(jme, "txclean: %d+%d@%lu\n",
  1119. i, ctxbi->nr_desc, jiffies);
  1120. err = txdesc[i].descwb.flags & TXWBFLAG_ALLERR;
  1121. for (j = 1 ; j < ctxbi->nr_desc ; ++j) {
  1122. ttxbi = txbi + ((i + j) & (mask));
  1123. txdesc[(i + j) & (mask)].dw[0] = 0;
  1124. pci_unmap_page(jme->pdev,
  1125. ttxbi->mapping,
  1126. ttxbi->len,
  1127. PCI_DMA_TODEVICE);
  1128. ttxbi->mapping = 0;
  1129. ttxbi->len = 0;
  1130. }
  1131. dev_kfree_skb(ctxbi->skb);
  1132. cnt += ctxbi->nr_desc;
  1133. if (unlikely(err)) {
  1134. ++(NET_STAT(jme).tx_carrier_errors);
  1135. } else {
  1136. ++(NET_STAT(jme).tx_packets);
  1137. NET_STAT(jme).tx_bytes += ctxbi->len;
  1138. }
  1139. ctxbi->skb = NULL;
  1140. ctxbi->len = 0;
  1141. ctxbi->start_xmit = 0;
  1142. } else {
  1143. break;
  1144. }
  1145. i = (i + ctxbi->nr_desc) & mask;
  1146. ctxbi->nr_desc = 0;
  1147. }
  1148. tx_dbg(jme, "txclean: done %d@%lu.\n", i, jiffies);
  1149. atomic_set(&txring->next_to_clean, i);
  1150. atomic_add(cnt, &txring->nr_free);
  1151. jme_wake_queue_if_stopped(jme);
  1152. out:
  1153. atomic_inc(&jme->tx_cleaning);
  1154. }
  1155. static void
  1156. jme_intr_msi(struct jme_adapter *jme, u32 intrstat)
  1157. {
  1158. /*
  1159. * Disable interrupt
  1160. */
  1161. jwrite32f(jme, JME_IENC, INTR_ENABLE);
  1162. if (intrstat & (INTR_LINKCH | INTR_SWINTR)) {
  1163. /*
  1164. * Link change event is critical
  1165. * all other events are ignored
  1166. */
  1167. jwrite32(jme, JME_IEVE, intrstat);
  1168. tasklet_schedule(&jme->linkch_task);
  1169. goto out_reenable;
  1170. }
  1171. if (intrstat & INTR_TMINTR) {
  1172. jwrite32(jme, JME_IEVE, INTR_TMINTR);
  1173. tasklet_schedule(&jme->pcc_task);
  1174. }
  1175. if (intrstat & (INTR_PCCTXTO | INTR_PCCTX)) {
  1176. jwrite32(jme, JME_IEVE, INTR_PCCTXTO | INTR_PCCTX | INTR_TX0);
  1177. tasklet_schedule(&jme->txclean_task);
  1178. }
  1179. if ((intrstat & (INTR_PCCRX0TO | INTR_PCCRX0 | INTR_RX0EMP))) {
  1180. jwrite32(jme, JME_IEVE, (intrstat & (INTR_PCCRX0TO |
  1181. INTR_PCCRX0 |
  1182. INTR_RX0EMP)) |
  1183. INTR_RX0);
  1184. }
  1185. if (test_bit(JME_FLAG_POLL, &jme->flags)) {
  1186. if (intrstat & INTR_RX0EMP)
  1187. atomic_inc(&jme->rx_empty);
  1188. if ((intrstat & (INTR_PCCRX0TO | INTR_PCCRX0 | INTR_RX0EMP))) {
  1189. if (likely(JME_RX_SCHEDULE_PREP(jme))) {
  1190. jme_polling_mode(jme);
  1191. JME_RX_SCHEDULE(jme);
  1192. }
  1193. }
  1194. } else {
  1195. if (intrstat & INTR_RX0EMP) {
  1196. atomic_inc(&jme->rx_empty);
  1197. tasklet_hi_schedule(&jme->rxempty_task);
  1198. } else if (intrstat & (INTR_PCCRX0TO | INTR_PCCRX0)) {
  1199. tasklet_hi_schedule(&jme->rxclean_task);
  1200. }
  1201. }
  1202. out_reenable:
  1203. /*
  1204. * Re-enable interrupt
  1205. */
  1206. jwrite32f(jme, JME_IENS, INTR_ENABLE);
  1207. }
  1208. static irqreturn_t
  1209. jme_intr(int irq, void *dev_id)
  1210. {
  1211. struct net_device *netdev = dev_id;
  1212. struct jme_adapter *jme = netdev_priv(netdev);
  1213. u32 intrstat;
  1214. intrstat = jread32(jme, JME_IEVE);
  1215. /*
  1216. * Check if it's really an interrupt for us
  1217. */
  1218. if (unlikely((intrstat & INTR_ENABLE) == 0))
  1219. return IRQ_NONE;
  1220. /*
  1221. * Check if the device still exist
  1222. */
  1223. if (unlikely(intrstat == ~((typeof(intrstat))0)))
  1224. return IRQ_NONE;
  1225. jme_intr_msi(jme, intrstat);
  1226. return IRQ_HANDLED;
  1227. }
  1228. static irqreturn_t
  1229. jme_msi(int irq, void *dev_id)
  1230. {
  1231. struct net_device *netdev = dev_id;
  1232. struct jme_adapter *jme = netdev_priv(netdev);
  1233. u32 intrstat;
  1234. pci_dma_sync_single_for_cpu(jme->pdev,
  1235. jme->shadow_dma,
  1236. sizeof(u32) * SHADOW_REG_NR,
  1237. PCI_DMA_FROMDEVICE);
  1238. intrstat = jme->shadow_regs[SHADOW_IEVE];
  1239. jme->shadow_regs[SHADOW_IEVE] = 0;
  1240. jme_intr_msi(jme, intrstat);
  1241. return IRQ_HANDLED;
  1242. }
  1243. static void
  1244. jme_reset_link(struct jme_adapter *jme)
  1245. {
  1246. jwrite32(jme, JME_TMCSR, TMCSR_SWIT);
  1247. }
  1248. static void
  1249. jme_restart_an(struct jme_adapter *jme)
  1250. {
  1251. u32 bmcr;
  1252. spin_lock_bh(&jme->phy_lock);
  1253. bmcr = jme_mdio_read(jme->dev, jme->mii_if.phy_id, MII_BMCR);
  1254. bmcr |= (BMCR_ANENABLE | BMCR_ANRESTART);
  1255. jme_mdio_write(jme->dev, jme->mii_if.phy_id, MII_BMCR, bmcr);
  1256. spin_unlock_bh(&jme->phy_lock);
  1257. }
  1258. static int
  1259. jme_request_irq(struct jme_adapter *jme)
  1260. {
  1261. int rc;
  1262. struct net_device *netdev = jme->dev;
  1263. irq_handler_t handler = jme_intr;
  1264. int irq_flags = IRQF_SHARED;
  1265. if (!pci_enable_msi(jme->pdev)) {
  1266. set_bit(JME_FLAG_MSI, &jme->flags);
  1267. handler = jme_msi;
  1268. irq_flags = 0;
  1269. }
  1270. rc = request_irq(jme->pdev->irq, handler, irq_flags, netdev->name,
  1271. netdev);
  1272. if (rc) {
  1273. jeprintk(jme->pdev,
  1274. "Unable to request %s interrupt (return: %d)\n",
  1275. test_bit(JME_FLAG_MSI, &jme->flags) ? "MSI" : "INTx",
  1276. rc);
  1277. if (test_bit(JME_FLAG_MSI, &jme->flags)) {
  1278. pci_disable_msi(jme->pdev);
  1279. clear_bit(JME_FLAG_MSI, &jme->flags);
  1280. }
  1281. } else {
  1282. netdev->irq = jme->pdev->irq;
  1283. }
  1284. return rc;
  1285. }
  1286. static void
  1287. jme_free_irq(struct jme_adapter *jme)
  1288. {
  1289. free_irq(jme->pdev->irq, jme->dev);
  1290. if (test_bit(JME_FLAG_MSI, &jme->flags)) {
  1291. pci_disable_msi(jme->pdev);
  1292. clear_bit(JME_FLAG_MSI, &jme->flags);
  1293. jme->dev->irq = jme->pdev->irq;
  1294. }
  1295. }
  1296. static int
  1297. jme_open(struct net_device *netdev)
  1298. {
  1299. struct jme_adapter *jme = netdev_priv(netdev);
  1300. int rc;
  1301. jme_clear_pm(jme);
  1302. JME_NAPI_ENABLE(jme);
  1303. tasklet_enable(&jme->txclean_task);
  1304. tasklet_hi_enable(&jme->rxclean_task);
  1305. tasklet_hi_enable(&jme->rxempty_task);
  1306. rc = jme_request_irq(jme);
  1307. if (rc)
  1308. goto err_out;
  1309. jme_enable_shadow(jme);
  1310. jme_start_irq(jme);
  1311. if (test_bit(JME_FLAG_SSET, &jme->flags))
  1312. jme_set_settings(netdev, &jme->old_ecmd);
  1313. else
  1314. jme_reset_phy_processor(jme);
  1315. jme_reset_link(jme);
  1316. return 0;
  1317. err_out:
  1318. netif_stop_queue(netdev);
  1319. netif_carrier_off(netdev);
  1320. return rc;
  1321. }
  1322. #ifdef CONFIG_PM
  1323. static void
  1324. jme_set_100m_half(struct jme_adapter *jme)
  1325. {
  1326. u32 bmcr, tmp;
  1327. bmcr = jme_mdio_read(jme->dev, jme->mii_if.phy_id, MII_BMCR);
  1328. tmp = bmcr & ~(BMCR_ANENABLE | BMCR_SPEED100 |
  1329. BMCR_SPEED1000 | BMCR_FULLDPLX);
  1330. tmp |= BMCR_SPEED100;
  1331. if (bmcr != tmp)
  1332. jme_mdio_write(jme->dev, jme->mii_if.phy_id, MII_BMCR, tmp);
  1333. if (jme->fpgaver)
  1334. jwrite32(jme, JME_GHC, GHC_SPEED_100M | GHC_LINK_POLL);
  1335. else
  1336. jwrite32(jme, JME_GHC, GHC_SPEED_100M);
  1337. }
  1338. #define JME_WAIT_LINK_TIME 2000 /* 2000ms */
  1339. static void
  1340. jme_wait_link(struct jme_adapter *jme)
  1341. {
  1342. u32 phylink, to = JME_WAIT_LINK_TIME;
  1343. mdelay(1000);
  1344. phylink = jme_linkstat_from_phy(jme);
  1345. while (!(phylink & PHY_LINK_UP) && (to -= 10) > 0) {
  1346. mdelay(10);
  1347. phylink = jme_linkstat_from_phy(jme);
  1348. }
  1349. }
  1350. #endif
  1351. static inline void
  1352. jme_phy_off(struct jme_adapter *jme)
  1353. {
  1354. jme_mdio_write(jme->dev, jme->mii_if.phy_id, MII_BMCR, BMCR_PDOWN);
  1355. }
  1356. static int
  1357. jme_close(struct net_device *netdev)
  1358. {
  1359. struct jme_adapter *jme = netdev_priv(netdev);
  1360. netif_stop_queue(netdev);
  1361. netif_carrier_off(netdev);
  1362. jme_stop_irq(jme);
  1363. jme_disable_shadow(jme);
  1364. jme_free_irq(jme);
  1365. JME_NAPI_DISABLE(jme);
  1366. tasklet_kill(&jme->linkch_task);
  1367. tasklet_kill(&jme->txclean_task);
  1368. tasklet_kill(&jme->rxclean_task);
  1369. tasklet_kill(&jme->rxempty_task);
  1370. jme_reset_ghc_speed(jme);
  1371. jme_disable_rx_engine(jme);
  1372. jme_disable_tx_engine(jme);
  1373. jme_reset_mac_processor(jme);
  1374. jme_free_rx_resources(jme);
  1375. jme_free_tx_resources(jme);
  1376. jme->phylink = 0;
  1377. jme_phy_off(jme);
  1378. return 0;
  1379. }
  1380. static int
  1381. jme_alloc_txdesc(struct jme_adapter *jme,
  1382. struct sk_buff *skb)
  1383. {
  1384. struct jme_ring *txring = jme->txring;
  1385. int idx, nr_alloc, mask = jme->tx_ring_mask;
  1386. idx = txring->next_to_use;
  1387. nr_alloc = skb_shinfo(skb)->nr_frags + 2;
  1388. if (unlikely(atomic_read(&txring->nr_free) < nr_alloc))
  1389. return -1;
  1390. atomic_sub(nr_alloc, &txring->nr_free);
  1391. txring->next_to_use = (txring->next_to_use + nr_alloc) & mask;
  1392. return idx;
  1393. }
  1394. static void
  1395. jme_fill_tx_map(struct pci_dev *pdev,
  1396. struct txdesc *txdesc,
  1397. struct jme_buffer_info *txbi,
  1398. struct page *page,
  1399. u32 page_offset,
  1400. u32 len,
  1401. u8 hidma)
  1402. {
  1403. dma_addr_t dmaaddr;
  1404. dmaaddr = pci_map_page(pdev,
  1405. page,
  1406. page_offset,
  1407. len,
  1408. PCI_DMA_TODEVICE);
  1409. pci_dma_sync_single_for_device(pdev,
  1410. dmaaddr,
  1411. len,
  1412. PCI_DMA_TODEVICE);
  1413. txdesc->dw[0] = 0;
  1414. txdesc->dw[1] = 0;
  1415. txdesc->desc2.flags = TXFLAG_OWN;
  1416. txdesc->desc2.flags |= (hidma) ? TXFLAG_64BIT : 0;
  1417. txdesc->desc2.datalen = cpu_to_le16(len);
  1418. txdesc->desc2.bufaddrh = cpu_to_le32((__u64)dmaaddr >> 32);
  1419. txdesc->desc2.bufaddrl = cpu_to_le32(
  1420. (__u64)dmaaddr & 0xFFFFFFFFUL);
  1421. txbi->mapping = dmaaddr;
  1422. txbi->len = len;
  1423. }
  1424. static void
  1425. jme_map_tx_skb(struct jme_adapter *jme, struct sk_buff *skb, int idx)
  1426. {
  1427. struct jme_ring *txring = jme->txring;
  1428. struct txdesc *txdesc = txring->desc, *ctxdesc;
  1429. struct jme_buffer_info *txbi = txring->bufinf, *ctxbi;
  1430. u8 hidma = jme->dev->features & NETIF_F_HIGHDMA;
  1431. int i, nr_frags = skb_shinfo(skb)->nr_frags;
  1432. int mask = jme->tx_ring_mask;
  1433. struct skb_frag_struct *frag;
  1434. u32 len;
  1435. for (i = 0 ; i < nr_frags ; ++i) {
  1436. frag = &skb_shinfo(skb)->frags[i];
  1437. ctxdesc = txdesc + ((idx + i + 2) & (mask));
  1438. ctxbi = txbi + ((idx + i + 2) & (mask));
  1439. jme_fill_tx_map(jme->pdev, ctxdesc, ctxbi, frag->page,
  1440. frag->page_offset, frag->size, hidma);
  1441. }
  1442. len = skb_is_nonlinear(skb) ? skb_headlen(skb) : skb->len;
  1443. ctxdesc = txdesc + ((idx + 1) & (mask));
  1444. ctxbi = txbi + ((idx + 1) & (mask));
  1445. jme_fill_tx_map(jme->pdev, ctxdesc, ctxbi, virt_to_page(skb->data),
  1446. offset_in_page(skb->data), len, hidma);
  1447. }
  1448. static int
  1449. jme_expand_header(struct jme_adapter *jme, struct sk_buff *skb)
  1450. {
  1451. if (unlikely(skb_shinfo(skb)->gso_size &&
  1452. skb_header_cloned(skb) &&
  1453. pskb_expand_head(skb, 0, 0, GFP_ATOMIC))) {
  1454. dev_kfree_skb(skb);
  1455. return -1;
  1456. }
  1457. return 0;
  1458. }
  1459. static int
  1460. jme_tx_tso(struct sk_buff *skb, __le16 *mss, u8 *flags)
  1461. {
  1462. *mss = cpu_to_le16(skb_shinfo(skb)->gso_size << TXDESC_MSS_SHIFT);
  1463. if (*mss) {
  1464. *flags |= TXFLAG_LSEN;
  1465. if (skb->protocol == htons(ETH_P_IP)) {
  1466. struct iphdr *iph = ip_hdr(skb);
  1467. iph->check = 0;
  1468. tcp_hdr(skb)->check = ~csum_tcpudp_magic(iph->saddr,
  1469. iph->daddr, 0,
  1470. IPPROTO_TCP,
  1471. 0);
  1472. } else {
  1473. struct ipv6hdr *ip6h = ipv6_hdr(skb);
  1474. tcp_hdr(skb)->check = ~csum_ipv6_magic(&ip6h->saddr,
  1475. &ip6h->daddr, 0,
  1476. IPPROTO_TCP,
  1477. 0);
  1478. }
  1479. return 0;
  1480. }
  1481. return 1;
  1482. }
  1483. static void
  1484. jme_tx_csum(struct jme_adapter *jme, struct sk_buff *skb, u8 *flags)
  1485. {
  1486. if (skb->ip_summed == CHECKSUM_PARTIAL) {
  1487. u8 ip_proto;
  1488. switch (skb->protocol) {
  1489. case htons(ETH_P_IP):
  1490. ip_proto = ip_hdr(skb)->protocol;
  1491. break;
  1492. case htons(ETH_P_IPV6):
  1493. ip_proto = ipv6_hdr(skb)->nexthdr;
  1494. break;
  1495. default:
  1496. ip_proto = 0;
  1497. break;
  1498. }
  1499. switch (ip_proto) {
  1500. case IPPROTO_TCP:
  1501. *flags |= TXFLAG_TCPCS;
  1502. break;
  1503. case IPPROTO_UDP:
  1504. *flags |= TXFLAG_UDPCS;
  1505. break;
  1506. default:
  1507. msg_tx_err(jme, "Error upper layer protocol.\n");
  1508. break;
  1509. }
  1510. }
  1511. }
  1512. static inline void
  1513. jme_tx_vlan(struct sk_buff *skb, __le16 *vlan, u8 *flags)
  1514. {
  1515. if (vlan_tx_tag_present(skb)) {
  1516. *flags |= TXFLAG_TAGON;
  1517. *vlan = cpu_to_le16(vlan_tx_tag_get(skb));
  1518. }
  1519. }
  1520. static int
  1521. jme_fill_first_tx_desc(struct jme_adapter *jme, struct sk_buff *skb, int idx)
  1522. {
  1523. struct jme_ring *txring = jme->txring;
  1524. struct txdesc *txdesc;
  1525. struct jme_buffer_info *txbi;
  1526. u8 flags;
  1527. txdesc = (struct txdesc *)txring->desc + idx;
  1528. txbi = txring->bufinf + idx;
  1529. txdesc->dw[0] = 0;
  1530. txdesc->dw[1] = 0;
  1531. txdesc->dw[2] = 0;
  1532. txdesc->dw[3] = 0;
  1533. txdesc->desc1.pktsize = cpu_to_le16(skb->len);
  1534. /*
  1535. * Set OWN bit at final.
  1536. * When kernel transmit faster than NIC.
  1537. * And NIC trying to send this descriptor before we tell
  1538. * it to start sending this TX queue.
  1539. * Other fields are already filled correctly.
  1540. */
  1541. wmb();
  1542. flags = TXFLAG_OWN | TXFLAG_INT;
  1543. /*
  1544. * Set checksum flags while not tso
  1545. */
  1546. if (jme_tx_tso(skb, &txdesc->desc1.mss, &flags))
  1547. jme_tx_csum(jme, skb, &flags);
  1548. jme_tx_vlan(skb, &txdesc->desc1.vlan, &flags);
  1549. txdesc->desc1.flags = flags;
  1550. /*
  1551. * Set tx buffer info after telling NIC to send
  1552. * For better tx_clean timing
  1553. */
  1554. wmb();
  1555. txbi->nr_desc = skb_shinfo(skb)->nr_frags + 2;
  1556. txbi->skb = skb;
  1557. txbi->len = skb->len;
  1558. txbi->start_xmit = jiffies;
  1559. if (!txbi->start_xmit)
  1560. txbi->start_xmit = (0UL-1);
  1561. return 0;
  1562. }
  1563. static void
  1564. jme_stop_queue_if_full(struct jme_adapter *jme)
  1565. {
  1566. struct jme_ring *txring = jme->txring;
  1567. struct jme_buffer_info *txbi = txring->bufinf;
  1568. int idx = atomic_read(&txring->next_to_clean);
  1569. txbi += idx;
  1570. smp_wmb();
  1571. if (unlikely(atomic_read(&txring->nr_free) < (MAX_SKB_FRAGS+2))) {
  1572. netif_stop_queue(jme->dev);
  1573. msg_tx_queued(jme, "TX Queue Paused.\n");
  1574. smp_wmb();
  1575. if (atomic_read(&txring->nr_free)
  1576. >= (jme->tx_wake_threshold)) {
  1577. netif_wake_queue(jme->dev);
  1578. msg_tx_queued(jme, "TX Queue Fast Waked.\n");
  1579. }
  1580. }
  1581. if (unlikely(txbi->start_xmit &&
  1582. (jiffies - txbi->start_xmit) >= TX_TIMEOUT &&
  1583. txbi->skb)) {
  1584. netif_stop_queue(jme->dev);
  1585. msg_tx_queued(jme, "TX Queue Stopped %d@%lu.\n", idx, jiffies);
  1586. }
  1587. }
  1588. /*
  1589. * This function is already protected by netif_tx_lock()
  1590. */
  1591. static int
  1592. jme_start_xmit(struct sk_buff *skb, struct net_device *netdev)
  1593. {
  1594. struct jme_adapter *jme = netdev_priv(netdev);
  1595. int idx;
  1596. if (unlikely(jme_expand_header(jme, skb))) {
  1597. ++(NET_STAT(jme).tx_dropped);
  1598. return NETDEV_TX_OK;
  1599. }
  1600. idx = jme_alloc_txdesc(jme, skb);
  1601. if (unlikely(idx < 0)) {
  1602. netif_stop_queue(netdev);
  1603. msg_tx_err(jme, "BUG! Tx ring full when queue awake!\n");
  1604. return NETDEV_TX_BUSY;
  1605. }
  1606. jme_map_tx_skb(jme, skb, idx);
  1607. jme_fill_first_tx_desc(jme, skb, idx);
  1608. jwrite32(jme, JME_TXCS, jme->reg_txcs |
  1609. TXCS_SELECT_QUEUE0 |
  1610. TXCS_QUEUE0S |
  1611. TXCS_ENABLE);
  1612. netdev->trans_start = jiffies;
  1613. tx_dbg(jme, "xmit: %d+%d@%lu\n", idx,
  1614. skb_shinfo(skb)->nr_frags + 2,
  1615. jiffies);
  1616. jme_stop_queue_if_full(jme);
  1617. return NETDEV_TX_OK;
  1618. }
  1619. static int
  1620. jme_set_macaddr(struct net_device *netdev, void *p)
  1621. {
  1622. struct jme_adapter *jme = netdev_priv(netdev);
  1623. struct sockaddr *addr = p;
  1624. u32 val;
  1625. if (netif_running(netdev))
  1626. return -EBUSY;
  1627. spin_lock_bh(&jme->macaddr_lock);
  1628. memcpy(netdev->dev_addr, addr->sa_data, netdev->addr_len);
  1629. val = (addr->sa_data[3] & 0xff) << 24 |
  1630. (addr->sa_data[2] & 0xff) << 16 |
  1631. (addr->sa_data[1] & 0xff) << 8 |
  1632. (addr->sa_data[0] & 0xff);
  1633. jwrite32(jme, JME_RXUMA_LO, val);
  1634. val = (addr->sa_data[5] & 0xff) << 8 |
  1635. (addr->sa_data[4] & 0xff);
  1636. jwrite32(jme, JME_RXUMA_HI, val);
  1637. spin_unlock_bh(&jme->macaddr_lock);
  1638. return 0;
  1639. }
  1640. static void
  1641. jme_set_multi(struct net_device *netdev)
  1642. {
  1643. struct jme_adapter *jme = netdev_priv(netdev);
  1644. u32 mc_hash[2] = {};
  1645. int i;
  1646. spin_lock_bh(&jme->rxmcs_lock);
  1647. jme->reg_rxmcs |= RXMCS_BRDFRAME | RXMCS_UNIFRAME;
  1648. if (netdev->flags & IFF_PROMISC) {
  1649. jme->reg_rxmcs |= RXMCS_ALLFRAME;
  1650. } else if (netdev->flags & IFF_ALLMULTI) {
  1651. jme->reg_rxmcs |= RXMCS_ALLMULFRAME;
  1652. } else if (netdev->flags & IFF_MULTICAST) {
  1653. struct dev_mc_list *mclist;
  1654. int bit_nr;
  1655. jme->reg_rxmcs |= RXMCS_MULFRAME | RXMCS_MULFILTERED;
  1656. for (i = 0, mclist = netdev->mc_list;
  1657. mclist && i < netdev->mc_count;
  1658. ++i, mclist = mclist->next) {
  1659. bit_nr = ether_crc(ETH_ALEN, mclist->dmi_addr) & 0x3F;
  1660. mc_hash[bit_nr >> 5] |= 1 << (bit_nr & 0x1F);
  1661. }
  1662. jwrite32(jme, JME_RXMCHT_LO, mc_hash[0]);
  1663. jwrite32(jme, JME_RXMCHT_HI, mc_hash[1]);
  1664. }
  1665. wmb();
  1666. jwrite32(jme, JME_RXMCS, jme->reg_rxmcs);
  1667. spin_unlock_bh(&jme->rxmcs_lock);
  1668. }
  1669. static int
  1670. jme_change_mtu(struct net_device *netdev, int new_mtu)
  1671. {
  1672. struct jme_adapter *jme = netdev_priv(netdev);
  1673. if (new_mtu == jme->old_mtu)
  1674. return 0;
  1675. if (((new_mtu + ETH_HLEN) > MAX_ETHERNET_JUMBO_PACKET_SIZE) ||
  1676. ((new_mtu) < IPV6_MIN_MTU))
  1677. return -EINVAL;
  1678. if (new_mtu > 4000) {
  1679. jme->reg_rxcs &= ~RXCS_FIFOTHNP;
  1680. jme->reg_rxcs |= RXCS_FIFOTHNP_64QW;
  1681. jme_restart_rx_engine(jme);
  1682. } else {
  1683. jme->reg_rxcs &= ~RXCS_FIFOTHNP;
  1684. jme->reg_rxcs |= RXCS_FIFOTHNP_128QW;
  1685. jme_restart_rx_engine(jme);
  1686. }
  1687. if (new_mtu > 1900) {
  1688. netdev->features &= ~(NETIF_F_HW_CSUM |
  1689. NETIF_F_TSO |
  1690. NETIF_F_TSO6);
  1691. } else {
  1692. if (test_bit(JME_FLAG_TXCSUM, &jme->flags))
  1693. netdev->features |= NETIF_F_HW_CSUM;
  1694. if (test_bit(JME_FLAG_TSO, &jme->flags))
  1695. netdev->features |= NETIF_F_TSO | NETIF_F_TSO6;
  1696. }
  1697. netdev->mtu = new_mtu;
  1698. jme_reset_link(jme);
  1699. return 0;
  1700. }
  1701. static void
  1702. jme_tx_timeout(struct net_device *netdev)
  1703. {
  1704. struct jme_adapter *jme = netdev_priv(netdev);
  1705. jme->phylink = 0;
  1706. jme_reset_phy_processor(jme);
  1707. if (test_bit(JME_FLAG_SSET, &jme->flags))
  1708. jme_set_settings(netdev, &jme->old_ecmd);
  1709. /*
  1710. * Force to Reset the link again
  1711. */
  1712. jme_reset_link(jme);
  1713. }
  1714. static void
  1715. jme_vlan_rx_register(struct net_device *netdev, struct vlan_group *grp)
  1716. {
  1717. struct jme_adapter *jme = netdev_priv(netdev);
  1718. jme->vlgrp = grp;
  1719. }
  1720. static void
  1721. jme_get_drvinfo(struct net_device *netdev,
  1722. struct ethtool_drvinfo *info)
  1723. {
  1724. struct jme_adapter *jme = netdev_priv(netdev);
  1725. strcpy(info->driver, DRV_NAME);
  1726. strcpy(info->version, DRV_VERSION);
  1727. strcpy(info->bus_info, pci_name(jme->pdev));
  1728. }
  1729. static int
  1730. jme_get_regs_len(struct net_device *netdev)
  1731. {
  1732. return JME_REG_LEN;
  1733. }
  1734. static void
  1735. mmapio_memcpy(struct jme_adapter *jme, u32 *p, u32 reg, int len)
  1736. {
  1737. int i;
  1738. for (i = 0 ; i < len ; i += 4)
  1739. p[i >> 2] = jread32(jme, reg + i);
  1740. }
  1741. static void
  1742. mdio_memcpy(struct jme_adapter *jme, u32 *p, int reg_nr)
  1743. {
  1744. int i;
  1745. u16 *p16 = (u16 *)p;
  1746. for (i = 0 ; i < reg_nr ; ++i)
  1747. p16[i] = jme_mdio_read(jme->dev, jme->mii_if.phy_id, i);
  1748. }
  1749. static void
  1750. jme_get_regs(struct net_device *netdev, struct ethtool_regs *regs, void *p)
  1751. {
  1752. struct jme_adapter *jme = netdev_priv(netdev);
  1753. u32 *p32 = (u32 *)p;
  1754. memset(p, 0xFF, JME_REG_LEN);
  1755. regs->version = 1;
  1756. mmapio_memcpy(jme, p32, JME_MAC, JME_MAC_LEN);
  1757. p32 += 0x100 >> 2;
  1758. mmapio_memcpy(jme, p32, JME_PHY, JME_PHY_LEN);
  1759. p32 += 0x100 >> 2;
  1760. mmapio_memcpy(jme, p32, JME_MISC, JME_MISC_LEN);
  1761. p32 += 0x100 >> 2;
  1762. mmapio_memcpy(jme, p32, JME_RSS, JME_RSS_LEN);
  1763. p32 += 0x100 >> 2;
  1764. mdio_memcpy(jme, p32, JME_PHY_REG_NR);
  1765. }
  1766. static int
  1767. jme_get_coalesce(struct net_device *netdev, struct ethtool_coalesce *ecmd)
  1768. {
  1769. struct jme_adapter *jme = netdev_priv(netdev);
  1770. ecmd->tx_coalesce_usecs = PCC_TX_TO;
  1771. ecmd->tx_max_coalesced_frames = PCC_TX_CNT;
  1772. if (test_bit(JME_FLAG_POLL, &jme->flags)) {
  1773. ecmd->use_adaptive_rx_coalesce = false;
  1774. ecmd->rx_coalesce_usecs = 0;
  1775. ecmd->rx_max_coalesced_frames = 0;
  1776. return 0;
  1777. }
  1778. ecmd->use_adaptive_rx_coalesce = true;
  1779. switch (jme->dpi.cur) {
  1780. case PCC_P1:
  1781. ecmd->rx_coalesce_usecs = PCC_P1_TO;
  1782. ecmd->rx_max_coalesced_frames = PCC_P1_CNT;
  1783. break;
  1784. case PCC_P2:
  1785. ecmd->rx_coalesce_usecs = PCC_P2_TO;
  1786. ecmd->rx_max_coalesced_frames = PCC_P2_CNT;
  1787. break;
  1788. case PCC_P3:
  1789. ecmd->rx_coalesce_usecs = PCC_P3_TO;
  1790. ecmd->rx_max_coalesced_frames = PCC_P3_CNT;
  1791. break;
  1792. default:
  1793. break;
  1794. }
  1795. return 0;
  1796. }
  1797. static int
  1798. jme_set_coalesce(struct net_device *netdev, struct ethtool_coalesce *ecmd)
  1799. {
  1800. struct jme_adapter *jme = netdev_priv(netdev);
  1801. struct dynpcc_info *dpi = &(jme->dpi);
  1802. if (netif_running(netdev))
  1803. return -EBUSY;
  1804. if (ecmd->use_adaptive_rx_coalesce
  1805. && test_bit(JME_FLAG_POLL, &jme->flags)) {
  1806. clear_bit(JME_FLAG_POLL, &jme->flags);
  1807. jme->jme_rx = netif_rx;
  1808. jme->jme_vlan_rx = vlan_hwaccel_rx;
  1809. dpi->cur = PCC_P1;
  1810. dpi->attempt = PCC_P1;
  1811. dpi->cnt = 0;
  1812. jme_set_rx_pcc(jme, PCC_P1);
  1813. jme_interrupt_mode(jme);
  1814. } else if (!(ecmd->use_adaptive_rx_coalesce)
  1815. && !(test_bit(JME_FLAG_POLL, &jme->flags))) {
  1816. set_bit(JME_FLAG_POLL, &jme->flags);
  1817. jme->jme_rx = netif_receive_skb;
  1818. jme->jme_vlan_rx = vlan_hwaccel_receive_skb;
  1819. jme_interrupt_mode(jme);
  1820. }
  1821. return 0;
  1822. }
  1823. static void
  1824. jme_get_pauseparam(struct net_device *netdev,
  1825. struct ethtool_pauseparam *ecmd)
  1826. {
  1827. struct jme_adapter *jme = netdev_priv(netdev);
  1828. u32 val;
  1829. ecmd->tx_pause = (jme->reg_txpfc & TXPFC_PF_EN) != 0;
  1830. ecmd->rx_pause = (jme->reg_rxmcs & RXMCS_FLOWCTRL) != 0;
  1831. spin_lock_bh(&jme->phy_lock);
  1832. val = jme_mdio_read(jme->dev, jme->mii_if.phy_id, MII_ADVERTISE);
  1833. spin_unlock_bh(&jme->phy_lock);
  1834. ecmd->autoneg =
  1835. (val & (ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM)) != 0;
  1836. }
  1837. static int
  1838. jme_set_pauseparam(struct net_device *netdev,
  1839. struct ethtool_pauseparam *ecmd)
  1840. {
  1841. struct jme_adapter *jme = netdev_priv(netdev);
  1842. u32 val;
  1843. if (((jme->reg_txpfc & TXPFC_PF_EN) != 0) ^
  1844. (ecmd->tx_pause != 0)) {
  1845. if (ecmd->tx_pause)
  1846. jme->reg_txpfc |= TXPFC_PF_EN;
  1847. else
  1848. jme->reg_txpfc &= ~TXPFC_PF_EN;
  1849. jwrite32(jme, JME_TXPFC, jme->reg_txpfc);
  1850. }
  1851. spin_lock_bh(&jme->rxmcs_lock);
  1852. if (((jme->reg_rxmcs & RXMCS_FLOWCTRL) != 0) ^
  1853. (ecmd->rx_pause != 0)) {
  1854. if (ecmd->rx_pause)
  1855. jme->reg_rxmcs |= RXMCS_FLOWCTRL;
  1856. else
  1857. jme->reg_rxmcs &= ~RXMCS_FLOWCTRL;
  1858. jwrite32(jme, JME_RXMCS, jme->reg_rxmcs);
  1859. }
  1860. spin_unlock_bh(&jme->rxmcs_lock);
  1861. spin_lock_bh(&jme->phy_lock);
  1862. val = jme_mdio_read(jme->dev, jme->mii_if.phy_id, MII_ADVERTISE);
  1863. if (((val & (ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM)) != 0) ^
  1864. (ecmd->autoneg != 0)) {
  1865. if (ecmd->autoneg)
  1866. val |= (ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM);
  1867. else
  1868. val &= ~(ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM);
  1869. jme_mdio_write(jme->dev, jme->mii_if.phy_id,
  1870. MII_ADVERTISE, val);
  1871. }
  1872. spin_unlock_bh(&jme->phy_lock);
  1873. return 0;
  1874. }
  1875. static void
  1876. jme_get_wol(struct net_device *netdev,
  1877. struct ethtool_wolinfo *wol)
  1878. {
  1879. struct jme_adapter *jme = netdev_priv(netdev);
  1880. wol->supported = WAKE_MAGIC | WAKE_PHY;
  1881. wol->wolopts = 0;
  1882. if (jme->reg_pmcs & (PMCS_LFEN | PMCS_LREN))
  1883. wol->wolopts |= WAKE_PHY;
  1884. if (jme->reg_pmcs & PMCS_MFEN)
  1885. wol->wolopts |= WAKE_MAGIC;
  1886. }
  1887. static int
  1888. jme_set_wol(struct net_device *netdev,
  1889. struct ethtool_wolinfo *wol)
  1890. {
  1891. struct jme_adapter *jme = netdev_priv(netdev);
  1892. if (wol->wolopts & (WAKE_MAGICSECURE |
  1893. WAKE_UCAST |
  1894. WAKE_MCAST |
  1895. WAKE_BCAST |
  1896. WAKE_ARP))
  1897. return -EOPNOTSUPP;
  1898. jme->reg_pmcs = 0;
  1899. if (wol->wolopts & WAKE_PHY)
  1900. jme->reg_pmcs |= PMCS_LFEN | PMCS_LREN;
  1901. if (wol->wolopts & WAKE_MAGIC)
  1902. jme->reg_pmcs |= PMCS_MFEN;
  1903. jwrite32(jme, JME_PMCS, jme->reg_pmcs);
  1904. return 0;
  1905. }
  1906. static int
  1907. jme_get_settings(struct net_device *netdev,
  1908. struct ethtool_cmd *ecmd)
  1909. {
  1910. struct jme_adapter *jme = netdev_priv(netdev);
  1911. int rc;
  1912. spin_lock_bh(&jme->phy_lock);
  1913. rc = mii_ethtool_gset(&(jme->mii_if), ecmd);
  1914. spin_unlock_bh(&jme->phy_lock);
  1915. return rc;
  1916. }
  1917. static int
  1918. jme_set_settings(struct net_device *netdev,
  1919. struct ethtool_cmd *ecmd)
  1920. {
  1921. struct jme_adapter *jme = netdev_priv(netdev);
  1922. int rc, fdc = 0;
  1923. if (ecmd->speed == SPEED_1000 && ecmd->autoneg != AUTONEG_ENABLE)
  1924. return -EINVAL;
  1925. if (jme->mii_if.force_media &&
  1926. ecmd->autoneg != AUTONEG_ENABLE &&
  1927. (jme->mii_if.full_duplex != ecmd->duplex))
  1928. fdc = 1;
  1929. spin_lock_bh(&jme->phy_lock);
  1930. rc = mii_ethtool_sset(&(jme->mii_if), ecmd);
  1931. spin_unlock_bh(&jme->phy_lock);
  1932. if (!rc && fdc)
  1933. jme_reset_link(jme);
  1934. if (!rc) {
  1935. set_bit(JME_FLAG_SSET, &jme->flags);
  1936. jme->old_ecmd = *ecmd;
  1937. }
  1938. return rc;
  1939. }
  1940. static u32
  1941. jme_get_link(struct net_device *netdev)
  1942. {
  1943. struct jme_adapter *jme = netdev_priv(netdev);
  1944. return jread32(jme, JME_PHY_LINK) & PHY_LINK_UP;
  1945. }
  1946. static u32
  1947. jme_get_msglevel(struct net_device *netdev)
  1948. {
  1949. struct jme_adapter *jme = netdev_priv(netdev);
  1950. return jme->msg_enable;
  1951. }
  1952. static void
  1953. jme_set_msglevel(struct net_device *netdev, u32 value)
  1954. {
  1955. struct jme_adapter *jme = netdev_priv(netdev);
  1956. jme->msg_enable = value;
  1957. }
  1958. static u32
  1959. jme_get_rx_csum(struct net_device *netdev)
  1960. {
  1961. struct jme_adapter *jme = netdev_priv(netdev);
  1962. return jme->reg_rxmcs & RXMCS_CHECKSUM;
  1963. }
  1964. static int
  1965. jme_set_rx_csum(struct net_device *netdev, u32 on)
  1966. {
  1967. struct jme_adapter *jme = netdev_priv(netdev);
  1968. spin_lock_bh(&jme->rxmcs_lock);
  1969. if (on)
  1970. jme->reg_rxmcs |= RXMCS_CHECKSUM;
  1971. else
  1972. jme->reg_rxmcs &= ~RXMCS_CHECKSUM;
  1973. jwrite32(jme, JME_RXMCS, jme->reg_rxmcs);
  1974. spin_unlock_bh(&jme->rxmcs_lock);
  1975. return 0;
  1976. }
  1977. static int
  1978. jme_set_tx_csum(struct net_device *netdev, u32 on)
  1979. {
  1980. struct jme_adapter *jme = netdev_priv(netdev);
  1981. if (on) {
  1982. set_bit(JME_FLAG_TXCSUM, &jme->flags);
  1983. if (netdev->mtu <= 1900)
  1984. netdev->features |= NETIF_F_HW_CSUM;
  1985. } else {
  1986. clear_bit(JME_FLAG_TXCSUM, &jme->flags);
  1987. netdev->features &= ~NETIF_F_HW_CSUM;
  1988. }
  1989. return 0;
  1990. }
  1991. static int
  1992. jme_set_tso(struct net_device *netdev, u32 on)
  1993. {
  1994. struct jme_adapter *jme = netdev_priv(netdev);
  1995. if (on) {
  1996. set_bit(JME_FLAG_TSO, &jme->flags);
  1997. if (netdev->mtu <= 1900)
  1998. netdev->features |= NETIF_F_TSO | NETIF_F_TSO6;
  1999. } else {
  2000. clear_bit(JME_FLAG_TSO, &jme->flags);
  2001. netdev->features &= ~(NETIF_F_TSO | NETIF_F_TSO6);
  2002. }
  2003. return 0;
  2004. }
  2005. static int
  2006. jme_nway_reset(struct net_device *netdev)
  2007. {
  2008. struct jme_adapter *jme = netdev_priv(netdev);
  2009. jme_restart_an(jme);
  2010. return 0;
  2011. }
  2012. static u8
  2013. jme_smb_read(struct jme_adapter *jme, unsigned int addr)
  2014. {
  2015. u32 val;
  2016. int to;
  2017. val = jread32(jme, JME_SMBCSR);
  2018. to = JME_SMB_BUSY_TIMEOUT;
  2019. while ((val & SMBCSR_BUSY) && --to) {
  2020. msleep(1);
  2021. val = jread32(jme, JME_SMBCSR);
  2022. }
  2023. if (!to) {
  2024. msg_hw(jme, "SMB Bus Busy.\n");
  2025. return 0xFF;
  2026. }
  2027. jwrite32(jme, JME_SMBINTF,
  2028. ((addr << SMBINTF_HWADDR_SHIFT) & SMBINTF_HWADDR) |
  2029. SMBINTF_HWRWN_READ |
  2030. SMBINTF_HWCMD);
  2031. val = jread32(jme, JME_SMBINTF);
  2032. to = JME_SMB_BUSY_TIMEOUT;
  2033. while ((val & SMBINTF_HWCMD) && --to) {
  2034. msleep(1);
  2035. val = jread32(jme, JME_SMBINTF);
  2036. }
  2037. if (!to) {
  2038. msg_hw(jme, "SMB Bus Busy.\n");
  2039. return 0xFF;
  2040. }
  2041. return (val & SMBINTF_HWDATR) >> SMBINTF_HWDATR_SHIFT;
  2042. }
  2043. static void
  2044. jme_smb_write(struct jme_adapter *jme, unsigned int addr, u8 data)
  2045. {
  2046. u32 val;
  2047. int to;
  2048. val = jread32(jme, JME_SMBCSR);
  2049. to = JME_SMB_BUSY_TIMEOUT;
  2050. while ((val & SMBCSR_BUSY) && --to) {
  2051. msleep(1);
  2052. val = jread32(jme, JME_SMBCSR);
  2053. }
  2054. if (!to) {
  2055. msg_hw(jme, "SMB Bus Busy.\n");
  2056. return;
  2057. }
  2058. jwrite32(jme, JME_SMBINTF,
  2059. ((data << SMBINTF_HWDATW_SHIFT) & SMBINTF_HWDATW) |
  2060. ((addr << SMBINTF_HWADDR_SHIFT) & SMBINTF_HWADDR) |
  2061. SMBINTF_HWRWN_WRITE |
  2062. SMBINTF_HWCMD);
  2063. val = jread32(jme, JME_SMBINTF);
  2064. to = JME_SMB_BUSY_TIMEOUT;
  2065. while ((val & SMBINTF_HWCMD) && --to) {
  2066. msleep(1);
  2067. val = jread32(jme, JME_SMBINTF);
  2068. }
  2069. if (!to) {
  2070. msg_hw(jme, "SMB Bus Busy.\n");
  2071. return;
  2072. }
  2073. mdelay(2);
  2074. }
  2075. static int
  2076. jme_get_eeprom_len(struct net_device *netdev)
  2077. {
  2078. struct jme_adapter *jme = netdev_priv(netdev);
  2079. u32 val;
  2080. val = jread32(jme, JME_SMBCSR);
  2081. return (val & SMBCSR_EEPROMD) ? JME_SMB_LEN : 0;
  2082. }
  2083. static int
  2084. jme_get_eeprom(struct net_device *netdev,
  2085. struct ethtool_eeprom *eeprom, u8 *data)
  2086. {
  2087. struct jme_adapter *jme = netdev_priv(netdev);
  2088. int i, offset = eeprom->offset, len = eeprom->len;
  2089. /*
  2090. * ethtool will check the boundary for us
  2091. */
  2092. eeprom->magic = JME_EEPROM_MAGIC;
  2093. for (i = 0 ; i < len ; ++i)
  2094. data[i] = jme_smb_read(jme, i + offset);
  2095. return 0;
  2096. }
  2097. static int
  2098. jme_set_eeprom(struct net_device *netdev,
  2099. struct ethtool_eeprom *eeprom, u8 *data)
  2100. {
  2101. struct jme_adapter *jme = netdev_priv(netdev);
  2102. int i, offset = eeprom->offset, len = eeprom->len;
  2103. if (eeprom->magic != JME_EEPROM_MAGIC)
  2104. return -EINVAL;
  2105. /*
  2106. * ethtool will check the boundary for us
  2107. */
  2108. for (i = 0 ; i < len ; ++i)
  2109. jme_smb_write(jme, i + offset, data[i]);
  2110. return 0;
  2111. }
  2112. static const struct ethtool_ops jme_ethtool_ops = {
  2113. .get_drvinfo = jme_get_drvinfo,
  2114. .get_regs_len = jme_get_regs_len,
  2115. .get_regs = jme_get_regs,
  2116. .get_coalesce = jme_get_coalesce,
  2117. .set_coalesce = jme_set_coalesce,
  2118. .get_pauseparam = jme_get_pauseparam,
  2119. .set_pauseparam = jme_set_pauseparam,
  2120. .get_wol = jme_get_wol,
  2121. .set_wol = jme_set_wol,
  2122. .get_settings = jme_get_settings,
  2123. .set_settings = jme_set_settings,
  2124. .get_link = jme_get_link,
  2125. .get_msglevel = jme_get_msglevel,
  2126. .set_msglevel = jme_set_msglevel,
  2127. .get_rx_csum = jme_get_rx_csum,
  2128. .set_rx_csum = jme_set_rx_csum,
  2129. .set_tx_csum = jme_set_tx_csum,
  2130. .set_tso = jme_set_tso,
  2131. .set_sg = ethtool_op_set_sg,
  2132. .nway_reset = jme_nway_reset,
  2133. .get_eeprom_len = jme_get_eeprom_len,
  2134. .get_eeprom = jme_get_eeprom,
  2135. .set_eeprom = jme_set_eeprom,
  2136. };
  2137. static int
  2138. jme_pci_dma64(struct pci_dev *pdev)
  2139. {
  2140. if (!pci_set_dma_mask(pdev, DMA_32BIT_MASK))
  2141. if (!pci_set_consistent_dma_mask(pdev, DMA_32BIT_MASK))
  2142. return 0;
  2143. return -1;
  2144. }
  2145. static inline void
  2146. jme_phy_init(struct jme_adapter *jme)
  2147. {
  2148. u16 reg26;
  2149. reg26 = jme_mdio_read(jme->dev, jme->mii_if.phy_id, 26);
  2150. jme_mdio_write(jme->dev, jme->mii_if.phy_id, 26, reg26 | 0x1000);
  2151. }
  2152. static inline void
  2153. jme_check_hw_ver(struct jme_adapter *jme)
  2154. {
  2155. u32 chipmode;
  2156. chipmode = jread32(jme, JME_CHIPMODE);
  2157. jme->fpgaver = (chipmode & CM_FPGAVER_MASK) >> CM_FPGAVER_SHIFT;
  2158. jme->chiprev = (chipmode & CM_CHIPREV_MASK) >> CM_CHIPREV_SHIFT;
  2159. }
  2160. static const struct net_device_ops jme_netdev_ops = {
  2161. .ndo_open = jme_open,
  2162. .ndo_stop = jme_close,
  2163. .ndo_validate_addr = eth_validate_addr,
  2164. .ndo_start_xmit = jme_start_xmit,
  2165. .ndo_set_mac_address = jme_set_macaddr,
  2166. .ndo_set_multicast_list = jme_set_multi,
  2167. .ndo_change_mtu = jme_change_mtu,
  2168. .ndo_tx_timeout = jme_tx_timeout,
  2169. .ndo_vlan_rx_register = jme_vlan_rx_register,
  2170. };
  2171. static int __devinit
  2172. jme_init_one(struct pci_dev *pdev,
  2173. const struct pci_device_id *ent)
  2174. {
  2175. int rc = 0, using_dac, i;
  2176. struct net_device *netdev;
  2177. struct jme_adapter *jme;
  2178. u16 bmcr, bmsr;
  2179. u32 apmc;
  2180. /*
  2181. * set up PCI device basics
  2182. */
  2183. rc = pci_enable_device(pdev);
  2184. if (rc) {
  2185. jeprintk(pdev, "Cannot enable PCI device.\n");
  2186. goto err_out;
  2187. }
  2188. using_dac = jme_pci_dma64(pdev);
  2189. if (using_dac < 0) {
  2190. jeprintk(pdev, "Cannot set PCI DMA Mask.\n");
  2191. rc = -EIO;
  2192. goto err_out_disable_pdev;
  2193. }
  2194. if (!(pci_resource_flags(pdev, 0) & IORESOURCE_MEM)) {
  2195. jeprintk(pdev, "No PCI resource region found.\n");
  2196. rc = -ENOMEM;
  2197. goto err_out_disable_pdev;
  2198. }
  2199. rc = pci_request_regions(pdev, DRV_NAME);
  2200. if (rc) {
  2201. jeprintk(pdev, "Cannot obtain PCI resource region.\n");
  2202. goto err_out_disable_pdev;
  2203. }
  2204. pci_set_master(pdev);
  2205. /*
  2206. * alloc and init net device
  2207. */
  2208. netdev = alloc_etherdev(sizeof(*jme));
  2209. if (!netdev) {
  2210. jeprintk(pdev, "Cannot allocate netdev structure.\n");
  2211. rc = -ENOMEM;
  2212. goto err_out_release_regions;
  2213. }
  2214. netdev->netdev_ops = &jme_netdev_ops;
  2215. netdev->ethtool_ops = &jme_ethtool_ops;
  2216. netdev->watchdog_timeo = TX_TIMEOUT;
  2217. netdev->features = NETIF_F_HW_CSUM |
  2218. NETIF_F_SG |
  2219. NETIF_F_TSO |
  2220. NETIF_F_TSO6 |
  2221. NETIF_F_HW_VLAN_TX |
  2222. NETIF_F_HW_VLAN_RX;
  2223. if (using_dac)
  2224. netdev->features |= NETIF_F_HIGHDMA;
  2225. SET_NETDEV_DEV(netdev, &pdev->dev);
  2226. pci_set_drvdata(pdev, netdev);
  2227. /*
  2228. * init adapter info
  2229. */
  2230. jme = netdev_priv(netdev);
  2231. jme->pdev = pdev;
  2232. jme->dev = netdev;
  2233. jme->jme_rx = netif_rx;
  2234. jme->jme_vlan_rx = vlan_hwaccel_rx;
  2235. jme->old_mtu = netdev->mtu = 1500;
  2236. jme->phylink = 0;
  2237. jme->tx_ring_size = 1 << 10;
  2238. jme->tx_ring_mask = jme->tx_ring_size - 1;
  2239. jme->tx_wake_threshold = 1 << 9;
  2240. jme->rx_ring_size = 1 << 9;
  2241. jme->rx_ring_mask = jme->rx_ring_size - 1;
  2242. jme->msg_enable = JME_DEF_MSG_ENABLE;
  2243. jme->regs = ioremap(pci_resource_start(pdev, 0),
  2244. pci_resource_len(pdev, 0));
  2245. if (!(jme->regs)) {
  2246. jeprintk(pdev, "Mapping PCI resource region error.\n");
  2247. rc = -ENOMEM;
  2248. goto err_out_free_netdev;
  2249. }
  2250. jme->shadow_regs = pci_alloc_consistent(pdev,
  2251. sizeof(u32) * SHADOW_REG_NR,
  2252. &(jme->shadow_dma));
  2253. if (!(jme->shadow_regs)) {
  2254. jeprintk(pdev, "Allocating shadow register mapping error.\n");
  2255. rc = -ENOMEM;
  2256. goto err_out_unmap;
  2257. }
  2258. if (no_pseudohp) {
  2259. apmc = jread32(jme, JME_APMC) & ~JME_APMC_PSEUDO_HP_EN;
  2260. jwrite32(jme, JME_APMC, apmc);
  2261. } else if (force_pseudohp) {
  2262. apmc = jread32(jme, JME_APMC) | JME_APMC_PSEUDO_HP_EN;
  2263. jwrite32(jme, JME_APMC, apmc);
  2264. }
  2265. NETIF_NAPI_SET(netdev, &jme->napi, jme_poll, jme->rx_ring_size >> 2)
  2266. spin_lock_init(&jme->phy_lock);
  2267. spin_lock_init(&jme->macaddr_lock);
  2268. spin_lock_init(&jme->rxmcs_lock);
  2269. atomic_set(&jme->link_changing, 1);
  2270. atomic_set(&jme->rx_cleaning, 1);
  2271. atomic_set(&jme->tx_cleaning, 1);
  2272. atomic_set(&jme->rx_empty, 1);
  2273. tasklet_init(&jme->pcc_task,
  2274. &jme_pcc_tasklet,
  2275. (unsigned long) jme);
  2276. tasklet_init(&jme->linkch_task,
  2277. &jme_link_change_tasklet,
  2278. (unsigned long) jme);
  2279. tasklet_init(&jme->txclean_task,
  2280. &jme_tx_clean_tasklet,
  2281. (unsigned long) jme);
  2282. tasklet_init(&jme->rxclean_task,
  2283. &jme_rx_clean_tasklet,
  2284. (unsigned long) jme);
  2285. tasklet_init(&jme->rxempty_task,
  2286. &jme_rx_empty_tasklet,
  2287. (unsigned long) jme);
  2288. tasklet_disable_nosync(&jme->txclean_task);
  2289. tasklet_disable_nosync(&jme->rxclean_task);
  2290. tasklet_disable_nosync(&jme->rxempty_task);
  2291. jme->dpi.cur = PCC_P1;
  2292. jme->reg_ghc = 0;
  2293. jme->reg_rxcs = RXCS_DEFAULT;
  2294. jme->reg_rxmcs = RXMCS_DEFAULT;
  2295. jme->reg_txpfc = 0;
  2296. jme->reg_pmcs = PMCS_MFEN;
  2297. set_bit(JME_FLAG_TXCSUM, &jme->flags);
  2298. set_bit(JME_FLAG_TSO, &jme->flags);
  2299. /*
  2300. * Get Max Read Req Size from PCI Config Space
  2301. */
  2302. pci_read_config_byte(pdev, PCI_DCSR_MRRS, &jme->mrrs);
  2303. jme->mrrs &= PCI_DCSR_MRRS_MASK;
  2304. switch (jme->mrrs) {
  2305. case MRRS_128B:
  2306. jme->reg_txcs = TXCS_DEFAULT | TXCS_DMASIZE_128B;
  2307. break;
  2308. case MRRS_256B:
  2309. jme->reg_txcs = TXCS_DEFAULT | TXCS_DMASIZE_256B;
  2310. break;
  2311. default:
  2312. jme->reg_txcs = TXCS_DEFAULT | TXCS_DMASIZE_512B;
  2313. break;
  2314. };
  2315. /*
  2316. * Must check before reset_mac_processor
  2317. */
  2318. jme_check_hw_ver(jme);
  2319. jme->mii_if.dev = netdev;
  2320. if (jme->fpgaver) {
  2321. jme->mii_if.phy_id = 0;
  2322. for (i = 1 ; i < 32 ; ++i) {
  2323. bmcr = jme_mdio_read(netdev, i, MII_BMCR);
  2324. bmsr = jme_mdio_read(netdev, i, MII_BMSR);
  2325. if (bmcr != 0xFFFFU && (bmcr != 0 || bmsr != 0)) {
  2326. jme->mii_if.phy_id = i;
  2327. break;
  2328. }
  2329. }
  2330. if (!jme->mii_if.phy_id) {
  2331. rc = -EIO;
  2332. jeprintk(pdev, "Can not find phy_id.\n");
  2333. goto err_out_free_shadow;
  2334. }
  2335. jme->reg_ghc |= GHC_LINK_POLL;
  2336. } else {
  2337. jme->mii_if.phy_id = 1;
  2338. }
  2339. if (pdev->device == PCI_DEVICE_ID_JMICRON_JMC250)
  2340. jme->mii_if.supports_gmii = true;
  2341. else
  2342. jme->mii_if.supports_gmii = false;
  2343. jme->mii_if.mdio_read = jme_mdio_read;
  2344. jme->mii_if.mdio_write = jme_mdio_write;
  2345. jme_clear_pm(jme);
  2346. jme_set_phyfifoa(jme);
  2347. pci_read_config_byte(pdev, PCI_REVISION_ID, &jme->rev);
  2348. if (!jme->fpgaver)
  2349. jme_phy_init(jme);
  2350. jme_phy_off(jme);
  2351. /*
  2352. * Reset MAC processor and reload EEPROM for MAC Address
  2353. */
  2354. jme_reset_mac_processor(jme);
  2355. rc = jme_reload_eeprom(jme);
  2356. if (rc) {
  2357. jeprintk(pdev,
  2358. "Reload eeprom for reading MAC Address error.\n");
  2359. goto err_out_free_shadow;
  2360. }
  2361. jme_load_macaddr(netdev);
  2362. /*
  2363. * Tell stack that we are not ready to work until open()
  2364. */
  2365. netif_carrier_off(netdev);
  2366. netif_stop_queue(netdev);
  2367. /*
  2368. * Register netdev
  2369. */
  2370. rc = register_netdev(netdev);
  2371. if (rc) {
  2372. jeprintk(pdev, "Cannot register net device.\n");
  2373. goto err_out_free_shadow;
  2374. }
  2375. msg_probe(jme, "JMC250 gigabit%s ver:%x rev:%x macaddr:%pM\n",
  2376. (jme->fpgaver != 0) ? " (FPGA)" : "",
  2377. (jme->fpgaver != 0) ? jme->fpgaver : jme->chiprev,
  2378. jme->rev, netdev->dev_addr);
  2379. return 0;
  2380. err_out_free_shadow:
  2381. pci_free_consistent(pdev,
  2382. sizeof(u32) * SHADOW_REG_NR,
  2383. jme->shadow_regs,
  2384. jme->shadow_dma);
  2385. err_out_unmap:
  2386. iounmap(jme->regs);
  2387. err_out_free_netdev:
  2388. pci_set_drvdata(pdev, NULL);
  2389. free_netdev(netdev);
  2390. err_out_release_regions:
  2391. pci_release_regions(pdev);
  2392. err_out_disable_pdev:
  2393. pci_disable_device(pdev);
  2394. err_out:
  2395. return rc;
  2396. }
  2397. static void __devexit
  2398. jme_remove_one(struct pci_dev *pdev)
  2399. {
  2400. struct net_device *netdev = pci_get_drvdata(pdev);
  2401. struct jme_adapter *jme = netdev_priv(netdev);
  2402. unregister_netdev(netdev);
  2403. pci_free_consistent(pdev,
  2404. sizeof(u32) * SHADOW_REG_NR,
  2405. jme->shadow_regs,
  2406. jme->shadow_dma);
  2407. iounmap(jme->regs);
  2408. pci_set_drvdata(pdev, NULL);
  2409. free_netdev(netdev);
  2410. pci_release_regions(pdev);
  2411. pci_disable_device(pdev);
  2412. }
  2413. #ifdef CONFIG_PM
  2414. static int
  2415. jme_suspend(struct pci_dev *pdev, pm_message_t state)
  2416. {
  2417. struct net_device *netdev = pci_get_drvdata(pdev);
  2418. struct jme_adapter *jme = netdev_priv(netdev);
  2419. atomic_dec(&jme->link_changing);
  2420. netif_device_detach(netdev);
  2421. netif_stop_queue(netdev);
  2422. jme_stop_irq(jme);
  2423. tasklet_disable(&jme->txclean_task);
  2424. tasklet_disable(&jme->rxclean_task);
  2425. tasklet_disable(&jme->rxempty_task);
  2426. jme_disable_shadow(jme);
  2427. if (netif_carrier_ok(netdev)) {
  2428. if (test_bit(JME_FLAG_POLL, &jme->flags))
  2429. jme_polling_mode(jme);
  2430. jme_stop_pcc_timer(jme);
  2431. jme_reset_ghc_speed(jme);
  2432. jme_disable_rx_engine(jme);
  2433. jme_disable_tx_engine(jme);
  2434. jme_reset_mac_processor(jme);
  2435. jme_free_rx_resources(jme);
  2436. jme_free_tx_resources(jme);
  2437. netif_carrier_off(netdev);
  2438. jme->phylink = 0;
  2439. }
  2440. tasklet_enable(&jme->txclean_task);
  2441. tasklet_hi_enable(&jme->rxclean_task);
  2442. tasklet_hi_enable(&jme->rxempty_task);
  2443. pci_save_state(pdev);
  2444. if (jme->reg_pmcs) {
  2445. jme_set_100m_half(jme);
  2446. if (jme->reg_pmcs & (PMCS_LFEN | PMCS_LREN))
  2447. jme_wait_link(jme);
  2448. jwrite32(jme, JME_PMCS, jme->reg_pmcs);
  2449. pci_enable_wake(pdev, PCI_D3cold, true);
  2450. } else {
  2451. jme_phy_off(jme);
  2452. }
  2453. pci_set_power_state(pdev, PCI_D3cold);
  2454. return 0;
  2455. }
  2456. static int
  2457. jme_resume(struct pci_dev *pdev)
  2458. {
  2459. struct net_device *netdev = pci_get_drvdata(pdev);
  2460. struct jme_adapter *jme = netdev_priv(netdev);
  2461. jme_clear_pm(jme);
  2462. pci_restore_state(pdev);
  2463. if (test_bit(JME_FLAG_SSET, &jme->flags))
  2464. jme_set_settings(netdev, &jme->old_ecmd);
  2465. else
  2466. jme_reset_phy_processor(jme);
  2467. jme_enable_shadow(jme);
  2468. jme_start_irq(jme);
  2469. netif_device_attach(netdev);
  2470. atomic_inc(&jme->link_changing);
  2471. jme_reset_link(jme);
  2472. return 0;
  2473. }
  2474. #endif
  2475. static struct pci_device_id jme_pci_tbl[] = {
  2476. { PCI_VDEVICE(JMICRON, PCI_DEVICE_ID_JMICRON_JMC250) },
  2477. { PCI_VDEVICE(JMICRON, PCI_DEVICE_ID_JMICRON_JMC260) },
  2478. { }
  2479. };
  2480. static struct pci_driver jme_driver = {
  2481. .name = DRV_NAME,
  2482. .id_table = jme_pci_tbl,
  2483. .probe = jme_init_one,
  2484. .remove = __devexit_p(jme_remove_one),
  2485. #ifdef CONFIG_PM
  2486. .suspend = jme_suspend,
  2487. .resume = jme_resume,
  2488. #endif /* CONFIG_PM */
  2489. };
  2490. static int __init
  2491. jme_init_module(void)
  2492. {
  2493. printk(KERN_INFO PFX "JMicron JMC250 gigabit ethernet "
  2494. "driver version %s\n", DRV_VERSION);
  2495. return pci_register_driver(&jme_driver);
  2496. }
  2497. static void __exit
  2498. jme_cleanup_module(void)
  2499. {
  2500. pci_unregister_driver(&jme_driver);
  2501. }
  2502. module_init(jme_init_module);
  2503. module_exit(jme_cleanup_module);
  2504. MODULE_AUTHOR("Guo-Fu Tseng <cooldavid@cooldavid.org>");
  2505. MODULE_DESCRIPTION("JMicron JMC2x0 PCI Express Ethernet driver");
  2506. MODULE_LICENSE("GPL");
  2507. MODULE_VERSION(DRV_VERSION);
  2508. MODULE_DEVICE_TABLE(pci, jme_pci_tbl);