sh_eth.c 65 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412241324142415241624172418241924202421242224232424242524262427242824292430243124322433243424352436243724382439244024412442244324442445244624472448244924502451245224532454245524562457245824592460246124622463246424652466246724682469247024712472247324742475247624772478247924802481248224832484248524862487248824892490249124922493249424952496249724982499250025012502250325042505250625072508250925102511251225132514251525162517251825192520252125222523252425252526252725282529253025312532253325342535253625372538253925402541254225432544254525462547254825492550255125522553255425552556255725582559256025612562256325642565256625672568256925702571257225732574257525762577257825792580258125822583258425852586258725882589259025912592259325942595259625972598259926002601260226032604260526062607260826092610261126122613261426152616261726182619262026212622262326242625262626272628262926302631263226332634263526362637263826392640264126422643264426452646264726482649265026512652265326542655265626572658265926602661266226632664266526662667266826692670267126722673267426752676267726782679268026812682268326842685268626872688268926902691269226932694269526962697269826992700270127022703270427052706270727082709271027112712271327142715271627172718271927202721272227232724272527262727272827292730273127322733273427352736273727382739274027412742274327442745274627472748274927502751275227532754275527562757275827592760276127622763276427652766
  1. /*
  2. * SuperH Ethernet device driver
  3. *
  4. * Copyright (C) 2006-2012 Nobuhiro Iwamatsu
  5. * Copyright (C) 2008-2013 Renesas Solutions Corp.
  6. * Copyright (C) 2013 Cogent Embedded, Inc.
  7. *
  8. * This program is free software; you can redistribute it and/or modify it
  9. * under the terms and conditions of the GNU General Public License,
  10. * version 2, as published by the Free Software Foundation.
  11. *
  12. * This program is distributed in the hope it will be useful, but WITHOUT
  13. * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  14. * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
  15. * more details.
  16. * You should have received a copy of the GNU General Public License along with
  17. * this program; if not, write to the Free Software Foundation, Inc.,
  18. * 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.
  19. *
  20. * The full GNU General Public License is included in this distribution in
  21. * the file called "COPYING".
  22. */
  23. #include <linux/init.h>
  24. #include <linux/module.h>
  25. #include <linux/kernel.h>
  26. #include <linux/spinlock.h>
  27. #include <linux/interrupt.h>
  28. #include <linux/dma-mapping.h>
  29. #include <linux/etherdevice.h>
  30. #include <linux/delay.h>
  31. #include <linux/platform_device.h>
  32. #include <linux/mdio-bitbang.h>
  33. #include <linux/netdevice.h>
  34. #include <linux/phy.h>
  35. #include <linux/cache.h>
  36. #include <linux/io.h>
  37. #include <linux/pm_runtime.h>
  38. #include <linux/slab.h>
  39. #include <linux/ethtool.h>
  40. #include <linux/if_vlan.h>
  41. #include <linux/clk.h>
  42. #include <linux/sh_eth.h>
  43. #include "sh_eth.h"
  44. #define SH_ETH_DEF_MSG_ENABLE \
  45. (NETIF_MSG_LINK | \
  46. NETIF_MSG_TIMER | \
  47. NETIF_MSG_RX_ERR| \
  48. NETIF_MSG_TX_ERR)
  49. static const u16 sh_eth_offset_gigabit[SH_ETH_MAX_REGISTER_OFFSET] = {
  50. [EDSR] = 0x0000,
  51. [EDMR] = 0x0400,
  52. [EDTRR] = 0x0408,
  53. [EDRRR] = 0x0410,
  54. [EESR] = 0x0428,
  55. [EESIPR] = 0x0430,
  56. [TDLAR] = 0x0010,
  57. [TDFAR] = 0x0014,
  58. [TDFXR] = 0x0018,
  59. [TDFFR] = 0x001c,
  60. [RDLAR] = 0x0030,
  61. [RDFAR] = 0x0034,
  62. [RDFXR] = 0x0038,
  63. [RDFFR] = 0x003c,
  64. [TRSCER] = 0x0438,
  65. [RMFCR] = 0x0440,
  66. [TFTR] = 0x0448,
  67. [FDR] = 0x0450,
  68. [RMCR] = 0x0458,
  69. [RPADIR] = 0x0460,
  70. [FCFTR] = 0x0468,
  71. [CSMR] = 0x04E4,
  72. [ECMR] = 0x0500,
  73. [ECSR] = 0x0510,
  74. [ECSIPR] = 0x0518,
  75. [PIR] = 0x0520,
  76. [PSR] = 0x0528,
  77. [PIPR] = 0x052c,
  78. [RFLR] = 0x0508,
  79. [APR] = 0x0554,
  80. [MPR] = 0x0558,
  81. [PFTCR] = 0x055c,
  82. [PFRCR] = 0x0560,
  83. [TPAUSER] = 0x0564,
  84. [GECMR] = 0x05b0,
  85. [BCULR] = 0x05b4,
  86. [MAHR] = 0x05c0,
  87. [MALR] = 0x05c8,
  88. [TROCR] = 0x0700,
  89. [CDCR] = 0x0708,
  90. [LCCR] = 0x0710,
  91. [CEFCR] = 0x0740,
  92. [FRECR] = 0x0748,
  93. [TSFRCR] = 0x0750,
  94. [TLFRCR] = 0x0758,
  95. [RFCR] = 0x0760,
  96. [CERCR] = 0x0768,
  97. [CEECR] = 0x0770,
  98. [MAFCR] = 0x0778,
  99. [RMII_MII] = 0x0790,
  100. [ARSTR] = 0x0000,
  101. [TSU_CTRST] = 0x0004,
  102. [TSU_FWEN0] = 0x0010,
  103. [TSU_FWEN1] = 0x0014,
  104. [TSU_FCM] = 0x0018,
  105. [TSU_BSYSL0] = 0x0020,
  106. [TSU_BSYSL1] = 0x0024,
  107. [TSU_PRISL0] = 0x0028,
  108. [TSU_PRISL1] = 0x002c,
  109. [TSU_FWSL0] = 0x0030,
  110. [TSU_FWSL1] = 0x0034,
  111. [TSU_FWSLC] = 0x0038,
  112. [TSU_QTAG0] = 0x0040,
  113. [TSU_QTAG1] = 0x0044,
  114. [TSU_FWSR] = 0x0050,
  115. [TSU_FWINMK] = 0x0054,
  116. [TSU_ADQT0] = 0x0048,
  117. [TSU_ADQT1] = 0x004c,
  118. [TSU_VTAG0] = 0x0058,
  119. [TSU_VTAG1] = 0x005c,
  120. [TSU_ADSBSY] = 0x0060,
  121. [TSU_TEN] = 0x0064,
  122. [TSU_POST1] = 0x0070,
  123. [TSU_POST2] = 0x0074,
  124. [TSU_POST3] = 0x0078,
  125. [TSU_POST4] = 0x007c,
  126. [TSU_ADRH0] = 0x0100,
  127. [TSU_ADRL0] = 0x0104,
  128. [TSU_ADRH31] = 0x01f8,
  129. [TSU_ADRL31] = 0x01fc,
  130. [TXNLCR0] = 0x0080,
  131. [TXALCR0] = 0x0084,
  132. [RXNLCR0] = 0x0088,
  133. [RXALCR0] = 0x008c,
  134. [FWNLCR0] = 0x0090,
  135. [FWALCR0] = 0x0094,
  136. [TXNLCR1] = 0x00a0,
  137. [TXALCR1] = 0x00a0,
  138. [RXNLCR1] = 0x00a8,
  139. [RXALCR1] = 0x00ac,
  140. [FWNLCR1] = 0x00b0,
  141. [FWALCR1] = 0x00b4,
  142. };
  143. static const u16 sh_eth_offset_fast_rcar[SH_ETH_MAX_REGISTER_OFFSET] = {
  144. [ECMR] = 0x0300,
  145. [RFLR] = 0x0308,
  146. [ECSR] = 0x0310,
  147. [ECSIPR] = 0x0318,
  148. [PIR] = 0x0320,
  149. [PSR] = 0x0328,
  150. [RDMLR] = 0x0340,
  151. [IPGR] = 0x0350,
  152. [APR] = 0x0354,
  153. [MPR] = 0x0358,
  154. [RFCF] = 0x0360,
  155. [TPAUSER] = 0x0364,
  156. [TPAUSECR] = 0x0368,
  157. [MAHR] = 0x03c0,
  158. [MALR] = 0x03c8,
  159. [TROCR] = 0x03d0,
  160. [CDCR] = 0x03d4,
  161. [LCCR] = 0x03d8,
  162. [CNDCR] = 0x03dc,
  163. [CEFCR] = 0x03e4,
  164. [FRECR] = 0x03e8,
  165. [TSFRCR] = 0x03ec,
  166. [TLFRCR] = 0x03f0,
  167. [RFCR] = 0x03f4,
  168. [MAFCR] = 0x03f8,
  169. [EDMR] = 0x0200,
  170. [EDTRR] = 0x0208,
  171. [EDRRR] = 0x0210,
  172. [TDLAR] = 0x0218,
  173. [RDLAR] = 0x0220,
  174. [EESR] = 0x0228,
  175. [EESIPR] = 0x0230,
  176. [TRSCER] = 0x0238,
  177. [RMFCR] = 0x0240,
  178. [TFTR] = 0x0248,
  179. [FDR] = 0x0250,
  180. [RMCR] = 0x0258,
  181. [TFUCR] = 0x0264,
  182. [RFOCR] = 0x0268,
  183. [FCFTR] = 0x0270,
  184. [TRIMD] = 0x027c,
  185. };
  186. static const u16 sh_eth_offset_fast_sh4[SH_ETH_MAX_REGISTER_OFFSET] = {
  187. [ECMR] = 0x0100,
  188. [RFLR] = 0x0108,
  189. [ECSR] = 0x0110,
  190. [ECSIPR] = 0x0118,
  191. [PIR] = 0x0120,
  192. [PSR] = 0x0128,
  193. [RDMLR] = 0x0140,
  194. [IPGR] = 0x0150,
  195. [APR] = 0x0154,
  196. [MPR] = 0x0158,
  197. [TPAUSER] = 0x0164,
  198. [RFCF] = 0x0160,
  199. [TPAUSECR] = 0x0168,
  200. [BCFRR] = 0x016c,
  201. [MAHR] = 0x01c0,
  202. [MALR] = 0x01c8,
  203. [TROCR] = 0x01d0,
  204. [CDCR] = 0x01d4,
  205. [LCCR] = 0x01d8,
  206. [CNDCR] = 0x01dc,
  207. [CEFCR] = 0x01e4,
  208. [FRECR] = 0x01e8,
  209. [TSFRCR] = 0x01ec,
  210. [TLFRCR] = 0x01f0,
  211. [RFCR] = 0x01f4,
  212. [MAFCR] = 0x01f8,
  213. [RTRATE] = 0x01fc,
  214. [EDMR] = 0x0000,
  215. [EDTRR] = 0x0008,
  216. [EDRRR] = 0x0010,
  217. [TDLAR] = 0x0018,
  218. [RDLAR] = 0x0020,
  219. [EESR] = 0x0028,
  220. [EESIPR] = 0x0030,
  221. [TRSCER] = 0x0038,
  222. [RMFCR] = 0x0040,
  223. [TFTR] = 0x0048,
  224. [FDR] = 0x0050,
  225. [RMCR] = 0x0058,
  226. [TFUCR] = 0x0064,
  227. [RFOCR] = 0x0068,
  228. [FCFTR] = 0x0070,
  229. [RPADIR] = 0x0078,
  230. [TRIMD] = 0x007c,
  231. [RBWAR] = 0x00c8,
  232. [RDFAR] = 0x00cc,
  233. [TBRAR] = 0x00d4,
  234. [TDFAR] = 0x00d8,
  235. };
  236. static const u16 sh_eth_offset_fast_sh3_sh2[SH_ETH_MAX_REGISTER_OFFSET] = {
  237. [ECMR] = 0x0160,
  238. [ECSR] = 0x0164,
  239. [ECSIPR] = 0x0168,
  240. [PIR] = 0x016c,
  241. [MAHR] = 0x0170,
  242. [MALR] = 0x0174,
  243. [RFLR] = 0x0178,
  244. [PSR] = 0x017c,
  245. [TROCR] = 0x0180,
  246. [CDCR] = 0x0184,
  247. [LCCR] = 0x0188,
  248. [CNDCR] = 0x018c,
  249. [CEFCR] = 0x0194,
  250. [FRECR] = 0x0198,
  251. [TSFRCR] = 0x019c,
  252. [TLFRCR] = 0x01a0,
  253. [RFCR] = 0x01a4,
  254. [MAFCR] = 0x01a8,
  255. [IPGR] = 0x01b4,
  256. [APR] = 0x01b8,
  257. [MPR] = 0x01bc,
  258. [TPAUSER] = 0x01c4,
  259. [BCFR] = 0x01cc,
  260. [ARSTR] = 0x0000,
  261. [TSU_CTRST] = 0x0004,
  262. [TSU_FWEN0] = 0x0010,
  263. [TSU_FWEN1] = 0x0014,
  264. [TSU_FCM] = 0x0018,
  265. [TSU_BSYSL0] = 0x0020,
  266. [TSU_BSYSL1] = 0x0024,
  267. [TSU_PRISL0] = 0x0028,
  268. [TSU_PRISL1] = 0x002c,
  269. [TSU_FWSL0] = 0x0030,
  270. [TSU_FWSL1] = 0x0034,
  271. [TSU_FWSLC] = 0x0038,
  272. [TSU_QTAGM0] = 0x0040,
  273. [TSU_QTAGM1] = 0x0044,
  274. [TSU_ADQT0] = 0x0048,
  275. [TSU_ADQT1] = 0x004c,
  276. [TSU_FWSR] = 0x0050,
  277. [TSU_FWINMK] = 0x0054,
  278. [TSU_ADSBSY] = 0x0060,
  279. [TSU_TEN] = 0x0064,
  280. [TSU_POST1] = 0x0070,
  281. [TSU_POST2] = 0x0074,
  282. [TSU_POST3] = 0x0078,
  283. [TSU_POST4] = 0x007c,
  284. [TXNLCR0] = 0x0080,
  285. [TXALCR0] = 0x0084,
  286. [RXNLCR0] = 0x0088,
  287. [RXALCR0] = 0x008c,
  288. [FWNLCR0] = 0x0090,
  289. [FWALCR0] = 0x0094,
  290. [TXNLCR1] = 0x00a0,
  291. [TXALCR1] = 0x00a0,
  292. [RXNLCR1] = 0x00a8,
  293. [RXALCR1] = 0x00ac,
  294. [FWNLCR1] = 0x00b0,
  295. [FWALCR1] = 0x00b4,
  296. [TSU_ADRH0] = 0x0100,
  297. [TSU_ADRL0] = 0x0104,
  298. [TSU_ADRL31] = 0x01fc,
  299. };
  300. static int sh_eth_is_gether(struct sh_eth_private *mdp)
  301. {
  302. if (mdp->reg_offset == sh_eth_offset_gigabit)
  303. return 1;
  304. else
  305. return 0;
  306. }
  307. static void sh_eth_select_mii(struct net_device *ndev)
  308. {
  309. u32 value = 0x0;
  310. struct sh_eth_private *mdp = netdev_priv(ndev);
  311. switch (mdp->phy_interface) {
  312. case PHY_INTERFACE_MODE_GMII:
  313. value = 0x2;
  314. break;
  315. case PHY_INTERFACE_MODE_MII:
  316. value = 0x1;
  317. break;
  318. case PHY_INTERFACE_MODE_RMII:
  319. value = 0x0;
  320. break;
  321. default:
  322. pr_warn("PHY interface mode was not setup. Set to MII.\n");
  323. value = 0x1;
  324. break;
  325. }
  326. sh_eth_write(ndev, value, RMII_MII);
  327. }
  328. static void sh_eth_set_duplex(struct net_device *ndev)
  329. {
  330. struct sh_eth_private *mdp = netdev_priv(ndev);
  331. if (mdp->duplex) /* Full */
  332. sh_eth_write(ndev, sh_eth_read(ndev, ECMR) | ECMR_DM, ECMR);
  333. else /* Half */
  334. sh_eth_write(ndev, sh_eth_read(ndev, ECMR) & ~ECMR_DM, ECMR);
  335. }
  336. /* There is CPU dependent code */
  337. static void sh_eth_set_rate_r8a777x(struct net_device *ndev)
  338. {
  339. struct sh_eth_private *mdp = netdev_priv(ndev);
  340. switch (mdp->speed) {
  341. case 10: /* 10BASE */
  342. sh_eth_write(ndev, sh_eth_read(ndev, ECMR) & ~ECMR_ELB, ECMR);
  343. break;
  344. case 100:/* 100BASE */
  345. sh_eth_write(ndev, sh_eth_read(ndev, ECMR) | ECMR_ELB, ECMR);
  346. break;
  347. default:
  348. break;
  349. }
  350. }
  351. /* R8A7778/9 */
  352. static struct sh_eth_cpu_data r8a777x_data = {
  353. .set_duplex = sh_eth_set_duplex,
  354. .set_rate = sh_eth_set_rate_r8a777x,
  355. .ecsr_value = ECSR_PSRTO | ECSR_LCHNG | ECSR_ICD,
  356. .ecsipr_value = ECSIPR_PSRTOIP | ECSIPR_LCHNGIP | ECSIPR_ICDIP,
  357. .eesipr_value = 0x01ff009f,
  358. .tx_check = EESR_FTC | EESR_CND | EESR_DLC | EESR_CD | EESR_RTO,
  359. .eesr_err_check = EESR_TWB | EESR_TABT | EESR_RABT | EESR_RDE |
  360. EESR_RFRMER | EESR_TFE | EESR_TDE | EESR_ECI,
  361. .apr = 1,
  362. .mpr = 1,
  363. .tpauser = 1,
  364. .hw_swap = 1,
  365. };
  366. static void sh_eth_set_rate_sh7724(struct net_device *ndev)
  367. {
  368. struct sh_eth_private *mdp = netdev_priv(ndev);
  369. switch (mdp->speed) {
  370. case 10: /* 10BASE */
  371. sh_eth_write(ndev, sh_eth_read(ndev, ECMR) & ~ECMR_RTM, ECMR);
  372. break;
  373. case 100:/* 100BASE */
  374. sh_eth_write(ndev, sh_eth_read(ndev, ECMR) | ECMR_RTM, ECMR);
  375. break;
  376. default:
  377. break;
  378. }
  379. }
  380. /* SH7724 */
  381. static struct sh_eth_cpu_data sh7724_data = {
  382. .set_duplex = sh_eth_set_duplex,
  383. .set_rate = sh_eth_set_rate_sh7724,
  384. .ecsr_value = ECSR_PSRTO | ECSR_LCHNG | ECSR_ICD,
  385. .ecsipr_value = ECSIPR_PSRTOIP | ECSIPR_LCHNGIP | ECSIPR_ICDIP,
  386. .eesipr_value = 0x01ff009f,
  387. .tx_check = EESR_FTC | EESR_CND | EESR_DLC | EESR_CD | EESR_RTO,
  388. .eesr_err_check = EESR_TWB | EESR_TABT | EESR_RABT | EESR_RDE |
  389. EESR_RFRMER | EESR_TFE | EESR_TDE | EESR_ECI,
  390. .apr = 1,
  391. .mpr = 1,
  392. .tpauser = 1,
  393. .hw_swap = 1,
  394. .rpadir = 1,
  395. .rpadir_value = 0x00020000, /* NET_IP_ALIGN assumed to be 2 */
  396. };
  397. static void sh_eth_set_rate_sh7757(struct net_device *ndev)
  398. {
  399. struct sh_eth_private *mdp = netdev_priv(ndev);
  400. switch (mdp->speed) {
  401. case 10: /* 10BASE */
  402. sh_eth_write(ndev, 0, RTRATE);
  403. break;
  404. case 100:/* 100BASE */
  405. sh_eth_write(ndev, 1, RTRATE);
  406. break;
  407. default:
  408. break;
  409. }
  410. }
  411. /* SH7757 */
  412. static struct sh_eth_cpu_data sh7757_data = {
  413. .set_duplex = sh_eth_set_duplex,
  414. .set_rate = sh_eth_set_rate_sh7757,
  415. .eesipr_value = DMAC_M_RFRMER | DMAC_M_ECI | 0x003fffff,
  416. .rmcr_value = 0x00000001,
  417. .tx_check = EESR_FTC | EESR_CND | EESR_DLC | EESR_CD | EESR_RTO,
  418. .eesr_err_check = EESR_TWB | EESR_TABT | EESR_RABT | EESR_RDE |
  419. EESR_RFRMER | EESR_TFE | EESR_TDE | EESR_ECI,
  420. .irq_flags = IRQF_SHARED,
  421. .apr = 1,
  422. .mpr = 1,
  423. .tpauser = 1,
  424. .hw_swap = 1,
  425. .no_ade = 1,
  426. .rpadir = 1,
  427. .rpadir_value = 2 << 16,
  428. };
  429. #define SH_GIGA_ETH_BASE 0xfee00000UL
  430. #define GIGA_MALR(port) (SH_GIGA_ETH_BASE + 0x800 * (port) + 0x05c8)
  431. #define GIGA_MAHR(port) (SH_GIGA_ETH_BASE + 0x800 * (port) + 0x05c0)
  432. static void sh_eth_chip_reset_giga(struct net_device *ndev)
  433. {
  434. int i;
  435. unsigned long mahr[2], malr[2];
  436. /* save MAHR and MALR */
  437. for (i = 0; i < 2; i++) {
  438. malr[i] = ioread32((void *)GIGA_MALR(i));
  439. mahr[i] = ioread32((void *)GIGA_MAHR(i));
  440. }
  441. /* reset device */
  442. iowrite32(ARSTR_ARSTR, (void *)(SH_GIGA_ETH_BASE + 0x1800));
  443. mdelay(1);
  444. /* restore MAHR and MALR */
  445. for (i = 0; i < 2; i++) {
  446. iowrite32(malr[i], (void *)GIGA_MALR(i));
  447. iowrite32(mahr[i], (void *)GIGA_MAHR(i));
  448. }
  449. }
  450. static void sh_eth_set_rate_giga(struct net_device *ndev)
  451. {
  452. struct sh_eth_private *mdp = netdev_priv(ndev);
  453. switch (mdp->speed) {
  454. case 10: /* 10BASE */
  455. sh_eth_write(ndev, 0x00000000, GECMR);
  456. break;
  457. case 100:/* 100BASE */
  458. sh_eth_write(ndev, 0x00000010, GECMR);
  459. break;
  460. case 1000: /* 1000BASE */
  461. sh_eth_write(ndev, 0x00000020, GECMR);
  462. break;
  463. default:
  464. break;
  465. }
  466. }
  467. /* SH7757(GETHERC) */
  468. static struct sh_eth_cpu_data sh7757_data_giga = {
  469. .chip_reset = sh_eth_chip_reset_giga,
  470. .set_duplex = sh_eth_set_duplex,
  471. .set_rate = sh_eth_set_rate_giga,
  472. .ecsr_value = ECSR_ICD | ECSR_MPD,
  473. .ecsipr_value = ECSIPR_LCHNGIP | ECSIPR_ICDIP | ECSIPR_MPDIP,
  474. .eesipr_value = DMAC_M_RFRMER | DMAC_M_ECI | 0x003fffff,
  475. .tx_check = EESR_TC1 | EESR_FTC,
  476. .eesr_err_check = EESR_TWB1 | EESR_TWB | EESR_TABT | EESR_RABT | \
  477. EESR_RDE | EESR_RFRMER | EESR_TFE | EESR_TDE | \
  478. EESR_ECI,
  479. .fdr_value = 0x0000072f,
  480. .rmcr_value = 0x00000001,
  481. .irq_flags = IRQF_SHARED,
  482. .apr = 1,
  483. .mpr = 1,
  484. .tpauser = 1,
  485. .bculr = 1,
  486. .hw_swap = 1,
  487. .rpadir = 1,
  488. .rpadir_value = 2 << 16,
  489. .no_trimd = 1,
  490. .no_ade = 1,
  491. .tsu = 1,
  492. };
  493. static void sh_eth_chip_reset(struct net_device *ndev)
  494. {
  495. struct sh_eth_private *mdp = netdev_priv(ndev);
  496. /* reset device */
  497. sh_eth_tsu_write(mdp, ARSTR_ARSTR, ARSTR);
  498. mdelay(1);
  499. }
  500. static void sh_eth_set_rate_gether(struct net_device *ndev)
  501. {
  502. struct sh_eth_private *mdp = netdev_priv(ndev);
  503. switch (mdp->speed) {
  504. case 10: /* 10BASE */
  505. sh_eth_write(ndev, GECMR_10, GECMR);
  506. break;
  507. case 100:/* 100BASE */
  508. sh_eth_write(ndev, GECMR_100, GECMR);
  509. break;
  510. case 1000: /* 1000BASE */
  511. sh_eth_write(ndev, GECMR_1000, GECMR);
  512. break;
  513. default:
  514. break;
  515. }
  516. }
  517. /* SH7734 */
  518. static struct sh_eth_cpu_data sh7734_data = {
  519. .chip_reset = sh_eth_chip_reset,
  520. .set_duplex = sh_eth_set_duplex,
  521. .set_rate = sh_eth_set_rate_gether,
  522. .ecsr_value = ECSR_ICD | ECSR_MPD,
  523. .ecsipr_value = ECSIPR_LCHNGIP | ECSIPR_ICDIP | ECSIPR_MPDIP,
  524. .eesipr_value = DMAC_M_RFRMER | DMAC_M_ECI | 0x003fffff,
  525. .tx_check = EESR_TC1 | EESR_FTC,
  526. .eesr_err_check = EESR_TWB1 | EESR_TWB | EESR_TABT | EESR_RABT | \
  527. EESR_RDE | EESR_RFRMER | EESR_TFE | EESR_TDE | \
  528. EESR_ECI,
  529. .apr = 1,
  530. .mpr = 1,
  531. .tpauser = 1,
  532. .bculr = 1,
  533. .hw_swap = 1,
  534. .no_trimd = 1,
  535. .no_ade = 1,
  536. .tsu = 1,
  537. .hw_crc = 1,
  538. .select_mii = 1,
  539. };
  540. /* SH7763 */
  541. static struct sh_eth_cpu_data sh7763_data = {
  542. .chip_reset = sh_eth_chip_reset,
  543. .set_duplex = sh_eth_set_duplex,
  544. .set_rate = sh_eth_set_rate_gether,
  545. .ecsr_value = ECSR_ICD | ECSR_MPD,
  546. .ecsipr_value = ECSIPR_LCHNGIP | ECSIPR_ICDIP | ECSIPR_MPDIP,
  547. .eesipr_value = DMAC_M_RFRMER | DMAC_M_ECI | 0x003fffff,
  548. .tx_check = EESR_TC1 | EESR_FTC,
  549. .eesr_err_check = EESR_TWB1 | EESR_TWB | EESR_TABT | EESR_RABT | \
  550. EESR_RDE | EESR_RFRMER | EESR_TFE | EESR_TDE | \
  551. EESR_ECI,
  552. .apr = 1,
  553. .mpr = 1,
  554. .tpauser = 1,
  555. .bculr = 1,
  556. .hw_swap = 1,
  557. .no_trimd = 1,
  558. .no_ade = 1,
  559. .tsu = 1,
  560. .irq_flags = IRQF_SHARED,
  561. };
  562. static void sh_eth_chip_reset_r8a7740(struct net_device *ndev)
  563. {
  564. struct sh_eth_private *mdp = netdev_priv(ndev);
  565. /* reset device */
  566. sh_eth_tsu_write(mdp, ARSTR_ARSTR, ARSTR);
  567. mdelay(1);
  568. sh_eth_select_mii(ndev);
  569. }
  570. /* R8A7740 */
  571. static struct sh_eth_cpu_data r8a7740_data = {
  572. .chip_reset = sh_eth_chip_reset_r8a7740,
  573. .set_duplex = sh_eth_set_duplex,
  574. .set_rate = sh_eth_set_rate_gether,
  575. .ecsr_value = ECSR_ICD | ECSR_MPD,
  576. .ecsipr_value = ECSIPR_LCHNGIP | ECSIPR_ICDIP | ECSIPR_MPDIP,
  577. .eesipr_value = DMAC_M_RFRMER | DMAC_M_ECI | 0x003fffff,
  578. .tx_check = EESR_TC1 | EESR_FTC,
  579. .eesr_err_check = EESR_TWB1 | EESR_TWB | EESR_TABT | EESR_RABT | \
  580. EESR_RDE | EESR_RFRMER | EESR_TFE | EESR_TDE | \
  581. EESR_ECI,
  582. .apr = 1,
  583. .mpr = 1,
  584. .tpauser = 1,
  585. .bculr = 1,
  586. .hw_swap = 1,
  587. .no_trimd = 1,
  588. .no_ade = 1,
  589. .tsu = 1,
  590. .select_mii = 1,
  591. .shift_rd0 = 1,
  592. };
  593. static struct sh_eth_cpu_data sh7619_data = {
  594. .eesipr_value = DMAC_M_RFRMER | DMAC_M_ECI | 0x003fffff,
  595. .apr = 1,
  596. .mpr = 1,
  597. .tpauser = 1,
  598. .hw_swap = 1,
  599. };
  600. static struct sh_eth_cpu_data sh771x_data = {
  601. .eesipr_value = DMAC_M_RFRMER | DMAC_M_ECI | 0x003fffff,
  602. .tsu = 1,
  603. };
  604. static void sh_eth_set_default_cpu_data(struct sh_eth_cpu_data *cd)
  605. {
  606. if (!cd->ecsr_value)
  607. cd->ecsr_value = DEFAULT_ECSR_INIT;
  608. if (!cd->ecsipr_value)
  609. cd->ecsipr_value = DEFAULT_ECSIPR_INIT;
  610. if (!cd->fcftr_value)
  611. cd->fcftr_value = DEFAULT_FIFO_F_D_RFF | \
  612. DEFAULT_FIFO_F_D_RFD;
  613. if (!cd->fdr_value)
  614. cd->fdr_value = DEFAULT_FDR_INIT;
  615. if (!cd->rmcr_value)
  616. cd->rmcr_value = DEFAULT_RMCR_VALUE;
  617. if (!cd->tx_check)
  618. cd->tx_check = DEFAULT_TX_CHECK;
  619. if (!cd->eesr_err_check)
  620. cd->eesr_err_check = DEFAULT_EESR_ERR_CHECK;
  621. }
  622. static int sh_eth_check_reset(struct net_device *ndev)
  623. {
  624. int ret = 0;
  625. int cnt = 100;
  626. while (cnt > 0) {
  627. if (!(sh_eth_read(ndev, EDMR) & 0x3))
  628. break;
  629. mdelay(1);
  630. cnt--;
  631. }
  632. if (cnt <= 0) {
  633. pr_err("Device reset failed\n");
  634. ret = -ETIMEDOUT;
  635. }
  636. return ret;
  637. }
  638. static int sh_eth_reset(struct net_device *ndev)
  639. {
  640. struct sh_eth_private *mdp = netdev_priv(ndev);
  641. int ret = 0;
  642. if (sh_eth_is_gether(mdp)) {
  643. sh_eth_write(ndev, EDSR_ENALL, EDSR);
  644. sh_eth_write(ndev, sh_eth_read(ndev, EDMR) | EDMR_SRST_GETHER,
  645. EDMR);
  646. ret = sh_eth_check_reset(ndev);
  647. if (ret)
  648. goto out;
  649. /* Table Init */
  650. sh_eth_write(ndev, 0x0, TDLAR);
  651. sh_eth_write(ndev, 0x0, TDFAR);
  652. sh_eth_write(ndev, 0x0, TDFXR);
  653. sh_eth_write(ndev, 0x0, TDFFR);
  654. sh_eth_write(ndev, 0x0, RDLAR);
  655. sh_eth_write(ndev, 0x0, RDFAR);
  656. sh_eth_write(ndev, 0x0, RDFXR);
  657. sh_eth_write(ndev, 0x0, RDFFR);
  658. /* Reset HW CRC register */
  659. if (mdp->cd->hw_crc)
  660. sh_eth_write(ndev, 0x0, CSMR);
  661. /* Select MII mode */
  662. if (mdp->cd->select_mii)
  663. sh_eth_select_mii(ndev);
  664. } else {
  665. sh_eth_write(ndev, sh_eth_read(ndev, EDMR) | EDMR_SRST_ETHER,
  666. EDMR);
  667. mdelay(3);
  668. sh_eth_write(ndev, sh_eth_read(ndev, EDMR) & ~EDMR_SRST_ETHER,
  669. EDMR);
  670. }
  671. out:
  672. return ret;
  673. }
  674. #if defined(CONFIG_CPU_SH4) || defined(CONFIG_ARCH_SHMOBILE)
  675. static void sh_eth_set_receive_align(struct sk_buff *skb)
  676. {
  677. int reserve;
  678. reserve = SH4_SKB_RX_ALIGN - ((u32)skb->data & (SH4_SKB_RX_ALIGN - 1));
  679. if (reserve)
  680. skb_reserve(skb, reserve);
  681. }
  682. #else
  683. static void sh_eth_set_receive_align(struct sk_buff *skb)
  684. {
  685. skb_reserve(skb, SH2_SH3_SKB_RX_ALIGN);
  686. }
  687. #endif
  688. /* CPU <-> EDMAC endian convert */
  689. static inline __u32 cpu_to_edmac(struct sh_eth_private *mdp, u32 x)
  690. {
  691. switch (mdp->edmac_endian) {
  692. case EDMAC_LITTLE_ENDIAN:
  693. return cpu_to_le32(x);
  694. case EDMAC_BIG_ENDIAN:
  695. return cpu_to_be32(x);
  696. }
  697. return x;
  698. }
  699. static inline __u32 edmac_to_cpu(struct sh_eth_private *mdp, u32 x)
  700. {
  701. switch (mdp->edmac_endian) {
  702. case EDMAC_LITTLE_ENDIAN:
  703. return le32_to_cpu(x);
  704. case EDMAC_BIG_ENDIAN:
  705. return be32_to_cpu(x);
  706. }
  707. return x;
  708. }
  709. /*
  710. * Program the hardware MAC address from dev->dev_addr.
  711. */
  712. static void update_mac_address(struct net_device *ndev)
  713. {
  714. sh_eth_write(ndev,
  715. (ndev->dev_addr[0] << 24) | (ndev->dev_addr[1] << 16) |
  716. (ndev->dev_addr[2] << 8) | (ndev->dev_addr[3]), MAHR);
  717. sh_eth_write(ndev,
  718. (ndev->dev_addr[4] << 8) | (ndev->dev_addr[5]), MALR);
  719. }
  720. /*
  721. * Get MAC address from SuperH MAC address register
  722. *
  723. * SuperH's Ethernet device doesn't have 'ROM' to MAC address.
  724. * This driver get MAC address that use by bootloader(U-boot or sh-ipl+g).
  725. * When you want use this device, you must set MAC address in bootloader.
  726. *
  727. */
  728. static void read_mac_address(struct net_device *ndev, unsigned char *mac)
  729. {
  730. if (mac[0] || mac[1] || mac[2] || mac[3] || mac[4] || mac[5]) {
  731. memcpy(ndev->dev_addr, mac, 6);
  732. } else {
  733. ndev->dev_addr[0] = (sh_eth_read(ndev, MAHR) >> 24);
  734. ndev->dev_addr[1] = (sh_eth_read(ndev, MAHR) >> 16) & 0xFF;
  735. ndev->dev_addr[2] = (sh_eth_read(ndev, MAHR) >> 8) & 0xFF;
  736. ndev->dev_addr[3] = (sh_eth_read(ndev, MAHR) & 0xFF);
  737. ndev->dev_addr[4] = (sh_eth_read(ndev, MALR) >> 8) & 0xFF;
  738. ndev->dev_addr[5] = (sh_eth_read(ndev, MALR) & 0xFF);
  739. }
  740. }
  741. static unsigned long sh_eth_get_edtrr_trns(struct sh_eth_private *mdp)
  742. {
  743. if (sh_eth_is_gether(mdp))
  744. return EDTRR_TRNS_GETHER;
  745. else
  746. return EDTRR_TRNS_ETHER;
  747. }
  748. struct bb_info {
  749. void (*set_gate)(void *addr);
  750. struct mdiobb_ctrl ctrl;
  751. void *addr;
  752. u32 mmd_msk;/* MMD */
  753. u32 mdo_msk;
  754. u32 mdi_msk;
  755. u32 mdc_msk;
  756. };
  757. /* PHY bit set */
  758. static void bb_set(void *addr, u32 msk)
  759. {
  760. iowrite32(ioread32(addr) | msk, addr);
  761. }
  762. /* PHY bit clear */
  763. static void bb_clr(void *addr, u32 msk)
  764. {
  765. iowrite32((ioread32(addr) & ~msk), addr);
  766. }
  767. /* PHY bit read */
  768. static int bb_read(void *addr, u32 msk)
  769. {
  770. return (ioread32(addr) & msk) != 0;
  771. }
  772. /* Data I/O pin control */
  773. static void sh_mmd_ctrl(struct mdiobb_ctrl *ctrl, int bit)
  774. {
  775. struct bb_info *bitbang = container_of(ctrl, struct bb_info, ctrl);
  776. if (bitbang->set_gate)
  777. bitbang->set_gate(bitbang->addr);
  778. if (bit)
  779. bb_set(bitbang->addr, bitbang->mmd_msk);
  780. else
  781. bb_clr(bitbang->addr, bitbang->mmd_msk);
  782. }
  783. /* Set bit data*/
  784. static void sh_set_mdio(struct mdiobb_ctrl *ctrl, int bit)
  785. {
  786. struct bb_info *bitbang = container_of(ctrl, struct bb_info, ctrl);
  787. if (bitbang->set_gate)
  788. bitbang->set_gate(bitbang->addr);
  789. if (bit)
  790. bb_set(bitbang->addr, bitbang->mdo_msk);
  791. else
  792. bb_clr(bitbang->addr, bitbang->mdo_msk);
  793. }
  794. /* Get bit data*/
  795. static int sh_get_mdio(struct mdiobb_ctrl *ctrl)
  796. {
  797. struct bb_info *bitbang = container_of(ctrl, struct bb_info, ctrl);
  798. if (bitbang->set_gate)
  799. bitbang->set_gate(bitbang->addr);
  800. return bb_read(bitbang->addr, bitbang->mdi_msk);
  801. }
  802. /* MDC pin control */
  803. static void sh_mdc_ctrl(struct mdiobb_ctrl *ctrl, int bit)
  804. {
  805. struct bb_info *bitbang = container_of(ctrl, struct bb_info, ctrl);
  806. if (bitbang->set_gate)
  807. bitbang->set_gate(bitbang->addr);
  808. if (bit)
  809. bb_set(bitbang->addr, bitbang->mdc_msk);
  810. else
  811. bb_clr(bitbang->addr, bitbang->mdc_msk);
  812. }
  813. /* mdio bus control struct */
  814. static struct mdiobb_ops bb_ops = {
  815. .owner = THIS_MODULE,
  816. .set_mdc = sh_mdc_ctrl,
  817. .set_mdio_dir = sh_mmd_ctrl,
  818. .set_mdio_data = sh_set_mdio,
  819. .get_mdio_data = sh_get_mdio,
  820. };
  821. /* free skb and descriptor buffer */
  822. static void sh_eth_ring_free(struct net_device *ndev)
  823. {
  824. struct sh_eth_private *mdp = netdev_priv(ndev);
  825. int i;
  826. /* Free Rx skb ringbuffer */
  827. if (mdp->rx_skbuff) {
  828. for (i = 0; i < mdp->num_rx_ring; i++) {
  829. if (mdp->rx_skbuff[i])
  830. dev_kfree_skb(mdp->rx_skbuff[i]);
  831. }
  832. }
  833. kfree(mdp->rx_skbuff);
  834. mdp->rx_skbuff = NULL;
  835. /* Free Tx skb ringbuffer */
  836. if (mdp->tx_skbuff) {
  837. for (i = 0; i < mdp->num_tx_ring; i++) {
  838. if (mdp->tx_skbuff[i])
  839. dev_kfree_skb(mdp->tx_skbuff[i]);
  840. }
  841. }
  842. kfree(mdp->tx_skbuff);
  843. mdp->tx_skbuff = NULL;
  844. }
  845. /* format skb and descriptor buffer */
  846. static void sh_eth_ring_format(struct net_device *ndev)
  847. {
  848. struct sh_eth_private *mdp = netdev_priv(ndev);
  849. int i;
  850. struct sk_buff *skb;
  851. struct sh_eth_rxdesc *rxdesc = NULL;
  852. struct sh_eth_txdesc *txdesc = NULL;
  853. int rx_ringsize = sizeof(*rxdesc) * mdp->num_rx_ring;
  854. int tx_ringsize = sizeof(*txdesc) * mdp->num_tx_ring;
  855. mdp->cur_rx = mdp->cur_tx = 0;
  856. mdp->dirty_rx = mdp->dirty_tx = 0;
  857. memset(mdp->rx_ring, 0, rx_ringsize);
  858. /* build Rx ring buffer */
  859. for (i = 0; i < mdp->num_rx_ring; i++) {
  860. /* skb */
  861. mdp->rx_skbuff[i] = NULL;
  862. skb = netdev_alloc_skb(ndev, mdp->rx_buf_sz);
  863. mdp->rx_skbuff[i] = skb;
  864. if (skb == NULL)
  865. break;
  866. dma_map_single(&ndev->dev, skb->data, mdp->rx_buf_sz,
  867. DMA_FROM_DEVICE);
  868. sh_eth_set_receive_align(skb);
  869. /* RX descriptor */
  870. rxdesc = &mdp->rx_ring[i];
  871. rxdesc->addr = virt_to_phys(PTR_ALIGN(skb->data, 4));
  872. rxdesc->status = cpu_to_edmac(mdp, RD_RACT | RD_RFP);
  873. /* The size of the buffer is 16 byte boundary. */
  874. rxdesc->buffer_length = ALIGN(mdp->rx_buf_sz, 16);
  875. /* Rx descriptor address set */
  876. if (i == 0) {
  877. sh_eth_write(ndev, mdp->rx_desc_dma, RDLAR);
  878. if (sh_eth_is_gether(mdp))
  879. sh_eth_write(ndev, mdp->rx_desc_dma, RDFAR);
  880. }
  881. }
  882. mdp->dirty_rx = (u32) (i - mdp->num_rx_ring);
  883. /* Mark the last entry as wrapping the ring. */
  884. rxdesc->status |= cpu_to_edmac(mdp, RD_RDEL);
  885. memset(mdp->tx_ring, 0, tx_ringsize);
  886. /* build Tx ring buffer */
  887. for (i = 0; i < mdp->num_tx_ring; i++) {
  888. mdp->tx_skbuff[i] = NULL;
  889. txdesc = &mdp->tx_ring[i];
  890. txdesc->status = cpu_to_edmac(mdp, TD_TFP);
  891. txdesc->buffer_length = 0;
  892. if (i == 0) {
  893. /* Tx descriptor address set */
  894. sh_eth_write(ndev, mdp->tx_desc_dma, TDLAR);
  895. if (sh_eth_is_gether(mdp))
  896. sh_eth_write(ndev, mdp->tx_desc_dma, TDFAR);
  897. }
  898. }
  899. txdesc->status |= cpu_to_edmac(mdp, TD_TDLE);
  900. }
  901. /* Get skb and descriptor buffer */
  902. static int sh_eth_ring_init(struct net_device *ndev)
  903. {
  904. struct sh_eth_private *mdp = netdev_priv(ndev);
  905. int rx_ringsize, tx_ringsize, ret = 0;
  906. /*
  907. * +26 gets the maximum ethernet encapsulation, +7 & ~7 because the
  908. * card needs room to do 8 byte alignment, +2 so we can reserve
  909. * the first 2 bytes, and +16 gets room for the status word from the
  910. * card.
  911. */
  912. mdp->rx_buf_sz = (ndev->mtu <= 1492 ? PKT_BUF_SZ :
  913. (((ndev->mtu + 26 + 7) & ~7) + 2 + 16));
  914. if (mdp->cd->rpadir)
  915. mdp->rx_buf_sz += NET_IP_ALIGN;
  916. /* Allocate RX and TX skb rings */
  917. mdp->rx_skbuff = kmalloc_array(mdp->num_rx_ring,
  918. sizeof(*mdp->rx_skbuff), GFP_KERNEL);
  919. if (!mdp->rx_skbuff) {
  920. ret = -ENOMEM;
  921. return ret;
  922. }
  923. mdp->tx_skbuff = kmalloc_array(mdp->num_tx_ring,
  924. sizeof(*mdp->tx_skbuff), GFP_KERNEL);
  925. if (!mdp->tx_skbuff) {
  926. ret = -ENOMEM;
  927. goto skb_ring_free;
  928. }
  929. /* Allocate all Rx descriptors. */
  930. rx_ringsize = sizeof(struct sh_eth_rxdesc) * mdp->num_rx_ring;
  931. mdp->rx_ring = dma_alloc_coherent(NULL, rx_ringsize, &mdp->rx_desc_dma,
  932. GFP_KERNEL);
  933. if (!mdp->rx_ring) {
  934. ret = -ENOMEM;
  935. goto desc_ring_free;
  936. }
  937. mdp->dirty_rx = 0;
  938. /* Allocate all Tx descriptors. */
  939. tx_ringsize = sizeof(struct sh_eth_txdesc) * mdp->num_tx_ring;
  940. mdp->tx_ring = dma_alloc_coherent(NULL, tx_ringsize, &mdp->tx_desc_dma,
  941. GFP_KERNEL);
  942. if (!mdp->tx_ring) {
  943. ret = -ENOMEM;
  944. goto desc_ring_free;
  945. }
  946. return ret;
  947. desc_ring_free:
  948. /* free DMA buffer */
  949. dma_free_coherent(NULL, rx_ringsize, mdp->rx_ring, mdp->rx_desc_dma);
  950. skb_ring_free:
  951. /* Free Rx and Tx skb ring buffer */
  952. sh_eth_ring_free(ndev);
  953. mdp->tx_ring = NULL;
  954. mdp->rx_ring = NULL;
  955. return ret;
  956. }
  957. static void sh_eth_free_dma_buffer(struct sh_eth_private *mdp)
  958. {
  959. int ringsize;
  960. if (mdp->rx_ring) {
  961. ringsize = sizeof(struct sh_eth_rxdesc) * mdp->num_rx_ring;
  962. dma_free_coherent(NULL, ringsize, mdp->rx_ring,
  963. mdp->rx_desc_dma);
  964. mdp->rx_ring = NULL;
  965. }
  966. if (mdp->tx_ring) {
  967. ringsize = sizeof(struct sh_eth_txdesc) * mdp->num_tx_ring;
  968. dma_free_coherent(NULL, ringsize, mdp->tx_ring,
  969. mdp->tx_desc_dma);
  970. mdp->tx_ring = NULL;
  971. }
  972. }
  973. static int sh_eth_dev_init(struct net_device *ndev, bool start)
  974. {
  975. int ret = 0;
  976. struct sh_eth_private *mdp = netdev_priv(ndev);
  977. u32 val;
  978. /* Soft Reset */
  979. ret = sh_eth_reset(ndev);
  980. if (ret)
  981. goto out;
  982. /* Descriptor format */
  983. sh_eth_ring_format(ndev);
  984. if (mdp->cd->rpadir)
  985. sh_eth_write(ndev, mdp->cd->rpadir_value, RPADIR);
  986. /* all sh_eth int mask */
  987. sh_eth_write(ndev, 0, EESIPR);
  988. #if defined(__LITTLE_ENDIAN)
  989. if (mdp->cd->hw_swap)
  990. sh_eth_write(ndev, EDMR_EL, EDMR);
  991. else
  992. #endif
  993. sh_eth_write(ndev, 0, EDMR);
  994. /* FIFO size set */
  995. sh_eth_write(ndev, mdp->cd->fdr_value, FDR);
  996. sh_eth_write(ndev, 0, TFTR);
  997. /* Frame recv control */
  998. sh_eth_write(ndev, mdp->cd->rmcr_value, RMCR);
  999. sh_eth_write(ndev, DESC_I_RINT8 | DESC_I_RINT5 | DESC_I_TINT2, TRSCER);
  1000. if (mdp->cd->bculr)
  1001. sh_eth_write(ndev, 0x800, BCULR); /* Burst sycle set */
  1002. sh_eth_write(ndev, mdp->cd->fcftr_value, FCFTR);
  1003. if (!mdp->cd->no_trimd)
  1004. sh_eth_write(ndev, 0, TRIMD);
  1005. /* Recv frame limit set register */
  1006. sh_eth_write(ndev, ndev->mtu + ETH_HLEN + VLAN_HLEN + ETH_FCS_LEN,
  1007. RFLR);
  1008. sh_eth_write(ndev, sh_eth_read(ndev, EESR), EESR);
  1009. if (start)
  1010. sh_eth_write(ndev, mdp->cd->eesipr_value, EESIPR);
  1011. /* PAUSE Prohibition */
  1012. val = (sh_eth_read(ndev, ECMR) & ECMR_DM) |
  1013. ECMR_ZPF | (mdp->duplex ? ECMR_DM : 0) | ECMR_TE | ECMR_RE;
  1014. sh_eth_write(ndev, val, ECMR);
  1015. if (mdp->cd->set_rate)
  1016. mdp->cd->set_rate(ndev);
  1017. /* E-MAC Status Register clear */
  1018. sh_eth_write(ndev, mdp->cd->ecsr_value, ECSR);
  1019. /* E-MAC Interrupt Enable register */
  1020. if (start)
  1021. sh_eth_write(ndev, mdp->cd->ecsipr_value, ECSIPR);
  1022. /* Set MAC address */
  1023. update_mac_address(ndev);
  1024. /* mask reset */
  1025. if (mdp->cd->apr)
  1026. sh_eth_write(ndev, APR_AP, APR);
  1027. if (mdp->cd->mpr)
  1028. sh_eth_write(ndev, MPR_MP, MPR);
  1029. if (mdp->cd->tpauser)
  1030. sh_eth_write(ndev, TPAUSER_UNLIMITED, TPAUSER);
  1031. if (start) {
  1032. /* Setting the Rx mode will start the Rx process. */
  1033. sh_eth_write(ndev, EDRRR_R, EDRRR);
  1034. netif_start_queue(ndev);
  1035. }
  1036. out:
  1037. return ret;
  1038. }
  1039. /* free Tx skb function */
  1040. static int sh_eth_txfree(struct net_device *ndev)
  1041. {
  1042. struct sh_eth_private *mdp = netdev_priv(ndev);
  1043. struct sh_eth_txdesc *txdesc;
  1044. int freeNum = 0;
  1045. int entry = 0;
  1046. for (; mdp->cur_tx - mdp->dirty_tx > 0; mdp->dirty_tx++) {
  1047. entry = mdp->dirty_tx % mdp->num_tx_ring;
  1048. txdesc = &mdp->tx_ring[entry];
  1049. if (txdesc->status & cpu_to_edmac(mdp, TD_TACT))
  1050. break;
  1051. /* Free the original skb. */
  1052. if (mdp->tx_skbuff[entry]) {
  1053. dma_unmap_single(&ndev->dev, txdesc->addr,
  1054. txdesc->buffer_length, DMA_TO_DEVICE);
  1055. dev_kfree_skb_irq(mdp->tx_skbuff[entry]);
  1056. mdp->tx_skbuff[entry] = NULL;
  1057. freeNum++;
  1058. }
  1059. txdesc->status = cpu_to_edmac(mdp, TD_TFP);
  1060. if (entry >= mdp->num_tx_ring - 1)
  1061. txdesc->status |= cpu_to_edmac(mdp, TD_TDLE);
  1062. ndev->stats.tx_packets++;
  1063. ndev->stats.tx_bytes += txdesc->buffer_length;
  1064. }
  1065. return freeNum;
  1066. }
  1067. /* Packet receive function */
  1068. static int sh_eth_rx(struct net_device *ndev, u32 intr_status, int *quota)
  1069. {
  1070. struct sh_eth_private *mdp = netdev_priv(ndev);
  1071. struct sh_eth_rxdesc *rxdesc;
  1072. int entry = mdp->cur_rx % mdp->num_rx_ring;
  1073. int boguscnt = (mdp->dirty_rx + mdp->num_rx_ring) - mdp->cur_rx;
  1074. struct sk_buff *skb;
  1075. int exceeded = 0;
  1076. u16 pkt_len = 0;
  1077. u32 desc_status;
  1078. rxdesc = &mdp->rx_ring[entry];
  1079. while (!(rxdesc->status & cpu_to_edmac(mdp, RD_RACT))) {
  1080. desc_status = edmac_to_cpu(mdp, rxdesc->status);
  1081. pkt_len = rxdesc->frame_length;
  1082. if (--boguscnt < 0)
  1083. break;
  1084. if (*quota <= 0) {
  1085. exceeded = 1;
  1086. break;
  1087. }
  1088. (*quota)--;
  1089. if (!(desc_status & RDFEND))
  1090. ndev->stats.rx_length_errors++;
  1091. /*
  1092. * In case of almost all GETHER/ETHERs, the Receive Frame State
  1093. * (RFS) bits in the Receive Descriptor 0 are from bit 9 to
  1094. * bit 0. However, in case of the R8A7740's GETHER, the RFS
  1095. * bits are from bit 25 to bit 16. So, the driver needs right
  1096. * shifting by 16.
  1097. */
  1098. if (mdp->cd->shift_rd0)
  1099. desc_status >>= 16;
  1100. if (desc_status & (RD_RFS1 | RD_RFS2 | RD_RFS3 | RD_RFS4 |
  1101. RD_RFS5 | RD_RFS6 | RD_RFS10)) {
  1102. ndev->stats.rx_errors++;
  1103. if (desc_status & RD_RFS1)
  1104. ndev->stats.rx_crc_errors++;
  1105. if (desc_status & RD_RFS2)
  1106. ndev->stats.rx_frame_errors++;
  1107. if (desc_status & RD_RFS3)
  1108. ndev->stats.rx_length_errors++;
  1109. if (desc_status & RD_RFS4)
  1110. ndev->stats.rx_length_errors++;
  1111. if (desc_status & RD_RFS6)
  1112. ndev->stats.rx_missed_errors++;
  1113. if (desc_status & RD_RFS10)
  1114. ndev->stats.rx_over_errors++;
  1115. } else {
  1116. if (!mdp->cd->hw_swap)
  1117. sh_eth_soft_swap(
  1118. phys_to_virt(ALIGN(rxdesc->addr, 4)),
  1119. pkt_len + 2);
  1120. skb = mdp->rx_skbuff[entry];
  1121. mdp->rx_skbuff[entry] = NULL;
  1122. if (mdp->cd->rpadir)
  1123. skb_reserve(skb, NET_IP_ALIGN);
  1124. skb_put(skb, pkt_len);
  1125. skb->protocol = eth_type_trans(skb, ndev);
  1126. netif_rx(skb);
  1127. ndev->stats.rx_packets++;
  1128. ndev->stats.rx_bytes += pkt_len;
  1129. }
  1130. rxdesc->status |= cpu_to_edmac(mdp, RD_RACT);
  1131. entry = (++mdp->cur_rx) % mdp->num_rx_ring;
  1132. rxdesc = &mdp->rx_ring[entry];
  1133. }
  1134. /* Refill the Rx ring buffers. */
  1135. for (; mdp->cur_rx - mdp->dirty_rx > 0; mdp->dirty_rx++) {
  1136. entry = mdp->dirty_rx % mdp->num_rx_ring;
  1137. rxdesc = &mdp->rx_ring[entry];
  1138. /* The size of the buffer is 16 byte boundary. */
  1139. rxdesc->buffer_length = ALIGN(mdp->rx_buf_sz, 16);
  1140. if (mdp->rx_skbuff[entry] == NULL) {
  1141. skb = netdev_alloc_skb(ndev, mdp->rx_buf_sz);
  1142. mdp->rx_skbuff[entry] = skb;
  1143. if (skb == NULL)
  1144. break; /* Better luck next round. */
  1145. dma_map_single(&ndev->dev, skb->data, mdp->rx_buf_sz,
  1146. DMA_FROM_DEVICE);
  1147. sh_eth_set_receive_align(skb);
  1148. skb_checksum_none_assert(skb);
  1149. rxdesc->addr = virt_to_phys(PTR_ALIGN(skb->data, 4));
  1150. }
  1151. if (entry >= mdp->num_rx_ring - 1)
  1152. rxdesc->status |=
  1153. cpu_to_edmac(mdp, RD_RACT | RD_RFP | RD_RDEL);
  1154. else
  1155. rxdesc->status |=
  1156. cpu_to_edmac(mdp, RD_RACT | RD_RFP);
  1157. }
  1158. /* Restart Rx engine if stopped. */
  1159. /* If we don't need to check status, don't. -KDU */
  1160. if (!(sh_eth_read(ndev, EDRRR) & EDRRR_R)) {
  1161. /* fix the values for the next receiving if RDE is set */
  1162. if (intr_status & EESR_RDE)
  1163. mdp->cur_rx = mdp->dirty_rx =
  1164. (sh_eth_read(ndev, RDFAR) -
  1165. sh_eth_read(ndev, RDLAR)) >> 4;
  1166. sh_eth_write(ndev, EDRRR_R, EDRRR);
  1167. }
  1168. return exceeded;
  1169. }
  1170. static void sh_eth_rcv_snd_disable(struct net_device *ndev)
  1171. {
  1172. /* disable tx and rx */
  1173. sh_eth_write(ndev, sh_eth_read(ndev, ECMR) &
  1174. ~(ECMR_RE | ECMR_TE), ECMR);
  1175. }
  1176. static void sh_eth_rcv_snd_enable(struct net_device *ndev)
  1177. {
  1178. /* enable tx and rx */
  1179. sh_eth_write(ndev, sh_eth_read(ndev, ECMR) |
  1180. (ECMR_RE | ECMR_TE), ECMR);
  1181. }
  1182. /* error control function */
  1183. static void sh_eth_error(struct net_device *ndev, int intr_status)
  1184. {
  1185. struct sh_eth_private *mdp = netdev_priv(ndev);
  1186. u32 felic_stat;
  1187. u32 link_stat;
  1188. u32 mask;
  1189. if (intr_status & EESR_ECI) {
  1190. felic_stat = sh_eth_read(ndev, ECSR);
  1191. sh_eth_write(ndev, felic_stat, ECSR); /* clear int */
  1192. if (felic_stat & ECSR_ICD)
  1193. ndev->stats.tx_carrier_errors++;
  1194. if (felic_stat & ECSR_LCHNG) {
  1195. /* Link Changed */
  1196. if (mdp->cd->no_psr || mdp->no_ether_link) {
  1197. goto ignore_link;
  1198. } else {
  1199. link_stat = (sh_eth_read(ndev, PSR));
  1200. if (mdp->ether_link_active_low)
  1201. link_stat = ~link_stat;
  1202. }
  1203. if (!(link_stat & PHY_ST_LINK))
  1204. sh_eth_rcv_snd_disable(ndev);
  1205. else {
  1206. /* Link Up */
  1207. sh_eth_write(ndev, sh_eth_read(ndev, EESIPR) &
  1208. ~DMAC_M_ECI, EESIPR);
  1209. /*clear int */
  1210. sh_eth_write(ndev, sh_eth_read(ndev, ECSR),
  1211. ECSR);
  1212. sh_eth_write(ndev, sh_eth_read(ndev, EESIPR) |
  1213. DMAC_M_ECI, EESIPR);
  1214. /* enable tx and rx */
  1215. sh_eth_rcv_snd_enable(ndev);
  1216. }
  1217. }
  1218. }
  1219. ignore_link:
  1220. if (intr_status & EESR_TWB) {
  1221. /* Write buck end. unused write back interrupt */
  1222. if (intr_status & EESR_TABT) /* Transmit Abort int */
  1223. ndev->stats.tx_aborted_errors++;
  1224. if (netif_msg_tx_err(mdp))
  1225. dev_err(&ndev->dev, "Transmit Abort\n");
  1226. }
  1227. if (intr_status & EESR_RABT) {
  1228. /* Receive Abort int */
  1229. if (intr_status & EESR_RFRMER) {
  1230. /* Receive Frame Overflow int */
  1231. ndev->stats.rx_frame_errors++;
  1232. if (netif_msg_rx_err(mdp))
  1233. dev_err(&ndev->dev, "Receive Abort\n");
  1234. }
  1235. }
  1236. if (intr_status & EESR_TDE) {
  1237. /* Transmit Descriptor Empty int */
  1238. ndev->stats.tx_fifo_errors++;
  1239. if (netif_msg_tx_err(mdp))
  1240. dev_err(&ndev->dev, "Transmit Descriptor Empty\n");
  1241. }
  1242. if (intr_status & EESR_TFE) {
  1243. /* FIFO under flow */
  1244. ndev->stats.tx_fifo_errors++;
  1245. if (netif_msg_tx_err(mdp))
  1246. dev_err(&ndev->dev, "Transmit FIFO Under flow\n");
  1247. }
  1248. if (intr_status & EESR_RDE) {
  1249. /* Receive Descriptor Empty int */
  1250. ndev->stats.rx_over_errors++;
  1251. if (netif_msg_rx_err(mdp))
  1252. dev_err(&ndev->dev, "Receive Descriptor Empty\n");
  1253. }
  1254. if (intr_status & EESR_RFE) {
  1255. /* Receive FIFO Overflow int */
  1256. ndev->stats.rx_fifo_errors++;
  1257. if (netif_msg_rx_err(mdp))
  1258. dev_err(&ndev->dev, "Receive FIFO Overflow\n");
  1259. }
  1260. if (!mdp->cd->no_ade && (intr_status & EESR_ADE)) {
  1261. /* Address Error */
  1262. ndev->stats.tx_fifo_errors++;
  1263. if (netif_msg_tx_err(mdp))
  1264. dev_err(&ndev->dev, "Address Error\n");
  1265. }
  1266. mask = EESR_TWB | EESR_TABT | EESR_ADE | EESR_TDE | EESR_TFE;
  1267. if (mdp->cd->no_ade)
  1268. mask &= ~EESR_ADE;
  1269. if (intr_status & mask) {
  1270. /* Tx error */
  1271. u32 edtrr = sh_eth_read(ndev, EDTRR);
  1272. /* dmesg */
  1273. dev_err(&ndev->dev, "TX error. status=%8.8x cur_tx=%8.8x ",
  1274. intr_status, mdp->cur_tx);
  1275. dev_err(&ndev->dev, "dirty_tx=%8.8x state=%8.8x EDTRR=%8.8x.\n",
  1276. mdp->dirty_tx, (u32) ndev->state, edtrr);
  1277. /* dirty buffer free */
  1278. sh_eth_txfree(ndev);
  1279. /* SH7712 BUG */
  1280. if (edtrr ^ sh_eth_get_edtrr_trns(mdp)) {
  1281. /* tx dma start */
  1282. sh_eth_write(ndev, sh_eth_get_edtrr_trns(mdp), EDTRR);
  1283. }
  1284. /* wakeup */
  1285. netif_wake_queue(ndev);
  1286. }
  1287. }
  1288. static irqreturn_t sh_eth_interrupt(int irq, void *netdev)
  1289. {
  1290. struct net_device *ndev = netdev;
  1291. struct sh_eth_private *mdp = netdev_priv(ndev);
  1292. struct sh_eth_cpu_data *cd = mdp->cd;
  1293. irqreturn_t ret = IRQ_NONE;
  1294. unsigned long intr_status, intr_enable;
  1295. spin_lock(&mdp->lock);
  1296. /* Get interrupt status */
  1297. intr_status = sh_eth_read(ndev, EESR);
  1298. /* Mask it with the interrupt mask, forcing ECI interrupt to be always
  1299. * enabled since it's the one that comes thru regardless of the mask,
  1300. * and we need to fully handle it in sh_eth_error() in order to quench
  1301. * it as it doesn't get cleared by just writing 1 to the ECI bit...
  1302. */
  1303. intr_enable = sh_eth_read(ndev, EESIPR);
  1304. intr_status &= intr_enable | DMAC_M_ECI;
  1305. if (intr_status & (EESR_RX_CHECK | cd->tx_check | cd->eesr_err_check))
  1306. ret = IRQ_HANDLED;
  1307. else
  1308. goto other_irq;
  1309. if (intr_status & EESR_RX_CHECK) {
  1310. if (napi_schedule_prep(&mdp->napi)) {
  1311. /* Mask Rx interrupts */
  1312. sh_eth_write(ndev, intr_enable & ~EESR_RX_CHECK,
  1313. EESIPR);
  1314. __napi_schedule(&mdp->napi);
  1315. } else {
  1316. dev_warn(&ndev->dev,
  1317. "ignoring interrupt, status 0x%08lx, mask 0x%08lx.\n",
  1318. intr_status, intr_enable);
  1319. }
  1320. }
  1321. /* Tx Check */
  1322. if (intr_status & cd->tx_check) {
  1323. /* Clear Tx interrupts */
  1324. sh_eth_write(ndev, intr_status & cd->tx_check, EESR);
  1325. sh_eth_txfree(ndev);
  1326. netif_wake_queue(ndev);
  1327. }
  1328. if (intr_status & cd->eesr_err_check) {
  1329. /* Clear error interrupts */
  1330. sh_eth_write(ndev, intr_status & cd->eesr_err_check, EESR);
  1331. sh_eth_error(ndev, intr_status);
  1332. }
  1333. other_irq:
  1334. spin_unlock(&mdp->lock);
  1335. return ret;
  1336. }
  1337. static int sh_eth_poll(struct napi_struct *napi, int budget)
  1338. {
  1339. struct sh_eth_private *mdp = container_of(napi, struct sh_eth_private,
  1340. napi);
  1341. struct net_device *ndev = napi->dev;
  1342. int quota = budget;
  1343. unsigned long intr_status;
  1344. for (;;) {
  1345. intr_status = sh_eth_read(ndev, EESR);
  1346. if (!(intr_status & EESR_RX_CHECK))
  1347. break;
  1348. /* Clear Rx interrupts */
  1349. sh_eth_write(ndev, intr_status & EESR_RX_CHECK, EESR);
  1350. if (sh_eth_rx(ndev, intr_status, &quota))
  1351. goto out;
  1352. }
  1353. napi_complete(napi);
  1354. /* Reenable Rx interrupts */
  1355. sh_eth_write(ndev, mdp->cd->eesipr_value, EESIPR);
  1356. out:
  1357. return budget - quota;
  1358. }
  1359. /* PHY state control function */
  1360. static void sh_eth_adjust_link(struct net_device *ndev)
  1361. {
  1362. struct sh_eth_private *mdp = netdev_priv(ndev);
  1363. struct phy_device *phydev = mdp->phydev;
  1364. int new_state = 0;
  1365. if (phydev->link) {
  1366. if (phydev->duplex != mdp->duplex) {
  1367. new_state = 1;
  1368. mdp->duplex = phydev->duplex;
  1369. if (mdp->cd->set_duplex)
  1370. mdp->cd->set_duplex(ndev);
  1371. }
  1372. if (phydev->speed != mdp->speed) {
  1373. new_state = 1;
  1374. mdp->speed = phydev->speed;
  1375. if (mdp->cd->set_rate)
  1376. mdp->cd->set_rate(ndev);
  1377. }
  1378. if (!mdp->link) {
  1379. sh_eth_write(ndev,
  1380. (sh_eth_read(ndev, ECMR) & ~ECMR_TXF), ECMR);
  1381. new_state = 1;
  1382. mdp->link = phydev->link;
  1383. if (mdp->cd->no_psr || mdp->no_ether_link)
  1384. sh_eth_rcv_snd_enable(ndev);
  1385. }
  1386. } else if (mdp->link) {
  1387. new_state = 1;
  1388. mdp->link = 0;
  1389. mdp->speed = 0;
  1390. mdp->duplex = -1;
  1391. if (mdp->cd->no_psr || mdp->no_ether_link)
  1392. sh_eth_rcv_snd_disable(ndev);
  1393. }
  1394. if (new_state && netif_msg_link(mdp))
  1395. phy_print_status(phydev);
  1396. }
  1397. /* PHY init function */
  1398. static int sh_eth_phy_init(struct net_device *ndev)
  1399. {
  1400. struct sh_eth_private *mdp = netdev_priv(ndev);
  1401. char phy_id[MII_BUS_ID_SIZE + 3];
  1402. struct phy_device *phydev = NULL;
  1403. snprintf(phy_id, sizeof(phy_id), PHY_ID_FMT,
  1404. mdp->mii_bus->id , mdp->phy_id);
  1405. mdp->link = 0;
  1406. mdp->speed = 0;
  1407. mdp->duplex = -1;
  1408. /* Try connect to PHY */
  1409. phydev = phy_connect(ndev, phy_id, sh_eth_adjust_link,
  1410. mdp->phy_interface);
  1411. if (IS_ERR(phydev)) {
  1412. dev_err(&ndev->dev, "phy_connect failed\n");
  1413. return PTR_ERR(phydev);
  1414. }
  1415. dev_info(&ndev->dev, "attached phy %i to driver %s\n",
  1416. phydev->addr, phydev->drv->name);
  1417. mdp->phydev = phydev;
  1418. return 0;
  1419. }
  1420. /* PHY control start function */
  1421. static int sh_eth_phy_start(struct net_device *ndev)
  1422. {
  1423. struct sh_eth_private *mdp = netdev_priv(ndev);
  1424. int ret;
  1425. ret = sh_eth_phy_init(ndev);
  1426. if (ret)
  1427. return ret;
  1428. /* reset phy - this also wakes it from PDOWN */
  1429. phy_write(mdp->phydev, MII_BMCR, BMCR_RESET);
  1430. phy_start(mdp->phydev);
  1431. return 0;
  1432. }
  1433. static int sh_eth_get_settings(struct net_device *ndev,
  1434. struct ethtool_cmd *ecmd)
  1435. {
  1436. struct sh_eth_private *mdp = netdev_priv(ndev);
  1437. unsigned long flags;
  1438. int ret;
  1439. spin_lock_irqsave(&mdp->lock, flags);
  1440. ret = phy_ethtool_gset(mdp->phydev, ecmd);
  1441. spin_unlock_irqrestore(&mdp->lock, flags);
  1442. return ret;
  1443. }
  1444. static int sh_eth_set_settings(struct net_device *ndev,
  1445. struct ethtool_cmd *ecmd)
  1446. {
  1447. struct sh_eth_private *mdp = netdev_priv(ndev);
  1448. unsigned long flags;
  1449. int ret;
  1450. spin_lock_irqsave(&mdp->lock, flags);
  1451. /* disable tx and rx */
  1452. sh_eth_rcv_snd_disable(ndev);
  1453. ret = phy_ethtool_sset(mdp->phydev, ecmd);
  1454. if (ret)
  1455. goto error_exit;
  1456. if (ecmd->duplex == DUPLEX_FULL)
  1457. mdp->duplex = 1;
  1458. else
  1459. mdp->duplex = 0;
  1460. if (mdp->cd->set_duplex)
  1461. mdp->cd->set_duplex(ndev);
  1462. error_exit:
  1463. mdelay(1);
  1464. /* enable tx and rx */
  1465. sh_eth_rcv_snd_enable(ndev);
  1466. spin_unlock_irqrestore(&mdp->lock, flags);
  1467. return ret;
  1468. }
  1469. static int sh_eth_nway_reset(struct net_device *ndev)
  1470. {
  1471. struct sh_eth_private *mdp = netdev_priv(ndev);
  1472. unsigned long flags;
  1473. int ret;
  1474. spin_lock_irqsave(&mdp->lock, flags);
  1475. ret = phy_start_aneg(mdp->phydev);
  1476. spin_unlock_irqrestore(&mdp->lock, flags);
  1477. return ret;
  1478. }
  1479. static u32 sh_eth_get_msglevel(struct net_device *ndev)
  1480. {
  1481. struct sh_eth_private *mdp = netdev_priv(ndev);
  1482. return mdp->msg_enable;
  1483. }
  1484. static void sh_eth_set_msglevel(struct net_device *ndev, u32 value)
  1485. {
  1486. struct sh_eth_private *mdp = netdev_priv(ndev);
  1487. mdp->msg_enable = value;
  1488. }
  1489. static const char sh_eth_gstrings_stats[][ETH_GSTRING_LEN] = {
  1490. "rx_current", "tx_current",
  1491. "rx_dirty", "tx_dirty",
  1492. };
  1493. #define SH_ETH_STATS_LEN ARRAY_SIZE(sh_eth_gstrings_stats)
  1494. static int sh_eth_get_sset_count(struct net_device *netdev, int sset)
  1495. {
  1496. switch (sset) {
  1497. case ETH_SS_STATS:
  1498. return SH_ETH_STATS_LEN;
  1499. default:
  1500. return -EOPNOTSUPP;
  1501. }
  1502. }
  1503. static void sh_eth_get_ethtool_stats(struct net_device *ndev,
  1504. struct ethtool_stats *stats, u64 *data)
  1505. {
  1506. struct sh_eth_private *mdp = netdev_priv(ndev);
  1507. int i = 0;
  1508. /* device-specific stats */
  1509. data[i++] = mdp->cur_rx;
  1510. data[i++] = mdp->cur_tx;
  1511. data[i++] = mdp->dirty_rx;
  1512. data[i++] = mdp->dirty_tx;
  1513. }
  1514. static void sh_eth_get_strings(struct net_device *ndev, u32 stringset, u8 *data)
  1515. {
  1516. switch (stringset) {
  1517. case ETH_SS_STATS:
  1518. memcpy(data, *sh_eth_gstrings_stats,
  1519. sizeof(sh_eth_gstrings_stats));
  1520. break;
  1521. }
  1522. }
  1523. static void sh_eth_get_ringparam(struct net_device *ndev,
  1524. struct ethtool_ringparam *ring)
  1525. {
  1526. struct sh_eth_private *mdp = netdev_priv(ndev);
  1527. ring->rx_max_pending = RX_RING_MAX;
  1528. ring->tx_max_pending = TX_RING_MAX;
  1529. ring->rx_pending = mdp->num_rx_ring;
  1530. ring->tx_pending = mdp->num_tx_ring;
  1531. }
  1532. static int sh_eth_set_ringparam(struct net_device *ndev,
  1533. struct ethtool_ringparam *ring)
  1534. {
  1535. struct sh_eth_private *mdp = netdev_priv(ndev);
  1536. int ret;
  1537. if (ring->tx_pending > TX_RING_MAX ||
  1538. ring->rx_pending > RX_RING_MAX ||
  1539. ring->tx_pending < TX_RING_MIN ||
  1540. ring->rx_pending < RX_RING_MIN)
  1541. return -EINVAL;
  1542. if (ring->rx_mini_pending || ring->rx_jumbo_pending)
  1543. return -EINVAL;
  1544. if (netif_running(ndev)) {
  1545. netif_tx_disable(ndev);
  1546. /* Disable interrupts by clearing the interrupt mask. */
  1547. sh_eth_write(ndev, 0x0000, EESIPR);
  1548. /* Stop the chip's Tx and Rx processes. */
  1549. sh_eth_write(ndev, 0, EDTRR);
  1550. sh_eth_write(ndev, 0, EDRRR);
  1551. synchronize_irq(ndev->irq);
  1552. }
  1553. /* Free all the skbuffs in the Rx queue. */
  1554. sh_eth_ring_free(ndev);
  1555. /* Free DMA buffer */
  1556. sh_eth_free_dma_buffer(mdp);
  1557. /* Set new parameters */
  1558. mdp->num_rx_ring = ring->rx_pending;
  1559. mdp->num_tx_ring = ring->tx_pending;
  1560. ret = sh_eth_ring_init(ndev);
  1561. if (ret < 0) {
  1562. dev_err(&ndev->dev, "%s: sh_eth_ring_init failed.\n", __func__);
  1563. return ret;
  1564. }
  1565. ret = sh_eth_dev_init(ndev, false);
  1566. if (ret < 0) {
  1567. dev_err(&ndev->dev, "%s: sh_eth_dev_init failed.\n", __func__);
  1568. return ret;
  1569. }
  1570. if (netif_running(ndev)) {
  1571. sh_eth_write(ndev, mdp->cd->eesipr_value, EESIPR);
  1572. /* Setting the Rx mode will start the Rx process. */
  1573. sh_eth_write(ndev, EDRRR_R, EDRRR);
  1574. netif_wake_queue(ndev);
  1575. }
  1576. return 0;
  1577. }
  1578. static const struct ethtool_ops sh_eth_ethtool_ops = {
  1579. .get_settings = sh_eth_get_settings,
  1580. .set_settings = sh_eth_set_settings,
  1581. .nway_reset = sh_eth_nway_reset,
  1582. .get_msglevel = sh_eth_get_msglevel,
  1583. .set_msglevel = sh_eth_set_msglevel,
  1584. .get_link = ethtool_op_get_link,
  1585. .get_strings = sh_eth_get_strings,
  1586. .get_ethtool_stats = sh_eth_get_ethtool_stats,
  1587. .get_sset_count = sh_eth_get_sset_count,
  1588. .get_ringparam = sh_eth_get_ringparam,
  1589. .set_ringparam = sh_eth_set_ringparam,
  1590. };
  1591. /* network device open function */
  1592. static int sh_eth_open(struct net_device *ndev)
  1593. {
  1594. int ret = 0;
  1595. struct sh_eth_private *mdp = netdev_priv(ndev);
  1596. pm_runtime_get_sync(&mdp->pdev->dev);
  1597. ret = request_irq(ndev->irq, sh_eth_interrupt,
  1598. mdp->cd->irq_flags, ndev->name, ndev);
  1599. if (ret) {
  1600. dev_err(&ndev->dev, "Can not assign IRQ number\n");
  1601. return ret;
  1602. }
  1603. /* Descriptor set */
  1604. ret = sh_eth_ring_init(ndev);
  1605. if (ret)
  1606. goto out_free_irq;
  1607. /* device init */
  1608. ret = sh_eth_dev_init(ndev, true);
  1609. if (ret)
  1610. goto out_free_irq;
  1611. /* PHY control start*/
  1612. ret = sh_eth_phy_start(ndev);
  1613. if (ret)
  1614. goto out_free_irq;
  1615. napi_enable(&mdp->napi);
  1616. return ret;
  1617. out_free_irq:
  1618. free_irq(ndev->irq, ndev);
  1619. pm_runtime_put_sync(&mdp->pdev->dev);
  1620. return ret;
  1621. }
  1622. /* Timeout function */
  1623. static void sh_eth_tx_timeout(struct net_device *ndev)
  1624. {
  1625. struct sh_eth_private *mdp = netdev_priv(ndev);
  1626. struct sh_eth_rxdesc *rxdesc;
  1627. int i;
  1628. netif_stop_queue(ndev);
  1629. if (netif_msg_timer(mdp))
  1630. dev_err(&ndev->dev, "%s: transmit timed out, status %8.8x,"
  1631. " resetting...\n", ndev->name, (int)sh_eth_read(ndev, EESR));
  1632. /* tx_errors count up */
  1633. ndev->stats.tx_errors++;
  1634. /* Free all the skbuffs in the Rx queue. */
  1635. for (i = 0; i < mdp->num_rx_ring; i++) {
  1636. rxdesc = &mdp->rx_ring[i];
  1637. rxdesc->status = 0;
  1638. rxdesc->addr = 0xBADF00D0;
  1639. if (mdp->rx_skbuff[i])
  1640. dev_kfree_skb(mdp->rx_skbuff[i]);
  1641. mdp->rx_skbuff[i] = NULL;
  1642. }
  1643. for (i = 0; i < mdp->num_tx_ring; i++) {
  1644. if (mdp->tx_skbuff[i])
  1645. dev_kfree_skb(mdp->tx_skbuff[i]);
  1646. mdp->tx_skbuff[i] = NULL;
  1647. }
  1648. /* device init */
  1649. sh_eth_dev_init(ndev, true);
  1650. }
  1651. /* Packet transmit function */
  1652. static int sh_eth_start_xmit(struct sk_buff *skb, struct net_device *ndev)
  1653. {
  1654. struct sh_eth_private *mdp = netdev_priv(ndev);
  1655. struct sh_eth_txdesc *txdesc;
  1656. u32 entry;
  1657. unsigned long flags;
  1658. spin_lock_irqsave(&mdp->lock, flags);
  1659. if ((mdp->cur_tx - mdp->dirty_tx) >= (mdp->num_tx_ring - 4)) {
  1660. if (!sh_eth_txfree(ndev)) {
  1661. if (netif_msg_tx_queued(mdp))
  1662. dev_warn(&ndev->dev, "TxFD exhausted.\n");
  1663. netif_stop_queue(ndev);
  1664. spin_unlock_irqrestore(&mdp->lock, flags);
  1665. return NETDEV_TX_BUSY;
  1666. }
  1667. }
  1668. spin_unlock_irqrestore(&mdp->lock, flags);
  1669. entry = mdp->cur_tx % mdp->num_tx_ring;
  1670. mdp->tx_skbuff[entry] = skb;
  1671. txdesc = &mdp->tx_ring[entry];
  1672. /* soft swap. */
  1673. if (!mdp->cd->hw_swap)
  1674. sh_eth_soft_swap(phys_to_virt(ALIGN(txdesc->addr, 4)),
  1675. skb->len + 2);
  1676. txdesc->addr = dma_map_single(&ndev->dev, skb->data, skb->len,
  1677. DMA_TO_DEVICE);
  1678. if (skb->len < ETHERSMALL)
  1679. txdesc->buffer_length = ETHERSMALL;
  1680. else
  1681. txdesc->buffer_length = skb->len;
  1682. if (entry >= mdp->num_tx_ring - 1)
  1683. txdesc->status |= cpu_to_edmac(mdp, TD_TACT | TD_TDLE);
  1684. else
  1685. txdesc->status |= cpu_to_edmac(mdp, TD_TACT);
  1686. mdp->cur_tx++;
  1687. if (!(sh_eth_read(ndev, EDTRR) & sh_eth_get_edtrr_trns(mdp)))
  1688. sh_eth_write(ndev, sh_eth_get_edtrr_trns(mdp), EDTRR);
  1689. return NETDEV_TX_OK;
  1690. }
  1691. /* device close function */
  1692. static int sh_eth_close(struct net_device *ndev)
  1693. {
  1694. struct sh_eth_private *mdp = netdev_priv(ndev);
  1695. napi_disable(&mdp->napi);
  1696. netif_stop_queue(ndev);
  1697. /* Disable interrupts by clearing the interrupt mask. */
  1698. sh_eth_write(ndev, 0x0000, EESIPR);
  1699. /* Stop the chip's Tx and Rx processes. */
  1700. sh_eth_write(ndev, 0, EDTRR);
  1701. sh_eth_write(ndev, 0, EDRRR);
  1702. /* PHY Disconnect */
  1703. if (mdp->phydev) {
  1704. phy_stop(mdp->phydev);
  1705. phy_disconnect(mdp->phydev);
  1706. }
  1707. free_irq(ndev->irq, ndev);
  1708. /* Free all the skbuffs in the Rx queue. */
  1709. sh_eth_ring_free(ndev);
  1710. /* free DMA buffer */
  1711. sh_eth_free_dma_buffer(mdp);
  1712. pm_runtime_put_sync(&mdp->pdev->dev);
  1713. return 0;
  1714. }
  1715. static struct net_device_stats *sh_eth_get_stats(struct net_device *ndev)
  1716. {
  1717. struct sh_eth_private *mdp = netdev_priv(ndev);
  1718. pm_runtime_get_sync(&mdp->pdev->dev);
  1719. ndev->stats.tx_dropped += sh_eth_read(ndev, TROCR);
  1720. sh_eth_write(ndev, 0, TROCR); /* (write clear) */
  1721. ndev->stats.collisions += sh_eth_read(ndev, CDCR);
  1722. sh_eth_write(ndev, 0, CDCR); /* (write clear) */
  1723. ndev->stats.tx_carrier_errors += sh_eth_read(ndev, LCCR);
  1724. sh_eth_write(ndev, 0, LCCR); /* (write clear) */
  1725. if (sh_eth_is_gether(mdp)) {
  1726. ndev->stats.tx_carrier_errors += sh_eth_read(ndev, CERCR);
  1727. sh_eth_write(ndev, 0, CERCR); /* (write clear) */
  1728. ndev->stats.tx_carrier_errors += sh_eth_read(ndev, CEECR);
  1729. sh_eth_write(ndev, 0, CEECR); /* (write clear) */
  1730. } else {
  1731. ndev->stats.tx_carrier_errors += sh_eth_read(ndev, CNDCR);
  1732. sh_eth_write(ndev, 0, CNDCR); /* (write clear) */
  1733. }
  1734. pm_runtime_put_sync(&mdp->pdev->dev);
  1735. return &ndev->stats;
  1736. }
  1737. /* ioctl to device function */
  1738. static int sh_eth_do_ioctl(struct net_device *ndev, struct ifreq *rq,
  1739. int cmd)
  1740. {
  1741. struct sh_eth_private *mdp = netdev_priv(ndev);
  1742. struct phy_device *phydev = mdp->phydev;
  1743. if (!netif_running(ndev))
  1744. return -EINVAL;
  1745. if (!phydev)
  1746. return -ENODEV;
  1747. return phy_mii_ioctl(phydev, rq, cmd);
  1748. }
  1749. /* For TSU_POSTn. Please refer to the manual about this (strange) bitfields */
  1750. static void *sh_eth_tsu_get_post_reg_offset(struct sh_eth_private *mdp,
  1751. int entry)
  1752. {
  1753. return sh_eth_tsu_get_offset(mdp, TSU_POST1) + (entry / 8 * 4);
  1754. }
  1755. static u32 sh_eth_tsu_get_post_mask(int entry)
  1756. {
  1757. return 0x0f << (28 - ((entry % 8) * 4));
  1758. }
  1759. static u32 sh_eth_tsu_get_post_bit(struct sh_eth_private *mdp, int entry)
  1760. {
  1761. return (0x08 >> (mdp->port << 1)) << (28 - ((entry % 8) * 4));
  1762. }
  1763. static void sh_eth_tsu_enable_cam_entry_post(struct net_device *ndev,
  1764. int entry)
  1765. {
  1766. struct sh_eth_private *mdp = netdev_priv(ndev);
  1767. u32 tmp;
  1768. void *reg_offset;
  1769. reg_offset = sh_eth_tsu_get_post_reg_offset(mdp, entry);
  1770. tmp = ioread32(reg_offset);
  1771. iowrite32(tmp | sh_eth_tsu_get_post_bit(mdp, entry), reg_offset);
  1772. }
  1773. static bool sh_eth_tsu_disable_cam_entry_post(struct net_device *ndev,
  1774. int entry)
  1775. {
  1776. struct sh_eth_private *mdp = netdev_priv(ndev);
  1777. u32 post_mask, ref_mask, tmp;
  1778. void *reg_offset;
  1779. reg_offset = sh_eth_tsu_get_post_reg_offset(mdp, entry);
  1780. post_mask = sh_eth_tsu_get_post_mask(entry);
  1781. ref_mask = sh_eth_tsu_get_post_bit(mdp, entry) & ~post_mask;
  1782. tmp = ioread32(reg_offset);
  1783. iowrite32(tmp & ~post_mask, reg_offset);
  1784. /* If other port enables, the function returns "true" */
  1785. return tmp & ref_mask;
  1786. }
  1787. static int sh_eth_tsu_busy(struct net_device *ndev)
  1788. {
  1789. int timeout = SH_ETH_TSU_TIMEOUT_MS * 100;
  1790. struct sh_eth_private *mdp = netdev_priv(ndev);
  1791. while ((sh_eth_tsu_read(mdp, TSU_ADSBSY) & TSU_ADSBSY_0)) {
  1792. udelay(10);
  1793. timeout--;
  1794. if (timeout <= 0) {
  1795. dev_err(&ndev->dev, "%s: timeout\n", __func__);
  1796. return -ETIMEDOUT;
  1797. }
  1798. }
  1799. return 0;
  1800. }
  1801. static int sh_eth_tsu_write_entry(struct net_device *ndev, void *reg,
  1802. const u8 *addr)
  1803. {
  1804. u32 val;
  1805. val = addr[0] << 24 | addr[1] << 16 | addr[2] << 8 | addr[3];
  1806. iowrite32(val, reg);
  1807. if (sh_eth_tsu_busy(ndev) < 0)
  1808. return -EBUSY;
  1809. val = addr[4] << 8 | addr[5];
  1810. iowrite32(val, reg + 4);
  1811. if (sh_eth_tsu_busy(ndev) < 0)
  1812. return -EBUSY;
  1813. return 0;
  1814. }
  1815. static void sh_eth_tsu_read_entry(void *reg, u8 *addr)
  1816. {
  1817. u32 val;
  1818. val = ioread32(reg);
  1819. addr[0] = (val >> 24) & 0xff;
  1820. addr[1] = (val >> 16) & 0xff;
  1821. addr[2] = (val >> 8) & 0xff;
  1822. addr[3] = val & 0xff;
  1823. val = ioread32(reg + 4);
  1824. addr[4] = (val >> 8) & 0xff;
  1825. addr[5] = val & 0xff;
  1826. }
  1827. static int sh_eth_tsu_find_entry(struct net_device *ndev, const u8 *addr)
  1828. {
  1829. struct sh_eth_private *mdp = netdev_priv(ndev);
  1830. void *reg_offset = sh_eth_tsu_get_offset(mdp, TSU_ADRH0);
  1831. int i;
  1832. u8 c_addr[ETH_ALEN];
  1833. for (i = 0; i < SH_ETH_TSU_CAM_ENTRIES; i++, reg_offset += 8) {
  1834. sh_eth_tsu_read_entry(reg_offset, c_addr);
  1835. if (memcmp(addr, c_addr, ETH_ALEN) == 0)
  1836. return i;
  1837. }
  1838. return -ENOENT;
  1839. }
  1840. static int sh_eth_tsu_find_empty(struct net_device *ndev)
  1841. {
  1842. u8 blank[ETH_ALEN];
  1843. int entry;
  1844. memset(blank, 0, sizeof(blank));
  1845. entry = sh_eth_tsu_find_entry(ndev, blank);
  1846. return (entry < 0) ? -ENOMEM : entry;
  1847. }
  1848. static int sh_eth_tsu_disable_cam_entry_table(struct net_device *ndev,
  1849. int entry)
  1850. {
  1851. struct sh_eth_private *mdp = netdev_priv(ndev);
  1852. void *reg_offset = sh_eth_tsu_get_offset(mdp, TSU_ADRH0);
  1853. int ret;
  1854. u8 blank[ETH_ALEN];
  1855. sh_eth_tsu_write(mdp, sh_eth_tsu_read(mdp, TSU_TEN) &
  1856. ~(1 << (31 - entry)), TSU_TEN);
  1857. memset(blank, 0, sizeof(blank));
  1858. ret = sh_eth_tsu_write_entry(ndev, reg_offset + entry * 8, blank);
  1859. if (ret < 0)
  1860. return ret;
  1861. return 0;
  1862. }
  1863. static int sh_eth_tsu_add_entry(struct net_device *ndev, const u8 *addr)
  1864. {
  1865. struct sh_eth_private *mdp = netdev_priv(ndev);
  1866. void *reg_offset = sh_eth_tsu_get_offset(mdp, TSU_ADRH0);
  1867. int i, ret;
  1868. if (!mdp->cd->tsu)
  1869. return 0;
  1870. i = sh_eth_tsu_find_entry(ndev, addr);
  1871. if (i < 0) {
  1872. /* No entry found, create one */
  1873. i = sh_eth_tsu_find_empty(ndev);
  1874. if (i < 0)
  1875. return -ENOMEM;
  1876. ret = sh_eth_tsu_write_entry(ndev, reg_offset + i * 8, addr);
  1877. if (ret < 0)
  1878. return ret;
  1879. /* Enable the entry */
  1880. sh_eth_tsu_write(mdp, sh_eth_tsu_read(mdp, TSU_TEN) |
  1881. (1 << (31 - i)), TSU_TEN);
  1882. }
  1883. /* Entry found or created, enable POST */
  1884. sh_eth_tsu_enable_cam_entry_post(ndev, i);
  1885. return 0;
  1886. }
  1887. static int sh_eth_tsu_del_entry(struct net_device *ndev, const u8 *addr)
  1888. {
  1889. struct sh_eth_private *mdp = netdev_priv(ndev);
  1890. int i, ret;
  1891. if (!mdp->cd->tsu)
  1892. return 0;
  1893. i = sh_eth_tsu_find_entry(ndev, addr);
  1894. if (i) {
  1895. /* Entry found */
  1896. if (sh_eth_tsu_disable_cam_entry_post(ndev, i))
  1897. goto done;
  1898. /* Disable the entry if both ports was disabled */
  1899. ret = sh_eth_tsu_disable_cam_entry_table(ndev, i);
  1900. if (ret < 0)
  1901. return ret;
  1902. }
  1903. done:
  1904. return 0;
  1905. }
  1906. static int sh_eth_tsu_purge_all(struct net_device *ndev)
  1907. {
  1908. struct sh_eth_private *mdp = netdev_priv(ndev);
  1909. int i, ret;
  1910. if (unlikely(!mdp->cd->tsu))
  1911. return 0;
  1912. for (i = 0; i < SH_ETH_TSU_CAM_ENTRIES; i++) {
  1913. if (sh_eth_tsu_disable_cam_entry_post(ndev, i))
  1914. continue;
  1915. /* Disable the entry if both ports was disabled */
  1916. ret = sh_eth_tsu_disable_cam_entry_table(ndev, i);
  1917. if (ret < 0)
  1918. return ret;
  1919. }
  1920. return 0;
  1921. }
  1922. static void sh_eth_tsu_purge_mcast(struct net_device *ndev)
  1923. {
  1924. struct sh_eth_private *mdp = netdev_priv(ndev);
  1925. u8 addr[ETH_ALEN];
  1926. void *reg_offset = sh_eth_tsu_get_offset(mdp, TSU_ADRH0);
  1927. int i;
  1928. if (unlikely(!mdp->cd->tsu))
  1929. return;
  1930. for (i = 0; i < SH_ETH_TSU_CAM_ENTRIES; i++, reg_offset += 8) {
  1931. sh_eth_tsu_read_entry(reg_offset, addr);
  1932. if (is_multicast_ether_addr(addr))
  1933. sh_eth_tsu_del_entry(ndev, addr);
  1934. }
  1935. }
  1936. /* Multicast reception directions set */
  1937. static void sh_eth_set_multicast_list(struct net_device *ndev)
  1938. {
  1939. struct sh_eth_private *mdp = netdev_priv(ndev);
  1940. u32 ecmr_bits;
  1941. int mcast_all = 0;
  1942. unsigned long flags;
  1943. spin_lock_irqsave(&mdp->lock, flags);
  1944. /*
  1945. * Initial condition is MCT = 1, PRM = 0.
  1946. * Depending on ndev->flags, set PRM or clear MCT
  1947. */
  1948. ecmr_bits = (sh_eth_read(ndev, ECMR) & ~ECMR_PRM) | ECMR_MCT;
  1949. if (!(ndev->flags & IFF_MULTICAST)) {
  1950. sh_eth_tsu_purge_mcast(ndev);
  1951. mcast_all = 1;
  1952. }
  1953. if (ndev->flags & IFF_ALLMULTI) {
  1954. sh_eth_tsu_purge_mcast(ndev);
  1955. ecmr_bits &= ~ECMR_MCT;
  1956. mcast_all = 1;
  1957. }
  1958. if (ndev->flags & IFF_PROMISC) {
  1959. sh_eth_tsu_purge_all(ndev);
  1960. ecmr_bits = (ecmr_bits & ~ECMR_MCT) | ECMR_PRM;
  1961. } else if (mdp->cd->tsu) {
  1962. struct netdev_hw_addr *ha;
  1963. netdev_for_each_mc_addr(ha, ndev) {
  1964. if (mcast_all && is_multicast_ether_addr(ha->addr))
  1965. continue;
  1966. if (sh_eth_tsu_add_entry(ndev, ha->addr) < 0) {
  1967. if (!mcast_all) {
  1968. sh_eth_tsu_purge_mcast(ndev);
  1969. ecmr_bits &= ~ECMR_MCT;
  1970. mcast_all = 1;
  1971. }
  1972. }
  1973. }
  1974. } else {
  1975. /* Normal, unicast/broadcast-only mode. */
  1976. ecmr_bits = (ecmr_bits & ~ECMR_PRM) | ECMR_MCT;
  1977. }
  1978. /* update the ethernet mode */
  1979. sh_eth_write(ndev, ecmr_bits, ECMR);
  1980. spin_unlock_irqrestore(&mdp->lock, flags);
  1981. }
  1982. static int sh_eth_get_vtag_index(struct sh_eth_private *mdp)
  1983. {
  1984. if (!mdp->port)
  1985. return TSU_VTAG0;
  1986. else
  1987. return TSU_VTAG1;
  1988. }
  1989. static int sh_eth_vlan_rx_add_vid(struct net_device *ndev,
  1990. __be16 proto, u16 vid)
  1991. {
  1992. struct sh_eth_private *mdp = netdev_priv(ndev);
  1993. int vtag_reg_index = sh_eth_get_vtag_index(mdp);
  1994. if (unlikely(!mdp->cd->tsu))
  1995. return -EPERM;
  1996. /* No filtering if vid = 0 */
  1997. if (!vid)
  1998. return 0;
  1999. mdp->vlan_num_ids++;
  2000. /*
  2001. * The controller has one VLAN tag HW filter. So, if the filter is
  2002. * already enabled, the driver disables it and the filte
  2003. */
  2004. if (mdp->vlan_num_ids > 1) {
  2005. /* disable VLAN filter */
  2006. sh_eth_tsu_write(mdp, 0, vtag_reg_index);
  2007. return 0;
  2008. }
  2009. sh_eth_tsu_write(mdp, TSU_VTAG_ENABLE | (vid & TSU_VTAG_VID_MASK),
  2010. vtag_reg_index);
  2011. return 0;
  2012. }
  2013. static int sh_eth_vlan_rx_kill_vid(struct net_device *ndev,
  2014. __be16 proto, u16 vid)
  2015. {
  2016. struct sh_eth_private *mdp = netdev_priv(ndev);
  2017. int vtag_reg_index = sh_eth_get_vtag_index(mdp);
  2018. if (unlikely(!mdp->cd->tsu))
  2019. return -EPERM;
  2020. /* No filtering if vid = 0 */
  2021. if (!vid)
  2022. return 0;
  2023. mdp->vlan_num_ids--;
  2024. sh_eth_tsu_write(mdp, 0, vtag_reg_index);
  2025. return 0;
  2026. }
  2027. /* SuperH's TSU register init function */
  2028. static void sh_eth_tsu_init(struct sh_eth_private *mdp)
  2029. {
  2030. sh_eth_tsu_write(mdp, 0, TSU_FWEN0); /* Disable forward(0->1) */
  2031. sh_eth_tsu_write(mdp, 0, TSU_FWEN1); /* Disable forward(1->0) */
  2032. sh_eth_tsu_write(mdp, 0, TSU_FCM); /* forward fifo 3k-3k */
  2033. sh_eth_tsu_write(mdp, 0xc, TSU_BSYSL0);
  2034. sh_eth_tsu_write(mdp, 0xc, TSU_BSYSL1);
  2035. sh_eth_tsu_write(mdp, 0, TSU_PRISL0);
  2036. sh_eth_tsu_write(mdp, 0, TSU_PRISL1);
  2037. sh_eth_tsu_write(mdp, 0, TSU_FWSL0);
  2038. sh_eth_tsu_write(mdp, 0, TSU_FWSL1);
  2039. sh_eth_tsu_write(mdp, TSU_FWSLC_POSTENU | TSU_FWSLC_POSTENL, TSU_FWSLC);
  2040. if (sh_eth_is_gether(mdp)) {
  2041. sh_eth_tsu_write(mdp, 0, TSU_QTAG0); /* Disable QTAG(0->1) */
  2042. sh_eth_tsu_write(mdp, 0, TSU_QTAG1); /* Disable QTAG(1->0) */
  2043. } else {
  2044. sh_eth_tsu_write(mdp, 0, TSU_QTAGM0); /* Disable QTAG(0->1) */
  2045. sh_eth_tsu_write(mdp, 0, TSU_QTAGM1); /* Disable QTAG(1->0) */
  2046. }
  2047. sh_eth_tsu_write(mdp, 0, TSU_FWSR); /* all interrupt status clear */
  2048. sh_eth_tsu_write(mdp, 0, TSU_FWINMK); /* Disable all interrupt */
  2049. sh_eth_tsu_write(mdp, 0, TSU_TEN); /* Disable all CAM entry */
  2050. sh_eth_tsu_write(mdp, 0, TSU_POST1); /* Disable CAM entry [ 0- 7] */
  2051. sh_eth_tsu_write(mdp, 0, TSU_POST2); /* Disable CAM entry [ 8-15] */
  2052. sh_eth_tsu_write(mdp, 0, TSU_POST3); /* Disable CAM entry [16-23] */
  2053. sh_eth_tsu_write(mdp, 0, TSU_POST4); /* Disable CAM entry [24-31] */
  2054. }
  2055. /* MDIO bus release function */
  2056. static int sh_mdio_release(struct net_device *ndev)
  2057. {
  2058. struct mii_bus *bus = dev_get_drvdata(&ndev->dev);
  2059. /* unregister mdio bus */
  2060. mdiobus_unregister(bus);
  2061. /* remove mdio bus info from net_device */
  2062. dev_set_drvdata(&ndev->dev, NULL);
  2063. /* free bitbang info */
  2064. free_mdio_bitbang(bus);
  2065. return 0;
  2066. }
  2067. /* MDIO bus init function */
  2068. static int sh_mdio_init(struct net_device *ndev, int id,
  2069. struct sh_eth_plat_data *pd)
  2070. {
  2071. int ret, i;
  2072. struct bb_info *bitbang;
  2073. struct sh_eth_private *mdp = netdev_priv(ndev);
  2074. /* create bit control struct for PHY */
  2075. bitbang = devm_kzalloc(&ndev->dev, sizeof(struct bb_info),
  2076. GFP_KERNEL);
  2077. if (!bitbang) {
  2078. ret = -ENOMEM;
  2079. goto out;
  2080. }
  2081. /* bitbang init */
  2082. bitbang->addr = mdp->addr + mdp->reg_offset[PIR];
  2083. bitbang->set_gate = pd->set_mdio_gate;
  2084. bitbang->mdi_msk = PIR_MDI;
  2085. bitbang->mdo_msk = PIR_MDO;
  2086. bitbang->mmd_msk = PIR_MMD;
  2087. bitbang->mdc_msk = PIR_MDC;
  2088. bitbang->ctrl.ops = &bb_ops;
  2089. /* MII controller setting */
  2090. mdp->mii_bus = alloc_mdio_bitbang(&bitbang->ctrl);
  2091. if (!mdp->mii_bus) {
  2092. ret = -ENOMEM;
  2093. goto out;
  2094. }
  2095. /* Hook up MII support for ethtool */
  2096. mdp->mii_bus->name = "sh_mii";
  2097. mdp->mii_bus->parent = &ndev->dev;
  2098. snprintf(mdp->mii_bus->id, MII_BUS_ID_SIZE, "%s-%x",
  2099. mdp->pdev->name, id);
  2100. /* PHY IRQ */
  2101. mdp->mii_bus->irq = devm_kzalloc(&ndev->dev,
  2102. sizeof(int) * PHY_MAX_ADDR,
  2103. GFP_KERNEL);
  2104. if (!mdp->mii_bus->irq) {
  2105. ret = -ENOMEM;
  2106. goto out_free_bus;
  2107. }
  2108. for (i = 0; i < PHY_MAX_ADDR; i++)
  2109. mdp->mii_bus->irq[i] = PHY_POLL;
  2110. /* register mdio bus */
  2111. ret = mdiobus_register(mdp->mii_bus);
  2112. if (ret)
  2113. goto out_free_bus;
  2114. dev_set_drvdata(&ndev->dev, mdp->mii_bus);
  2115. return 0;
  2116. out_free_bus:
  2117. free_mdio_bitbang(mdp->mii_bus);
  2118. out:
  2119. return ret;
  2120. }
  2121. static const u16 *sh_eth_get_register_offset(int register_type)
  2122. {
  2123. const u16 *reg_offset = NULL;
  2124. switch (register_type) {
  2125. case SH_ETH_REG_GIGABIT:
  2126. reg_offset = sh_eth_offset_gigabit;
  2127. break;
  2128. case SH_ETH_REG_FAST_RCAR:
  2129. reg_offset = sh_eth_offset_fast_rcar;
  2130. break;
  2131. case SH_ETH_REG_FAST_SH4:
  2132. reg_offset = sh_eth_offset_fast_sh4;
  2133. break;
  2134. case SH_ETH_REG_FAST_SH3_SH2:
  2135. reg_offset = sh_eth_offset_fast_sh3_sh2;
  2136. break;
  2137. default:
  2138. pr_err("Unknown register type (%d)\n", register_type);
  2139. break;
  2140. }
  2141. return reg_offset;
  2142. }
  2143. static const struct net_device_ops sh_eth_netdev_ops = {
  2144. .ndo_open = sh_eth_open,
  2145. .ndo_stop = sh_eth_close,
  2146. .ndo_start_xmit = sh_eth_start_xmit,
  2147. .ndo_get_stats = sh_eth_get_stats,
  2148. .ndo_tx_timeout = sh_eth_tx_timeout,
  2149. .ndo_do_ioctl = sh_eth_do_ioctl,
  2150. .ndo_validate_addr = eth_validate_addr,
  2151. .ndo_set_mac_address = eth_mac_addr,
  2152. .ndo_change_mtu = eth_change_mtu,
  2153. };
  2154. static const struct net_device_ops sh_eth_netdev_ops_tsu = {
  2155. .ndo_open = sh_eth_open,
  2156. .ndo_stop = sh_eth_close,
  2157. .ndo_start_xmit = sh_eth_start_xmit,
  2158. .ndo_get_stats = sh_eth_get_stats,
  2159. .ndo_set_rx_mode = sh_eth_set_multicast_list,
  2160. .ndo_vlan_rx_add_vid = sh_eth_vlan_rx_add_vid,
  2161. .ndo_vlan_rx_kill_vid = sh_eth_vlan_rx_kill_vid,
  2162. .ndo_tx_timeout = sh_eth_tx_timeout,
  2163. .ndo_do_ioctl = sh_eth_do_ioctl,
  2164. .ndo_validate_addr = eth_validate_addr,
  2165. .ndo_set_mac_address = eth_mac_addr,
  2166. .ndo_change_mtu = eth_change_mtu,
  2167. };
  2168. static int sh_eth_drv_probe(struct platform_device *pdev)
  2169. {
  2170. int ret, devno = 0;
  2171. struct resource *res;
  2172. struct net_device *ndev = NULL;
  2173. struct sh_eth_private *mdp = NULL;
  2174. struct sh_eth_plat_data *pd = pdev->dev.platform_data;
  2175. const struct platform_device_id *id = platform_get_device_id(pdev);
  2176. /* get base addr */
  2177. res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  2178. if (unlikely(res == NULL)) {
  2179. dev_err(&pdev->dev, "invalid resource\n");
  2180. ret = -EINVAL;
  2181. goto out;
  2182. }
  2183. ndev = alloc_etherdev(sizeof(struct sh_eth_private));
  2184. if (!ndev) {
  2185. ret = -ENOMEM;
  2186. goto out;
  2187. }
  2188. /* The sh Ether-specific entries in the device structure. */
  2189. ndev->base_addr = res->start;
  2190. devno = pdev->id;
  2191. if (devno < 0)
  2192. devno = 0;
  2193. ndev->dma = -1;
  2194. ret = platform_get_irq(pdev, 0);
  2195. if (ret < 0) {
  2196. ret = -ENODEV;
  2197. goto out_release;
  2198. }
  2199. ndev->irq = ret;
  2200. SET_NETDEV_DEV(ndev, &pdev->dev);
  2201. /* Fill in the fields of the device structure with ethernet values. */
  2202. ether_setup(ndev);
  2203. mdp = netdev_priv(ndev);
  2204. mdp->num_tx_ring = TX_RING_SIZE;
  2205. mdp->num_rx_ring = RX_RING_SIZE;
  2206. mdp->addr = devm_ioremap_resource(&pdev->dev, res);
  2207. if (IS_ERR(mdp->addr)) {
  2208. ret = PTR_ERR(mdp->addr);
  2209. goto out_release;
  2210. }
  2211. spin_lock_init(&mdp->lock);
  2212. mdp->pdev = pdev;
  2213. pm_runtime_enable(&pdev->dev);
  2214. pm_runtime_resume(&pdev->dev);
  2215. /* get PHY ID */
  2216. mdp->phy_id = pd->phy;
  2217. mdp->phy_interface = pd->phy_interface;
  2218. /* EDMAC endian */
  2219. mdp->edmac_endian = pd->edmac_endian;
  2220. mdp->no_ether_link = pd->no_ether_link;
  2221. mdp->ether_link_active_low = pd->ether_link_active_low;
  2222. mdp->reg_offset = sh_eth_get_register_offset(pd->register_type);
  2223. /* set cpu data */
  2224. mdp->cd = (struct sh_eth_cpu_data *)id->driver_data;
  2225. sh_eth_set_default_cpu_data(mdp->cd);
  2226. /* set function */
  2227. if (mdp->cd->tsu)
  2228. ndev->netdev_ops = &sh_eth_netdev_ops_tsu;
  2229. else
  2230. ndev->netdev_ops = &sh_eth_netdev_ops;
  2231. SET_ETHTOOL_OPS(ndev, &sh_eth_ethtool_ops);
  2232. ndev->watchdog_timeo = TX_TIMEOUT;
  2233. /* debug message level */
  2234. mdp->msg_enable = SH_ETH_DEF_MSG_ENABLE;
  2235. /* read and set MAC address */
  2236. read_mac_address(ndev, pd->mac_addr);
  2237. if (!is_valid_ether_addr(ndev->dev_addr)) {
  2238. dev_warn(&pdev->dev,
  2239. "no valid MAC address supplied, using a random one.\n");
  2240. eth_hw_addr_random(ndev);
  2241. }
  2242. /* ioremap the TSU registers */
  2243. if (mdp->cd->tsu) {
  2244. struct resource *rtsu;
  2245. rtsu = platform_get_resource(pdev, IORESOURCE_MEM, 1);
  2246. mdp->tsu_addr = devm_ioremap_resource(&pdev->dev, rtsu);
  2247. if (IS_ERR(mdp->tsu_addr)) {
  2248. ret = PTR_ERR(mdp->tsu_addr);
  2249. goto out_release;
  2250. }
  2251. mdp->port = devno % 2;
  2252. ndev->features = NETIF_F_HW_VLAN_CTAG_FILTER;
  2253. }
  2254. /* initialize first or needed device */
  2255. if (!devno || pd->needs_init) {
  2256. if (mdp->cd->chip_reset)
  2257. mdp->cd->chip_reset(ndev);
  2258. if (mdp->cd->tsu) {
  2259. /* TSU init (Init only)*/
  2260. sh_eth_tsu_init(mdp);
  2261. }
  2262. }
  2263. netif_napi_add(ndev, &mdp->napi, sh_eth_poll, 64);
  2264. /* network device register */
  2265. ret = register_netdev(ndev);
  2266. if (ret)
  2267. goto out_napi_del;
  2268. /* mdio bus init */
  2269. ret = sh_mdio_init(ndev, pdev->id, pd);
  2270. if (ret)
  2271. goto out_unregister;
  2272. /* print device information */
  2273. pr_info("Base address at 0x%x, %pM, IRQ %d.\n",
  2274. (u32)ndev->base_addr, ndev->dev_addr, ndev->irq);
  2275. platform_set_drvdata(pdev, ndev);
  2276. return ret;
  2277. out_unregister:
  2278. unregister_netdev(ndev);
  2279. out_napi_del:
  2280. netif_napi_del(&mdp->napi);
  2281. out_release:
  2282. /* net_dev free */
  2283. if (ndev)
  2284. free_netdev(ndev);
  2285. out:
  2286. return ret;
  2287. }
  2288. static int sh_eth_drv_remove(struct platform_device *pdev)
  2289. {
  2290. struct net_device *ndev = platform_get_drvdata(pdev);
  2291. struct sh_eth_private *mdp = netdev_priv(ndev);
  2292. sh_mdio_release(ndev);
  2293. unregister_netdev(ndev);
  2294. netif_napi_del(&mdp->napi);
  2295. pm_runtime_disable(&pdev->dev);
  2296. free_netdev(ndev);
  2297. return 0;
  2298. }
  2299. #ifdef CONFIG_PM
  2300. static int sh_eth_runtime_nop(struct device *dev)
  2301. {
  2302. /*
  2303. * Runtime PM callback shared between ->runtime_suspend()
  2304. * and ->runtime_resume(). Simply returns success.
  2305. *
  2306. * This driver re-initializes all registers after
  2307. * pm_runtime_get_sync() anyway so there is no need
  2308. * to save and restore registers here.
  2309. */
  2310. return 0;
  2311. }
  2312. static const struct dev_pm_ops sh_eth_dev_pm_ops = {
  2313. .runtime_suspend = sh_eth_runtime_nop,
  2314. .runtime_resume = sh_eth_runtime_nop,
  2315. };
  2316. #define SH_ETH_PM_OPS (&sh_eth_dev_pm_ops)
  2317. #else
  2318. #define SH_ETH_PM_OPS NULL
  2319. #endif
  2320. static struct platform_device_id sh_eth_id_table[] = {
  2321. { "sh7619-ether", (kernel_ulong_t)&sh7619_data },
  2322. { "sh771x-ether", (kernel_ulong_t)&sh771x_data },
  2323. { "sh7724-ether", (kernel_ulong_t)&sh7724_data },
  2324. { "sh7734-gether", (kernel_ulong_t)&sh7734_data },
  2325. { "sh7757-ether", (kernel_ulong_t)&sh7757_data },
  2326. { "sh7757-gether", (kernel_ulong_t)&sh7757_data_giga },
  2327. { "sh7763-gether", (kernel_ulong_t)&sh7763_data },
  2328. { "r8a7740-gether", (kernel_ulong_t)&r8a7740_data },
  2329. { "r8a777x-ether", (kernel_ulong_t)&r8a777x_data },
  2330. { }
  2331. };
  2332. MODULE_DEVICE_TABLE(platform, sh_eth_id_table);
  2333. static struct platform_driver sh_eth_driver = {
  2334. .probe = sh_eth_drv_probe,
  2335. .remove = sh_eth_drv_remove,
  2336. .id_table = sh_eth_id_table,
  2337. .driver = {
  2338. .name = CARDNAME,
  2339. .pm = SH_ETH_PM_OPS,
  2340. },
  2341. };
  2342. module_platform_driver(sh_eth_driver);
  2343. MODULE_AUTHOR("Nobuhiro Iwamatsu, Yoshihiro Shimoda");
  2344. MODULE_DESCRIPTION("Renesas SuperH Ethernet driver");
  2345. MODULE_LICENSE("GPL v2");