jme.c 66 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413241424152416241724182419242024212422242324242425242624272428242924302431243224332434243524362437243824392440244124422443244424452446244724482449245024512452245324542455245624572458245924602461246224632464246524662467246824692470247124722473247424752476247724782479248024812482248324842485248624872488248924902491249224932494249524962497249824992500250125022503250425052506250725082509251025112512251325142515251625172518251925202521252225232524252525262527252825292530253125322533253425352536253725382539254025412542254325442545254625472548254925502551255225532554255525562557255825592560256125622563256425652566256725682569257025712572257325742575257625772578257925802581258225832584258525862587258825892590259125922593259425952596259725982599260026012602260326042605260626072608260926102611261226132614261526162617261826192620262126222623262426252626262726282629263026312632263326342635263626372638263926402641264226432644264526462647264826492650265126522653265426552656265726582659266026612662266326642665266626672668266926702671267226732674267526762677267826792680268126822683268426852686268726882689269026912692269326942695269626972698269927002701270227032704270527062707270827092710271127122713271427152716271727182719272027212722272327242725272627272728272927302731273227332734273527362737273827392740274127422743274427452746274727482749275027512752275327542755275627572758275927602761276227632764276527662767276827692770277127722773277427752776277727782779278027812782278327842785278627872788278927902791279227932794279527962797279827992800280128022803280428052806280728082809281028112812281328142815281628172818281928202821282228232824282528262827282828292830283128322833283428352836283728382839284028412842284328442845284628472848284928502851285228532854285528562857285828592860286128622863286428652866286728682869287028712872287328742875287628772878287928802881288228832884288528862887288828892890289128922893289428952896289728982899290029012902290329042905290629072908290929102911291229132914291529162917291829192920292129222923292429252926292729282929293029312932293329342935293629372938293929402941294229432944294529462947294829492950295129522953295429552956295729582959296029612962296329642965296629672968296929702971297229732974297529762977297829792980298129822983298429852986298729882989299029912992299329942995299629972998299930003001300230033004300530063007300830093010301130123013301430153016301730183019302030213022302330243025
  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. --limit;
  825. desccnt = rxdesc->descwb.desccnt & RXWBDCNT_DCNT;
  826. if (unlikely(desccnt > 1 ||
  827. rxdesc->descwb.errstat & RXWBERR_ALLERR)) {
  828. if (rxdesc->descwb.errstat & RXWBERR_CRCERR)
  829. ++(NET_STAT(jme).rx_crc_errors);
  830. else if (rxdesc->descwb.errstat & RXWBERR_OVERUN)
  831. ++(NET_STAT(jme).rx_fifo_errors);
  832. else
  833. ++(NET_STAT(jme).rx_errors);
  834. if (desccnt > 1)
  835. limit -= desccnt - 1;
  836. for (j = i, ccnt = desccnt ; ccnt-- ; ) {
  837. jme_set_clean_rxdesc(jme, j);
  838. j = (j + 1) & (mask);
  839. }
  840. } else {
  841. jme_alloc_and_feed_skb(jme, i);
  842. }
  843. i = (i + desccnt) & (mask);
  844. }
  845. out:
  846. atomic_set(&rxring->next_to_clean, i);
  847. out_inc:
  848. atomic_inc(&jme->rx_cleaning);
  849. return limit > 0 ? limit : 0;
  850. }
  851. static void
  852. jme_attempt_pcc(struct dynpcc_info *dpi, int atmp)
  853. {
  854. if (likely(atmp == dpi->cur)) {
  855. dpi->cnt = 0;
  856. return;
  857. }
  858. if (dpi->attempt == atmp) {
  859. ++(dpi->cnt);
  860. } else {
  861. dpi->attempt = atmp;
  862. dpi->cnt = 0;
  863. }
  864. }
  865. static void
  866. jme_dynamic_pcc(struct jme_adapter *jme)
  867. {
  868. register struct dynpcc_info *dpi = &(jme->dpi);
  869. if ((NET_STAT(jme).rx_bytes - dpi->last_bytes) > PCC_P3_THRESHOLD)
  870. jme_attempt_pcc(dpi, PCC_P3);
  871. else if ((NET_STAT(jme).rx_packets - dpi->last_pkts) > PCC_P2_THRESHOLD
  872. || dpi->intr_cnt > PCC_INTR_THRESHOLD)
  873. jme_attempt_pcc(dpi, PCC_P2);
  874. else
  875. jme_attempt_pcc(dpi, PCC_P1);
  876. if (unlikely(dpi->attempt != dpi->cur && dpi->cnt > 5)) {
  877. if (dpi->attempt < dpi->cur)
  878. tasklet_schedule(&jme->rxclean_task);
  879. jme_set_rx_pcc(jme, dpi->attempt);
  880. dpi->cur = dpi->attempt;
  881. dpi->cnt = 0;
  882. }
  883. }
  884. static void
  885. jme_start_pcc_timer(struct jme_adapter *jme)
  886. {
  887. struct dynpcc_info *dpi = &(jme->dpi);
  888. dpi->last_bytes = NET_STAT(jme).rx_bytes;
  889. dpi->last_pkts = NET_STAT(jme).rx_packets;
  890. dpi->intr_cnt = 0;
  891. jwrite32(jme, JME_TMCSR,
  892. TMCSR_EN | ((0xFFFFFF - PCC_INTERVAL_US) & TMCSR_CNT));
  893. }
  894. static inline void
  895. jme_stop_pcc_timer(struct jme_adapter *jme)
  896. {
  897. jwrite32(jme, JME_TMCSR, 0);
  898. }
  899. static void
  900. jme_shutdown_nic(struct jme_adapter *jme)
  901. {
  902. u32 phylink;
  903. phylink = jme_linkstat_from_phy(jme);
  904. if (!(phylink & PHY_LINK_UP)) {
  905. /*
  906. * Disable all interrupt before issue timer
  907. */
  908. jme_stop_irq(jme);
  909. jwrite32(jme, JME_TIMER2, TMCSR_EN | 0xFFFFFE);
  910. }
  911. }
  912. static void
  913. jme_pcc_tasklet(unsigned long arg)
  914. {
  915. struct jme_adapter *jme = (struct jme_adapter *)arg;
  916. struct net_device *netdev = jme->dev;
  917. if (unlikely(test_bit(JME_FLAG_SHUTDOWN, &jme->flags))) {
  918. jme_shutdown_nic(jme);
  919. return;
  920. }
  921. if (unlikely(!netif_carrier_ok(netdev) ||
  922. (atomic_read(&jme->link_changing) != 1)
  923. )) {
  924. jme_stop_pcc_timer(jme);
  925. return;
  926. }
  927. if (!(test_bit(JME_FLAG_POLL, &jme->flags)))
  928. jme_dynamic_pcc(jme);
  929. jme_start_pcc_timer(jme);
  930. }
  931. static inline void
  932. jme_polling_mode(struct jme_adapter *jme)
  933. {
  934. jme_set_rx_pcc(jme, PCC_OFF);
  935. }
  936. static inline void
  937. jme_interrupt_mode(struct jme_adapter *jme)
  938. {
  939. jme_set_rx_pcc(jme, PCC_P1);
  940. }
  941. static inline int
  942. jme_pseudo_hotplug_enabled(struct jme_adapter *jme)
  943. {
  944. u32 apmc;
  945. apmc = jread32(jme, JME_APMC);
  946. return apmc & JME_APMC_PSEUDO_HP_EN;
  947. }
  948. static void
  949. jme_start_shutdown_timer(struct jme_adapter *jme)
  950. {
  951. u32 apmc;
  952. apmc = jread32(jme, JME_APMC) | JME_APMC_PCIE_SD_EN;
  953. apmc &= ~JME_APMC_EPIEN_CTRL;
  954. if (!no_extplug) {
  955. jwrite32f(jme, JME_APMC, apmc | JME_APMC_EPIEN_CTRL_EN);
  956. wmb();
  957. }
  958. jwrite32f(jme, JME_APMC, apmc);
  959. jwrite32f(jme, JME_TIMER2, 0);
  960. set_bit(JME_FLAG_SHUTDOWN, &jme->flags);
  961. jwrite32(jme, JME_TMCSR,
  962. TMCSR_EN | ((0xFFFFFF - APMC_PHP_SHUTDOWN_DELAY) & TMCSR_CNT));
  963. }
  964. static void
  965. jme_stop_shutdown_timer(struct jme_adapter *jme)
  966. {
  967. u32 apmc;
  968. jwrite32f(jme, JME_TMCSR, 0);
  969. jwrite32f(jme, JME_TIMER2, 0);
  970. clear_bit(JME_FLAG_SHUTDOWN, &jme->flags);
  971. apmc = jread32(jme, JME_APMC);
  972. apmc &= ~(JME_APMC_PCIE_SD_EN | JME_APMC_EPIEN_CTRL);
  973. jwrite32f(jme, JME_APMC, apmc | JME_APMC_EPIEN_CTRL_DIS);
  974. wmb();
  975. jwrite32f(jme, JME_APMC, apmc);
  976. }
  977. static void
  978. jme_link_change_tasklet(unsigned long arg)
  979. {
  980. struct jme_adapter *jme = (struct jme_adapter *)arg;
  981. struct net_device *netdev = jme->dev;
  982. int rc;
  983. while (!atomic_dec_and_test(&jme->link_changing)) {
  984. atomic_inc(&jme->link_changing);
  985. msg_intr(jme, "Get link change lock failed.\n");
  986. while (atomic_read(&jme->link_changing) != 1)
  987. msg_intr(jme, "Waiting link change lock.\n");
  988. }
  989. if (jme_check_link(netdev, 1) && jme->old_mtu == netdev->mtu)
  990. goto out;
  991. jme->old_mtu = netdev->mtu;
  992. netif_stop_queue(netdev);
  993. if (jme_pseudo_hotplug_enabled(jme))
  994. jme_stop_shutdown_timer(jme);
  995. jme_stop_pcc_timer(jme);
  996. tasklet_disable(&jme->txclean_task);
  997. tasklet_disable(&jme->rxclean_task);
  998. tasklet_disable(&jme->rxempty_task);
  999. if (netif_carrier_ok(netdev)) {
  1000. jme_reset_ghc_speed(jme);
  1001. jme_disable_rx_engine(jme);
  1002. jme_disable_tx_engine(jme);
  1003. jme_reset_mac_processor(jme);
  1004. jme_free_rx_resources(jme);
  1005. jme_free_tx_resources(jme);
  1006. if (test_bit(JME_FLAG_POLL, &jme->flags))
  1007. jme_polling_mode(jme);
  1008. netif_carrier_off(netdev);
  1009. }
  1010. jme_check_link(netdev, 0);
  1011. if (netif_carrier_ok(netdev)) {
  1012. rc = jme_setup_rx_resources(jme);
  1013. if (rc) {
  1014. jeprintk(jme->pdev, "Allocating resources for RX error"
  1015. ", Device STOPPED!\n");
  1016. goto out_enable_tasklet;
  1017. }
  1018. rc = jme_setup_tx_resources(jme);
  1019. if (rc) {
  1020. jeprintk(jme->pdev, "Allocating resources for TX error"
  1021. ", Device STOPPED!\n");
  1022. goto err_out_free_rx_resources;
  1023. }
  1024. jme_enable_rx_engine(jme);
  1025. jme_enable_tx_engine(jme);
  1026. netif_start_queue(netdev);
  1027. if (test_bit(JME_FLAG_POLL, &jme->flags))
  1028. jme_interrupt_mode(jme);
  1029. jme_start_pcc_timer(jme);
  1030. } else if (jme_pseudo_hotplug_enabled(jme)) {
  1031. jme_start_shutdown_timer(jme);
  1032. }
  1033. goto out_enable_tasklet;
  1034. err_out_free_rx_resources:
  1035. jme_free_rx_resources(jme);
  1036. out_enable_tasklet:
  1037. tasklet_enable(&jme->txclean_task);
  1038. tasklet_hi_enable(&jme->rxclean_task);
  1039. tasklet_hi_enable(&jme->rxempty_task);
  1040. out:
  1041. atomic_inc(&jme->link_changing);
  1042. }
  1043. static void
  1044. jme_rx_clean_tasklet(unsigned long arg)
  1045. {
  1046. struct jme_adapter *jme = (struct jme_adapter *)arg;
  1047. struct dynpcc_info *dpi = &(jme->dpi);
  1048. jme_process_receive(jme, jme->rx_ring_size);
  1049. ++(dpi->intr_cnt);
  1050. }
  1051. static int
  1052. jme_poll(JME_NAPI_HOLDER(holder), JME_NAPI_WEIGHT(budget))
  1053. {
  1054. struct jme_adapter *jme = jme_napi_priv(holder);
  1055. int rest;
  1056. rest = jme_process_receive(jme, JME_NAPI_WEIGHT_VAL(budget));
  1057. while (atomic_read(&jme->rx_empty) > 0) {
  1058. atomic_dec(&jme->rx_empty);
  1059. ++(NET_STAT(jme).rx_dropped);
  1060. jme_restart_rx_engine(jme);
  1061. }
  1062. atomic_inc(&jme->rx_empty);
  1063. if (rest) {
  1064. JME_RX_COMPLETE(netdev, holder);
  1065. jme_interrupt_mode(jme);
  1066. }
  1067. JME_NAPI_WEIGHT_SET(budget, rest);
  1068. return JME_NAPI_WEIGHT_VAL(budget) - rest;
  1069. }
  1070. static void
  1071. jme_rx_empty_tasklet(unsigned long arg)
  1072. {
  1073. struct jme_adapter *jme = (struct jme_adapter *)arg;
  1074. if (unlikely(atomic_read(&jme->link_changing) != 1))
  1075. return;
  1076. if (unlikely(!netif_carrier_ok(jme->dev)))
  1077. return;
  1078. msg_rx_status(jme, "RX Queue Full!\n");
  1079. jme_rx_clean_tasklet(arg);
  1080. while (atomic_read(&jme->rx_empty) > 0) {
  1081. atomic_dec(&jme->rx_empty);
  1082. ++(NET_STAT(jme).rx_dropped);
  1083. jme_restart_rx_engine(jme);
  1084. }
  1085. atomic_inc(&jme->rx_empty);
  1086. }
  1087. static void
  1088. jme_wake_queue_if_stopped(struct jme_adapter *jme)
  1089. {
  1090. struct jme_ring *txring = jme->txring;
  1091. smp_wmb();
  1092. if (unlikely(netif_queue_stopped(jme->dev) &&
  1093. atomic_read(&txring->nr_free) >= (jme->tx_wake_threshold))) {
  1094. msg_tx_done(jme, "TX Queue Waked.\n");
  1095. netif_wake_queue(jme->dev);
  1096. }
  1097. }
  1098. static void
  1099. jme_tx_clean_tasklet(unsigned long arg)
  1100. {
  1101. struct jme_adapter *jme = (struct jme_adapter *)arg;
  1102. struct jme_ring *txring = &(jme->txring[0]);
  1103. struct txdesc *txdesc = txring->desc;
  1104. struct jme_buffer_info *txbi = txring->bufinf, *ctxbi, *ttxbi;
  1105. int i, j, cnt = 0, max, err, mask;
  1106. tx_dbg(jme, "Into txclean.\n");
  1107. if (unlikely(!atomic_dec_and_test(&jme->tx_cleaning)))
  1108. goto out;
  1109. if (unlikely(atomic_read(&jme->link_changing) != 1))
  1110. goto out;
  1111. if (unlikely(!netif_carrier_ok(jme->dev)))
  1112. goto out;
  1113. max = jme->tx_ring_size - atomic_read(&txring->nr_free);
  1114. mask = jme->tx_ring_mask;
  1115. for (i = atomic_read(&txring->next_to_clean) ; cnt < max ; ) {
  1116. ctxbi = txbi + i;
  1117. if (likely(ctxbi->skb &&
  1118. !(txdesc[i].descwb.flags & TXWBFLAG_OWN))) {
  1119. tx_dbg(jme, "txclean: %d+%d@%lu\n",
  1120. i, ctxbi->nr_desc, jiffies);
  1121. err = txdesc[i].descwb.flags & TXWBFLAG_ALLERR;
  1122. for (j = 1 ; j < ctxbi->nr_desc ; ++j) {
  1123. ttxbi = txbi + ((i + j) & (mask));
  1124. txdesc[(i + j) & (mask)].dw[0] = 0;
  1125. pci_unmap_page(jme->pdev,
  1126. ttxbi->mapping,
  1127. ttxbi->len,
  1128. PCI_DMA_TODEVICE);
  1129. ttxbi->mapping = 0;
  1130. ttxbi->len = 0;
  1131. }
  1132. dev_kfree_skb(ctxbi->skb);
  1133. cnt += ctxbi->nr_desc;
  1134. if (unlikely(err)) {
  1135. ++(NET_STAT(jme).tx_carrier_errors);
  1136. } else {
  1137. ++(NET_STAT(jme).tx_packets);
  1138. NET_STAT(jme).tx_bytes += ctxbi->len;
  1139. }
  1140. ctxbi->skb = NULL;
  1141. ctxbi->len = 0;
  1142. ctxbi->start_xmit = 0;
  1143. } else {
  1144. break;
  1145. }
  1146. i = (i + ctxbi->nr_desc) & mask;
  1147. ctxbi->nr_desc = 0;
  1148. }
  1149. tx_dbg(jme, "txclean: done %d@%lu.\n", i, jiffies);
  1150. atomic_set(&txring->next_to_clean, i);
  1151. atomic_add(cnt, &txring->nr_free);
  1152. jme_wake_queue_if_stopped(jme);
  1153. out:
  1154. atomic_inc(&jme->tx_cleaning);
  1155. }
  1156. static void
  1157. jme_intr_msi(struct jme_adapter *jme, u32 intrstat)
  1158. {
  1159. /*
  1160. * Disable interrupt
  1161. */
  1162. jwrite32f(jme, JME_IENC, INTR_ENABLE);
  1163. if (intrstat & (INTR_LINKCH | INTR_SWINTR)) {
  1164. /*
  1165. * Link change event is critical
  1166. * all other events are ignored
  1167. */
  1168. jwrite32(jme, JME_IEVE, intrstat);
  1169. tasklet_schedule(&jme->linkch_task);
  1170. goto out_reenable;
  1171. }
  1172. if (intrstat & INTR_TMINTR) {
  1173. jwrite32(jme, JME_IEVE, INTR_TMINTR);
  1174. tasklet_schedule(&jme->pcc_task);
  1175. }
  1176. if (intrstat & (INTR_PCCTXTO | INTR_PCCTX)) {
  1177. jwrite32(jme, JME_IEVE, INTR_PCCTXTO | INTR_PCCTX | INTR_TX0);
  1178. tasklet_schedule(&jme->txclean_task);
  1179. }
  1180. if ((intrstat & (INTR_PCCRX0TO | INTR_PCCRX0 | INTR_RX0EMP))) {
  1181. jwrite32(jme, JME_IEVE, (intrstat & (INTR_PCCRX0TO |
  1182. INTR_PCCRX0 |
  1183. INTR_RX0EMP)) |
  1184. INTR_RX0);
  1185. }
  1186. if (test_bit(JME_FLAG_POLL, &jme->flags)) {
  1187. if (intrstat & INTR_RX0EMP)
  1188. atomic_inc(&jme->rx_empty);
  1189. if ((intrstat & (INTR_PCCRX0TO | INTR_PCCRX0 | INTR_RX0EMP))) {
  1190. if (likely(JME_RX_SCHEDULE_PREP(jme))) {
  1191. jme_polling_mode(jme);
  1192. JME_RX_SCHEDULE(jme);
  1193. }
  1194. }
  1195. } else {
  1196. if (intrstat & INTR_RX0EMP) {
  1197. atomic_inc(&jme->rx_empty);
  1198. tasklet_hi_schedule(&jme->rxempty_task);
  1199. } else if (intrstat & (INTR_PCCRX0TO | INTR_PCCRX0)) {
  1200. tasklet_hi_schedule(&jme->rxclean_task);
  1201. }
  1202. }
  1203. out_reenable:
  1204. /*
  1205. * Re-enable interrupt
  1206. */
  1207. jwrite32f(jme, JME_IENS, INTR_ENABLE);
  1208. }
  1209. static irqreturn_t
  1210. jme_intr(int irq, void *dev_id)
  1211. {
  1212. struct net_device *netdev = dev_id;
  1213. struct jme_adapter *jme = netdev_priv(netdev);
  1214. u32 intrstat;
  1215. intrstat = jread32(jme, JME_IEVE);
  1216. /*
  1217. * Check if it's really an interrupt for us
  1218. */
  1219. if (unlikely((intrstat & INTR_ENABLE) == 0))
  1220. return IRQ_NONE;
  1221. /*
  1222. * Check if the device still exist
  1223. */
  1224. if (unlikely(intrstat == ~((typeof(intrstat))0)))
  1225. return IRQ_NONE;
  1226. jme_intr_msi(jme, intrstat);
  1227. return IRQ_HANDLED;
  1228. }
  1229. static irqreturn_t
  1230. jme_msi(int irq, void *dev_id)
  1231. {
  1232. struct net_device *netdev = dev_id;
  1233. struct jme_adapter *jme = netdev_priv(netdev);
  1234. u32 intrstat;
  1235. pci_dma_sync_single_for_cpu(jme->pdev,
  1236. jme->shadow_dma,
  1237. sizeof(u32) * SHADOW_REG_NR,
  1238. PCI_DMA_FROMDEVICE);
  1239. intrstat = jme->shadow_regs[SHADOW_IEVE];
  1240. jme->shadow_regs[SHADOW_IEVE] = 0;
  1241. jme_intr_msi(jme, intrstat);
  1242. return IRQ_HANDLED;
  1243. }
  1244. static void
  1245. jme_reset_link(struct jme_adapter *jme)
  1246. {
  1247. jwrite32(jme, JME_TMCSR, TMCSR_SWIT);
  1248. }
  1249. static void
  1250. jme_restart_an(struct jme_adapter *jme)
  1251. {
  1252. u32 bmcr;
  1253. spin_lock_bh(&jme->phy_lock);
  1254. bmcr = jme_mdio_read(jme->dev, jme->mii_if.phy_id, MII_BMCR);
  1255. bmcr |= (BMCR_ANENABLE | BMCR_ANRESTART);
  1256. jme_mdio_write(jme->dev, jme->mii_if.phy_id, MII_BMCR, bmcr);
  1257. spin_unlock_bh(&jme->phy_lock);
  1258. }
  1259. static int
  1260. jme_request_irq(struct jme_adapter *jme)
  1261. {
  1262. int rc;
  1263. struct net_device *netdev = jme->dev;
  1264. irq_handler_t handler = jme_intr;
  1265. int irq_flags = IRQF_SHARED;
  1266. if (!pci_enable_msi(jme->pdev)) {
  1267. set_bit(JME_FLAG_MSI, &jme->flags);
  1268. handler = jme_msi;
  1269. irq_flags = 0;
  1270. }
  1271. rc = request_irq(jme->pdev->irq, handler, irq_flags, netdev->name,
  1272. netdev);
  1273. if (rc) {
  1274. jeprintk(jme->pdev,
  1275. "Unable to request %s interrupt (return: %d)\n",
  1276. test_bit(JME_FLAG_MSI, &jme->flags) ? "MSI" : "INTx",
  1277. rc);
  1278. if (test_bit(JME_FLAG_MSI, &jme->flags)) {
  1279. pci_disable_msi(jme->pdev);
  1280. clear_bit(JME_FLAG_MSI, &jme->flags);
  1281. }
  1282. } else {
  1283. netdev->irq = jme->pdev->irq;
  1284. }
  1285. return rc;
  1286. }
  1287. static void
  1288. jme_free_irq(struct jme_adapter *jme)
  1289. {
  1290. free_irq(jme->pdev->irq, jme->dev);
  1291. if (test_bit(JME_FLAG_MSI, &jme->flags)) {
  1292. pci_disable_msi(jme->pdev);
  1293. clear_bit(JME_FLAG_MSI, &jme->flags);
  1294. jme->dev->irq = jme->pdev->irq;
  1295. }
  1296. }
  1297. static int
  1298. jme_open(struct net_device *netdev)
  1299. {
  1300. struct jme_adapter *jme = netdev_priv(netdev);
  1301. int rc;
  1302. jme_clear_pm(jme);
  1303. JME_NAPI_ENABLE(jme);
  1304. tasklet_enable(&jme->txclean_task);
  1305. tasklet_hi_enable(&jme->rxclean_task);
  1306. tasklet_hi_enable(&jme->rxempty_task);
  1307. rc = jme_request_irq(jme);
  1308. if (rc)
  1309. goto err_out;
  1310. jme_enable_shadow(jme);
  1311. jme_start_irq(jme);
  1312. if (test_bit(JME_FLAG_SSET, &jme->flags))
  1313. jme_set_settings(netdev, &jme->old_ecmd);
  1314. else
  1315. jme_reset_phy_processor(jme);
  1316. jme_reset_link(jme);
  1317. return 0;
  1318. err_out:
  1319. netif_stop_queue(netdev);
  1320. netif_carrier_off(netdev);
  1321. return rc;
  1322. }
  1323. #ifdef CONFIG_PM
  1324. static void
  1325. jme_set_100m_half(struct jme_adapter *jme)
  1326. {
  1327. u32 bmcr, tmp;
  1328. bmcr = jme_mdio_read(jme->dev, jme->mii_if.phy_id, MII_BMCR);
  1329. tmp = bmcr & ~(BMCR_ANENABLE | BMCR_SPEED100 |
  1330. BMCR_SPEED1000 | BMCR_FULLDPLX);
  1331. tmp |= BMCR_SPEED100;
  1332. if (bmcr != tmp)
  1333. jme_mdio_write(jme->dev, jme->mii_if.phy_id, MII_BMCR, tmp);
  1334. if (jme->fpgaver)
  1335. jwrite32(jme, JME_GHC, GHC_SPEED_100M | GHC_LINK_POLL);
  1336. else
  1337. jwrite32(jme, JME_GHC, GHC_SPEED_100M);
  1338. }
  1339. #define JME_WAIT_LINK_TIME 2000 /* 2000ms */
  1340. static void
  1341. jme_wait_link(struct jme_adapter *jme)
  1342. {
  1343. u32 phylink, to = JME_WAIT_LINK_TIME;
  1344. mdelay(1000);
  1345. phylink = jme_linkstat_from_phy(jme);
  1346. while (!(phylink & PHY_LINK_UP) && (to -= 10) > 0) {
  1347. mdelay(10);
  1348. phylink = jme_linkstat_from_phy(jme);
  1349. }
  1350. }
  1351. #endif
  1352. static inline void
  1353. jme_phy_off(struct jme_adapter *jme)
  1354. {
  1355. jme_mdio_write(jme->dev, jme->mii_if.phy_id, MII_BMCR, BMCR_PDOWN);
  1356. }
  1357. static int
  1358. jme_close(struct net_device *netdev)
  1359. {
  1360. struct jme_adapter *jme = netdev_priv(netdev);
  1361. netif_stop_queue(netdev);
  1362. netif_carrier_off(netdev);
  1363. jme_stop_irq(jme);
  1364. jme_disable_shadow(jme);
  1365. jme_free_irq(jme);
  1366. JME_NAPI_DISABLE(jme);
  1367. tasklet_kill(&jme->linkch_task);
  1368. tasklet_kill(&jme->txclean_task);
  1369. tasklet_kill(&jme->rxclean_task);
  1370. tasklet_kill(&jme->rxempty_task);
  1371. jme_reset_ghc_speed(jme);
  1372. jme_disable_rx_engine(jme);
  1373. jme_disable_tx_engine(jme);
  1374. jme_reset_mac_processor(jme);
  1375. jme_free_rx_resources(jme);
  1376. jme_free_tx_resources(jme);
  1377. jme->phylink = 0;
  1378. jme_phy_off(jme);
  1379. return 0;
  1380. }
  1381. static int
  1382. jme_alloc_txdesc(struct jme_adapter *jme,
  1383. struct sk_buff *skb)
  1384. {
  1385. struct jme_ring *txring = jme->txring;
  1386. int idx, nr_alloc, mask = jme->tx_ring_mask;
  1387. idx = txring->next_to_use;
  1388. nr_alloc = skb_shinfo(skb)->nr_frags + 2;
  1389. if (unlikely(atomic_read(&txring->nr_free) < nr_alloc))
  1390. return -1;
  1391. atomic_sub(nr_alloc, &txring->nr_free);
  1392. txring->next_to_use = (txring->next_to_use + nr_alloc) & mask;
  1393. return idx;
  1394. }
  1395. static void
  1396. jme_fill_tx_map(struct pci_dev *pdev,
  1397. struct txdesc *txdesc,
  1398. struct jme_buffer_info *txbi,
  1399. struct page *page,
  1400. u32 page_offset,
  1401. u32 len,
  1402. u8 hidma)
  1403. {
  1404. dma_addr_t dmaaddr;
  1405. dmaaddr = pci_map_page(pdev,
  1406. page,
  1407. page_offset,
  1408. len,
  1409. PCI_DMA_TODEVICE);
  1410. pci_dma_sync_single_for_device(pdev,
  1411. dmaaddr,
  1412. len,
  1413. PCI_DMA_TODEVICE);
  1414. txdesc->dw[0] = 0;
  1415. txdesc->dw[1] = 0;
  1416. txdesc->desc2.flags = TXFLAG_OWN;
  1417. txdesc->desc2.flags |= (hidma) ? TXFLAG_64BIT : 0;
  1418. txdesc->desc2.datalen = cpu_to_le16(len);
  1419. txdesc->desc2.bufaddrh = cpu_to_le32((__u64)dmaaddr >> 32);
  1420. txdesc->desc2.bufaddrl = cpu_to_le32(
  1421. (__u64)dmaaddr & 0xFFFFFFFFUL);
  1422. txbi->mapping = dmaaddr;
  1423. txbi->len = len;
  1424. }
  1425. static void
  1426. jme_map_tx_skb(struct jme_adapter *jme, struct sk_buff *skb, int idx)
  1427. {
  1428. struct jme_ring *txring = jme->txring;
  1429. struct txdesc *txdesc = txring->desc, *ctxdesc;
  1430. struct jme_buffer_info *txbi = txring->bufinf, *ctxbi;
  1431. u8 hidma = jme->dev->features & NETIF_F_HIGHDMA;
  1432. int i, nr_frags = skb_shinfo(skb)->nr_frags;
  1433. int mask = jme->tx_ring_mask;
  1434. struct skb_frag_struct *frag;
  1435. u32 len;
  1436. for (i = 0 ; i < nr_frags ; ++i) {
  1437. frag = &skb_shinfo(skb)->frags[i];
  1438. ctxdesc = txdesc + ((idx + i + 2) & (mask));
  1439. ctxbi = txbi + ((idx + i + 2) & (mask));
  1440. jme_fill_tx_map(jme->pdev, ctxdesc, ctxbi, frag->page,
  1441. frag->page_offset, frag->size, hidma);
  1442. }
  1443. len = skb_is_nonlinear(skb) ? skb_headlen(skb) : skb->len;
  1444. ctxdesc = txdesc + ((idx + 1) & (mask));
  1445. ctxbi = txbi + ((idx + 1) & (mask));
  1446. jme_fill_tx_map(jme->pdev, ctxdesc, ctxbi, virt_to_page(skb->data),
  1447. offset_in_page(skb->data), len, hidma);
  1448. }
  1449. static int
  1450. jme_expand_header(struct jme_adapter *jme, struct sk_buff *skb)
  1451. {
  1452. if (unlikely(skb_shinfo(skb)->gso_size &&
  1453. skb_header_cloned(skb) &&
  1454. pskb_expand_head(skb, 0, 0, GFP_ATOMIC))) {
  1455. dev_kfree_skb(skb);
  1456. return -1;
  1457. }
  1458. return 0;
  1459. }
  1460. static int
  1461. jme_tx_tso(struct sk_buff *skb, __le16 *mss, u8 *flags)
  1462. {
  1463. *mss = cpu_to_le16(skb_shinfo(skb)->gso_size << TXDESC_MSS_SHIFT);
  1464. if (*mss) {
  1465. *flags |= TXFLAG_LSEN;
  1466. if (skb->protocol == htons(ETH_P_IP)) {
  1467. struct iphdr *iph = ip_hdr(skb);
  1468. iph->check = 0;
  1469. tcp_hdr(skb)->check = ~csum_tcpudp_magic(iph->saddr,
  1470. iph->daddr, 0,
  1471. IPPROTO_TCP,
  1472. 0);
  1473. } else {
  1474. struct ipv6hdr *ip6h = ipv6_hdr(skb);
  1475. tcp_hdr(skb)->check = ~csum_ipv6_magic(&ip6h->saddr,
  1476. &ip6h->daddr, 0,
  1477. IPPROTO_TCP,
  1478. 0);
  1479. }
  1480. return 0;
  1481. }
  1482. return 1;
  1483. }
  1484. static void
  1485. jme_tx_csum(struct jme_adapter *jme, struct sk_buff *skb, u8 *flags)
  1486. {
  1487. if (skb->ip_summed == CHECKSUM_PARTIAL) {
  1488. u8 ip_proto;
  1489. switch (skb->protocol) {
  1490. case htons(ETH_P_IP):
  1491. ip_proto = ip_hdr(skb)->protocol;
  1492. break;
  1493. case htons(ETH_P_IPV6):
  1494. ip_proto = ipv6_hdr(skb)->nexthdr;
  1495. break;
  1496. default:
  1497. ip_proto = 0;
  1498. break;
  1499. }
  1500. switch (ip_proto) {
  1501. case IPPROTO_TCP:
  1502. *flags |= TXFLAG_TCPCS;
  1503. break;
  1504. case IPPROTO_UDP:
  1505. *flags |= TXFLAG_UDPCS;
  1506. break;
  1507. default:
  1508. msg_tx_err(jme, "Error upper layer protocol.\n");
  1509. break;
  1510. }
  1511. }
  1512. }
  1513. static inline void
  1514. jme_tx_vlan(struct sk_buff *skb, __le16 *vlan, u8 *flags)
  1515. {
  1516. if (vlan_tx_tag_present(skb)) {
  1517. *flags |= TXFLAG_TAGON;
  1518. *vlan = cpu_to_le16(vlan_tx_tag_get(skb));
  1519. }
  1520. }
  1521. static int
  1522. jme_fill_first_tx_desc(struct jme_adapter *jme, struct sk_buff *skb, int idx)
  1523. {
  1524. struct jme_ring *txring = jme->txring;
  1525. struct txdesc *txdesc;
  1526. struct jme_buffer_info *txbi;
  1527. u8 flags;
  1528. txdesc = (struct txdesc *)txring->desc + idx;
  1529. txbi = txring->bufinf + idx;
  1530. txdesc->dw[0] = 0;
  1531. txdesc->dw[1] = 0;
  1532. txdesc->dw[2] = 0;
  1533. txdesc->dw[3] = 0;
  1534. txdesc->desc1.pktsize = cpu_to_le16(skb->len);
  1535. /*
  1536. * Set OWN bit at final.
  1537. * When kernel transmit faster than NIC.
  1538. * And NIC trying to send this descriptor before we tell
  1539. * it to start sending this TX queue.
  1540. * Other fields are already filled correctly.
  1541. */
  1542. wmb();
  1543. flags = TXFLAG_OWN | TXFLAG_INT;
  1544. /*
  1545. * Set checksum flags while not tso
  1546. */
  1547. if (jme_tx_tso(skb, &txdesc->desc1.mss, &flags))
  1548. jme_tx_csum(jme, skb, &flags);
  1549. jme_tx_vlan(skb, &txdesc->desc1.vlan, &flags);
  1550. txdesc->desc1.flags = flags;
  1551. /*
  1552. * Set tx buffer info after telling NIC to send
  1553. * For better tx_clean timing
  1554. */
  1555. wmb();
  1556. txbi->nr_desc = skb_shinfo(skb)->nr_frags + 2;
  1557. txbi->skb = skb;
  1558. txbi->len = skb->len;
  1559. txbi->start_xmit = jiffies;
  1560. if (!txbi->start_xmit)
  1561. txbi->start_xmit = (0UL-1);
  1562. return 0;
  1563. }
  1564. static void
  1565. jme_stop_queue_if_full(struct jme_adapter *jme)
  1566. {
  1567. struct jme_ring *txring = jme->txring;
  1568. struct jme_buffer_info *txbi = txring->bufinf;
  1569. int idx = atomic_read(&txring->next_to_clean);
  1570. txbi += idx;
  1571. smp_wmb();
  1572. if (unlikely(atomic_read(&txring->nr_free) < (MAX_SKB_FRAGS+2))) {
  1573. netif_stop_queue(jme->dev);
  1574. msg_tx_queued(jme, "TX Queue Paused.\n");
  1575. smp_wmb();
  1576. if (atomic_read(&txring->nr_free)
  1577. >= (jme->tx_wake_threshold)) {
  1578. netif_wake_queue(jme->dev);
  1579. msg_tx_queued(jme, "TX Queue Fast Waked.\n");
  1580. }
  1581. }
  1582. if (unlikely(txbi->start_xmit &&
  1583. (jiffies - txbi->start_xmit) >= TX_TIMEOUT &&
  1584. txbi->skb)) {
  1585. netif_stop_queue(jme->dev);
  1586. msg_tx_queued(jme, "TX Queue Stopped %d@%lu.\n", idx, jiffies);
  1587. }
  1588. }
  1589. /*
  1590. * This function is already protected by netif_tx_lock()
  1591. */
  1592. static int
  1593. jme_start_xmit(struct sk_buff *skb, struct net_device *netdev)
  1594. {
  1595. struct jme_adapter *jme = netdev_priv(netdev);
  1596. int idx;
  1597. if (unlikely(jme_expand_header(jme, skb))) {
  1598. ++(NET_STAT(jme).tx_dropped);
  1599. return NETDEV_TX_OK;
  1600. }
  1601. idx = jme_alloc_txdesc(jme, skb);
  1602. if (unlikely(idx < 0)) {
  1603. netif_stop_queue(netdev);
  1604. msg_tx_err(jme, "BUG! Tx ring full when queue awake!\n");
  1605. return NETDEV_TX_BUSY;
  1606. }
  1607. jme_map_tx_skb(jme, skb, idx);
  1608. jme_fill_first_tx_desc(jme, skb, idx);
  1609. jwrite32(jme, JME_TXCS, jme->reg_txcs |
  1610. TXCS_SELECT_QUEUE0 |
  1611. TXCS_QUEUE0S |
  1612. TXCS_ENABLE);
  1613. netdev->trans_start = jiffies;
  1614. tx_dbg(jme, "xmit: %d+%d@%lu\n", idx,
  1615. skb_shinfo(skb)->nr_frags + 2,
  1616. jiffies);
  1617. jme_stop_queue_if_full(jme);
  1618. return NETDEV_TX_OK;
  1619. }
  1620. static int
  1621. jme_set_macaddr(struct net_device *netdev, void *p)
  1622. {
  1623. struct jme_adapter *jme = netdev_priv(netdev);
  1624. struct sockaddr *addr = p;
  1625. u32 val;
  1626. if (netif_running(netdev))
  1627. return -EBUSY;
  1628. spin_lock_bh(&jme->macaddr_lock);
  1629. memcpy(netdev->dev_addr, addr->sa_data, netdev->addr_len);
  1630. val = (addr->sa_data[3] & 0xff) << 24 |
  1631. (addr->sa_data[2] & 0xff) << 16 |
  1632. (addr->sa_data[1] & 0xff) << 8 |
  1633. (addr->sa_data[0] & 0xff);
  1634. jwrite32(jme, JME_RXUMA_LO, val);
  1635. val = (addr->sa_data[5] & 0xff) << 8 |
  1636. (addr->sa_data[4] & 0xff);
  1637. jwrite32(jme, JME_RXUMA_HI, val);
  1638. spin_unlock_bh(&jme->macaddr_lock);
  1639. return 0;
  1640. }
  1641. static void
  1642. jme_set_multi(struct net_device *netdev)
  1643. {
  1644. struct jme_adapter *jme = netdev_priv(netdev);
  1645. u32 mc_hash[2] = {};
  1646. int i;
  1647. spin_lock_bh(&jme->rxmcs_lock);
  1648. jme->reg_rxmcs |= RXMCS_BRDFRAME | RXMCS_UNIFRAME;
  1649. if (netdev->flags & IFF_PROMISC) {
  1650. jme->reg_rxmcs |= RXMCS_ALLFRAME;
  1651. } else if (netdev->flags & IFF_ALLMULTI) {
  1652. jme->reg_rxmcs |= RXMCS_ALLMULFRAME;
  1653. } else if (netdev->flags & IFF_MULTICAST) {
  1654. struct dev_mc_list *mclist;
  1655. int bit_nr;
  1656. jme->reg_rxmcs |= RXMCS_MULFRAME | RXMCS_MULFILTERED;
  1657. for (i = 0, mclist = netdev->mc_list;
  1658. mclist && i < netdev->mc_count;
  1659. ++i, mclist = mclist->next) {
  1660. bit_nr = ether_crc(ETH_ALEN, mclist->dmi_addr) & 0x3F;
  1661. mc_hash[bit_nr >> 5] |= 1 << (bit_nr & 0x1F);
  1662. }
  1663. jwrite32(jme, JME_RXMCHT_LO, mc_hash[0]);
  1664. jwrite32(jme, JME_RXMCHT_HI, mc_hash[1]);
  1665. }
  1666. wmb();
  1667. jwrite32(jme, JME_RXMCS, jme->reg_rxmcs);
  1668. spin_unlock_bh(&jme->rxmcs_lock);
  1669. }
  1670. static int
  1671. jme_change_mtu(struct net_device *netdev, int new_mtu)
  1672. {
  1673. struct jme_adapter *jme = netdev_priv(netdev);
  1674. if (new_mtu == jme->old_mtu)
  1675. return 0;
  1676. if (((new_mtu + ETH_HLEN) > MAX_ETHERNET_JUMBO_PACKET_SIZE) ||
  1677. ((new_mtu) < IPV6_MIN_MTU))
  1678. return -EINVAL;
  1679. if (new_mtu > 4000) {
  1680. jme->reg_rxcs &= ~RXCS_FIFOTHNP;
  1681. jme->reg_rxcs |= RXCS_FIFOTHNP_64QW;
  1682. jme_restart_rx_engine(jme);
  1683. } else {
  1684. jme->reg_rxcs &= ~RXCS_FIFOTHNP;
  1685. jme->reg_rxcs |= RXCS_FIFOTHNP_128QW;
  1686. jme_restart_rx_engine(jme);
  1687. }
  1688. if (new_mtu > 1900) {
  1689. netdev->features &= ~(NETIF_F_HW_CSUM |
  1690. NETIF_F_TSO |
  1691. NETIF_F_TSO6);
  1692. } else {
  1693. if (test_bit(JME_FLAG_TXCSUM, &jme->flags))
  1694. netdev->features |= NETIF_F_HW_CSUM;
  1695. if (test_bit(JME_FLAG_TSO, &jme->flags))
  1696. netdev->features |= NETIF_F_TSO | NETIF_F_TSO6;
  1697. }
  1698. netdev->mtu = new_mtu;
  1699. jme_reset_link(jme);
  1700. return 0;
  1701. }
  1702. static void
  1703. jme_tx_timeout(struct net_device *netdev)
  1704. {
  1705. struct jme_adapter *jme = netdev_priv(netdev);
  1706. jme->phylink = 0;
  1707. jme_reset_phy_processor(jme);
  1708. if (test_bit(JME_FLAG_SSET, &jme->flags))
  1709. jme_set_settings(netdev, &jme->old_ecmd);
  1710. /*
  1711. * Force to Reset the link again
  1712. */
  1713. jme_reset_link(jme);
  1714. }
  1715. static void
  1716. jme_vlan_rx_register(struct net_device *netdev, struct vlan_group *grp)
  1717. {
  1718. struct jme_adapter *jme = netdev_priv(netdev);
  1719. jme->vlgrp = grp;
  1720. }
  1721. static void
  1722. jme_get_drvinfo(struct net_device *netdev,
  1723. struct ethtool_drvinfo *info)
  1724. {
  1725. struct jme_adapter *jme = netdev_priv(netdev);
  1726. strcpy(info->driver, DRV_NAME);
  1727. strcpy(info->version, DRV_VERSION);
  1728. strcpy(info->bus_info, pci_name(jme->pdev));
  1729. }
  1730. static int
  1731. jme_get_regs_len(struct net_device *netdev)
  1732. {
  1733. return JME_REG_LEN;
  1734. }
  1735. static void
  1736. mmapio_memcpy(struct jme_adapter *jme, u32 *p, u32 reg, int len)
  1737. {
  1738. int i;
  1739. for (i = 0 ; i < len ; i += 4)
  1740. p[i >> 2] = jread32(jme, reg + i);
  1741. }
  1742. static void
  1743. mdio_memcpy(struct jme_adapter *jme, u32 *p, int reg_nr)
  1744. {
  1745. int i;
  1746. u16 *p16 = (u16 *)p;
  1747. for (i = 0 ; i < reg_nr ; ++i)
  1748. p16[i] = jme_mdio_read(jme->dev, jme->mii_if.phy_id, i);
  1749. }
  1750. static void
  1751. jme_get_regs(struct net_device *netdev, struct ethtool_regs *regs, void *p)
  1752. {
  1753. struct jme_adapter *jme = netdev_priv(netdev);
  1754. u32 *p32 = (u32 *)p;
  1755. memset(p, 0xFF, JME_REG_LEN);
  1756. regs->version = 1;
  1757. mmapio_memcpy(jme, p32, JME_MAC, JME_MAC_LEN);
  1758. p32 += 0x100 >> 2;
  1759. mmapio_memcpy(jme, p32, JME_PHY, JME_PHY_LEN);
  1760. p32 += 0x100 >> 2;
  1761. mmapio_memcpy(jme, p32, JME_MISC, JME_MISC_LEN);
  1762. p32 += 0x100 >> 2;
  1763. mmapio_memcpy(jme, p32, JME_RSS, JME_RSS_LEN);
  1764. p32 += 0x100 >> 2;
  1765. mdio_memcpy(jme, p32, JME_PHY_REG_NR);
  1766. }
  1767. static int
  1768. jme_get_coalesce(struct net_device *netdev, struct ethtool_coalesce *ecmd)
  1769. {
  1770. struct jme_adapter *jme = netdev_priv(netdev);
  1771. ecmd->tx_coalesce_usecs = PCC_TX_TO;
  1772. ecmd->tx_max_coalesced_frames = PCC_TX_CNT;
  1773. if (test_bit(JME_FLAG_POLL, &jme->flags)) {
  1774. ecmd->use_adaptive_rx_coalesce = false;
  1775. ecmd->rx_coalesce_usecs = 0;
  1776. ecmd->rx_max_coalesced_frames = 0;
  1777. return 0;
  1778. }
  1779. ecmd->use_adaptive_rx_coalesce = true;
  1780. switch (jme->dpi.cur) {
  1781. case PCC_P1:
  1782. ecmd->rx_coalesce_usecs = PCC_P1_TO;
  1783. ecmd->rx_max_coalesced_frames = PCC_P1_CNT;
  1784. break;
  1785. case PCC_P2:
  1786. ecmd->rx_coalesce_usecs = PCC_P2_TO;
  1787. ecmd->rx_max_coalesced_frames = PCC_P2_CNT;
  1788. break;
  1789. case PCC_P3:
  1790. ecmd->rx_coalesce_usecs = PCC_P3_TO;
  1791. ecmd->rx_max_coalesced_frames = PCC_P3_CNT;
  1792. break;
  1793. default:
  1794. break;
  1795. }
  1796. return 0;
  1797. }
  1798. static int
  1799. jme_set_coalesce(struct net_device *netdev, struct ethtool_coalesce *ecmd)
  1800. {
  1801. struct jme_adapter *jme = netdev_priv(netdev);
  1802. struct dynpcc_info *dpi = &(jme->dpi);
  1803. if (netif_running(netdev))
  1804. return -EBUSY;
  1805. if (ecmd->use_adaptive_rx_coalesce
  1806. && test_bit(JME_FLAG_POLL, &jme->flags)) {
  1807. clear_bit(JME_FLAG_POLL, &jme->flags);
  1808. jme->jme_rx = netif_rx;
  1809. jme->jme_vlan_rx = vlan_hwaccel_rx;
  1810. dpi->cur = PCC_P1;
  1811. dpi->attempt = PCC_P1;
  1812. dpi->cnt = 0;
  1813. jme_set_rx_pcc(jme, PCC_P1);
  1814. jme_interrupt_mode(jme);
  1815. } else if (!(ecmd->use_adaptive_rx_coalesce)
  1816. && !(test_bit(JME_FLAG_POLL, &jme->flags))) {
  1817. set_bit(JME_FLAG_POLL, &jme->flags);
  1818. jme->jme_rx = netif_receive_skb;
  1819. jme->jme_vlan_rx = vlan_hwaccel_receive_skb;
  1820. jme_interrupt_mode(jme);
  1821. }
  1822. return 0;
  1823. }
  1824. static void
  1825. jme_get_pauseparam(struct net_device *netdev,
  1826. struct ethtool_pauseparam *ecmd)
  1827. {
  1828. struct jme_adapter *jme = netdev_priv(netdev);
  1829. u32 val;
  1830. ecmd->tx_pause = (jme->reg_txpfc & TXPFC_PF_EN) != 0;
  1831. ecmd->rx_pause = (jme->reg_rxmcs & RXMCS_FLOWCTRL) != 0;
  1832. spin_lock_bh(&jme->phy_lock);
  1833. val = jme_mdio_read(jme->dev, jme->mii_if.phy_id, MII_ADVERTISE);
  1834. spin_unlock_bh(&jme->phy_lock);
  1835. ecmd->autoneg =
  1836. (val & (ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM)) != 0;
  1837. }
  1838. static int
  1839. jme_set_pauseparam(struct net_device *netdev,
  1840. struct ethtool_pauseparam *ecmd)
  1841. {
  1842. struct jme_adapter *jme = netdev_priv(netdev);
  1843. u32 val;
  1844. if (((jme->reg_txpfc & TXPFC_PF_EN) != 0) ^
  1845. (ecmd->tx_pause != 0)) {
  1846. if (ecmd->tx_pause)
  1847. jme->reg_txpfc |= TXPFC_PF_EN;
  1848. else
  1849. jme->reg_txpfc &= ~TXPFC_PF_EN;
  1850. jwrite32(jme, JME_TXPFC, jme->reg_txpfc);
  1851. }
  1852. spin_lock_bh(&jme->rxmcs_lock);
  1853. if (((jme->reg_rxmcs & RXMCS_FLOWCTRL) != 0) ^
  1854. (ecmd->rx_pause != 0)) {
  1855. if (ecmd->rx_pause)
  1856. jme->reg_rxmcs |= RXMCS_FLOWCTRL;
  1857. else
  1858. jme->reg_rxmcs &= ~RXMCS_FLOWCTRL;
  1859. jwrite32(jme, JME_RXMCS, jme->reg_rxmcs);
  1860. }
  1861. spin_unlock_bh(&jme->rxmcs_lock);
  1862. spin_lock_bh(&jme->phy_lock);
  1863. val = jme_mdio_read(jme->dev, jme->mii_if.phy_id, MII_ADVERTISE);
  1864. if (((val & (ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM)) != 0) ^
  1865. (ecmd->autoneg != 0)) {
  1866. if (ecmd->autoneg)
  1867. val |= (ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM);
  1868. else
  1869. val &= ~(ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM);
  1870. jme_mdio_write(jme->dev, jme->mii_if.phy_id,
  1871. MII_ADVERTISE, val);
  1872. }
  1873. spin_unlock_bh(&jme->phy_lock);
  1874. return 0;
  1875. }
  1876. static void
  1877. jme_get_wol(struct net_device *netdev,
  1878. struct ethtool_wolinfo *wol)
  1879. {
  1880. struct jme_adapter *jme = netdev_priv(netdev);
  1881. wol->supported = WAKE_MAGIC | WAKE_PHY;
  1882. wol->wolopts = 0;
  1883. if (jme->reg_pmcs & (PMCS_LFEN | PMCS_LREN))
  1884. wol->wolopts |= WAKE_PHY;
  1885. if (jme->reg_pmcs & PMCS_MFEN)
  1886. wol->wolopts |= WAKE_MAGIC;
  1887. }
  1888. static int
  1889. jme_set_wol(struct net_device *netdev,
  1890. struct ethtool_wolinfo *wol)
  1891. {
  1892. struct jme_adapter *jme = netdev_priv(netdev);
  1893. if (wol->wolopts & (WAKE_MAGICSECURE |
  1894. WAKE_UCAST |
  1895. WAKE_MCAST |
  1896. WAKE_BCAST |
  1897. WAKE_ARP))
  1898. return -EOPNOTSUPP;
  1899. jme->reg_pmcs = 0;
  1900. if (wol->wolopts & WAKE_PHY)
  1901. jme->reg_pmcs |= PMCS_LFEN | PMCS_LREN;
  1902. if (wol->wolopts & WAKE_MAGIC)
  1903. jme->reg_pmcs |= PMCS_MFEN;
  1904. jwrite32(jme, JME_PMCS, jme->reg_pmcs);
  1905. return 0;
  1906. }
  1907. static int
  1908. jme_get_settings(struct net_device *netdev,
  1909. struct ethtool_cmd *ecmd)
  1910. {
  1911. struct jme_adapter *jme = netdev_priv(netdev);
  1912. int rc;
  1913. spin_lock_bh(&jme->phy_lock);
  1914. rc = mii_ethtool_gset(&(jme->mii_if), ecmd);
  1915. spin_unlock_bh(&jme->phy_lock);
  1916. return rc;
  1917. }
  1918. static int
  1919. jme_set_settings(struct net_device *netdev,
  1920. struct ethtool_cmd *ecmd)
  1921. {
  1922. struct jme_adapter *jme = netdev_priv(netdev);
  1923. int rc, fdc = 0;
  1924. if (ecmd->speed == SPEED_1000 && ecmd->autoneg != AUTONEG_ENABLE)
  1925. return -EINVAL;
  1926. if (jme->mii_if.force_media &&
  1927. ecmd->autoneg != AUTONEG_ENABLE &&
  1928. (jme->mii_if.full_duplex != ecmd->duplex))
  1929. fdc = 1;
  1930. spin_lock_bh(&jme->phy_lock);
  1931. rc = mii_ethtool_sset(&(jme->mii_if), ecmd);
  1932. spin_unlock_bh(&jme->phy_lock);
  1933. if (!rc && fdc)
  1934. jme_reset_link(jme);
  1935. if (!rc) {
  1936. set_bit(JME_FLAG_SSET, &jme->flags);
  1937. jme->old_ecmd = *ecmd;
  1938. }
  1939. return rc;
  1940. }
  1941. static u32
  1942. jme_get_link(struct net_device *netdev)
  1943. {
  1944. struct jme_adapter *jme = netdev_priv(netdev);
  1945. return jread32(jme, JME_PHY_LINK) & PHY_LINK_UP;
  1946. }
  1947. static u32
  1948. jme_get_msglevel(struct net_device *netdev)
  1949. {
  1950. struct jme_adapter *jme = netdev_priv(netdev);
  1951. return jme->msg_enable;
  1952. }
  1953. static void
  1954. jme_set_msglevel(struct net_device *netdev, u32 value)
  1955. {
  1956. struct jme_adapter *jme = netdev_priv(netdev);
  1957. jme->msg_enable = value;
  1958. }
  1959. static u32
  1960. jme_get_rx_csum(struct net_device *netdev)
  1961. {
  1962. struct jme_adapter *jme = netdev_priv(netdev);
  1963. return jme->reg_rxmcs & RXMCS_CHECKSUM;
  1964. }
  1965. static int
  1966. jme_set_rx_csum(struct net_device *netdev, u32 on)
  1967. {
  1968. struct jme_adapter *jme = netdev_priv(netdev);
  1969. spin_lock_bh(&jme->rxmcs_lock);
  1970. if (on)
  1971. jme->reg_rxmcs |= RXMCS_CHECKSUM;
  1972. else
  1973. jme->reg_rxmcs &= ~RXMCS_CHECKSUM;
  1974. jwrite32(jme, JME_RXMCS, jme->reg_rxmcs);
  1975. spin_unlock_bh(&jme->rxmcs_lock);
  1976. return 0;
  1977. }
  1978. static int
  1979. jme_set_tx_csum(struct net_device *netdev, u32 on)
  1980. {
  1981. struct jme_adapter *jme = netdev_priv(netdev);
  1982. if (on) {
  1983. set_bit(JME_FLAG_TXCSUM, &jme->flags);
  1984. if (netdev->mtu <= 1900)
  1985. netdev->features |= NETIF_F_HW_CSUM;
  1986. } else {
  1987. clear_bit(JME_FLAG_TXCSUM, &jme->flags);
  1988. netdev->features &= ~NETIF_F_HW_CSUM;
  1989. }
  1990. return 0;
  1991. }
  1992. static int
  1993. jme_set_tso(struct net_device *netdev, u32 on)
  1994. {
  1995. struct jme_adapter *jme = netdev_priv(netdev);
  1996. if (on) {
  1997. set_bit(JME_FLAG_TSO, &jme->flags);
  1998. if (netdev->mtu <= 1900)
  1999. netdev->features |= NETIF_F_TSO | NETIF_F_TSO6;
  2000. } else {
  2001. clear_bit(JME_FLAG_TSO, &jme->flags);
  2002. netdev->features &= ~(NETIF_F_TSO | NETIF_F_TSO6);
  2003. }
  2004. return 0;
  2005. }
  2006. static int
  2007. jme_nway_reset(struct net_device *netdev)
  2008. {
  2009. struct jme_adapter *jme = netdev_priv(netdev);
  2010. jme_restart_an(jme);
  2011. return 0;
  2012. }
  2013. static u8
  2014. jme_smb_read(struct jme_adapter *jme, unsigned int addr)
  2015. {
  2016. u32 val;
  2017. int to;
  2018. val = jread32(jme, JME_SMBCSR);
  2019. to = JME_SMB_BUSY_TIMEOUT;
  2020. while ((val & SMBCSR_BUSY) && --to) {
  2021. msleep(1);
  2022. val = jread32(jme, JME_SMBCSR);
  2023. }
  2024. if (!to) {
  2025. msg_hw(jme, "SMB Bus Busy.\n");
  2026. return 0xFF;
  2027. }
  2028. jwrite32(jme, JME_SMBINTF,
  2029. ((addr << SMBINTF_HWADDR_SHIFT) & SMBINTF_HWADDR) |
  2030. SMBINTF_HWRWN_READ |
  2031. SMBINTF_HWCMD);
  2032. val = jread32(jme, JME_SMBINTF);
  2033. to = JME_SMB_BUSY_TIMEOUT;
  2034. while ((val & SMBINTF_HWCMD) && --to) {
  2035. msleep(1);
  2036. val = jread32(jme, JME_SMBINTF);
  2037. }
  2038. if (!to) {
  2039. msg_hw(jme, "SMB Bus Busy.\n");
  2040. return 0xFF;
  2041. }
  2042. return (val & SMBINTF_HWDATR) >> SMBINTF_HWDATR_SHIFT;
  2043. }
  2044. static void
  2045. jme_smb_write(struct jme_adapter *jme, unsigned int addr, u8 data)
  2046. {
  2047. u32 val;
  2048. int to;
  2049. val = jread32(jme, JME_SMBCSR);
  2050. to = JME_SMB_BUSY_TIMEOUT;
  2051. while ((val & SMBCSR_BUSY) && --to) {
  2052. msleep(1);
  2053. val = jread32(jme, JME_SMBCSR);
  2054. }
  2055. if (!to) {
  2056. msg_hw(jme, "SMB Bus Busy.\n");
  2057. return;
  2058. }
  2059. jwrite32(jme, JME_SMBINTF,
  2060. ((data << SMBINTF_HWDATW_SHIFT) & SMBINTF_HWDATW) |
  2061. ((addr << SMBINTF_HWADDR_SHIFT) & SMBINTF_HWADDR) |
  2062. SMBINTF_HWRWN_WRITE |
  2063. SMBINTF_HWCMD);
  2064. val = jread32(jme, JME_SMBINTF);
  2065. to = JME_SMB_BUSY_TIMEOUT;
  2066. while ((val & SMBINTF_HWCMD) && --to) {
  2067. msleep(1);
  2068. val = jread32(jme, JME_SMBINTF);
  2069. }
  2070. if (!to) {
  2071. msg_hw(jme, "SMB Bus Busy.\n");
  2072. return;
  2073. }
  2074. mdelay(2);
  2075. }
  2076. static int
  2077. jme_get_eeprom_len(struct net_device *netdev)
  2078. {
  2079. struct jme_adapter *jme = netdev_priv(netdev);
  2080. u32 val;
  2081. val = jread32(jme, JME_SMBCSR);
  2082. return (val & SMBCSR_EEPROMD) ? JME_SMB_LEN : 0;
  2083. }
  2084. static int
  2085. jme_get_eeprom(struct net_device *netdev,
  2086. struct ethtool_eeprom *eeprom, u8 *data)
  2087. {
  2088. struct jme_adapter *jme = netdev_priv(netdev);
  2089. int i, offset = eeprom->offset, len = eeprom->len;
  2090. /*
  2091. * ethtool will check the boundary for us
  2092. */
  2093. eeprom->magic = JME_EEPROM_MAGIC;
  2094. for (i = 0 ; i < len ; ++i)
  2095. data[i] = jme_smb_read(jme, i + offset);
  2096. return 0;
  2097. }
  2098. static int
  2099. jme_set_eeprom(struct net_device *netdev,
  2100. struct ethtool_eeprom *eeprom, u8 *data)
  2101. {
  2102. struct jme_adapter *jme = netdev_priv(netdev);
  2103. int i, offset = eeprom->offset, len = eeprom->len;
  2104. if (eeprom->magic != JME_EEPROM_MAGIC)
  2105. return -EINVAL;
  2106. /*
  2107. * ethtool will check the boundary for us
  2108. */
  2109. for (i = 0 ; i < len ; ++i)
  2110. jme_smb_write(jme, i + offset, data[i]);
  2111. return 0;
  2112. }
  2113. static const struct ethtool_ops jme_ethtool_ops = {
  2114. .get_drvinfo = jme_get_drvinfo,
  2115. .get_regs_len = jme_get_regs_len,
  2116. .get_regs = jme_get_regs,
  2117. .get_coalesce = jme_get_coalesce,
  2118. .set_coalesce = jme_set_coalesce,
  2119. .get_pauseparam = jme_get_pauseparam,
  2120. .set_pauseparam = jme_set_pauseparam,
  2121. .get_wol = jme_get_wol,
  2122. .set_wol = jme_set_wol,
  2123. .get_settings = jme_get_settings,
  2124. .set_settings = jme_set_settings,
  2125. .get_link = jme_get_link,
  2126. .get_msglevel = jme_get_msglevel,
  2127. .set_msglevel = jme_set_msglevel,
  2128. .get_rx_csum = jme_get_rx_csum,
  2129. .set_rx_csum = jme_set_rx_csum,
  2130. .set_tx_csum = jme_set_tx_csum,
  2131. .set_tso = jme_set_tso,
  2132. .set_sg = ethtool_op_set_sg,
  2133. .nway_reset = jme_nway_reset,
  2134. .get_eeprom_len = jme_get_eeprom_len,
  2135. .get_eeprom = jme_get_eeprom,
  2136. .set_eeprom = jme_set_eeprom,
  2137. };
  2138. static int
  2139. jme_pci_dma64(struct pci_dev *pdev)
  2140. {
  2141. if (!pci_set_dma_mask(pdev, DMA_32BIT_MASK))
  2142. if (!pci_set_consistent_dma_mask(pdev, DMA_32BIT_MASK))
  2143. return 0;
  2144. return -1;
  2145. }
  2146. static inline void
  2147. jme_phy_init(struct jme_adapter *jme)
  2148. {
  2149. u16 reg26;
  2150. reg26 = jme_mdio_read(jme->dev, jme->mii_if.phy_id, 26);
  2151. jme_mdio_write(jme->dev, jme->mii_if.phy_id, 26, reg26 | 0x1000);
  2152. }
  2153. static inline void
  2154. jme_check_hw_ver(struct jme_adapter *jme)
  2155. {
  2156. u32 chipmode;
  2157. chipmode = jread32(jme, JME_CHIPMODE);
  2158. jme->fpgaver = (chipmode & CM_FPGAVER_MASK) >> CM_FPGAVER_SHIFT;
  2159. jme->chiprev = (chipmode & CM_CHIPREV_MASK) >> CM_CHIPREV_SHIFT;
  2160. }
  2161. static const struct net_device_ops jme_netdev_ops = {
  2162. .ndo_open = jme_open,
  2163. .ndo_stop = jme_close,
  2164. .ndo_validate_addr = eth_validate_addr,
  2165. .ndo_start_xmit = jme_start_xmit,
  2166. .ndo_set_mac_address = jme_set_macaddr,
  2167. .ndo_set_multicast_list = jme_set_multi,
  2168. .ndo_change_mtu = jme_change_mtu,
  2169. .ndo_tx_timeout = jme_tx_timeout,
  2170. .ndo_vlan_rx_register = jme_vlan_rx_register,
  2171. };
  2172. static int __devinit
  2173. jme_init_one(struct pci_dev *pdev,
  2174. const struct pci_device_id *ent)
  2175. {
  2176. int rc = 0, using_dac, i;
  2177. struct net_device *netdev;
  2178. struct jme_adapter *jme;
  2179. u16 bmcr, bmsr;
  2180. u32 apmc;
  2181. /*
  2182. * set up PCI device basics
  2183. */
  2184. rc = pci_enable_device(pdev);
  2185. if (rc) {
  2186. jeprintk(pdev, "Cannot enable PCI device.\n");
  2187. goto err_out;
  2188. }
  2189. using_dac = jme_pci_dma64(pdev);
  2190. if (using_dac < 0) {
  2191. jeprintk(pdev, "Cannot set PCI DMA Mask.\n");
  2192. rc = -EIO;
  2193. goto err_out_disable_pdev;
  2194. }
  2195. if (!(pci_resource_flags(pdev, 0) & IORESOURCE_MEM)) {
  2196. jeprintk(pdev, "No PCI resource region found.\n");
  2197. rc = -ENOMEM;
  2198. goto err_out_disable_pdev;
  2199. }
  2200. rc = pci_request_regions(pdev, DRV_NAME);
  2201. if (rc) {
  2202. jeprintk(pdev, "Cannot obtain PCI resource region.\n");
  2203. goto err_out_disable_pdev;
  2204. }
  2205. pci_set_master(pdev);
  2206. /*
  2207. * alloc and init net device
  2208. */
  2209. netdev = alloc_etherdev(sizeof(*jme));
  2210. if (!netdev) {
  2211. jeprintk(pdev, "Cannot allocate netdev structure.\n");
  2212. rc = -ENOMEM;
  2213. goto err_out_release_regions;
  2214. }
  2215. netdev->netdev_ops = &jme_netdev_ops;
  2216. netdev->ethtool_ops = &jme_ethtool_ops;
  2217. netdev->watchdog_timeo = TX_TIMEOUT;
  2218. netdev->features = NETIF_F_HW_CSUM |
  2219. NETIF_F_SG |
  2220. NETIF_F_TSO |
  2221. NETIF_F_TSO6 |
  2222. NETIF_F_HW_VLAN_TX |
  2223. NETIF_F_HW_VLAN_RX;
  2224. if (using_dac)
  2225. netdev->features |= NETIF_F_HIGHDMA;
  2226. SET_NETDEV_DEV(netdev, &pdev->dev);
  2227. pci_set_drvdata(pdev, netdev);
  2228. /*
  2229. * init adapter info
  2230. */
  2231. jme = netdev_priv(netdev);
  2232. jme->pdev = pdev;
  2233. jme->dev = netdev;
  2234. jme->jme_rx = netif_rx;
  2235. jme->jme_vlan_rx = vlan_hwaccel_rx;
  2236. jme->old_mtu = netdev->mtu = 1500;
  2237. jme->phylink = 0;
  2238. jme->tx_ring_size = 1 << 10;
  2239. jme->tx_ring_mask = jme->tx_ring_size - 1;
  2240. jme->tx_wake_threshold = 1 << 9;
  2241. jme->rx_ring_size = 1 << 9;
  2242. jme->rx_ring_mask = jme->rx_ring_size - 1;
  2243. jme->msg_enable = JME_DEF_MSG_ENABLE;
  2244. jme->regs = ioremap(pci_resource_start(pdev, 0),
  2245. pci_resource_len(pdev, 0));
  2246. if (!(jme->regs)) {
  2247. jeprintk(pdev, "Mapping PCI resource region error.\n");
  2248. rc = -ENOMEM;
  2249. goto err_out_free_netdev;
  2250. }
  2251. jme->shadow_regs = pci_alloc_consistent(pdev,
  2252. sizeof(u32) * SHADOW_REG_NR,
  2253. &(jme->shadow_dma));
  2254. if (!(jme->shadow_regs)) {
  2255. jeprintk(pdev, "Allocating shadow register mapping error.\n");
  2256. rc = -ENOMEM;
  2257. goto err_out_unmap;
  2258. }
  2259. if (no_pseudohp) {
  2260. apmc = jread32(jme, JME_APMC) & ~JME_APMC_PSEUDO_HP_EN;
  2261. jwrite32(jme, JME_APMC, apmc);
  2262. } else if (force_pseudohp) {
  2263. apmc = jread32(jme, JME_APMC) | JME_APMC_PSEUDO_HP_EN;
  2264. jwrite32(jme, JME_APMC, apmc);
  2265. }
  2266. NETIF_NAPI_SET(netdev, &jme->napi, jme_poll, jme->rx_ring_size >> 2)
  2267. spin_lock_init(&jme->phy_lock);
  2268. spin_lock_init(&jme->macaddr_lock);
  2269. spin_lock_init(&jme->rxmcs_lock);
  2270. atomic_set(&jme->link_changing, 1);
  2271. atomic_set(&jme->rx_cleaning, 1);
  2272. atomic_set(&jme->tx_cleaning, 1);
  2273. atomic_set(&jme->rx_empty, 1);
  2274. tasklet_init(&jme->pcc_task,
  2275. &jme_pcc_tasklet,
  2276. (unsigned long) jme);
  2277. tasklet_init(&jme->linkch_task,
  2278. &jme_link_change_tasklet,
  2279. (unsigned long) jme);
  2280. tasklet_init(&jme->txclean_task,
  2281. &jme_tx_clean_tasklet,
  2282. (unsigned long) jme);
  2283. tasklet_init(&jme->rxclean_task,
  2284. &jme_rx_clean_tasklet,
  2285. (unsigned long) jme);
  2286. tasklet_init(&jme->rxempty_task,
  2287. &jme_rx_empty_tasklet,
  2288. (unsigned long) jme);
  2289. tasklet_disable_nosync(&jme->txclean_task);
  2290. tasklet_disable_nosync(&jme->rxclean_task);
  2291. tasklet_disable_nosync(&jme->rxempty_task);
  2292. jme->dpi.cur = PCC_P1;
  2293. jme->reg_ghc = 0;
  2294. jme->reg_rxcs = RXCS_DEFAULT;
  2295. jme->reg_rxmcs = RXMCS_DEFAULT;
  2296. jme->reg_txpfc = 0;
  2297. jme->reg_pmcs = PMCS_MFEN;
  2298. set_bit(JME_FLAG_TXCSUM, &jme->flags);
  2299. set_bit(JME_FLAG_TSO, &jme->flags);
  2300. /*
  2301. * Get Max Read Req Size from PCI Config Space
  2302. */
  2303. pci_read_config_byte(pdev, PCI_DCSR_MRRS, &jme->mrrs);
  2304. jme->mrrs &= PCI_DCSR_MRRS_MASK;
  2305. switch (jme->mrrs) {
  2306. case MRRS_128B:
  2307. jme->reg_txcs = TXCS_DEFAULT | TXCS_DMASIZE_128B;
  2308. break;
  2309. case MRRS_256B:
  2310. jme->reg_txcs = TXCS_DEFAULT | TXCS_DMASIZE_256B;
  2311. break;
  2312. default:
  2313. jme->reg_txcs = TXCS_DEFAULT | TXCS_DMASIZE_512B;
  2314. break;
  2315. };
  2316. /*
  2317. * Must check before reset_mac_processor
  2318. */
  2319. jme_check_hw_ver(jme);
  2320. jme->mii_if.dev = netdev;
  2321. if (jme->fpgaver) {
  2322. jme->mii_if.phy_id = 0;
  2323. for (i = 1 ; i < 32 ; ++i) {
  2324. bmcr = jme_mdio_read(netdev, i, MII_BMCR);
  2325. bmsr = jme_mdio_read(netdev, i, MII_BMSR);
  2326. if (bmcr != 0xFFFFU && (bmcr != 0 || bmsr != 0)) {
  2327. jme->mii_if.phy_id = i;
  2328. break;
  2329. }
  2330. }
  2331. if (!jme->mii_if.phy_id) {
  2332. rc = -EIO;
  2333. jeprintk(pdev, "Can not find phy_id.\n");
  2334. goto err_out_free_shadow;
  2335. }
  2336. jme->reg_ghc |= GHC_LINK_POLL;
  2337. } else {
  2338. jme->mii_if.phy_id = 1;
  2339. }
  2340. if (pdev->device == PCI_DEVICE_ID_JMICRON_JMC250)
  2341. jme->mii_if.supports_gmii = true;
  2342. else
  2343. jme->mii_if.supports_gmii = false;
  2344. jme->mii_if.mdio_read = jme_mdio_read;
  2345. jme->mii_if.mdio_write = jme_mdio_write;
  2346. jme_clear_pm(jme);
  2347. jme_set_phyfifoa(jme);
  2348. pci_read_config_byte(pdev, PCI_REVISION_ID, &jme->rev);
  2349. if (!jme->fpgaver)
  2350. jme_phy_init(jme);
  2351. jme_phy_off(jme);
  2352. /*
  2353. * Reset MAC processor and reload EEPROM for MAC Address
  2354. */
  2355. jme_reset_mac_processor(jme);
  2356. rc = jme_reload_eeprom(jme);
  2357. if (rc) {
  2358. jeprintk(pdev,
  2359. "Reload eeprom for reading MAC Address error.\n");
  2360. goto err_out_free_shadow;
  2361. }
  2362. jme_load_macaddr(netdev);
  2363. /*
  2364. * Tell stack that we are not ready to work until open()
  2365. */
  2366. netif_carrier_off(netdev);
  2367. netif_stop_queue(netdev);
  2368. /*
  2369. * Register netdev
  2370. */
  2371. rc = register_netdev(netdev);
  2372. if (rc) {
  2373. jeprintk(pdev, "Cannot register net device.\n");
  2374. goto err_out_free_shadow;
  2375. }
  2376. msg_probe(jme, "JMC250 gigabit%s ver:%x rev:%x macaddr:%pM\n",
  2377. (jme->fpgaver != 0) ? " (FPGA)" : "",
  2378. (jme->fpgaver != 0) ? jme->fpgaver : jme->chiprev,
  2379. jme->rev, netdev->dev_addr);
  2380. return 0;
  2381. err_out_free_shadow:
  2382. pci_free_consistent(pdev,
  2383. sizeof(u32) * SHADOW_REG_NR,
  2384. jme->shadow_regs,
  2385. jme->shadow_dma);
  2386. err_out_unmap:
  2387. iounmap(jme->regs);
  2388. err_out_free_netdev:
  2389. pci_set_drvdata(pdev, NULL);
  2390. free_netdev(netdev);
  2391. err_out_release_regions:
  2392. pci_release_regions(pdev);
  2393. err_out_disable_pdev:
  2394. pci_disable_device(pdev);
  2395. err_out:
  2396. return rc;
  2397. }
  2398. static void __devexit
  2399. jme_remove_one(struct pci_dev *pdev)
  2400. {
  2401. struct net_device *netdev = pci_get_drvdata(pdev);
  2402. struct jme_adapter *jme = netdev_priv(netdev);
  2403. unregister_netdev(netdev);
  2404. pci_free_consistent(pdev,
  2405. sizeof(u32) * SHADOW_REG_NR,
  2406. jme->shadow_regs,
  2407. jme->shadow_dma);
  2408. iounmap(jme->regs);
  2409. pci_set_drvdata(pdev, NULL);
  2410. free_netdev(netdev);
  2411. pci_release_regions(pdev);
  2412. pci_disable_device(pdev);
  2413. }
  2414. #ifdef CONFIG_PM
  2415. static int
  2416. jme_suspend(struct pci_dev *pdev, pm_message_t state)
  2417. {
  2418. struct net_device *netdev = pci_get_drvdata(pdev);
  2419. struct jme_adapter *jme = netdev_priv(netdev);
  2420. atomic_dec(&jme->link_changing);
  2421. netif_device_detach(netdev);
  2422. netif_stop_queue(netdev);
  2423. jme_stop_irq(jme);
  2424. tasklet_disable(&jme->txclean_task);
  2425. tasklet_disable(&jme->rxclean_task);
  2426. tasklet_disable(&jme->rxempty_task);
  2427. jme_disable_shadow(jme);
  2428. if (netif_carrier_ok(netdev)) {
  2429. if (test_bit(JME_FLAG_POLL, &jme->flags))
  2430. jme_polling_mode(jme);
  2431. jme_stop_pcc_timer(jme);
  2432. jme_reset_ghc_speed(jme);
  2433. jme_disable_rx_engine(jme);
  2434. jme_disable_tx_engine(jme);
  2435. jme_reset_mac_processor(jme);
  2436. jme_free_rx_resources(jme);
  2437. jme_free_tx_resources(jme);
  2438. netif_carrier_off(netdev);
  2439. jme->phylink = 0;
  2440. }
  2441. tasklet_enable(&jme->txclean_task);
  2442. tasklet_hi_enable(&jme->rxclean_task);
  2443. tasklet_hi_enable(&jme->rxempty_task);
  2444. pci_save_state(pdev);
  2445. if (jme->reg_pmcs) {
  2446. jme_set_100m_half(jme);
  2447. if (jme->reg_pmcs & (PMCS_LFEN | PMCS_LREN))
  2448. jme_wait_link(jme);
  2449. jwrite32(jme, JME_PMCS, jme->reg_pmcs);
  2450. pci_enable_wake(pdev, PCI_D3cold, true);
  2451. } else {
  2452. jme_phy_off(jme);
  2453. }
  2454. pci_set_power_state(pdev, PCI_D3cold);
  2455. return 0;
  2456. }
  2457. static int
  2458. jme_resume(struct pci_dev *pdev)
  2459. {
  2460. struct net_device *netdev = pci_get_drvdata(pdev);
  2461. struct jme_adapter *jme = netdev_priv(netdev);
  2462. jme_clear_pm(jme);
  2463. pci_restore_state(pdev);
  2464. if (test_bit(JME_FLAG_SSET, &jme->flags))
  2465. jme_set_settings(netdev, &jme->old_ecmd);
  2466. else
  2467. jme_reset_phy_processor(jme);
  2468. jme_enable_shadow(jme);
  2469. jme_start_irq(jme);
  2470. netif_device_attach(netdev);
  2471. atomic_inc(&jme->link_changing);
  2472. jme_reset_link(jme);
  2473. return 0;
  2474. }
  2475. #endif
  2476. static struct pci_device_id jme_pci_tbl[] = {
  2477. { PCI_VDEVICE(JMICRON, PCI_DEVICE_ID_JMICRON_JMC250) },
  2478. { PCI_VDEVICE(JMICRON, PCI_DEVICE_ID_JMICRON_JMC260) },
  2479. { }
  2480. };
  2481. static struct pci_driver jme_driver = {
  2482. .name = DRV_NAME,
  2483. .id_table = jme_pci_tbl,
  2484. .probe = jme_init_one,
  2485. .remove = __devexit_p(jme_remove_one),
  2486. #ifdef CONFIG_PM
  2487. .suspend = jme_suspend,
  2488. .resume = jme_resume,
  2489. #endif /* CONFIG_PM */
  2490. };
  2491. static int __init
  2492. jme_init_module(void)
  2493. {
  2494. printk(KERN_INFO PFX "JMicron JMC250 gigabit ethernet "
  2495. "driver version %s\n", DRV_VERSION);
  2496. return pci_register_driver(&jme_driver);
  2497. }
  2498. static void __exit
  2499. jme_cleanup_module(void)
  2500. {
  2501. pci_unregister_driver(&jme_driver);
  2502. }
  2503. module_init(jme_init_module);
  2504. module_exit(jme_cleanup_module);
  2505. MODULE_AUTHOR("Guo-Fu Tseng <cooldavid@cooldavid.org>");
  2506. MODULE_DESCRIPTION("JMicron JMC2x0 PCI Express Ethernet driver");
  2507. MODULE_LICENSE("GPL");
  2508. MODULE_VERSION(DRV_VERSION);
  2509. MODULE_DEVICE_TABLE(pci, jme_pci_tbl);