bcmgenet.c 67 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412241324142415241624172418241924202421242224232424242524262427242824292430243124322433243424352436243724382439244024412442244324442445244624472448244924502451245224532454245524562457245824592460246124622463246424652466246724682469247024712472247324742475247624772478247924802481248224832484248524862487248824892490249124922493249424952496249724982499250025012502250325042505250625072508250925102511251225132514251525162517251825192520252125222523252425252526252725282529253025312532253325342535253625372538253925402541254225432544254525462547254825492550255125522553255425552556255725582559256025612562256325642565256625672568256925702571257225732574257525762577257825792580258125822583
  1. /*
  2. * Broadcom GENET (Gigabit Ethernet) controller driver
  3. *
  4. * Copyright (c) 2014 Broadcom Corporation
  5. *
  6. * This program is free software; you can redistribute it and/or modify
  7. * it under the terms of the GNU General Public License version 2 as
  8. * published by the Free Software Foundation.
  9. *
  10. * This program is distributed in the hope that it will be useful,
  11. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  12. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  13. * GNU General Public License for more details.
  14. *
  15. * You should have received a copy of the GNU General Public License
  16. * along with this program; if not, write to the Free Software
  17. * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
  18. */
  19. #define pr_fmt(fmt) "bcmgenet: " fmt
  20. #include <linux/kernel.h>
  21. #include <linux/module.h>
  22. #include <linux/sched.h>
  23. #include <linux/types.h>
  24. #include <linux/fcntl.h>
  25. #include <linux/interrupt.h>
  26. #include <linux/string.h>
  27. #include <linux/if_ether.h>
  28. #include <linux/init.h>
  29. #include <linux/errno.h>
  30. #include <linux/delay.h>
  31. #include <linux/platform_device.h>
  32. #include <linux/dma-mapping.h>
  33. #include <linux/pm.h>
  34. #include <linux/clk.h>
  35. #include <linux/of.h>
  36. #include <linux/of_address.h>
  37. #include <linux/of_irq.h>
  38. #include <linux/of_net.h>
  39. #include <linux/of_platform.h>
  40. #include <net/arp.h>
  41. #include <linux/mii.h>
  42. #include <linux/ethtool.h>
  43. #include <linux/netdevice.h>
  44. #include <linux/inetdevice.h>
  45. #include <linux/etherdevice.h>
  46. #include <linux/skbuff.h>
  47. #include <linux/in.h>
  48. #include <linux/ip.h>
  49. #include <linux/ipv6.h>
  50. #include <linux/phy.h>
  51. #include <asm/unaligned.h>
  52. #include "bcmgenet.h"
  53. /* Maximum number of hardware queues, downsized if needed */
  54. #define GENET_MAX_MQ_CNT 4
  55. /* Default highest priority queue for multi queue support */
  56. #define GENET_Q0_PRIORITY 0
  57. #define GENET_DEFAULT_BD_CNT \
  58. (TOTAL_DESC - priv->hw_params->tx_queues * priv->hw_params->bds_cnt)
  59. #define RX_BUF_LENGTH 2048
  60. #define SKB_ALIGNMENT 32
  61. /* Tx/Rx DMA register offset, skip 256 descriptors */
  62. #define WORDS_PER_BD(p) (p->hw_params->words_per_bd)
  63. #define DMA_DESC_SIZE (WORDS_PER_BD(priv) * sizeof(u32))
  64. #define GENET_TDMA_REG_OFF (priv->hw_params->tdma_offset + \
  65. TOTAL_DESC * DMA_DESC_SIZE)
  66. #define GENET_RDMA_REG_OFF (priv->hw_params->rdma_offset + \
  67. TOTAL_DESC * DMA_DESC_SIZE)
  68. static inline void dmadesc_set_length_status(struct bcmgenet_priv *priv,
  69. void __iomem *d, u32 value)
  70. {
  71. __raw_writel(value, d + DMA_DESC_LENGTH_STATUS);
  72. }
  73. static inline u32 dmadesc_get_length_status(struct bcmgenet_priv *priv,
  74. void __iomem *d)
  75. {
  76. return __raw_readl(d + DMA_DESC_LENGTH_STATUS);
  77. }
  78. static inline void dmadesc_set_addr(struct bcmgenet_priv *priv,
  79. void __iomem *d,
  80. dma_addr_t addr)
  81. {
  82. __raw_writel(lower_32_bits(addr), d + DMA_DESC_ADDRESS_LO);
  83. /* Register writes to GISB bus can take couple hundred nanoseconds
  84. * and are done for each packet, save these expensive writes unless
  85. * the platform is explicitely configured for 64-bits/LPAE.
  86. */
  87. #ifdef CONFIG_PHYS_ADDR_T_64BIT
  88. if (priv->hw_params->flags & GENET_HAS_40BITS)
  89. __raw_writel(upper_32_bits(addr), d + DMA_DESC_ADDRESS_HI);
  90. #endif
  91. }
  92. /* Combined address + length/status setter */
  93. static inline void dmadesc_set(struct bcmgenet_priv *priv,
  94. void __iomem *d, dma_addr_t addr, u32 val)
  95. {
  96. dmadesc_set_length_status(priv, d, val);
  97. dmadesc_set_addr(priv, d, addr);
  98. }
  99. static inline dma_addr_t dmadesc_get_addr(struct bcmgenet_priv *priv,
  100. void __iomem *d)
  101. {
  102. dma_addr_t addr;
  103. addr = __raw_readl(d + DMA_DESC_ADDRESS_LO);
  104. /* Register writes to GISB bus can take couple hundred nanoseconds
  105. * and are done for each packet, save these expensive writes unless
  106. * the platform is explicitely configured for 64-bits/LPAE.
  107. */
  108. #ifdef CONFIG_PHYS_ADDR_T_64BIT
  109. if (priv->hw_params->flags & GENET_HAS_40BITS)
  110. addr |= (u64)__raw_readl(d + DMA_DESC_ADDRESS_HI) << 32;
  111. #endif
  112. return addr;
  113. }
  114. #define GENET_VER_FMT "%1d.%1d EPHY: 0x%04x"
  115. #define GENET_MSG_DEFAULT (NETIF_MSG_DRV | NETIF_MSG_PROBE | \
  116. NETIF_MSG_LINK)
  117. static inline u32 bcmgenet_rbuf_ctrl_get(struct bcmgenet_priv *priv)
  118. {
  119. if (GENET_IS_V1(priv))
  120. return bcmgenet_rbuf_readl(priv, RBUF_FLUSH_CTRL_V1);
  121. else
  122. return bcmgenet_sys_readl(priv, SYS_RBUF_FLUSH_CTRL);
  123. }
  124. static inline void bcmgenet_rbuf_ctrl_set(struct bcmgenet_priv *priv, u32 val)
  125. {
  126. if (GENET_IS_V1(priv))
  127. bcmgenet_rbuf_writel(priv, val, RBUF_FLUSH_CTRL_V1);
  128. else
  129. bcmgenet_sys_writel(priv, val, SYS_RBUF_FLUSH_CTRL);
  130. }
  131. /* These macros are defined to deal with register map change
  132. * between GENET1.1 and GENET2. Only those currently being used
  133. * by driver are defined.
  134. */
  135. static inline u32 bcmgenet_tbuf_ctrl_get(struct bcmgenet_priv *priv)
  136. {
  137. if (GENET_IS_V1(priv))
  138. return bcmgenet_rbuf_readl(priv, TBUF_CTRL_V1);
  139. else
  140. return __raw_readl(priv->base +
  141. priv->hw_params->tbuf_offset + TBUF_CTRL);
  142. }
  143. static inline void bcmgenet_tbuf_ctrl_set(struct bcmgenet_priv *priv, u32 val)
  144. {
  145. if (GENET_IS_V1(priv))
  146. bcmgenet_rbuf_writel(priv, val, TBUF_CTRL_V1);
  147. else
  148. __raw_writel(val, priv->base +
  149. priv->hw_params->tbuf_offset + TBUF_CTRL);
  150. }
  151. static inline u32 bcmgenet_bp_mc_get(struct bcmgenet_priv *priv)
  152. {
  153. if (GENET_IS_V1(priv))
  154. return bcmgenet_rbuf_readl(priv, TBUF_BP_MC_V1);
  155. else
  156. return __raw_readl(priv->base +
  157. priv->hw_params->tbuf_offset + TBUF_BP_MC);
  158. }
  159. static inline void bcmgenet_bp_mc_set(struct bcmgenet_priv *priv, u32 val)
  160. {
  161. if (GENET_IS_V1(priv))
  162. bcmgenet_rbuf_writel(priv, val, TBUF_BP_MC_V1);
  163. else
  164. __raw_writel(val, priv->base +
  165. priv->hw_params->tbuf_offset + TBUF_BP_MC);
  166. }
  167. /* RX/TX DMA register accessors */
  168. enum dma_reg {
  169. DMA_RING_CFG = 0,
  170. DMA_CTRL,
  171. DMA_STATUS,
  172. DMA_SCB_BURST_SIZE,
  173. DMA_ARB_CTRL,
  174. DMA_PRIORITY,
  175. DMA_RING_PRIORITY,
  176. };
  177. static const u8 bcmgenet_dma_regs_v3plus[] = {
  178. [DMA_RING_CFG] = 0x00,
  179. [DMA_CTRL] = 0x04,
  180. [DMA_STATUS] = 0x08,
  181. [DMA_SCB_BURST_SIZE] = 0x0C,
  182. [DMA_ARB_CTRL] = 0x2C,
  183. [DMA_PRIORITY] = 0x30,
  184. [DMA_RING_PRIORITY] = 0x38,
  185. };
  186. static const u8 bcmgenet_dma_regs_v2[] = {
  187. [DMA_RING_CFG] = 0x00,
  188. [DMA_CTRL] = 0x04,
  189. [DMA_STATUS] = 0x08,
  190. [DMA_SCB_BURST_SIZE] = 0x0C,
  191. [DMA_ARB_CTRL] = 0x30,
  192. [DMA_PRIORITY] = 0x34,
  193. [DMA_RING_PRIORITY] = 0x3C,
  194. };
  195. static const u8 bcmgenet_dma_regs_v1[] = {
  196. [DMA_CTRL] = 0x00,
  197. [DMA_STATUS] = 0x04,
  198. [DMA_SCB_BURST_SIZE] = 0x0C,
  199. [DMA_ARB_CTRL] = 0x30,
  200. [DMA_PRIORITY] = 0x34,
  201. [DMA_RING_PRIORITY] = 0x3C,
  202. };
  203. /* Set at runtime once bcmgenet version is known */
  204. static const u8 *bcmgenet_dma_regs;
  205. static inline struct bcmgenet_priv *dev_to_priv(struct device *dev)
  206. {
  207. return netdev_priv(dev_get_drvdata(dev));
  208. }
  209. static inline u32 bcmgenet_tdma_readl(struct bcmgenet_priv *priv,
  210. enum dma_reg r)
  211. {
  212. return __raw_readl(priv->base + GENET_TDMA_REG_OFF +
  213. DMA_RINGS_SIZE + bcmgenet_dma_regs[r]);
  214. }
  215. static inline void bcmgenet_tdma_writel(struct bcmgenet_priv *priv,
  216. u32 val, enum dma_reg r)
  217. {
  218. __raw_writel(val, priv->base + GENET_TDMA_REG_OFF +
  219. DMA_RINGS_SIZE + bcmgenet_dma_regs[r]);
  220. }
  221. static inline u32 bcmgenet_rdma_readl(struct bcmgenet_priv *priv,
  222. enum dma_reg r)
  223. {
  224. return __raw_readl(priv->base + GENET_RDMA_REG_OFF +
  225. DMA_RINGS_SIZE + bcmgenet_dma_regs[r]);
  226. }
  227. static inline void bcmgenet_rdma_writel(struct bcmgenet_priv *priv,
  228. u32 val, enum dma_reg r)
  229. {
  230. __raw_writel(val, priv->base + GENET_RDMA_REG_OFF +
  231. DMA_RINGS_SIZE + bcmgenet_dma_regs[r]);
  232. }
  233. /* RDMA/TDMA ring registers and accessors
  234. * we merge the common fields and just prefix with T/D the registers
  235. * having different meaning depending on the direction
  236. */
  237. enum dma_ring_reg {
  238. TDMA_READ_PTR = 0,
  239. RDMA_WRITE_PTR = TDMA_READ_PTR,
  240. TDMA_READ_PTR_HI,
  241. RDMA_WRITE_PTR_HI = TDMA_READ_PTR_HI,
  242. TDMA_CONS_INDEX,
  243. RDMA_PROD_INDEX = TDMA_CONS_INDEX,
  244. TDMA_PROD_INDEX,
  245. RDMA_CONS_INDEX = TDMA_PROD_INDEX,
  246. DMA_RING_BUF_SIZE,
  247. DMA_START_ADDR,
  248. DMA_START_ADDR_HI,
  249. DMA_END_ADDR,
  250. DMA_END_ADDR_HI,
  251. DMA_MBUF_DONE_THRESH,
  252. TDMA_FLOW_PERIOD,
  253. RDMA_XON_XOFF_THRESH = TDMA_FLOW_PERIOD,
  254. TDMA_WRITE_PTR,
  255. RDMA_READ_PTR = TDMA_WRITE_PTR,
  256. TDMA_WRITE_PTR_HI,
  257. RDMA_READ_PTR_HI = TDMA_WRITE_PTR_HI
  258. };
  259. /* GENET v4 supports 40-bits pointer addressing
  260. * for obvious reasons the LO and HI word parts
  261. * are contiguous, but this offsets the other
  262. * registers.
  263. */
  264. static const u8 genet_dma_ring_regs_v4[] = {
  265. [TDMA_READ_PTR] = 0x00,
  266. [TDMA_READ_PTR_HI] = 0x04,
  267. [TDMA_CONS_INDEX] = 0x08,
  268. [TDMA_PROD_INDEX] = 0x0C,
  269. [DMA_RING_BUF_SIZE] = 0x10,
  270. [DMA_START_ADDR] = 0x14,
  271. [DMA_START_ADDR_HI] = 0x18,
  272. [DMA_END_ADDR] = 0x1C,
  273. [DMA_END_ADDR_HI] = 0x20,
  274. [DMA_MBUF_DONE_THRESH] = 0x24,
  275. [TDMA_FLOW_PERIOD] = 0x28,
  276. [TDMA_WRITE_PTR] = 0x2C,
  277. [TDMA_WRITE_PTR_HI] = 0x30,
  278. };
  279. static const u8 genet_dma_ring_regs_v123[] = {
  280. [TDMA_READ_PTR] = 0x00,
  281. [TDMA_CONS_INDEX] = 0x04,
  282. [TDMA_PROD_INDEX] = 0x08,
  283. [DMA_RING_BUF_SIZE] = 0x0C,
  284. [DMA_START_ADDR] = 0x10,
  285. [DMA_END_ADDR] = 0x14,
  286. [DMA_MBUF_DONE_THRESH] = 0x18,
  287. [TDMA_FLOW_PERIOD] = 0x1C,
  288. [TDMA_WRITE_PTR] = 0x20,
  289. };
  290. /* Set at runtime once GENET version is known */
  291. static const u8 *genet_dma_ring_regs;
  292. static inline u32 bcmgenet_tdma_ring_readl(struct bcmgenet_priv *priv,
  293. unsigned int ring,
  294. enum dma_ring_reg r)
  295. {
  296. return __raw_readl(priv->base + GENET_TDMA_REG_OFF +
  297. (DMA_RING_SIZE * ring) +
  298. genet_dma_ring_regs[r]);
  299. }
  300. static inline void bcmgenet_tdma_ring_writel(struct bcmgenet_priv *priv,
  301. unsigned int ring,
  302. u32 val,
  303. enum dma_ring_reg r)
  304. {
  305. __raw_writel(val, priv->base + GENET_TDMA_REG_OFF +
  306. (DMA_RING_SIZE * ring) +
  307. genet_dma_ring_regs[r]);
  308. }
  309. static inline u32 bcmgenet_rdma_ring_readl(struct bcmgenet_priv *priv,
  310. unsigned int ring,
  311. enum dma_ring_reg r)
  312. {
  313. return __raw_readl(priv->base + GENET_RDMA_REG_OFF +
  314. (DMA_RING_SIZE * ring) +
  315. genet_dma_ring_regs[r]);
  316. }
  317. static inline void bcmgenet_rdma_ring_writel(struct bcmgenet_priv *priv,
  318. unsigned int ring,
  319. u32 val,
  320. enum dma_ring_reg r)
  321. {
  322. __raw_writel(val, priv->base + GENET_RDMA_REG_OFF +
  323. (DMA_RING_SIZE * ring) +
  324. genet_dma_ring_regs[r]);
  325. }
  326. static int bcmgenet_get_settings(struct net_device *dev,
  327. struct ethtool_cmd *cmd)
  328. {
  329. struct bcmgenet_priv *priv = netdev_priv(dev);
  330. if (!netif_running(dev))
  331. return -EINVAL;
  332. if (!priv->phydev)
  333. return -ENODEV;
  334. return phy_ethtool_gset(priv->phydev, cmd);
  335. }
  336. static int bcmgenet_set_settings(struct net_device *dev,
  337. struct ethtool_cmd *cmd)
  338. {
  339. struct bcmgenet_priv *priv = netdev_priv(dev);
  340. if (!netif_running(dev))
  341. return -EINVAL;
  342. if (!priv->phydev)
  343. return -ENODEV;
  344. return phy_ethtool_sset(priv->phydev, cmd);
  345. }
  346. static int bcmgenet_set_rx_csum(struct net_device *dev,
  347. netdev_features_t wanted)
  348. {
  349. struct bcmgenet_priv *priv = netdev_priv(dev);
  350. u32 rbuf_chk_ctrl;
  351. bool rx_csum_en;
  352. rx_csum_en = !!(wanted & NETIF_F_RXCSUM);
  353. rbuf_chk_ctrl = bcmgenet_rbuf_readl(priv, RBUF_CHK_CTRL);
  354. /* enable rx checksumming */
  355. if (rx_csum_en)
  356. rbuf_chk_ctrl |= RBUF_RXCHK_EN;
  357. else
  358. rbuf_chk_ctrl &= ~RBUF_RXCHK_EN;
  359. priv->desc_rxchk_en = rx_csum_en;
  360. /* If UniMAC forwards CRC, we need to skip over it to get
  361. * a valid CHK bit to be set in the per-packet status word
  362. */
  363. if (rx_csum_en && priv->crc_fwd_en)
  364. rbuf_chk_ctrl |= RBUF_SKIP_FCS;
  365. else
  366. rbuf_chk_ctrl &= ~RBUF_SKIP_FCS;
  367. bcmgenet_rbuf_writel(priv, rbuf_chk_ctrl, RBUF_CHK_CTRL);
  368. return 0;
  369. }
  370. static int bcmgenet_set_tx_csum(struct net_device *dev,
  371. netdev_features_t wanted)
  372. {
  373. struct bcmgenet_priv *priv = netdev_priv(dev);
  374. bool desc_64b_en;
  375. u32 tbuf_ctrl, rbuf_ctrl;
  376. tbuf_ctrl = bcmgenet_tbuf_ctrl_get(priv);
  377. rbuf_ctrl = bcmgenet_rbuf_readl(priv, RBUF_CTRL);
  378. desc_64b_en = !!(wanted & (NETIF_F_IP_CSUM | NETIF_F_IPV6_CSUM));
  379. /* enable 64 bytes descriptor in both directions (RBUF and TBUF) */
  380. if (desc_64b_en) {
  381. tbuf_ctrl |= RBUF_64B_EN;
  382. rbuf_ctrl |= RBUF_64B_EN;
  383. } else {
  384. tbuf_ctrl &= ~RBUF_64B_EN;
  385. rbuf_ctrl &= ~RBUF_64B_EN;
  386. }
  387. priv->desc_64b_en = desc_64b_en;
  388. bcmgenet_tbuf_ctrl_set(priv, tbuf_ctrl);
  389. bcmgenet_rbuf_writel(priv, rbuf_ctrl, RBUF_CTRL);
  390. return 0;
  391. }
  392. static int bcmgenet_set_features(struct net_device *dev,
  393. netdev_features_t features)
  394. {
  395. netdev_features_t changed = features ^ dev->features;
  396. netdev_features_t wanted = dev->wanted_features;
  397. int ret = 0;
  398. if (changed & (NETIF_F_IP_CSUM | NETIF_F_IPV6_CSUM))
  399. ret = bcmgenet_set_tx_csum(dev, wanted);
  400. if (changed & (NETIF_F_RXCSUM))
  401. ret = bcmgenet_set_rx_csum(dev, wanted);
  402. return ret;
  403. }
  404. static u32 bcmgenet_get_msglevel(struct net_device *dev)
  405. {
  406. struct bcmgenet_priv *priv = netdev_priv(dev);
  407. return priv->msg_enable;
  408. }
  409. static void bcmgenet_set_msglevel(struct net_device *dev, u32 level)
  410. {
  411. struct bcmgenet_priv *priv = netdev_priv(dev);
  412. priv->msg_enable = level;
  413. }
  414. /* standard ethtool support functions. */
  415. enum bcmgenet_stat_type {
  416. BCMGENET_STAT_NETDEV = -1,
  417. BCMGENET_STAT_MIB_RX,
  418. BCMGENET_STAT_MIB_TX,
  419. BCMGENET_STAT_RUNT,
  420. BCMGENET_STAT_MISC,
  421. };
  422. struct bcmgenet_stats {
  423. char stat_string[ETH_GSTRING_LEN];
  424. int stat_sizeof;
  425. int stat_offset;
  426. enum bcmgenet_stat_type type;
  427. /* reg offset from UMAC base for misc counters */
  428. u16 reg_offset;
  429. };
  430. #define STAT_NETDEV(m) { \
  431. .stat_string = __stringify(m), \
  432. .stat_sizeof = sizeof(((struct net_device_stats *)0)->m), \
  433. .stat_offset = offsetof(struct net_device_stats, m), \
  434. .type = BCMGENET_STAT_NETDEV, \
  435. }
  436. #define STAT_GENET_MIB(str, m, _type) { \
  437. .stat_string = str, \
  438. .stat_sizeof = sizeof(((struct bcmgenet_priv *)0)->m), \
  439. .stat_offset = offsetof(struct bcmgenet_priv, m), \
  440. .type = _type, \
  441. }
  442. #define STAT_GENET_MIB_RX(str, m) STAT_GENET_MIB(str, m, BCMGENET_STAT_MIB_RX)
  443. #define STAT_GENET_MIB_TX(str, m) STAT_GENET_MIB(str, m, BCMGENET_STAT_MIB_TX)
  444. #define STAT_GENET_RUNT(str, m) STAT_GENET_MIB(str, m, BCMGENET_STAT_RUNT)
  445. #define STAT_GENET_MISC(str, m, offset) { \
  446. .stat_string = str, \
  447. .stat_sizeof = sizeof(((struct bcmgenet_priv *)0)->m), \
  448. .stat_offset = offsetof(struct bcmgenet_priv, m), \
  449. .type = BCMGENET_STAT_MISC, \
  450. .reg_offset = offset, \
  451. }
  452. /* There is a 0xC gap between the end of RX and beginning of TX stats and then
  453. * between the end of TX stats and the beginning of the RX RUNT
  454. */
  455. #define BCMGENET_STAT_OFFSET 0xc
  456. /* Hardware counters must be kept in sync because the order/offset
  457. * is important here (order in structure declaration = order in hardware)
  458. */
  459. static const struct bcmgenet_stats bcmgenet_gstrings_stats[] = {
  460. /* general stats */
  461. STAT_NETDEV(rx_packets),
  462. STAT_NETDEV(tx_packets),
  463. STAT_NETDEV(rx_bytes),
  464. STAT_NETDEV(tx_bytes),
  465. STAT_NETDEV(rx_errors),
  466. STAT_NETDEV(tx_errors),
  467. STAT_NETDEV(rx_dropped),
  468. STAT_NETDEV(tx_dropped),
  469. STAT_NETDEV(multicast),
  470. /* UniMAC RSV counters */
  471. STAT_GENET_MIB_RX("rx_64_octets", mib.rx.pkt_cnt.cnt_64),
  472. STAT_GENET_MIB_RX("rx_65_127_oct", mib.rx.pkt_cnt.cnt_127),
  473. STAT_GENET_MIB_RX("rx_128_255_oct", mib.rx.pkt_cnt.cnt_255),
  474. STAT_GENET_MIB_RX("rx_256_511_oct", mib.rx.pkt_cnt.cnt_511),
  475. STAT_GENET_MIB_RX("rx_512_1023_oct", mib.rx.pkt_cnt.cnt_1023),
  476. STAT_GENET_MIB_RX("rx_1024_1518_oct", mib.rx.pkt_cnt.cnt_1518),
  477. STAT_GENET_MIB_RX("rx_vlan_1519_1522_oct", mib.rx.pkt_cnt.cnt_mgv),
  478. STAT_GENET_MIB_RX("rx_1522_2047_oct", mib.rx.pkt_cnt.cnt_2047),
  479. STAT_GENET_MIB_RX("rx_2048_4095_oct", mib.rx.pkt_cnt.cnt_4095),
  480. STAT_GENET_MIB_RX("rx_4096_9216_oct", mib.rx.pkt_cnt.cnt_9216),
  481. STAT_GENET_MIB_RX("rx_pkts", mib.rx.pkt),
  482. STAT_GENET_MIB_RX("rx_bytes", mib.rx.bytes),
  483. STAT_GENET_MIB_RX("rx_multicast", mib.rx.mca),
  484. STAT_GENET_MIB_RX("rx_broadcast", mib.rx.bca),
  485. STAT_GENET_MIB_RX("rx_fcs", mib.rx.fcs),
  486. STAT_GENET_MIB_RX("rx_control", mib.rx.cf),
  487. STAT_GENET_MIB_RX("rx_pause", mib.rx.pf),
  488. STAT_GENET_MIB_RX("rx_unknown", mib.rx.uo),
  489. STAT_GENET_MIB_RX("rx_align", mib.rx.aln),
  490. STAT_GENET_MIB_RX("rx_outrange", mib.rx.flr),
  491. STAT_GENET_MIB_RX("rx_code", mib.rx.cde),
  492. STAT_GENET_MIB_RX("rx_carrier", mib.rx.fcr),
  493. STAT_GENET_MIB_RX("rx_oversize", mib.rx.ovr),
  494. STAT_GENET_MIB_RX("rx_jabber", mib.rx.jbr),
  495. STAT_GENET_MIB_RX("rx_mtu_err", mib.rx.mtue),
  496. STAT_GENET_MIB_RX("rx_good_pkts", mib.rx.pok),
  497. STAT_GENET_MIB_RX("rx_unicast", mib.rx.uc),
  498. STAT_GENET_MIB_RX("rx_ppp", mib.rx.ppp),
  499. STAT_GENET_MIB_RX("rx_crc", mib.rx.rcrc),
  500. /* UniMAC TSV counters */
  501. STAT_GENET_MIB_TX("tx_64_octets", mib.tx.pkt_cnt.cnt_64),
  502. STAT_GENET_MIB_TX("tx_65_127_oct", mib.tx.pkt_cnt.cnt_127),
  503. STAT_GENET_MIB_TX("tx_128_255_oct", mib.tx.pkt_cnt.cnt_255),
  504. STAT_GENET_MIB_TX("tx_256_511_oct", mib.tx.pkt_cnt.cnt_511),
  505. STAT_GENET_MIB_TX("tx_512_1023_oct", mib.tx.pkt_cnt.cnt_1023),
  506. STAT_GENET_MIB_TX("tx_1024_1518_oct", mib.tx.pkt_cnt.cnt_1518),
  507. STAT_GENET_MIB_TX("tx_vlan_1519_1522_oct", mib.tx.pkt_cnt.cnt_mgv),
  508. STAT_GENET_MIB_TX("tx_1522_2047_oct", mib.tx.pkt_cnt.cnt_2047),
  509. STAT_GENET_MIB_TX("tx_2048_4095_oct", mib.tx.pkt_cnt.cnt_4095),
  510. STAT_GENET_MIB_TX("tx_4096_9216_oct", mib.tx.pkt_cnt.cnt_9216),
  511. STAT_GENET_MIB_TX("tx_pkts", mib.tx.pkts),
  512. STAT_GENET_MIB_TX("tx_multicast", mib.tx.mca),
  513. STAT_GENET_MIB_TX("tx_broadcast", mib.tx.bca),
  514. STAT_GENET_MIB_TX("tx_pause", mib.tx.pf),
  515. STAT_GENET_MIB_TX("tx_control", mib.tx.cf),
  516. STAT_GENET_MIB_TX("tx_fcs_err", mib.tx.fcs),
  517. STAT_GENET_MIB_TX("tx_oversize", mib.tx.ovr),
  518. STAT_GENET_MIB_TX("tx_defer", mib.tx.drf),
  519. STAT_GENET_MIB_TX("tx_excess_defer", mib.tx.edf),
  520. STAT_GENET_MIB_TX("tx_single_col", mib.tx.scl),
  521. STAT_GENET_MIB_TX("tx_multi_col", mib.tx.mcl),
  522. STAT_GENET_MIB_TX("tx_late_col", mib.tx.lcl),
  523. STAT_GENET_MIB_TX("tx_excess_col", mib.tx.ecl),
  524. STAT_GENET_MIB_TX("tx_frags", mib.tx.frg),
  525. STAT_GENET_MIB_TX("tx_total_col", mib.tx.ncl),
  526. STAT_GENET_MIB_TX("tx_jabber", mib.tx.jbr),
  527. STAT_GENET_MIB_TX("tx_bytes", mib.tx.bytes),
  528. STAT_GENET_MIB_TX("tx_good_pkts", mib.tx.pok),
  529. STAT_GENET_MIB_TX("tx_unicast", mib.tx.uc),
  530. /* UniMAC RUNT counters */
  531. STAT_GENET_RUNT("rx_runt_pkts", mib.rx_runt_cnt),
  532. STAT_GENET_RUNT("rx_runt_valid_fcs", mib.rx_runt_fcs),
  533. STAT_GENET_RUNT("rx_runt_inval_fcs_align", mib.rx_runt_fcs_align),
  534. STAT_GENET_RUNT("rx_runt_bytes", mib.rx_runt_bytes),
  535. /* Misc UniMAC counters */
  536. STAT_GENET_MISC("rbuf_ovflow_cnt", mib.rbuf_ovflow_cnt,
  537. UMAC_RBUF_OVFL_CNT),
  538. STAT_GENET_MISC("rbuf_err_cnt", mib.rbuf_err_cnt, UMAC_RBUF_ERR_CNT),
  539. STAT_GENET_MISC("mdf_err_cnt", mib.mdf_err_cnt, UMAC_MDF_ERR_CNT),
  540. };
  541. #define BCMGENET_STATS_LEN ARRAY_SIZE(bcmgenet_gstrings_stats)
  542. static void bcmgenet_get_drvinfo(struct net_device *dev,
  543. struct ethtool_drvinfo *info)
  544. {
  545. strlcpy(info->driver, "bcmgenet", sizeof(info->driver));
  546. strlcpy(info->version, "v2.0", sizeof(info->version));
  547. info->n_stats = BCMGENET_STATS_LEN;
  548. }
  549. static int bcmgenet_get_sset_count(struct net_device *dev, int string_set)
  550. {
  551. switch (string_set) {
  552. case ETH_SS_STATS:
  553. return BCMGENET_STATS_LEN;
  554. default:
  555. return -EOPNOTSUPP;
  556. }
  557. }
  558. static void bcmgenet_get_strings(struct net_device *dev,
  559. u32 stringset, u8 *data)
  560. {
  561. int i;
  562. switch (stringset) {
  563. case ETH_SS_STATS:
  564. for (i = 0; i < BCMGENET_STATS_LEN; i++) {
  565. memcpy(data + i * ETH_GSTRING_LEN,
  566. bcmgenet_gstrings_stats[i].stat_string,
  567. ETH_GSTRING_LEN);
  568. }
  569. break;
  570. }
  571. }
  572. static void bcmgenet_update_mib_counters(struct bcmgenet_priv *priv)
  573. {
  574. int i, j = 0;
  575. for (i = 0; i < BCMGENET_STATS_LEN; i++) {
  576. const struct bcmgenet_stats *s;
  577. u8 offset = 0;
  578. u32 val = 0;
  579. char *p;
  580. s = &bcmgenet_gstrings_stats[i];
  581. switch (s->type) {
  582. case BCMGENET_STAT_NETDEV:
  583. continue;
  584. case BCMGENET_STAT_MIB_RX:
  585. case BCMGENET_STAT_MIB_TX:
  586. case BCMGENET_STAT_RUNT:
  587. if (s->type != BCMGENET_STAT_MIB_RX)
  588. offset = BCMGENET_STAT_OFFSET;
  589. val = bcmgenet_umac_readl(priv, UMAC_MIB_START +
  590. j + offset);
  591. break;
  592. case BCMGENET_STAT_MISC:
  593. val = bcmgenet_umac_readl(priv, s->reg_offset);
  594. /* clear if overflowed */
  595. if (val == ~0)
  596. bcmgenet_umac_writel(priv, 0, s->reg_offset);
  597. break;
  598. }
  599. j += s->stat_sizeof;
  600. p = (char *)priv + s->stat_offset;
  601. *(u32 *)p = val;
  602. }
  603. }
  604. static void bcmgenet_get_ethtool_stats(struct net_device *dev,
  605. struct ethtool_stats *stats,
  606. u64 *data)
  607. {
  608. struct bcmgenet_priv *priv = netdev_priv(dev);
  609. int i;
  610. if (netif_running(dev))
  611. bcmgenet_update_mib_counters(priv);
  612. for (i = 0; i < BCMGENET_STATS_LEN; i++) {
  613. const struct bcmgenet_stats *s;
  614. char *p;
  615. s = &bcmgenet_gstrings_stats[i];
  616. if (s->type == BCMGENET_STAT_NETDEV)
  617. p = (char *)&dev->stats;
  618. else
  619. p = (char *)priv;
  620. p += s->stat_offset;
  621. data[i] = *(u32 *)p;
  622. }
  623. }
  624. /* standard ethtool support functions. */
  625. static struct ethtool_ops bcmgenet_ethtool_ops = {
  626. .get_strings = bcmgenet_get_strings,
  627. .get_sset_count = bcmgenet_get_sset_count,
  628. .get_ethtool_stats = bcmgenet_get_ethtool_stats,
  629. .get_settings = bcmgenet_get_settings,
  630. .set_settings = bcmgenet_set_settings,
  631. .get_drvinfo = bcmgenet_get_drvinfo,
  632. .get_link = ethtool_op_get_link,
  633. .get_msglevel = bcmgenet_get_msglevel,
  634. .set_msglevel = bcmgenet_set_msglevel,
  635. };
  636. /* Power down the unimac, based on mode. */
  637. static void bcmgenet_power_down(struct bcmgenet_priv *priv,
  638. enum bcmgenet_power_mode mode)
  639. {
  640. u32 reg;
  641. switch (mode) {
  642. case GENET_POWER_CABLE_SENSE:
  643. phy_detach(priv->phydev);
  644. break;
  645. case GENET_POWER_PASSIVE:
  646. /* Power down LED */
  647. bcmgenet_mii_reset(priv->dev);
  648. if (priv->hw_params->flags & GENET_HAS_EXT) {
  649. reg = bcmgenet_ext_readl(priv, EXT_EXT_PWR_MGMT);
  650. reg |= (EXT_PWR_DOWN_PHY |
  651. EXT_PWR_DOWN_DLL | EXT_PWR_DOWN_BIAS);
  652. bcmgenet_ext_writel(priv, reg, EXT_EXT_PWR_MGMT);
  653. }
  654. break;
  655. default:
  656. break;
  657. }
  658. }
  659. static void bcmgenet_power_up(struct bcmgenet_priv *priv,
  660. enum bcmgenet_power_mode mode)
  661. {
  662. u32 reg;
  663. if (!(priv->hw_params->flags & GENET_HAS_EXT))
  664. return;
  665. reg = bcmgenet_ext_readl(priv, EXT_EXT_PWR_MGMT);
  666. switch (mode) {
  667. case GENET_POWER_PASSIVE:
  668. reg &= ~(EXT_PWR_DOWN_DLL | EXT_PWR_DOWN_PHY |
  669. EXT_PWR_DOWN_BIAS);
  670. /* fallthrough */
  671. case GENET_POWER_CABLE_SENSE:
  672. /* enable APD */
  673. reg |= EXT_PWR_DN_EN_LD;
  674. break;
  675. default:
  676. break;
  677. }
  678. bcmgenet_ext_writel(priv, reg, EXT_EXT_PWR_MGMT);
  679. bcmgenet_mii_reset(priv->dev);
  680. }
  681. /* ioctl handle special commands that are not present in ethtool. */
  682. static int bcmgenet_ioctl(struct net_device *dev, struct ifreq *rq, int cmd)
  683. {
  684. struct bcmgenet_priv *priv = netdev_priv(dev);
  685. int val = 0;
  686. if (!netif_running(dev))
  687. return -EINVAL;
  688. switch (cmd) {
  689. case SIOCGMIIPHY:
  690. case SIOCGMIIREG:
  691. case SIOCSMIIREG:
  692. if (!priv->phydev)
  693. val = -ENODEV;
  694. else
  695. val = phy_mii_ioctl(priv->phydev, rq, cmd);
  696. break;
  697. default:
  698. val = -EINVAL;
  699. break;
  700. }
  701. return val;
  702. }
  703. static struct enet_cb *bcmgenet_get_txcb(struct bcmgenet_priv *priv,
  704. struct bcmgenet_tx_ring *ring)
  705. {
  706. struct enet_cb *tx_cb_ptr;
  707. tx_cb_ptr = ring->cbs;
  708. tx_cb_ptr += ring->write_ptr - ring->cb_ptr;
  709. tx_cb_ptr->bd_addr = priv->tx_bds + ring->write_ptr * DMA_DESC_SIZE;
  710. /* Advancing local write pointer */
  711. if (ring->write_ptr == ring->end_ptr)
  712. ring->write_ptr = ring->cb_ptr;
  713. else
  714. ring->write_ptr++;
  715. return tx_cb_ptr;
  716. }
  717. /* Simple helper to free a control block's resources */
  718. static void bcmgenet_free_cb(struct enet_cb *cb)
  719. {
  720. dev_kfree_skb_any(cb->skb);
  721. cb->skb = NULL;
  722. dma_unmap_addr_set(cb, dma_addr, 0);
  723. }
  724. static inline void bcmgenet_tx_ring16_int_disable(struct bcmgenet_priv *priv,
  725. struct bcmgenet_tx_ring *ring)
  726. {
  727. bcmgenet_intrl2_0_writel(priv,
  728. UMAC_IRQ_TXDMA_BDONE | UMAC_IRQ_TXDMA_PDONE,
  729. INTRL2_CPU_MASK_SET);
  730. }
  731. static inline void bcmgenet_tx_ring16_int_enable(struct bcmgenet_priv *priv,
  732. struct bcmgenet_tx_ring *ring)
  733. {
  734. bcmgenet_intrl2_0_writel(priv,
  735. UMAC_IRQ_TXDMA_BDONE | UMAC_IRQ_TXDMA_PDONE,
  736. INTRL2_CPU_MASK_CLEAR);
  737. }
  738. static inline void bcmgenet_tx_ring_int_enable(struct bcmgenet_priv *priv,
  739. struct bcmgenet_tx_ring *ring)
  740. {
  741. bcmgenet_intrl2_1_writel(priv,
  742. (1 << ring->index), INTRL2_CPU_MASK_CLEAR);
  743. priv->int1_mask &= ~(1 << ring->index);
  744. }
  745. static inline void bcmgenet_tx_ring_int_disable(struct bcmgenet_priv *priv,
  746. struct bcmgenet_tx_ring *ring)
  747. {
  748. bcmgenet_intrl2_1_writel(priv,
  749. (1 << ring->index), INTRL2_CPU_MASK_SET);
  750. priv->int1_mask |= (1 << ring->index);
  751. }
  752. /* Unlocked version of the reclaim routine */
  753. static void __bcmgenet_tx_reclaim(struct net_device *dev,
  754. struct bcmgenet_tx_ring *ring)
  755. {
  756. struct bcmgenet_priv *priv = netdev_priv(dev);
  757. int last_tx_cn, last_c_index, num_tx_bds;
  758. struct enet_cb *tx_cb_ptr;
  759. struct netdev_queue *txq;
  760. unsigned int c_index;
  761. /* Compute how many buffers are transmited since last xmit call */
  762. c_index = bcmgenet_tdma_ring_readl(priv, ring->index, TDMA_CONS_INDEX);
  763. txq = netdev_get_tx_queue(dev, ring->queue);
  764. last_c_index = ring->c_index;
  765. num_tx_bds = ring->size;
  766. c_index &= (num_tx_bds - 1);
  767. if (c_index >= last_c_index)
  768. last_tx_cn = c_index - last_c_index;
  769. else
  770. last_tx_cn = num_tx_bds - last_c_index + c_index;
  771. netif_dbg(priv, tx_done, dev,
  772. "%s ring=%d index=%d last_tx_cn=%d last_index=%d\n",
  773. __func__, ring->index,
  774. c_index, last_tx_cn, last_c_index);
  775. /* Reclaim transmitted buffers */
  776. while (last_tx_cn-- > 0) {
  777. tx_cb_ptr = ring->cbs + last_c_index;
  778. if (tx_cb_ptr->skb) {
  779. dev->stats.tx_bytes += tx_cb_ptr->skb->len;
  780. dma_unmap_single(&dev->dev,
  781. dma_unmap_addr(tx_cb_ptr, dma_addr),
  782. tx_cb_ptr->skb->len,
  783. DMA_TO_DEVICE);
  784. bcmgenet_free_cb(tx_cb_ptr);
  785. } else if (dma_unmap_addr(tx_cb_ptr, dma_addr)) {
  786. dev->stats.tx_bytes +=
  787. dma_unmap_len(tx_cb_ptr, dma_len);
  788. dma_unmap_page(&dev->dev,
  789. dma_unmap_addr(tx_cb_ptr, dma_addr),
  790. dma_unmap_len(tx_cb_ptr, dma_len),
  791. DMA_TO_DEVICE);
  792. dma_unmap_addr_set(tx_cb_ptr, dma_addr, 0);
  793. }
  794. dev->stats.tx_packets++;
  795. ring->free_bds += 1;
  796. last_c_index++;
  797. last_c_index &= (num_tx_bds - 1);
  798. }
  799. if (ring->free_bds > (MAX_SKB_FRAGS + 1))
  800. ring->int_disable(priv, ring);
  801. if (netif_tx_queue_stopped(txq))
  802. netif_tx_wake_queue(txq);
  803. ring->c_index = c_index;
  804. }
  805. static void bcmgenet_tx_reclaim(struct net_device *dev,
  806. struct bcmgenet_tx_ring *ring)
  807. {
  808. unsigned long flags;
  809. spin_lock_irqsave(&ring->lock, flags);
  810. __bcmgenet_tx_reclaim(dev, ring);
  811. spin_unlock_irqrestore(&ring->lock, flags);
  812. }
  813. static void bcmgenet_tx_reclaim_all(struct net_device *dev)
  814. {
  815. struct bcmgenet_priv *priv = netdev_priv(dev);
  816. int i;
  817. if (netif_is_multiqueue(dev)) {
  818. for (i = 0; i < priv->hw_params->tx_queues; i++)
  819. bcmgenet_tx_reclaim(dev, &priv->tx_rings[i]);
  820. }
  821. bcmgenet_tx_reclaim(dev, &priv->tx_rings[DESC_INDEX]);
  822. }
  823. /* Transmits a single SKB (either head of a fragment or a single SKB)
  824. * caller must hold priv->lock
  825. */
  826. static int bcmgenet_xmit_single(struct net_device *dev,
  827. struct sk_buff *skb,
  828. u16 dma_desc_flags,
  829. struct bcmgenet_tx_ring *ring)
  830. {
  831. struct bcmgenet_priv *priv = netdev_priv(dev);
  832. struct device *kdev = &priv->pdev->dev;
  833. struct enet_cb *tx_cb_ptr;
  834. unsigned int skb_len;
  835. dma_addr_t mapping;
  836. u32 length_status;
  837. int ret;
  838. tx_cb_ptr = bcmgenet_get_txcb(priv, ring);
  839. if (unlikely(!tx_cb_ptr))
  840. BUG();
  841. tx_cb_ptr->skb = skb;
  842. skb_len = skb_headlen(skb) < ETH_ZLEN ? ETH_ZLEN : skb_headlen(skb);
  843. mapping = dma_map_single(kdev, skb->data, skb_len, DMA_TO_DEVICE);
  844. ret = dma_mapping_error(kdev, mapping);
  845. if (ret) {
  846. netif_err(priv, tx_err, dev, "Tx DMA map failed\n");
  847. dev_kfree_skb(skb);
  848. return ret;
  849. }
  850. dma_unmap_addr_set(tx_cb_ptr, dma_addr, mapping);
  851. dma_unmap_len_set(tx_cb_ptr, dma_len, skb->len);
  852. length_status = (skb_len << DMA_BUFLENGTH_SHIFT) | dma_desc_flags |
  853. (priv->hw_params->qtag_mask << DMA_TX_QTAG_SHIFT) |
  854. DMA_TX_APPEND_CRC;
  855. if (skb->ip_summed == CHECKSUM_PARTIAL)
  856. length_status |= DMA_TX_DO_CSUM;
  857. dmadesc_set(priv, tx_cb_ptr->bd_addr, mapping, length_status);
  858. /* Decrement total BD count and advance our write pointer */
  859. ring->free_bds -= 1;
  860. ring->prod_index += 1;
  861. ring->prod_index &= DMA_P_INDEX_MASK;
  862. return 0;
  863. }
  864. /* Transmit a SKB fragement */
  865. static int bcmgenet_xmit_frag(struct net_device *dev,
  866. skb_frag_t *frag,
  867. u16 dma_desc_flags,
  868. struct bcmgenet_tx_ring *ring)
  869. {
  870. struct bcmgenet_priv *priv = netdev_priv(dev);
  871. struct device *kdev = &priv->pdev->dev;
  872. struct enet_cb *tx_cb_ptr;
  873. dma_addr_t mapping;
  874. int ret;
  875. tx_cb_ptr = bcmgenet_get_txcb(priv, ring);
  876. if (unlikely(!tx_cb_ptr))
  877. BUG();
  878. tx_cb_ptr->skb = NULL;
  879. mapping = skb_frag_dma_map(kdev, frag, 0,
  880. skb_frag_size(frag), DMA_TO_DEVICE);
  881. ret = dma_mapping_error(kdev, mapping);
  882. if (ret) {
  883. netif_err(priv, tx_err, dev, "%s: Tx DMA map failed\n",
  884. __func__);
  885. return ret;
  886. }
  887. dma_unmap_addr_set(tx_cb_ptr, dma_addr, mapping);
  888. dma_unmap_len_set(tx_cb_ptr, dma_len, frag->size);
  889. dmadesc_set(priv, tx_cb_ptr->bd_addr, mapping,
  890. (frag->size << DMA_BUFLENGTH_SHIFT) | dma_desc_flags |
  891. (priv->hw_params->qtag_mask << DMA_TX_QTAG_SHIFT));
  892. ring->free_bds -= 1;
  893. ring->prod_index += 1;
  894. ring->prod_index &= DMA_P_INDEX_MASK;
  895. return 0;
  896. }
  897. /* Reallocate the SKB to put enough headroom in front of it and insert
  898. * the transmit checksum offsets in the descriptors
  899. */
  900. static int bcmgenet_put_tx_csum(struct net_device *dev, struct sk_buff *skb)
  901. {
  902. struct status_64 *status = NULL;
  903. struct sk_buff *new_skb;
  904. u16 offset;
  905. u8 ip_proto;
  906. u16 ip_ver;
  907. u32 tx_csum_info;
  908. if (unlikely(skb_headroom(skb) < sizeof(*status))) {
  909. /* If 64 byte status block enabled, must make sure skb has
  910. * enough headroom for us to insert 64B status block.
  911. */
  912. new_skb = skb_realloc_headroom(skb, sizeof(*status));
  913. dev_kfree_skb(skb);
  914. if (!new_skb) {
  915. dev->stats.tx_errors++;
  916. dev->stats.tx_dropped++;
  917. return -ENOMEM;
  918. }
  919. skb = new_skb;
  920. }
  921. skb_push(skb, sizeof(*status));
  922. status = (struct status_64 *)skb->data;
  923. if (skb->ip_summed == CHECKSUM_PARTIAL) {
  924. ip_ver = htons(skb->protocol);
  925. switch (ip_ver) {
  926. case ETH_P_IP:
  927. ip_proto = ip_hdr(skb)->protocol;
  928. break;
  929. case ETH_P_IPV6:
  930. ip_proto = ipv6_hdr(skb)->nexthdr;
  931. break;
  932. default:
  933. return 0;
  934. }
  935. offset = skb_checksum_start_offset(skb) - sizeof(*status);
  936. tx_csum_info = (offset << STATUS_TX_CSUM_START_SHIFT) |
  937. (offset + skb->csum_offset);
  938. /* Set the length valid bit for TCP and UDP and just set
  939. * the special UDP flag for IPv4, else just set to 0.
  940. */
  941. if (ip_proto == IPPROTO_TCP || ip_proto == IPPROTO_UDP) {
  942. tx_csum_info |= STATUS_TX_CSUM_LV;
  943. if (ip_proto == IPPROTO_UDP && ip_ver == ETH_P_IP)
  944. tx_csum_info |= STATUS_TX_CSUM_PROTO_UDP;
  945. } else
  946. tx_csum_info = 0;
  947. status->tx_csum_info = tx_csum_info;
  948. }
  949. return 0;
  950. }
  951. static netdev_tx_t bcmgenet_xmit(struct sk_buff *skb, struct net_device *dev)
  952. {
  953. struct bcmgenet_priv *priv = netdev_priv(dev);
  954. struct bcmgenet_tx_ring *ring = NULL;
  955. struct netdev_queue *txq;
  956. unsigned long flags = 0;
  957. int nr_frags, index;
  958. u16 dma_desc_flags;
  959. int ret;
  960. int i;
  961. index = skb_get_queue_mapping(skb);
  962. /* Mapping strategy:
  963. * queue_mapping = 0, unclassified, packet xmited through ring16
  964. * queue_mapping = 1, goes to ring 0. (highest priority queue
  965. * queue_mapping = 2, goes to ring 1.
  966. * queue_mapping = 3, goes to ring 2.
  967. * queue_mapping = 4, goes to ring 3.
  968. */
  969. if (index == 0)
  970. index = DESC_INDEX;
  971. else
  972. index -= 1;
  973. nr_frags = skb_shinfo(skb)->nr_frags;
  974. ring = &priv->tx_rings[index];
  975. txq = netdev_get_tx_queue(dev, ring->queue);
  976. spin_lock_irqsave(&ring->lock, flags);
  977. if (ring->free_bds <= nr_frags + 1) {
  978. netif_tx_stop_queue(txq);
  979. netdev_err(dev, "%s: tx ring %d full when queue %d awake\n",
  980. __func__, index, ring->queue);
  981. ret = NETDEV_TX_BUSY;
  982. goto out;
  983. }
  984. /* set the SKB transmit checksum */
  985. if (priv->desc_64b_en) {
  986. ret = bcmgenet_put_tx_csum(dev, skb);
  987. if (ret) {
  988. ret = NETDEV_TX_OK;
  989. goto out;
  990. }
  991. }
  992. dma_desc_flags = DMA_SOP;
  993. if (nr_frags == 0)
  994. dma_desc_flags |= DMA_EOP;
  995. /* Transmit single SKB or head of fragment list */
  996. ret = bcmgenet_xmit_single(dev, skb, dma_desc_flags, ring);
  997. if (ret) {
  998. ret = NETDEV_TX_OK;
  999. goto out;
  1000. }
  1001. /* xmit fragment */
  1002. for (i = 0; i < nr_frags; i++) {
  1003. ret = bcmgenet_xmit_frag(dev,
  1004. &skb_shinfo(skb)->frags[i],
  1005. (i == nr_frags - 1) ? DMA_EOP : 0, ring);
  1006. if (ret) {
  1007. ret = NETDEV_TX_OK;
  1008. goto out;
  1009. }
  1010. }
  1011. skb_tx_timestamp(skb);
  1012. /* we kept a software copy of how much we should advance the TDMA
  1013. * producer index, now write it down to the hardware
  1014. */
  1015. bcmgenet_tdma_ring_writel(priv, ring->index,
  1016. ring->prod_index, TDMA_PROD_INDEX);
  1017. if (ring->free_bds <= (MAX_SKB_FRAGS + 1)) {
  1018. netif_tx_stop_queue(txq);
  1019. ring->int_enable(priv, ring);
  1020. }
  1021. out:
  1022. spin_unlock_irqrestore(&ring->lock, flags);
  1023. return ret;
  1024. }
  1025. static int bcmgenet_rx_refill(struct bcmgenet_priv *priv,
  1026. struct enet_cb *cb)
  1027. {
  1028. struct device *kdev = &priv->pdev->dev;
  1029. struct sk_buff *skb;
  1030. dma_addr_t mapping;
  1031. int ret;
  1032. skb = netdev_alloc_skb(priv->dev,
  1033. priv->rx_buf_len + SKB_ALIGNMENT);
  1034. if (!skb)
  1035. return -ENOMEM;
  1036. /* a caller did not release this control block */
  1037. WARN_ON(cb->skb != NULL);
  1038. cb->skb = skb;
  1039. mapping = dma_map_single(kdev, skb->data,
  1040. priv->rx_buf_len, DMA_FROM_DEVICE);
  1041. ret = dma_mapping_error(kdev, mapping);
  1042. if (ret) {
  1043. bcmgenet_free_cb(cb);
  1044. netif_err(priv, rx_err, priv->dev,
  1045. "%s DMA map failed\n", __func__);
  1046. return ret;
  1047. }
  1048. dma_unmap_addr_set(cb, dma_addr, mapping);
  1049. /* assign packet, prepare descriptor, and advance pointer */
  1050. dmadesc_set_addr(priv, priv->rx_bd_assign_ptr, mapping);
  1051. /* turn on the newly assigned BD for DMA to use */
  1052. priv->rx_bd_assign_index++;
  1053. priv->rx_bd_assign_index &= (priv->num_rx_bds - 1);
  1054. priv->rx_bd_assign_ptr = priv->rx_bds +
  1055. (priv->rx_bd_assign_index * DMA_DESC_SIZE);
  1056. return 0;
  1057. }
  1058. /* bcmgenet_desc_rx - descriptor based rx process.
  1059. * this could be called from bottom half, or from NAPI polling method.
  1060. */
  1061. static unsigned int bcmgenet_desc_rx(struct bcmgenet_priv *priv,
  1062. unsigned int budget)
  1063. {
  1064. struct net_device *dev = priv->dev;
  1065. struct enet_cb *cb;
  1066. struct sk_buff *skb;
  1067. u32 dma_length_status;
  1068. unsigned long dma_flag;
  1069. int len, err;
  1070. unsigned int rxpktprocessed = 0, rxpkttoprocess;
  1071. unsigned int p_index;
  1072. unsigned int chksum_ok = 0;
  1073. p_index = bcmgenet_rdma_ring_readl(priv,
  1074. DESC_INDEX, RDMA_PROD_INDEX);
  1075. p_index &= DMA_P_INDEX_MASK;
  1076. if (p_index < priv->rx_c_index)
  1077. rxpkttoprocess = (DMA_C_INDEX_MASK + 1) -
  1078. priv->rx_c_index + p_index;
  1079. else
  1080. rxpkttoprocess = p_index - priv->rx_c_index;
  1081. netif_dbg(priv, rx_status, dev,
  1082. "RDMA: rxpkttoprocess=%d\n", rxpkttoprocess);
  1083. while ((rxpktprocessed < rxpkttoprocess) &&
  1084. (rxpktprocessed < budget)) {
  1085. /* Unmap the packet contents such that we can use the
  1086. * RSV from the 64 bytes descriptor when enabled and save
  1087. * a 32-bits register read
  1088. */
  1089. cb = &priv->rx_cbs[priv->rx_read_ptr];
  1090. skb = cb->skb;
  1091. dma_unmap_single(&dev->dev, dma_unmap_addr(cb, dma_addr),
  1092. priv->rx_buf_len, DMA_FROM_DEVICE);
  1093. if (!priv->desc_64b_en) {
  1094. dma_length_status = dmadesc_get_length_status(priv,
  1095. priv->rx_bds +
  1096. (priv->rx_read_ptr *
  1097. DMA_DESC_SIZE));
  1098. } else {
  1099. struct status_64 *status;
  1100. status = (struct status_64 *)skb->data;
  1101. dma_length_status = status->length_status;
  1102. }
  1103. /* DMA flags and length are still valid no matter how
  1104. * we got the Receive Status Vector (64B RSB or register)
  1105. */
  1106. dma_flag = dma_length_status & 0xffff;
  1107. len = dma_length_status >> DMA_BUFLENGTH_SHIFT;
  1108. netif_dbg(priv, rx_status, dev,
  1109. "%s: p_ind=%d c_ind=%d read_ptr=%d len_stat=0x%08x\n",
  1110. __func__, p_index, priv->rx_c_index, priv->rx_read_ptr,
  1111. dma_length_status);
  1112. rxpktprocessed++;
  1113. priv->rx_read_ptr++;
  1114. priv->rx_read_ptr &= (priv->num_rx_bds - 1);
  1115. /* out of memory, just drop packets at the hardware level */
  1116. if (unlikely(!skb)) {
  1117. dev->stats.rx_dropped++;
  1118. dev->stats.rx_errors++;
  1119. goto refill;
  1120. }
  1121. if (unlikely(!(dma_flag & DMA_EOP) || !(dma_flag & DMA_SOP))) {
  1122. netif_err(priv, rx_status, dev,
  1123. "Droping fragmented packet!\n");
  1124. dev->stats.rx_dropped++;
  1125. dev->stats.rx_errors++;
  1126. dev_kfree_skb_any(cb->skb);
  1127. cb->skb = NULL;
  1128. goto refill;
  1129. }
  1130. /* report errors */
  1131. if (unlikely(dma_flag & (DMA_RX_CRC_ERROR |
  1132. DMA_RX_OV |
  1133. DMA_RX_NO |
  1134. DMA_RX_LG |
  1135. DMA_RX_RXER))) {
  1136. netif_err(priv, rx_status, dev, "dma_flag=0x%x\n",
  1137. (unsigned int)dma_flag);
  1138. if (dma_flag & DMA_RX_CRC_ERROR)
  1139. dev->stats.rx_crc_errors++;
  1140. if (dma_flag & DMA_RX_OV)
  1141. dev->stats.rx_over_errors++;
  1142. if (dma_flag & DMA_RX_NO)
  1143. dev->stats.rx_frame_errors++;
  1144. if (dma_flag & DMA_RX_LG)
  1145. dev->stats.rx_length_errors++;
  1146. dev->stats.rx_dropped++;
  1147. dev->stats.rx_errors++;
  1148. /* discard the packet and advance consumer index.*/
  1149. dev_kfree_skb_any(cb->skb);
  1150. cb->skb = NULL;
  1151. goto refill;
  1152. } /* error packet */
  1153. chksum_ok = (dma_flag & priv->dma_rx_chk_bit) &&
  1154. priv->desc_rxchk_en;
  1155. skb_put(skb, len);
  1156. if (priv->desc_64b_en) {
  1157. skb_pull(skb, 64);
  1158. len -= 64;
  1159. }
  1160. if (likely(chksum_ok))
  1161. skb->ip_summed = CHECKSUM_UNNECESSARY;
  1162. /* remove hardware 2bytes added for IP alignment */
  1163. skb_pull(skb, 2);
  1164. len -= 2;
  1165. if (priv->crc_fwd_en) {
  1166. skb_trim(skb, len - ETH_FCS_LEN);
  1167. len -= ETH_FCS_LEN;
  1168. }
  1169. /*Finish setting up the received SKB and send it to the kernel*/
  1170. skb->protocol = eth_type_trans(skb, priv->dev);
  1171. dev->stats.rx_packets++;
  1172. dev->stats.rx_bytes += len;
  1173. if (dma_flag & DMA_RX_MULT)
  1174. dev->stats.multicast++;
  1175. /* Notify kernel */
  1176. napi_gro_receive(&priv->napi, skb);
  1177. cb->skb = NULL;
  1178. netif_dbg(priv, rx_status, dev, "pushed up to kernel\n");
  1179. /* refill RX path on the current control block */
  1180. refill:
  1181. err = bcmgenet_rx_refill(priv, cb);
  1182. if (err)
  1183. netif_err(priv, rx_err, dev, "Rx refill failed\n");
  1184. }
  1185. return rxpktprocessed;
  1186. }
  1187. /* Assign skb to RX DMA descriptor. */
  1188. static int bcmgenet_alloc_rx_buffers(struct bcmgenet_priv *priv)
  1189. {
  1190. struct enet_cb *cb;
  1191. int ret = 0;
  1192. int i;
  1193. netif_dbg(priv, hw, priv->dev, "%s:\n", __func__);
  1194. /* loop here for each buffer needing assign */
  1195. for (i = 0; i < priv->num_rx_bds; i++) {
  1196. cb = &priv->rx_cbs[priv->rx_bd_assign_index];
  1197. if (cb->skb)
  1198. continue;
  1199. /* set the DMA descriptor length once and for all
  1200. * it will only change if we support dynamically sizing
  1201. * priv->rx_buf_len, but we do not
  1202. */
  1203. dmadesc_set_length_status(priv, priv->rx_bd_assign_ptr,
  1204. priv->rx_buf_len << DMA_BUFLENGTH_SHIFT);
  1205. ret = bcmgenet_rx_refill(priv, cb);
  1206. if (ret)
  1207. break;
  1208. }
  1209. return ret;
  1210. }
  1211. static void bcmgenet_free_rx_buffers(struct bcmgenet_priv *priv)
  1212. {
  1213. struct enet_cb *cb;
  1214. int i;
  1215. for (i = 0; i < priv->num_rx_bds; i++) {
  1216. cb = &priv->rx_cbs[i];
  1217. if (dma_unmap_addr(cb, dma_addr)) {
  1218. dma_unmap_single(&priv->dev->dev,
  1219. dma_unmap_addr(cb, dma_addr),
  1220. priv->rx_buf_len, DMA_FROM_DEVICE);
  1221. dma_unmap_addr_set(cb, dma_addr, 0);
  1222. }
  1223. if (cb->skb)
  1224. bcmgenet_free_cb(cb);
  1225. }
  1226. }
  1227. static int reset_umac(struct bcmgenet_priv *priv)
  1228. {
  1229. struct device *kdev = &priv->pdev->dev;
  1230. unsigned int timeout = 0;
  1231. u32 reg;
  1232. /* 7358a0/7552a0: bad default in RBUF_FLUSH_CTRL.umac_sw_rst */
  1233. bcmgenet_rbuf_ctrl_set(priv, 0);
  1234. udelay(10);
  1235. /* disable MAC while updating its registers */
  1236. bcmgenet_umac_writel(priv, 0, UMAC_CMD);
  1237. /* issue soft reset, wait for it to complete */
  1238. bcmgenet_umac_writel(priv, CMD_SW_RESET, UMAC_CMD);
  1239. while (timeout++ < 1000) {
  1240. reg = bcmgenet_umac_readl(priv, UMAC_CMD);
  1241. if (!(reg & CMD_SW_RESET))
  1242. return 0;
  1243. udelay(1);
  1244. }
  1245. if (timeout == 1000) {
  1246. dev_err(kdev,
  1247. "timeout waiting for MAC to come out of resetn\n");
  1248. return -ETIMEDOUT;
  1249. }
  1250. return 0;
  1251. }
  1252. static int init_umac(struct bcmgenet_priv *priv)
  1253. {
  1254. struct device *kdev = &priv->pdev->dev;
  1255. int ret;
  1256. u32 reg, cpu_mask_clear;
  1257. dev_dbg(&priv->pdev->dev, "bcmgenet: init_umac\n");
  1258. ret = reset_umac(priv);
  1259. if (ret)
  1260. return ret;
  1261. bcmgenet_umac_writel(priv, 0, UMAC_CMD);
  1262. /* clear tx/rx counter */
  1263. bcmgenet_umac_writel(priv,
  1264. MIB_RESET_RX | MIB_RESET_TX | MIB_RESET_RUNT, UMAC_MIB_CTRL);
  1265. bcmgenet_umac_writel(priv, 0, UMAC_MIB_CTRL);
  1266. bcmgenet_umac_writel(priv, ENET_MAX_MTU_SIZE, UMAC_MAX_FRAME_LEN);
  1267. /* init rx registers, enable ip header optimization */
  1268. reg = bcmgenet_rbuf_readl(priv, RBUF_CTRL);
  1269. reg |= RBUF_ALIGN_2B;
  1270. bcmgenet_rbuf_writel(priv, reg, RBUF_CTRL);
  1271. if (!GENET_IS_V1(priv) && !GENET_IS_V2(priv))
  1272. bcmgenet_rbuf_writel(priv, 1, RBUF_TBUF_SIZE_CTRL);
  1273. /* Mask all interrupts.*/
  1274. bcmgenet_intrl2_0_writel(priv, 0xFFFFFFFF, INTRL2_CPU_MASK_SET);
  1275. bcmgenet_intrl2_0_writel(priv, 0xFFFFFFFF, INTRL2_CPU_CLEAR);
  1276. bcmgenet_intrl2_0_writel(priv, 0, INTRL2_CPU_MASK_CLEAR);
  1277. cpu_mask_clear = UMAC_IRQ_RXDMA_BDONE;
  1278. dev_dbg(kdev, "%s:Enabling RXDMA_BDONE interrupt\n", __func__);
  1279. /* Monitor cable plug/unpluged event for internal PHY */
  1280. if (phy_is_internal(priv->phydev))
  1281. cpu_mask_clear |= (UMAC_IRQ_LINK_DOWN | UMAC_IRQ_LINK_UP);
  1282. else if (priv->ext_phy)
  1283. cpu_mask_clear |= (UMAC_IRQ_LINK_DOWN | UMAC_IRQ_LINK_UP);
  1284. else if (priv->phy_interface == PHY_INTERFACE_MODE_MOCA) {
  1285. reg = bcmgenet_bp_mc_get(priv);
  1286. reg |= BIT(priv->hw_params->bp_in_en_shift);
  1287. /* bp_mask: back pressure mask */
  1288. if (netif_is_multiqueue(priv->dev))
  1289. reg |= priv->hw_params->bp_in_mask;
  1290. else
  1291. reg &= ~priv->hw_params->bp_in_mask;
  1292. bcmgenet_bp_mc_set(priv, reg);
  1293. }
  1294. /* Enable MDIO interrupts on GENET v3+ */
  1295. if (priv->hw_params->flags & GENET_HAS_MDIO_INTR)
  1296. cpu_mask_clear |= UMAC_IRQ_MDIO_DONE | UMAC_IRQ_MDIO_ERROR;
  1297. bcmgenet_intrl2_0_writel(priv, cpu_mask_clear,
  1298. INTRL2_CPU_MASK_CLEAR);
  1299. /* Enable rx/tx engine.*/
  1300. dev_dbg(kdev, "done init umac\n");
  1301. return 0;
  1302. }
  1303. /* Initialize all house-keeping variables for a TX ring, along
  1304. * with corresponding hardware registers
  1305. */
  1306. static void bcmgenet_init_tx_ring(struct bcmgenet_priv *priv,
  1307. unsigned int index, unsigned int size,
  1308. unsigned int write_ptr, unsigned int end_ptr)
  1309. {
  1310. struct bcmgenet_tx_ring *ring = &priv->tx_rings[index];
  1311. u32 words_per_bd = WORDS_PER_BD(priv);
  1312. u32 flow_period_val = 0;
  1313. unsigned int first_bd;
  1314. spin_lock_init(&ring->lock);
  1315. ring->index = index;
  1316. if (index == DESC_INDEX) {
  1317. ring->queue = 0;
  1318. ring->int_enable = bcmgenet_tx_ring16_int_enable;
  1319. ring->int_disable = bcmgenet_tx_ring16_int_disable;
  1320. } else {
  1321. ring->queue = index + 1;
  1322. ring->int_enable = bcmgenet_tx_ring_int_enable;
  1323. ring->int_disable = bcmgenet_tx_ring_int_disable;
  1324. }
  1325. ring->cbs = priv->tx_cbs + write_ptr;
  1326. ring->size = size;
  1327. ring->c_index = 0;
  1328. ring->free_bds = size;
  1329. ring->write_ptr = write_ptr;
  1330. ring->cb_ptr = write_ptr;
  1331. ring->end_ptr = end_ptr - 1;
  1332. ring->prod_index = 0;
  1333. /* Set flow period for ring != 16 */
  1334. if (index != DESC_INDEX)
  1335. flow_period_val = ENET_MAX_MTU_SIZE << 16;
  1336. bcmgenet_tdma_ring_writel(priv, index, 0, TDMA_PROD_INDEX);
  1337. bcmgenet_tdma_ring_writel(priv, index, 0, TDMA_CONS_INDEX);
  1338. bcmgenet_tdma_ring_writel(priv, index, 1, DMA_MBUF_DONE_THRESH);
  1339. /* Disable rate control for now */
  1340. bcmgenet_tdma_ring_writel(priv, index, flow_period_val,
  1341. TDMA_FLOW_PERIOD);
  1342. /* Unclassified traffic goes to ring 16 */
  1343. bcmgenet_tdma_ring_writel(priv, index,
  1344. ((size << DMA_RING_SIZE_SHIFT) | RX_BUF_LENGTH),
  1345. DMA_RING_BUF_SIZE);
  1346. first_bd = write_ptr;
  1347. /* Set start and end address, read and write pointers */
  1348. bcmgenet_tdma_ring_writel(priv, index, first_bd * words_per_bd,
  1349. DMA_START_ADDR);
  1350. bcmgenet_tdma_ring_writel(priv, index, first_bd * words_per_bd,
  1351. TDMA_READ_PTR);
  1352. bcmgenet_tdma_ring_writel(priv, index, first_bd,
  1353. TDMA_WRITE_PTR);
  1354. bcmgenet_tdma_ring_writel(priv, index, end_ptr * words_per_bd - 1,
  1355. DMA_END_ADDR);
  1356. }
  1357. /* Initialize a RDMA ring */
  1358. static int bcmgenet_init_rx_ring(struct bcmgenet_priv *priv,
  1359. unsigned int index, unsigned int size)
  1360. {
  1361. u32 words_per_bd = WORDS_PER_BD(priv);
  1362. int ret;
  1363. priv->num_rx_bds = TOTAL_DESC;
  1364. priv->rx_bds = priv->base + priv->hw_params->rdma_offset;
  1365. priv->rx_bd_assign_ptr = priv->rx_bds;
  1366. priv->rx_bd_assign_index = 0;
  1367. priv->rx_c_index = 0;
  1368. priv->rx_read_ptr = 0;
  1369. priv->rx_cbs = kzalloc(priv->num_rx_bds * sizeof(struct enet_cb),
  1370. GFP_KERNEL);
  1371. if (!priv->rx_cbs)
  1372. return -ENOMEM;
  1373. ret = bcmgenet_alloc_rx_buffers(priv);
  1374. if (ret) {
  1375. kfree(priv->rx_cbs);
  1376. return ret;
  1377. }
  1378. bcmgenet_rdma_ring_writel(priv, index, 0, RDMA_WRITE_PTR);
  1379. bcmgenet_rdma_ring_writel(priv, index, 0, RDMA_PROD_INDEX);
  1380. bcmgenet_rdma_ring_writel(priv, index, 0, RDMA_CONS_INDEX);
  1381. bcmgenet_rdma_ring_writel(priv, index,
  1382. ((size << DMA_RING_SIZE_SHIFT) | RX_BUF_LENGTH),
  1383. DMA_RING_BUF_SIZE);
  1384. bcmgenet_rdma_ring_writel(priv, index, 0, DMA_START_ADDR);
  1385. bcmgenet_rdma_ring_writel(priv, index,
  1386. words_per_bd * size - 1, DMA_END_ADDR);
  1387. bcmgenet_rdma_ring_writel(priv, index,
  1388. (DMA_FC_THRESH_LO << DMA_XOFF_THRESHOLD_SHIFT) |
  1389. DMA_FC_THRESH_HI, RDMA_XON_XOFF_THRESH);
  1390. bcmgenet_rdma_ring_writel(priv, index, 0, RDMA_READ_PTR);
  1391. return ret;
  1392. }
  1393. /* init multi xmit queues, only available for GENET2+
  1394. * the queue is partitioned as follows:
  1395. *
  1396. * queue 0 - 3 is priority based, each one has 32 descriptors,
  1397. * with queue 0 being the highest priority queue.
  1398. *
  1399. * queue 16 is the default tx queue with GENET_DEFAULT_BD_CNT
  1400. * descriptors: 256 - (number of tx queues * bds per queues) = 128
  1401. * descriptors.
  1402. *
  1403. * The transmit control block pool is then partitioned as following:
  1404. * - tx_cbs[0...127] are for queue 16
  1405. * - tx_ring_cbs[0] points to tx_cbs[128..159]
  1406. * - tx_ring_cbs[1] points to tx_cbs[160..191]
  1407. * - tx_ring_cbs[2] points to tx_cbs[192..223]
  1408. * - tx_ring_cbs[3] points to tx_cbs[224..255]
  1409. */
  1410. static void bcmgenet_init_multiq(struct net_device *dev)
  1411. {
  1412. struct bcmgenet_priv *priv = netdev_priv(dev);
  1413. unsigned int i, dma_enable;
  1414. u32 reg, dma_ctrl, ring_cfg = 0, dma_priority = 0;
  1415. if (!netif_is_multiqueue(dev)) {
  1416. netdev_warn(dev, "called with non multi queue aware HW\n");
  1417. return;
  1418. }
  1419. dma_ctrl = bcmgenet_tdma_readl(priv, DMA_CTRL);
  1420. dma_enable = dma_ctrl & DMA_EN;
  1421. dma_ctrl &= ~DMA_EN;
  1422. bcmgenet_tdma_writel(priv, dma_ctrl, DMA_CTRL);
  1423. /* Enable strict priority arbiter mode */
  1424. bcmgenet_tdma_writel(priv, DMA_ARBITER_SP, DMA_ARB_CTRL);
  1425. for (i = 0; i < priv->hw_params->tx_queues; i++) {
  1426. /* first 64 tx_cbs are reserved for default tx queue
  1427. * (ring 16)
  1428. */
  1429. bcmgenet_init_tx_ring(priv, i, priv->hw_params->bds_cnt,
  1430. i * priv->hw_params->bds_cnt,
  1431. (i + 1) * priv->hw_params->bds_cnt);
  1432. /* Configure ring as decriptor ring and setup priority */
  1433. ring_cfg |= 1 << i;
  1434. dma_priority |= ((GENET_Q0_PRIORITY + i) <<
  1435. (GENET_MAX_MQ_CNT + 1) * i);
  1436. dma_ctrl |= 1 << (i + DMA_RING_BUF_EN_SHIFT);
  1437. }
  1438. /* Enable rings */
  1439. reg = bcmgenet_tdma_readl(priv, DMA_RING_CFG);
  1440. reg |= ring_cfg;
  1441. bcmgenet_tdma_writel(priv, reg, DMA_RING_CFG);
  1442. /* Use configured rings priority and set ring #16 priority */
  1443. reg = bcmgenet_tdma_readl(priv, DMA_RING_PRIORITY);
  1444. reg |= ((GENET_Q0_PRIORITY + priv->hw_params->tx_queues) << 20);
  1445. reg |= dma_priority;
  1446. bcmgenet_tdma_writel(priv, reg, DMA_PRIORITY);
  1447. /* Configure ring as descriptor ring and re-enable DMA if enabled */
  1448. reg = bcmgenet_tdma_readl(priv, DMA_CTRL);
  1449. reg |= dma_ctrl;
  1450. if (dma_enable)
  1451. reg |= DMA_EN;
  1452. bcmgenet_tdma_writel(priv, reg, DMA_CTRL);
  1453. }
  1454. static void bcmgenet_fini_dma(struct bcmgenet_priv *priv)
  1455. {
  1456. int i;
  1457. /* disable DMA */
  1458. bcmgenet_rdma_writel(priv, 0, DMA_CTRL);
  1459. bcmgenet_tdma_writel(priv, 0, DMA_CTRL);
  1460. for (i = 0; i < priv->num_tx_bds; i++) {
  1461. if (priv->tx_cbs[i].skb != NULL) {
  1462. dev_kfree_skb(priv->tx_cbs[i].skb);
  1463. priv->tx_cbs[i].skb = NULL;
  1464. }
  1465. }
  1466. bcmgenet_free_rx_buffers(priv);
  1467. kfree(priv->rx_cbs);
  1468. kfree(priv->tx_cbs);
  1469. }
  1470. /* init_edma: Initialize DMA control register */
  1471. static int bcmgenet_init_dma(struct bcmgenet_priv *priv)
  1472. {
  1473. int ret;
  1474. netif_dbg(priv, hw, priv->dev, "bcmgenet: init_edma\n");
  1475. /* by default, enable ring 16 (descriptor based) */
  1476. ret = bcmgenet_init_rx_ring(priv, DESC_INDEX, TOTAL_DESC);
  1477. if (ret) {
  1478. netdev_err(priv->dev, "failed to initialize RX ring\n");
  1479. return ret;
  1480. }
  1481. /* init rDma */
  1482. bcmgenet_rdma_writel(priv, DMA_MAX_BURST_LENGTH, DMA_SCB_BURST_SIZE);
  1483. /* Init tDma */
  1484. bcmgenet_tdma_writel(priv, DMA_MAX_BURST_LENGTH, DMA_SCB_BURST_SIZE);
  1485. /* Initialize commont TX ring structures */
  1486. priv->tx_bds = priv->base + priv->hw_params->tdma_offset;
  1487. priv->num_tx_bds = TOTAL_DESC;
  1488. priv->tx_cbs = kzalloc(priv->num_tx_bds * sizeof(struct enet_cb),
  1489. GFP_KERNEL);
  1490. if (!priv->tx_cbs) {
  1491. bcmgenet_fini_dma(priv);
  1492. return -ENOMEM;
  1493. }
  1494. /* initialize multi xmit queue */
  1495. bcmgenet_init_multiq(priv->dev);
  1496. /* initialize special ring 16 */
  1497. bcmgenet_init_tx_ring(priv, DESC_INDEX, GENET_DEFAULT_BD_CNT,
  1498. priv->hw_params->tx_queues * priv->hw_params->bds_cnt,
  1499. TOTAL_DESC);
  1500. return 0;
  1501. }
  1502. /* NAPI polling method*/
  1503. static int bcmgenet_poll(struct napi_struct *napi, int budget)
  1504. {
  1505. struct bcmgenet_priv *priv = container_of(napi,
  1506. struct bcmgenet_priv, napi);
  1507. unsigned int work_done;
  1508. /* tx reclaim */
  1509. bcmgenet_tx_reclaim(priv->dev, &priv->tx_rings[DESC_INDEX]);
  1510. work_done = bcmgenet_desc_rx(priv, budget);
  1511. /* Advancing our consumer index*/
  1512. priv->rx_c_index += work_done;
  1513. priv->rx_c_index &= DMA_C_INDEX_MASK;
  1514. bcmgenet_rdma_ring_writel(priv, DESC_INDEX,
  1515. priv->rx_c_index, RDMA_CONS_INDEX);
  1516. if (work_done < budget) {
  1517. napi_complete(napi);
  1518. bcmgenet_intrl2_0_writel(priv,
  1519. UMAC_IRQ_RXDMA_BDONE, INTRL2_CPU_MASK_CLEAR);
  1520. }
  1521. return work_done;
  1522. }
  1523. /* Interrupt bottom half */
  1524. static void bcmgenet_irq_task(struct work_struct *work)
  1525. {
  1526. struct bcmgenet_priv *priv = container_of(
  1527. work, struct bcmgenet_priv, bcmgenet_irq_work);
  1528. netif_dbg(priv, intr, priv->dev, "%s\n", __func__);
  1529. /* Link UP/DOWN event */
  1530. if ((priv->hw_params->flags & GENET_HAS_MDIO_INTR) &&
  1531. (priv->irq0_stat & (UMAC_IRQ_LINK_UP|UMAC_IRQ_LINK_DOWN))) {
  1532. phy_mac_interrupt(priv->phydev,
  1533. priv->irq0_stat & UMAC_IRQ_LINK_UP);
  1534. priv->irq0_stat &= ~(UMAC_IRQ_LINK_UP|UMAC_IRQ_LINK_DOWN);
  1535. }
  1536. }
  1537. /* bcmgenet_isr1: interrupt handler for ring buffer. */
  1538. static irqreturn_t bcmgenet_isr1(int irq, void *dev_id)
  1539. {
  1540. struct bcmgenet_priv *priv = dev_id;
  1541. unsigned int index;
  1542. /* Save irq status for bottom-half processing. */
  1543. priv->irq1_stat =
  1544. bcmgenet_intrl2_1_readl(priv, INTRL2_CPU_STAT) &
  1545. ~priv->int1_mask;
  1546. /* clear inerrupts*/
  1547. bcmgenet_intrl2_1_writel(priv, priv->irq1_stat, INTRL2_CPU_CLEAR);
  1548. netif_dbg(priv, intr, priv->dev,
  1549. "%s: IRQ=0x%x\n", __func__, priv->irq1_stat);
  1550. /* Check the MBDONE interrupts.
  1551. * packet is done, reclaim descriptors
  1552. */
  1553. if (priv->irq1_stat & 0x0000ffff) {
  1554. index = 0;
  1555. for (index = 0; index < 16; index++) {
  1556. if (priv->irq1_stat & (1 << index))
  1557. bcmgenet_tx_reclaim(priv->dev,
  1558. &priv->tx_rings[index]);
  1559. }
  1560. }
  1561. return IRQ_HANDLED;
  1562. }
  1563. /* bcmgenet_isr0: Handle various interrupts. */
  1564. static irqreturn_t bcmgenet_isr0(int irq, void *dev_id)
  1565. {
  1566. struct bcmgenet_priv *priv = dev_id;
  1567. /* Save irq status for bottom-half processing. */
  1568. priv->irq0_stat =
  1569. bcmgenet_intrl2_0_readl(priv, INTRL2_CPU_STAT) &
  1570. ~bcmgenet_intrl2_0_readl(priv, INTRL2_CPU_MASK_STATUS);
  1571. /* clear inerrupts*/
  1572. bcmgenet_intrl2_0_writel(priv, priv->irq0_stat, INTRL2_CPU_CLEAR);
  1573. netif_dbg(priv, intr, priv->dev,
  1574. "IRQ=0x%x\n", priv->irq0_stat);
  1575. if (priv->irq0_stat & (UMAC_IRQ_RXDMA_BDONE | UMAC_IRQ_RXDMA_PDONE)) {
  1576. /* We use NAPI(software interrupt throttling, if
  1577. * Rx Descriptor throttling is not used.
  1578. * Disable interrupt, will be enabled in the poll method.
  1579. */
  1580. if (likely(napi_schedule_prep(&priv->napi))) {
  1581. bcmgenet_intrl2_0_writel(priv,
  1582. UMAC_IRQ_RXDMA_BDONE, INTRL2_CPU_MASK_SET);
  1583. __napi_schedule(&priv->napi);
  1584. }
  1585. }
  1586. if (priv->irq0_stat &
  1587. (UMAC_IRQ_TXDMA_BDONE | UMAC_IRQ_TXDMA_PDONE)) {
  1588. /* Tx reclaim */
  1589. bcmgenet_tx_reclaim(priv->dev, &priv->tx_rings[DESC_INDEX]);
  1590. }
  1591. if (priv->irq0_stat & (UMAC_IRQ_PHY_DET_R |
  1592. UMAC_IRQ_PHY_DET_F |
  1593. UMAC_IRQ_LINK_UP |
  1594. UMAC_IRQ_LINK_DOWN |
  1595. UMAC_IRQ_HFB_SM |
  1596. UMAC_IRQ_HFB_MM |
  1597. UMAC_IRQ_MPD_R)) {
  1598. /* all other interested interrupts handled in bottom half */
  1599. schedule_work(&priv->bcmgenet_irq_work);
  1600. }
  1601. if ((priv->hw_params->flags & GENET_HAS_MDIO_INTR) &&
  1602. priv->irq0_stat & (UMAC_IRQ_MDIO_DONE | UMAC_IRQ_MDIO_ERROR)) {
  1603. priv->irq0_stat &= ~(UMAC_IRQ_MDIO_DONE | UMAC_IRQ_MDIO_ERROR);
  1604. wake_up(&priv->wq);
  1605. }
  1606. return IRQ_HANDLED;
  1607. }
  1608. static void bcmgenet_umac_reset(struct bcmgenet_priv *priv)
  1609. {
  1610. u32 reg;
  1611. reg = bcmgenet_rbuf_ctrl_get(priv);
  1612. reg |= BIT(1);
  1613. bcmgenet_rbuf_ctrl_set(priv, reg);
  1614. udelay(10);
  1615. reg &= ~BIT(1);
  1616. bcmgenet_rbuf_ctrl_set(priv, reg);
  1617. udelay(10);
  1618. }
  1619. static void bcmgenet_set_hw_addr(struct bcmgenet_priv *priv,
  1620. unsigned char *addr)
  1621. {
  1622. bcmgenet_umac_writel(priv, (addr[0] << 24) | (addr[1] << 16) |
  1623. (addr[2] << 8) | addr[3], UMAC_MAC0);
  1624. bcmgenet_umac_writel(priv, (addr[4] << 8) | addr[5], UMAC_MAC1);
  1625. }
  1626. static int bcmgenet_wol_resume(struct bcmgenet_priv *priv)
  1627. {
  1628. int ret;
  1629. /* From WOL-enabled suspend, switch to regular clock */
  1630. clk_disable(priv->clk_wol);
  1631. /* init umac registers to synchronize s/w with h/w */
  1632. ret = init_umac(priv);
  1633. if (ret)
  1634. return ret;
  1635. phy_init_hw(priv->phydev);
  1636. /* Speed settings must be restored */
  1637. bcmgenet_mii_config(priv->dev);
  1638. return 0;
  1639. }
  1640. /* Returns a reusable dma control register value */
  1641. static u32 bcmgenet_dma_disable(struct bcmgenet_priv *priv)
  1642. {
  1643. u32 reg;
  1644. u32 dma_ctrl;
  1645. /* disable DMA */
  1646. dma_ctrl = 1 << (DESC_INDEX + DMA_RING_BUF_EN_SHIFT) | DMA_EN;
  1647. reg = bcmgenet_tdma_readl(priv, DMA_CTRL);
  1648. reg &= ~dma_ctrl;
  1649. bcmgenet_tdma_writel(priv, reg, DMA_CTRL);
  1650. reg = bcmgenet_rdma_readl(priv, DMA_CTRL);
  1651. reg &= ~dma_ctrl;
  1652. bcmgenet_rdma_writel(priv, reg, DMA_CTRL);
  1653. bcmgenet_umac_writel(priv, 1, UMAC_TX_FLUSH);
  1654. udelay(10);
  1655. bcmgenet_umac_writel(priv, 0, UMAC_TX_FLUSH);
  1656. return dma_ctrl;
  1657. }
  1658. static void bcmgenet_enable_dma(struct bcmgenet_priv *priv, u32 dma_ctrl)
  1659. {
  1660. u32 reg;
  1661. reg = bcmgenet_rdma_readl(priv, DMA_CTRL);
  1662. reg |= dma_ctrl;
  1663. bcmgenet_rdma_writel(priv, reg, DMA_CTRL);
  1664. reg = bcmgenet_tdma_readl(priv, DMA_CTRL);
  1665. reg |= dma_ctrl;
  1666. bcmgenet_tdma_writel(priv, reg, DMA_CTRL);
  1667. }
  1668. static int bcmgenet_open(struct net_device *dev)
  1669. {
  1670. struct bcmgenet_priv *priv = netdev_priv(dev);
  1671. unsigned long dma_ctrl;
  1672. u32 reg;
  1673. int ret;
  1674. netif_dbg(priv, ifup, dev, "bcmgenet_open\n");
  1675. /* Turn on the clock */
  1676. if (!IS_ERR(priv->clk))
  1677. clk_prepare_enable(priv->clk);
  1678. /* take MAC out of reset */
  1679. bcmgenet_umac_reset(priv);
  1680. ret = init_umac(priv);
  1681. if (ret)
  1682. goto err_clk_disable;
  1683. /* disable ethernet MAC while updating its registers */
  1684. reg = bcmgenet_umac_readl(priv, UMAC_CMD);
  1685. reg &= ~(CMD_TX_EN | CMD_RX_EN);
  1686. bcmgenet_umac_writel(priv, reg, UMAC_CMD);
  1687. bcmgenet_set_hw_addr(priv, dev->dev_addr);
  1688. if (priv->wol_enabled) {
  1689. ret = bcmgenet_wol_resume(priv);
  1690. if (ret)
  1691. return ret;
  1692. }
  1693. if (phy_is_internal(priv->phydev)) {
  1694. reg = bcmgenet_ext_readl(priv, EXT_EXT_PWR_MGMT);
  1695. reg |= EXT_ENERGY_DET_MASK;
  1696. bcmgenet_ext_writel(priv, reg, EXT_EXT_PWR_MGMT);
  1697. }
  1698. /* Disable RX/TX DMA and flush TX queues */
  1699. dma_ctrl = bcmgenet_dma_disable(priv);
  1700. /* Reinitialize TDMA and RDMA and SW housekeeping */
  1701. ret = bcmgenet_init_dma(priv);
  1702. if (ret) {
  1703. netdev_err(dev, "failed to initialize DMA\n");
  1704. goto err_fini_dma;
  1705. }
  1706. /* Always enable ring 16 - descriptor ring */
  1707. bcmgenet_enable_dma(priv, dma_ctrl);
  1708. ret = request_irq(priv->irq0, bcmgenet_isr0, IRQF_SHARED,
  1709. dev->name, priv);
  1710. if (ret < 0) {
  1711. netdev_err(dev, "can't request IRQ %d\n", priv->irq0);
  1712. goto err_fini_dma;
  1713. }
  1714. ret = request_irq(priv->irq1, bcmgenet_isr1, IRQF_SHARED,
  1715. dev->name, priv);
  1716. if (ret < 0) {
  1717. netdev_err(dev, "can't request IRQ %d\n", priv->irq1);
  1718. goto err_irq0;
  1719. }
  1720. /* Start the network engine */
  1721. napi_enable(&priv->napi);
  1722. reg = bcmgenet_umac_readl(priv, UMAC_CMD);
  1723. reg |= (CMD_TX_EN | CMD_RX_EN);
  1724. bcmgenet_umac_writel(priv, reg, UMAC_CMD);
  1725. /* Make sure we reflect the value of CRC_CMD_FWD */
  1726. priv->crc_fwd_en = !!(reg & CMD_CRC_FWD);
  1727. device_set_wakeup_capable(&dev->dev, 1);
  1728. if (phy_is_internal(priv->phydev))
  1729. bcmgenet_power_up(priv, GENET_POWER_PASSIVE);
  1730. netif_tx_start_all_queues(dev);
  1731. phy_start(priv->phydev);
  1732. return 0;
  1733. err_irq0:
  1734. free_irq(priv->irq0, dev);
  1735. err_fini_dma:
  1736. bcmgenet_fini_dma(priv);
  1737. err_clk_disable:
  1738. if (!IS_ERR(priv->clk))
  1739. clk_disable_unprepare(priv->clk);
  1740. return ret;
  1741. }
  1742. static int bcmgenet_dma_teardown(struct bcmgenet_priv *priv)
  1743. {
  1744. int ret = 0;
  1745. int timeout = 0;
  1746. u32 reg;
  1747. /* Disable TDMA to stop add more frames in TX DMA */
  1748. reg = bcmgenet_tdma_readl(priv, DMA_CTRL);
  1749. reg &= ~DMA_EN;
  1750. bcmgenet_tdma_writel(priv, reg, DMA_CTRL);
  1751. /* Check TDMA status register to confirm TDMA is disabled */
  1752. while (timeout++ < DMA_TIMEOUT_VAL) {
  1753. reg = bcmgenet_tdma_readl(priv, DMA_STATUS);
  1754. if (reg & DMA_DISABLED)
  1755. break;
  1756. udelay(1);
  1757. }
  1758. if (timeout == DMA_TIMEOUT_VAL) {
  1759. netdev_warn(priv->dev,
  1760. "Timed out while disabling TX DMA\n");
  1761. ret = -ETIMEDOUT;
  1762. }
  1763. /* Wait 10ms for packet drain in both tx and rx dma */
  1764. usleep_range(10000, 20000);
  1765. /* Disable RDMA */
  1766. reg = bcmgenet_rdma_readl(priv, DMA_CTRL);
  1767. reg &= ~DMA_EN;
  1768. bcmgenet_rdma_writel(priv, reg, DMA_CTRL);
  1769. timeout = 0;
  1770. /* Check RDMA status register to confirm RDMA is disabled */
  1771. while (timeout++ < DMA_TIMEOUT_VAL) {
  1772. reg = bcmgenet_rdma_readl(priv, DMA_STATUS);
  1773. if (reg & DMA_DISABLED)
  1774. break;
  1775. udelay(1);
  1776. }
  1777. if (timeout == DMA_TIMEOUT_VAL) {
  1778. netdev_warn(priv->dev,
  1779. "Timed out while disabling RX DMA\n");
  1780. ret = -ETIMEDOUT;
  1781. }
  1782. return ret;
  1783. }
  1784. static int bcmgenet_close(struct net_device *dev)
  1785. {
  1786. struct bcmgenet_priv *priv = netdev_priv(dev);
  1787. int ret;
  1788. u32 reg;
  1789. netif_dbg(priv, ifdown, dev, "bcmgenet_close\n");
  1790. phy_stop(priv->phydev);
  1791. /* Disable MAC receive */
  1792. reg = bcmgenet_umac_readl(priv, UMAC_CMD);
  1793. reg &= ~CMD_RX_EN;
  1794. bcmgenet_umac_writel(priv, reg, UMAC_CMD);
  1795. netif_tx_stop_all_queues(dev);
  1796. ret = bcmgenet_dma_teardown(priv);
  1797. if (ret)
  1798. return ret;
  1799. /* Disable MAC transmit. TX DMA disabled have to done before this */
  1800. reg = bcmgenet_umac_readl(priv, UMAC_CMD);
  1801. reg &= ~CMD_TX_EN;
  1802. bcmgenet_umac_writel(priv, reg, UMAC_CMD);
  1803. napi_disable(&priv->napi);
  1804. /* tx reclaim */
  1805. bcmgenet_tx_reclaim_all(dev);
  1806. bcmgenet_fini_dma(priv);
  1807. free_irq(priv->irq0, priv);
  1808. free_irq(priv->irq1, priv);
  1809. /* Wait for pending work items to complete - we are stopping
  1810. * the clock now. Since interrupts are disabled, no new work
  1811. * will be scheduled.
  1812. */
  1813. cancel_work_sync(&priv->bcmgenet_irq_work);
  1814. if (phy_is_internal(priv->phydev))
  1815. bcmgenet_power_down(priv, GENET_POWER_PASSIVE);
  1816. if (priv->wol_enabled)
  1817. clk_enable(priv->clk_wol);
  1818. if (!IS_ERR(priv->clk))
  1819. clk_disable_unprepare(priv->clk);
  1820. return 0;
  1821. }
  1822. static void bcmgenet_timeout(struct net_device *dev)
  1823. {
  1824. struct bcmgenet_priv *priv = netdev_priv(dev);
  1825. netif_dbg(priv, tx_err, dev, "bcmgenet_timeout\n");
  1826. dev->trans_start = jiffies;
  1827. dev->stats.tx_errors++;
  1828. netif_tx_wake_all_queues(dev);
  1829. }
  1830. #define MAX_MC_COUNT 16
  1831. static inline void bcmgenet_set_mdf_addr(struct bcmgenet_priv *priv,
  1832. unsigned char *addr,
  1833. int *i,
  1834. int *mc)
  1835. {
  1836. u32 reg;
  1837. bcmgenet_umac_writel(priv,
  1838. addr[0] << 8 | addr[1], UMAC_MDF_ADDR + (*i * 4));
  1839. bcmgenet_umac_writel(priv,
  1840. addr[2] << 24 | addr[3] << 16 |
  1841. addr[4] << 8 | addr[5],
  1842. UMAC_MDF_ADDR + ((*i + 1) * 4));
  1843. reg = bcmgenet_umac_readl(priv, UMAC_MDF_CTRL);
  1844. reg |= (1 << (MAX_MC_COUNT - *mc));
  1845. bcmgenet_umac_writel(priv, reg, UMAC_MDF_CTRL);
  1846. *i += 2;
  1847. (*mc)++;
  1848. }
  1849. static void bcmgenet_set_rx_mode(struct net_device *dev)
  1850. {
  1851. struct bcmgenet_priv *priv = netdev_priv(dev);
  1852. struct netdev_hw_addr *ha;
  1853. int i, mc;
  1854. u32 reg;
  1855. netif_dbg(priv, hw, dev, "%s: %08X\n", __func__, dev->flags);
  1856. /* Promiscous mode */
  1857. reg = bcmgenet_umac_readl(priv, UMAC_CMD);
  1858. if (dev->flags & IFF_PROMISC) {
  1859. reg |= CMD_PROMISC;
  1860. bcmgenet_umac_writel(priv, reg, UMAC_CMD);
  1861. bcmgenet_umac_writel(priv, 0, UMAC_MDF_CTRL);
  1862. return;
  1863. } else {
  1864. reg &= ~CMD_PROMISC;
  1865. bcmgenet_umac_writel(priv, reg, UMAC_CMD);
  1866. }
  1867. /* UniMac doesn't support ALLMULTI */
  1868. if (dev->flags & IFF_ALLMULTI) {
  1869. netdev_warn(dev, "ALLMULTI is not supported\n");
  1870. return;
  1871. }
  1872. /* update MDF filter */
  1873. i = 0;
  1874. mc = 0;
  1875. /* Broadcast */
  1876. bcmgenet_set_mdf_addr(priv, dev->broadcast, &i, &mc);
  1877. /* my own address.*/
  1878. bcmgenet_set_mdf_addr(priv, dev->dev_addr, &i, &mc);
  1879. /* Unicast list*/
  1880. if (netdev_uc_count(dev) > (MAX_MC_COUNT - mc))
  1881. return;
  1882. if (!netdev_uc_empty(dev))
  1883. netdev_for_each_uc_addr(ha, dev)
  1884. bcmgenet_set_mdf_addr(priv, ha->addr, &i, &mc);
  1885. /* Multicast */
  1886. if (netdev_mc_empty(dev) || netdev_mc_count(dev) >= (MAX_MC_COUNT - mc))
  1887. return;
  1888. netdev_for_each_mc_addr(ha, dev)
  1889. bcmgenet_set_mdf_addr(priv, ha->addr, &i, &mc);
  1890. }
  1891. /* Set the hardware MAC address. */
  1892. static int bcmgenet_set_mac_addr(struct net_device *dev, void *p)
  1893. {
  1894. struct sockaddr *addr = p;
  1895. /* Setting the MAC address at the hardware level is not possible
  1896. * without disabling the UniMAC RX/TX enable bits.
  1897. */
  1898. if (netif_running(dev))
  1899. return -EBUSY;
  1900. ether_addr_copy(dev->dev_addr, addr->sa_data);
  1901. return 0;
  1902. }
  1903. static const struct net_device_ops bcmgenet_netdev_ops = {
  1904. .ndo_open = bcmgenet_open,
  1905. .ndo_stop = bcmgenet_close,
  1906. .ndo_start_xmit = bcmgenet_xmit,
  1907. .ndo_tx_timeout = bcmgenet_timeout,
  1908. .ndo_set_rx_mode = bcmgenet_set_rx_mode,
  1909. .ndo_set_mac_address = bcmgenet_set_mac_addr,
  1910. .ndo_do_ioctl = bcmgenet_ioctl,
  1911. .ndo_set_features = bcmgenet_set_features,
  1912. };
  1913. /* Array of GENET hardware parameters/characteristics */
  1914. static struct bcmgenet_hw_params bcmgenet_hw_params[] = {
  1915. [GENET_V1] = {
  1916. .tx_queues = 0,
  1917. .rx_queues = 0,
  1918. .bds_cnt = 0,
  1919. .bp_in_en_shift = 16,
  1920. .bp_in_mask = 0xffff,
  1921. .hfb_filter_cnt = 16,
  1922. .qtag_mask = 0x1F,
  1923. .hfb_offset = 0x1000,
  1924. .rdma_offset = 0x2000,
  1925. .tdma_offset = 0x3000,
  1926. .words_per_bd = 2,
  1927. },
  1928. [GENET_V2] = {
  1929. .tx_queues = 4,
  1930. .rx_queues = 4,
  1931. .bds_cnt = 32,
  1932. .bp_in_en_shift = 16,
  1933. .bp_in_mask = 0xffff,
  1934. .hfb_filter_cnt = 16,
  1935. .qtag_mask = 0x1F,
  1936. .tbuf_offset = 0x0600,
  1937. .hfb_offset = 0x1000,
  1938. .hfb_reg_offset = 0x2000,
  1939. .rdma_offset = 0x3000,
  1940. .tdma_offset = 0x4000,
  1941. .words_per_bd = 2,
  1942. .flags = GENET_HAS_EXT,
  1943. },
  1944. [GENET_V3] = {
  1945. .tx_queues = 4,
  1946. .rx_queues = 4,
  1947. .bds_cnt = 32,
  1948. .bp_in_en_shift = 17,
  1949. .bp_in_mask = 0x1ffff,
  1950. .hfb_filter_cnt = 48,
  1951. .qtag_mask = 0x3F,
  1952. .tbuf_offset = 0x0600,
  1953. .hfb_offset = 0x8000,
  1954. .hfb_reg_offset = 0xfc00,
  1955. .rdma_offset = 0x10000,
  1956. .tdma_offset = 0x11000,
  1957. .words_per_bd = 2,
  1958. .flags = GENET_HAS_EXT | GENET_HAS_MDIO_INTR,
  1959. },
  1960. [GENET_V4] = {
  1961. .tx_queues = 4,
  1962. .rx_queues = 4,
  1963. .bds_cnt = 32,
  1964. .bp_in_en_shift = 17,
  1965. .bp_in_mask = 0x1ffff,
  1966. .hfb_filter_cnt = 48,
  1967. .qtag_mask = 0x3F,
  1968. .tbuf_offset = 0x0600,
  1969. .hfb_offset = 0x8000,
  1970. .hfb_reg_offset = 0xfc00,
  1971. .rdma_offset = 0x2000,
  1972. .tdma_offset = 0x4000,
  1973. .words_per_bd = 3,
  1974. .flags = GENET_HAS_40BITS | GENET_HAS_EXT | GENET_HAS_MDIO_INTR,
  1975. },
  1976. };
  1977. /* Infer hardware parameters from the detected GENET version */
  1978. static void bcmgenet_set_hw_params(struct bcmgenet_priv *priv)
  1979. {
  1980. struct bcmgenet_hw_params *params;
  1981. u32 reg;
  1982. u8 major;
  1983. if (GENET_IS_V4(priv)) {
  1984. bcmgenet_dma_regs = bcmgenet_dma_regs_v3plus;
  1985. genet_dma_ring_regs = genet_dma_ring_regs_v4;
  1986. priv->dma_rx_chk_bit = DMA_RX_CHK_V3PLUS;
  1987. priv->version = GENET_V4;
  1988. } else if (GENET_IS_V3(priv)) {
  1989. bcmgenet_dma_regs = bcmgenet_dma_regs_v3plus;
  1990. genet_dma_ring_regs = genet_dma_ring_regs_v123;
  1991. priv->dma_rx_chk_bit = DMA_RX_CHK_V3PLUS;
  1992. priv->version = GENET_V3;
  1993. } else if (GENET_IS_V2(priv)) {
  1994. bcmgenet_dma_regs = bcmgenet_dma_regs_v2;
  1995. genet_dma_ring_regs = genet_dma_ring_regs_v123;
  1996. priv->dma_rx_chk_bit = DMA_RX_CHK_V12;
  1997. priv->version = GENET_V2;
  1998. } else if (GENET_IS_V1(priv)) {
  1999. bcmgenet_dma_regs = bcmgenet_dma_regs_v1;
  2000. genet_dma_ring_regs = genet_dma_ring_regs_v123;
  2001. priv->dma_rx_chk_bit = DMA_RX_CHK_V12;
  2002. priv->version = GENET_V1;
  2003. }
  2004. /* enum genet_version starts at 1 */
  2005. priv->hw_params = &bcmgenet_hw_params[priv->version];
  2006. params = priv->hw_params;
  2007. /* Read GENET HW version */
  2008. reg = bcmgenet_sys_readl(priv, SYS_REV_CTRL);
  2009. major = (reg >> 24 & 0x0f);
  2010. if (major == 5)
  2011. major = 4;
  2012. else if (major == 0)
  2013. major = 1;
  2014. if (major != priv->version) {
  2015. dev_err(&priv->pdev->dev,
  2016. "GENET version mismatch, got: %d, configured for: %d\n",
  2017. major, priv->version);
  2018. }
  2019. /* Print the GENET core version */
  2020. dev_info(&priv->pdev->dev, "GENET " GENET_VER_FMT,
  2021. major, (reg >> 16) & 0x0f, reg & 0xffff);
  2022. #ifdef CONFIG_PHYS_ADDR_T_64BIT
  2023. if (!(params->flags & GENET_HAS_40BITS))
  2024. pr_warn("GENET does not support 40-bits PA\n");
  2025. #endif
  2026. pr_debug("Configuration for version: %d\n"
  2027. "TXq: %1d, RXq: %1d, BDs: %1d\n"
  2028. "BP << en: %2d, BP msk: 0x%05x\n"
  2029. "HFB count: %2d, QTAQ msk: 0x%05x\n"
  2030. "TBUF: 0x%04x, HFB: 0x%04x, HFBreg: 0x%04x\n"
  2031. "RDMA: 0x%05x, TDMA: 0x%05x\n"
  2032. "Words/BD: %d\n",
  2033. priv->version,
  2034. params->tx_queues, params->rx_queues, params->bds_cnt,
  2035. params->bp_in_en_shift, params->bp_in_mask,
  2036. params->hfb_filter_cnt, params->qtag_mask,
  2037. params->tbuf_offset, params->hfb_offset,
  2038. params->hfb_reg_offset,
  2039. params->rdma_offset, params->tdma_offset,
  2040. params->words_per_bd);
  2041. }
  2042. static const struct of_device_id bcmgenet_match[] = {
  2043. { .compatible = "brcm,genet-v1", .data = (void *)GENET_V1 },
  2044. { .compatible = "brcm,genet-v2", .data = (void *)GENET_V2 },
  2045. { .compatible = "brcm,genet-v3", .data = (void *)GENET_V3 },
  2046. { .compatible = "brcm,genet-v4", .data = (void *)GENET_V4 },
  2047. { },
  2048. };
  2049. static int bcmgenet_probe(struct platform_device *pdev)
  2050. {
  2051. struct device_node *dn = pdev->dev.of_node;
  2052. const struct of_device_id *of_id;
  2053. struct bcmgenet_priv *priv;
  2054. struct net_device *dev;
  2055. const void *macaddr;
  2056. struct resource *r;
  2057. int err = -EIO;
  2058. /* Up to GENET_MAX_MQ_CNT + 1 TX queues and a single RX queue */
  2059. dev = alloc_etherdev_mqs(sizeof(*priv), GENET_MAX_MQ_CNT + 1, 1);
  2060. if (!dev) {
  2061. dev_err(&pdev->dev, "can't allocate net device\n");
  2062. return -ENOMEM;
  2063. }
  2064. of_id = of_match_node(bcmgenet_match, dn);
  2065. if (!of_id)
  2066. return -EINVAL;
  2067. priv = netdev_priv(dev);
  2068. priv->irq0 = platform_get_irq(pdev, 0);
  2069. priv->irq1 = platform_get_irq(pdev, 1);
  2070. if (!priv->irq0 || !priv->irq1) {
  2071. dev_err(&pdev->dev, "can't find IRQs\n");
  2072. err = -EINVAL;
  2073. goto err;
  2074. }
  2075. macaddr = of_get_mac_address(dn);
  2076. if (!macaddr) {
  2077. dev_err(&pdev->dev, "can't find MAC address\n");
  2078. err = -EINVAL;
  2079. goto err;
  2080. }
  2081. r = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  2082. priv->base = devm_ioremap_resource(&pdev->dev, r);
  2083. if (IS_ERR(priv->base)) {
  2084. err = PTR_ERR(priv->base);
  2085. goto err;
  2086. }
  2087. SET_NETDEV_DEV(dev, &pdev->dev);
  2088. dev_set_drvdata(&pdev->dev, dev);
  2089. ether_addr_copy(dev->dev_addr, macaddr);
  2090. dev->watchdog_timeo = 2 * HZ;
  2091. dev->ethtool_ops = &bcmgenet_ethtool_ops;
  2092. dev->netdev_ops = &bcmgenet_netdev_ops;
  2093. netif_napi_add(dev, &priv->napi, bcmgenet_poll, 64);
  2094. priv->msg_enable = netif_msg_init(-1, GENET_MSG_DEFAULT);
  2095. /* Set hardware features */
  2096. dev->hw_features |= NETIF_F_SG | NETIF_F_IP_CSUM |
  2097. NETIF_F_IPV6_CSUM | NETIF_F_RXCSUM;
  2098. /* Set the needed headroom to account for any possible
  2099. * features enabling/disabling at runtime
  2100. */
  2101. dev->needed_headroom += 64;
  2102. netdev_boot_setup_check(dev);
  2103. priv->dev = dev;
  2104. priv->pdev = pdev;
  2105. priv->version = (enum bcmgenet_version)of_id->data;
  2106. bcmgenet_set_hw_params(priv);
  2107. /* Mii wait queue */
  2108. init_waitqueue_head(&priv->wq);
  2109. /* Always use RX_BUF_LENGTH (2KB) buffer for all chips */
  2110. priv->rx_buf_len = RX_BUF_LENGTH;
  2111. INIT_WORK(&priv->bcmgenet_irq_work, bcmgenet_irq_task);
  2112. priv->clk = devm_clk_get(&priv->pdev->dev, "enet");
  2113. if (IS_ERR(priv->clk))
  2114. dev_warn(&priv->pdev->dev, "failed to get enet clock\n");
  2115. priv->clk_wol = devm_clk_get(&priv->pdev->dev, "enet-wol");
  2116. if (IS_ERR(priv->clk_wol))
  2117. dev_warn(&priv->pdev->dev, "failed to get enet-wol clock\n");
  2118. if (!IS_ERR(priv->clk))
  2119. clk_prepare_enable(priv->clk);
  2120. err = reset_umac(priv);
  2121. if (err)
  2122. goto err_clk_disable;
  2123. err = bcmgenet_mii_init(dev);
  2124. if (err)
  2125. goto err_clk_disable;
  2126. /* setup number of real queues + 1 (GENET_V1 has 0 hardware queues
  2127. * just the ring 16 descriptor based TX
  2128. */
  2129. netif_set_real_num_tx_queues(priv->dev, priv->hw_params->tx_queues + 1);
  2130. netif_set_real_num_rx_queues(priv->dev, priv->hw_params->rx_queues + 1);
  2131. err = register_netdev(dev);
  2132. if (err)
  2133. goto err_clk_disable;
  2134. /* Turn off the main clock, WOL clock is handled separately */
  2135. if (!IS_ERR(priv->clk))
  2136. clk_disable_unprepare(priv->clk);
  2137. return err;
  2138. err_clk_disable:
  2139. if (!IS_ERR(priv->clk))
  2140. clk_disable_unprepare(priv->clk);
  2141. err:
  2142. free_netdev(dev);
  2143. return err;
  2144. }
  2145. static int bcmgenet_remove(struct platform_device *pdev)
  2146. {
  2147. struct bcmgenet_priv *priv = dev_to_priv(&pdev->dev);
  2148. dev_set_drvdata(&pdev->dev, NULL);
  2149. unregister_netdev(priv->dev);
  2150. bcmgenet_mii_exit(priv->dev);
  2151. free_netdev(priv->dev);
  2152. return 0;
  2153. }
  2154. static struct platform_driver bcmgenet_driver = {
  2155. .probe = bcmgenet_probe,
  2156. .remove = bcmgenet_remove,
  2157. .driver = {
  2158. .name = "bcmgenet",
  2159. .owner = THIS_MODULE,
  2160. .of_match_table = bcmgenet_match,
  2161. },
  2162. };
  2163. module_platform_driver(bcmgenet_driver);
  2164. MODULE_AUTHOR("Broadcom Corporation");
  2165. MODULE_DESCRIPTION("Broadcom GENET Ethernet controller driver");
  2166. MODULE_ALIAS("platform:bcmgenet");
  2167. MODULE_LICENSE("GPL");