jme.c 66 KB

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