sh_eth.c 33 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350
  1. /*
  2. * SuperH Ethernet device driver
  3. *
  4. * Copyright (C) 2006-2008 Nobuhiro Iwamatsu
  5. * Copyright (C) 2008 Renesas Solutions Corp.
  6. *
  7. * This program is free software; you can redistribute it and/or modify it
  8. * under the terms and conditions of the GNU General Public License,
  9. * version 2, as published by the Free Software Foundation.
  10. *
  11. * This program is distributed in the hope it will be useful, but WITHOUT
  12. * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  13. * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
  14. * more details.
  15. * You should have received a copy of the GNU General Public License along with
  16. * this program; if not, write to the Free Software Foundation, Inc.,
  17. * 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.
  18. *
  19. * The full GNU General Public License is included in this distribution in
  20. * the file called "COPYING".
  21. */
  22. #include <linux/init.h>
  23. #include <linux/dma-mapping.h>
  24. #include <linux/etherdevice.h>
  25. #include <linux/delay.h>
  26. #include <linux/platform_device.h>
  27. #include <linux/mdio-bitbang.h>
  28. #include <linux/netdevice.h>
  29. #include <linux/phy.h>
  30. #include <linux/cache.h>
  31. #include <linux/io.h>
  32. #include "sh_eth.h"
  33. /* CPU <-> EDMAC endian convert */
  34. static inline __u32 cpu_to_edmac(struct sh_eth_private *mdp, u32 x)
  35. {
  36. switch (mdp->edmac_endian) {
  37. case EDMAC_LITTLE_ENDIAN:
  38. return cpu_to_le32(x);
  39. case EDMAC_BIG_ENDIAN:
  40. return cpu_to_be32(x);
  41. }
  42. return x;
  43. }
  44. static inline __u32 edmac_to_cpu(struct sh_eth_private *mdp, u32 x)
  45. {
  46. switch (mdp->edmac_endian) {
  47. case EDMAC_LITTLE_ENDIAN:
  48. return le32_to_cpu(x);
  49. case EDMAC_BIG_ENDIAN:
  50. return be32_to_cpu(x);
  51. }
  52. return x;
  53. }
  54. /*
  55. * Program the hardware MAC address from dev->dev_addr.
  56. */
  57. static void update_mac_address(struct net_device *ndev)
  58. {
  59. u32 ioaddr = ndev->base_addr;
  60. ctrl_outl((ndev->dev_addr[0] << 24) | (ndev->dev_addr[1] << 16) |
  61. (ndev->dev_addr[2] << 8) | (ndev->dev_addr[3]),
  62. ioaddr + MAHR);
  63. ctrl_outl((ndev->dev_addr[4] << 8) | (ndev->dev_addr[5]),
  64. ioaddr + MALR);
  65. }
  66. /*
  67. * Get MAC address from SuperH MAC address register
  68. *
  69. * SuperH's Ethernet device doesn't have 'ROM' to MAC address.
  70. * This driver get MAC address that use by bootloader(U-boot or sh-ipl+g).
  71. * When you want use this device, you must set MAC address in bootloader.
  72. *
  73. */
  74. static void read_mac_address(struct net_device *ndev)
  75. {
  76. u32 ioaddr = ndev->base_addr;
  77. ndev->dev_addr[0] = (ctrl_inl(ioaddr + MAHR) >> 24);
  78. ndev->dev_addr[1] = (ctrl_inl(ioaddr + MAHR) >> 16) & 0xFF;
  79. ndev->dev_addr[2] = (ctrl_inl(ioaddr + MAHR) >> 8) & 0xFF;
  80. ndev->dev_addr[3] = (ctrl_inl(ioaddr + MAHR) & 0xFF);
  81. ndev->dev_addr[4] = (ctrl_inl(ioaddr + MALR) >> 8) & 0xFF;
  82. ndev->dev_addr[5] = (ctrl_inl(ioaddr + MALR) & 0xFF);
  83. }
  84. struct bb_info {
  85. struct mdiobb_ctrl ctrl;
  86. u32 addr;
  87. u32 mmd_msk;/* MMD */
  88. u32 mdo_msk;
  89. u32 mdi_msk;
  90. u32 mdc_msk;
  91. };
  92. /* PHY bit set */
  93. static void bb_set(u32 addr, u32 msk)
  94. {
  95. ctrl_outl(ctrl_inl(addr) | msk, addr);
  96. }
  97. /* PHY bit clear */
  98. static void bb_clr(u32 addr, u32 msk)
  99. {
  100. ctrl_outl((ctrl_inl(addr) & ~msk), addr);
  101. }
  102. /* PHY bit read */
  103. static int bb_read(u32 addr, u32 msk)
  104. {
  105. return (ctrl_inl(addr) & msk) != 0;
  106. }
  107. /* Data I/O pin control */
  108. static void sh_mmd_ctrl(struct mdiobb_ctrl *ctrl, int bit)
  109. {
  110. struct bb_info *bitbang = container_of(ctrl, struct bb_info, ctrl);
  111. if (bit)
  112. bb_set(bitbang->addr, bitbang->mmd_msk);
  113. else
  114. bb_clr(bitbang->addr, bitbang->mmd_msk);
  115. }
  116. /* Set bit data*/
  117. static void sh_set_mdio(struct mdiobb_ctrl *ctrl, int bit)
  118. {
  119. struct bb_info *bitbang = container_of(ctrl, struct bb_info, ctrl);
  120. if (bit)
  121. bb_set(bitbang->addr, bitbang->mdo_msk);
  122. else
  123. bb_clr(bitbang->addr, bitbang->mdo_msk);
  124. }
  125. /* Get bit data*/
  126. static int sh_get_mdio(struct mdiobb_ctrl *ctrl)
  127. {
  128. struct bb_info *bitbang = container_of(ctrl, struct bb_info, ctrl);
  129. return bb_read(bitbang->addr, bitbang->mdi_msk);
  130. }
  131. /* MDC pin control */
  132. static void sh_mdc_ctrl(struct mdiobb_ctrl *ctrl, int bit)
  133. {
  134. struct bb_info *bitbang = container_of(ctrl, struct bb_info, ctrl);
  135. if (bit)
  136. bb_set(bitbang->addr, bitbang->mdc_msk);
  137. else
  138. bb_clr(bitbang->addr, bitbang->mdc_msk);
  139. }
  140. /* mdio bus control struct */
  141. static struct mdiobb_ops bb_ops = {
  142. .owner = THIS_MODULE,
  143. .set_mdc = sh_mdc_ctrl,
  144. .set_mdio_dir = sh_mmd_ctrl,
  145. .set_mdio_data = sh_set_mdio,
  146. .get_mdio_data = sh_get_mdio,
  147. };
  148. /* Chip Reset */
  149. static void sh_eth_reset(struct net_device *ndev)
  150. {
  151. u32 ioaddr = ndev->base_addr;
  152. #if defined(CONFIG_CPU_SUBTYPE_SH7763)
  153. int cnt = 100;
  154. ctrl_outl(EDSR_ENALL, ioaddr + EDSR);
  155. ctrl_outl(ctrl_inl(ioaddr + EDMR) | EDMR_SRST, ioaddr + EDMR);
  156. while (cnt > 0) {
  157. if (!(ctrl_inl(ioaddr + EDMR) & 0x3))
  158. break;
  159. mdelay(1);
  160. cnt--;
  161. }
  162. if (cnt < 0)
  163. printk(KERN_ERR "Device reset fail\n");
  164. /* Table Init */
  165. ctrl_outl(0x0, ioaddr + TDLAR);
  166. ctrl_outl(0x0, ioaddr + TDFAR);
  167. ctrl_outl(0x0, ioaddr + TDFXR);
  168. ctrl_outl(0x0, ioaddr + TDFFR);
  169. ctrl_outl(0x0, ioaddr + RDLAR);
  170. ctrl_outl(0x0, ioaddr + RDFAR);
  171. ctrl_outl(0x0, ioaddr + RDFXR);
  172. ctrl_outl(0x0, ioaddr + RDFFR);
  173. #else
  174. ctrl_outl(ctrl_inl(ioaddr + EDMR) | EDMR_SRST, ioaddr + EDMR);
  175. mdelay(3);
  176. ctrl_outl(ctrl_inl(ioaddr + EDMR) & ~EDMR_SRST, ioaddr + EDMR);
  177. #endif
  178. }
  179. /* free skb and descriptor buffer */
  180. static void sh_eth_ring_free(struct net_device *ndev)
  181. {
  182. struct sh_eth_private *mdp = netdev_priv(ndev);
  183. int i;
  184. /* Free Rx skb ringbuffer */
  185. if (mdp->rx_skbuff) {
  186. for (i = 0; i < RX_RING_SIZE; i++) {
  187. if (mdp->rx_skbuff[i])
  188. dev_kfree_skb(mdp->rx_skbuff[i]);
  189. }
  190. }
  191. kfree(mdp->rx_skbuff);
  192. /* Free Tx skb ringbuffer */
  193. if (mdp->tx_skbuff) {
  194. for (i = 0; i < TX_RING_SIZE; i++) {
  195. if (mdp->tx_skbuff[i])
  196. dev_kfree_skb(mdp->tx_skbuff[i]);
  197. }
  198. }
  199. kfree(mdp->tx_skbuff);
  200. }
  201. /* format skb and descriptor buffer */
  202. static void sh_eth_ring_format(struct net_device *ndev)
  203. {
  204. u32 ioaddr = ndev->base_addr, reserve = 0;
  205. struct sh_eth_private *mdp = netdev_priv(ndev);
  206. int i;
  207. struct sk_buff *skb;
  208. struct sh_eth_rxdesc *rxdesc = NULL;
  209. struct sh_eth_txdesc *txdesc = NULL;
  210. int rx_ringsize = sizeof(*rxdesc) * RX_RING_SIZE;
  211. int tx_ringsize = sizeof(*txdesc) * TX_RING_SIZE;
  212. mdp->cur_rx = mdp->cur_tx = 0;
  213. mdp->dirty_rx = mdp->dirty_tx = 0;
  214. memset(mdp->rx_ring, 0, rx_ringsize);
  215. /* build Rx ring buffer */
  216. for (i = 0; i < RX_RING_SIZE; i++) {
  217. /* skb */
  218. mdp->rx_skbuff[i] = NULL;
  219. skb = dev_alloc_skb(mdp->rx_buf_sz);
  220. mdp->rx_skbuff[i] = skb;
  221. if (skb == NULL)
  222. break;
  223. skb->dev = ndev; /* Mark as being used by this device. */
  224. #if defined(CONFIG_CPU_SUBTYPE_SH7763)
  225. reserve = SH7763_SKB_ALIGN
  226. - ((uint32_t)skb->data & (SH7763_SKB_ALIGN-1));
  227. if (reserve)
  228. skb_reserve(skb, reserve);
  229. #else
  230. skb_reserve(skb, RX_OFFSET);
  231. #endif
  232. /* RX descriptor */
  233. rxdesc = &mdp->rx_ring[i];
  234. rxdesc->addr = (u32)skb->data & ~0x3UL;
  235. rxdesc->status = cpu_to_edmac(mdp, RD_RACT | RD_RFP);
  236. /* The size of the buffer is 16 byte boundary. */
  237. rxdesc->buffer_length = (mdp->rx_buf_sz + 16) & ~0x0F;
  238. /* Rx descriptor address set */
  239. if (i == 0) {
  240. ctrl_outl((u32)rxdesc, ioaddr + RDLAR);
  241. #if defined(CONFIG_CPU_SUBTYPE_SH7763)
  242. ctrl_outl((u32)rxdesc, ioaddr + RDFAR);
  243. #endif
  244. }
  245. }
  246. /* Rx descriptor address set */
  247. #if defined(CONFIG_CPU_SUBTYPE_SH7763)
  248. ctrl_outl((u32)rxdesc, ioaddr + RDFXR);
  249. ctrl_outl(0x1, ioaddr + RDFFR);
  250. #endif
  251. mdp->dirty_rx = (u32) (i - RX_RING_SIZE);
  252. /* Mark the last entry as wrapping the ring. */
  253. rxdesc->status |= cpu_to_edmac(mdp, RD_RDEL);
  254. memset(mdp->tx_ring, 0, tx_ringsize);
  255. /* build Tx ring buffer */
  256. for (i = 0; i < TX_RING_SIZE; i++) {
  257. mdp->tx_skbuff[i] = NULL;
  258. txdesc = &mdp->tx_ring[i];
  259. txdesc->status = cpu_to_edmac(mdp, TD_TFP);
  260. txdesc->buffer_length = 0;
  261. if (i == 0) {
  262. /* Tx descriptor address set */
  263. ctrl_outl((u32)txdesc, ioaddr + TDLAR);
  264. #if defined(CONFIG_CPU_SUBTYPE_SH7763)
  265. ctrl_outl((u32)txdesc, ioaddr + TDFAR);
  266. #endif
  267. }
  268. }
  269. /* Tx descriptor address set */
  270. #if defined(CONFIG_CPU_SUBTYPE_SH7763)
  271. ctrl_outl((u32)txdesc, ioaddr + TDFXR);
  272. ctrl_outl(0x1, ioaddr + TDFFR);
  273. #endif
  274. txdesc->status |= cpu_to_edmac(mdp, TD_TDLE);
  275. }
  276. /* Get skb and descriptor buffer */
  277. static int sh_eth_ring_init(struct net_device *ndev)
  278. {
  279. struct sh_eth_private *mdp = netdev_priv(ndev);
  280. int rx_ringsize, tx_ringsize, ret = 0;
  281. /*
  282. * +26 gets the maximum ethernet encapsulation, +7 & ~7 because the
  283. * card needs room to do 8 byte alignment, +2 so we can reserve
  284. * the first 2 bytes, and +16 gets room for the status word from the
  285. * card.
  286. */
  287. mdp->rx_buf_sz = (ndev->mtu <= 1492 ? PKT_BUF_SZ :
  288. (((ndev->mtu + 26 + 7) & ~7) + 2 + 16));
  289. /* Allocate RX and TX skb rings */
  290. mdp->rx_skbuff = kmalloc(sizeof(*mdp->rx_skbuff) * RX_RING_SIZE,
  291. GFP_KERNEL);
  292. if (!mdp->rx_skbuff) {
  293. printk(KERN_ERR "%s: Cannot allocate Rx skb\n", ndev->name);
  294. ret = -ENOMEM;
  295. return ret;
  296. }
  297. mdp->tx_skbuff = kmalloc(sizeof(*mdp->tx_skbuff) * TX_RING_SIZE,
  298. GFP_KERNEL);
  299. if (!mdp->tx_skbuff) {
  300. printk(KERN_ERR "%s: Cannot allocate Tx skb\n", ndev->name);
  301. ret = -ENOMEM;
  302. goto skb_ring_free;
  303. }
  304. /* Allocate all Rx descriptors. */
  305. rx_ringsize = sizeof(struct sh_eth_rxdesc) * RX_RING_SIZE;
  306. mdp->rx_ring = dma_alloc_coherent(NULL, rx_ringsize, &mdp->rx_desc_dma,
  307. GFP_KERNEL);
  308. if (!mdp->rx_ring) {
  309. printk(KERN_ERR "%s: Cannot allocate Rx Ring (size %d bytes)\n",
  310. ndev->name, rx_ringsize);
  311. ret = -ENOMEM;
  312. goto desc_ring_free;
  313. }
  314. mdp->dirty_rx = 0;
  315. /* Allocate all Tx descriptors. */
  316. tx_ringsize = sizeof(struct sh_eth_txdesc) * TX_RING_SIZE;
  317. mdp->tx_ring = dma_alloc_coherent(NULL, tx_ringsize, &mdp->tx_desc_dma,
  318. GFP_KERNEL);
  319. if (!mdp->tx_ring) {
  320. printk(KERN_ERR "%s: Cannot allocate Tx Ring (size %d bytes)\n",
  321. ndev->name, tx_ringsize);
  322. ret = -ENOMEM;
  323. goto desc_ring_free;
  324. }
  325. return ret;
  326. desc_ring_free:
  327. /* free DMA buffer */
  328. dma_free_coherent(NULL, rx_ringsize, mdp->rx_ring, mdp->rx_desc_dma);
  329. skb_ring_free:
  330. /* Free Rx and Tx skb ring buffer */
  331. sh_eth_ring_free(ndev);
  332. return ret;
  333. }
  334. static int sh_eth_dev_init(struct net_device *ndev)
  335. {
  336. int ret = 0;
  337. struct sh_eth_private *mdp = netdev_priv(ndev);
  338. u32 ioaddr = ndev->base_addr;
  339. u_int32_t rx_int_var, tx_int_var;
  340. u32 val;
  341. /* Soft Reset */
  342. sh_eth_reset(ndev);
  343. /* Descriptor format */
  344. sh_eth_ring_format(ndev);
  345. ctrl_outl(RPADIR_INIT, ioaddr + RPADIR);
  346. /* all sh_eth int mask */
  347. ctrl_outl(0, ioaddr + EESIPR);
  348. #if defined(CONFIG_CPU_SUBTYPE_SH7763)
  349. ctrl_outl(EDMR_EL, ioaddr + EDMR);
  350. #else
  351. ctrl_outl(0, ioaddr + EDMR); /* Endian change */
  352. #endif
  353. /* FIFO size set */
  354. ctrl_outl((FIFO_SIZE_T | FIFO_SIZE_R), ioaddr + FDR);
  355. ctrl_outl(0, ioaddr + TFTR);
  356. /* Frame recv control */
  357. ctrl_outl(0, ioaddr + RMCR);
  358. rx_int_var = mdp->rx_int_var = DESC_I_RINT8 | DESC_I_RINT5;
  359. tx_int_var = mdp->tx_int_var = DESC_I_TINT2;
  360. ctrl_outl(rx_int_var | tx_int_var, ioaddr + TRSCER);
  361. #if defined(CONFIG_CPU_SUBTYPE_SH7763)
  362. /* Burst sycle set */
  363. ctrl_outl(0x800, ioaddr + BCULR);
  364. #endif
  365. ctrl_outl((FIFO_F_D_RFF | FIFO_F_D_RFD), ioaddr + FCFTR);
  366. #if !defined(CONFIG_CPU_SUBTYPE_SH7763)
  367. ctrl_outl(0, ioaddr + TRIMD);
  368. #endif
  369. /* Recv frame limit set register */
  370. ctrl_outl(RFLR_VALUE, ioaddr + RFLR);
  371. ctrl_outl(ctrl_inl(ioaddr + EESR), ioaddr + EESR);
  372. ctrl_outl((DMAC_M_RFRMER | DMAC_M_ECI | 0x003fffff), ioaddr + EESIPR);
  373. /* PAUSE Prohibition */
  374. val = (ctrl_inl(ioaddr + ECMR) & ECMR_DM) |
  375. ECMR_ZPF | (mdp->duplex ? ECMR_DM : 0) | ECMR_TE | ECMR_RE;
  376. ctrl_outl(val, ioaddr + ECMR);
  377. /* E-MAC Status Register clear */
  378. ctrl_outl(ECSR_INIT, ioaddr + ECSR);
  379. /* E-MAC Interrupt Enable register */
  380. ctrl_outl(ECSIPR_INIT, ioaddr + ECSIPR);
  381. /* Set MAC address */
  382. update_mac_address(ndev);
  383. /* mask reset */
  384. #if defined(CONFIG_CPU_SUBTYPE_SH7710) || defined(CONFIG_CPU_SUBTYPE_SH7763)
  385. ctrl_outl(APR_AP, ioaddr + APR);
  386. ctrl_outl(MPR_MP, ioaddr + MPR);
  387. ctrl_outl(TPAUSER_UNLIMITED, ioaddr + TPAUSER);
  388. #endif
  389. #if defined(CONFIG_CPU_SUBTYPE_SH7710)
  390. ctrl_outl(BCFR_UNLIMITED, ioaddr + BCFR);
  391. #endif
  392. /* Setting the Rx mode will start the Rx process. */
  393. ctrl_outl(EDRRR_R, ioaddr + EDRRR);
  394. netif_start_queue(ndev);
  395. return ret;
  396. }
  397. /* free Tx skb function */
  398. static int sh_eth_txfree(struct net_device *ndev)
  399. {
  400. struct sh_eth_private *mdp = netdev_priv(ndev);
  401. struct sh_eth_txdesc *txdesc;
  402. int freeNum = 0;
  403. int entry = 0;
  404. for (; mdp->cur_tx - mdp->dirty_tx > 0; mdp->dirty_tx++) {
  405. entry = mdp->dirty_tx % TX_RING_SIZE;
  406. txdesc = &mdp->tx_ring[entry];
  407. if (txdesc->status & cpu_to_edmac(mdp, TD_TACT))
  408. break;
  409. /* Free the original skb. */
  410. if (mdp->tx_skbuff[entry]) {
  411. dev_kfree_skb_irq(mdp->tx_skbuff[entry]);
  412. mdp->tx_skbuff[entry] = NULL;
  413. freeNum++;
  414. }
  415. txdesc->status = cpu_to_edmac(mdp, TD_TFP);
  416. if (entry >= TX_RING_SIZE - 1)
  417. txdesc->status |= cpu_to_edmac(mdp, TD_TDLE);
  418. mdp->stats.tx_packets++;
  419. mdp->stats.tx_bytes += txdesc->buffer_length;
  420. }
  421. return freeNum;
  422. }
  423. /* Packet receive function */
  424. static int sh_eth_rx(struct net_device *ndev)
  425. {
  426. struct sh_eth_private *mdp = netdev_priv(ndev);
  427. struct sh_eth_rxdesc *rxdesc;
  428. int entry = mdp->cur_rx % RX_RING_SIZE;
  429. int boguscnt = (mdp->dirty_rx + RX_RING_SIZE) - mdp->cur_rx;
  430. struct sk_buff *skb;
  431. u16 pkt_len = 0;
  432. u32 desc_status, reserve = 0;
  433. rxdesc = &mdp->rx_ring[entry];
  434. while (!(rxdesc->status & cpu_to_edmac(mdp, RD_RACT))) {
  435. desc_status = edmac_to_cpu(mdp, rxdesc->status);
  436. pkt_len = rxdesc->frame_length;
  437. if (--boguscnt < 0)
  438. break;
  439. if (!(desc_status & RDFEND))
  440. mdp->stats.rx_length_errors++;
  441. if (desc_status & (RD_RFS1 | RD_RFS2 | RD_RFS3 | RD_RFS4 |
  442. RD_RFS5 | RD_RFS6 | RD_RFS10)) {
  443. mdp->stats.rx_errors++;
  444. if (desc_status & RD_RFS1)
  445. mdp->stats.rx_crc_errors++;
  446. if (desc_status & RD_RFS2)
  447. mdp->stats.rx_frame_errors++;
  448. if (desc_status & RD_RFS3)
  449. mdp->stats.rx_length_errors++;
  450. if (desc_status & RD_RFS4)
  451. mdp->stats.rx_length_errors++;
  452. if (desc_status & RD_RFS6)
  453. mdp->stats.rx_missed_errors++;
  454. if (desc_status & RD_RFS10)
  455. mdp->stats.rx_over_errors++;
  456. } else {
  457. swaps((char *)(rxdesc->addr & ~0x3), pkt_len + 2);
  458. skb = mdp->rx_skbuff[entry];
  459. mdp->rx_skbuff[entry] = NULL;
  460. skb_put(skb, pkt_len);
  461. skb->protocol = eth_type_trans(skb, ndev);
  462. netif_rx(skb);
  463. mdp->stats.rx_packets++;
  464. mdp->stats.rx_bytes += pkt_len;
  465. }
  466. rxdesc->status |= cpu_to_edmac(mdp, RD_RACT);
  467. entry = (++mdp->cur_rx) % RX_RING_SIZE;
  468. }
  469. /* Refill the Rx ring buffers. */
  470. for (; mdp->cur_rx - mdp->dirty_rx > 0; mdp->dirty_rx++) {
  471. entry = mdp->dirty_rx % RX_RING_SIZE;
  472. rxdesc = &mdp->rx_ring[entry];
  473. /* The size of the buffer is 16 byte boundary. */
  474. rxdesc->buffer_length = (mdp->rx_buf_sz + 16) & ~0x0F;
  475. if (mdp->rx_skbuff[entry] == NULL) {
  476. skb = dev_alloc_skb(mdp->rx_buf_sz);
  477. mdp->rx_skbuff[entry] = skb;
  478. if (skb == NULL)
  479. break; /* Better luck next round. */
  480. skb->dev = ndev;
  481. #if defined(CONFIG_CPU_SUBTYPE_SH7763)
  482. reserve = SH7763_SKB_ALIGN
  483. - ((uint32_t)skb->data & (SH7763_SKB_ALIGN-1));
  484. if (reserve)
  485. skb_reserve(skb, reserve);
  486. #else
  487. skb_reserve(skb, RX_OFFSET);
  488. #endif
  489. skb->ip_summed = CHECKSUM_NONE;
  490. rxdesc->addr = (u32)skb->data & ~0x3UL;
  491. }
  492. if (entry >= RX_RING_SIZE - 1)
  493. rxdesc->status |=
  494. cpu_to_edmac(mdp, RD_RACT | RD_RFP | RD_RDEL);
  495. else
  496. rxdesc->status |=
  497. cpu_to_edmac(mdp, RD_RACT | RD_RFP);
  498. }
  499. /* Restart Rx engine if stopped. */
  500. /* If we don't need to check status, don't. -KDU */
  501. if (!(ctrl_inl(ndev->base_addr + EDRRR) & EDRRR_R))
  502. ctrl_outl(EDRRR_R, ndev->base_addr + EDRRR);
  503. return 0;
  504. }
  505. /* error control function */
  506. static void sh_eth_error(struct net_device *ndev, int intr_status)
  507. {
  508. struct sh_eth_private *mdp = netdev_priv(ndev);
  509. u32 ioaddr = ndev->base_addr;
  510. u32 felic_stat;
  511. if (intr_status & EESR_ECI) {
  512. felic_stat = ctrl_inl(ioaddr + ECSR);
  513. ctrl_outl(felic_stat, ioaddr + ECSR); /* clear int */
  514. if (felic_stat & ECSR_ICD)
  515. mdp->stats.tx_carrier_errors++;
  516. if (felic_stat & ECSR_LCHNG) {
  517. /* Link Changed */
  518. u32 link_stat = (ctrl_inl(ioaddr + PSR));
  519. if (!(link_stat & PHY_ST_LINK)) {
  520. /* Link Down : disable tx and rx */
  521. ctrl_outl(ctrl_inl(ioaddr + ECMR) &
  522. ~(ECMR_RE | ECMR_TE), ioaddr + ECMR);
  523. } else {
  524. /* Link Up */
  525. ctrl_outl(ctrl_inl(ioaddr + EESIPR) &
  526. ~DMAC_M_ECI, ioaddr + EESIPR);
  527. /*clear int */
  528. ctrl_outl(ctrl_inl(ioaddr + ECSR),
  529. ioaddr + ECSR);
  530. ctrl_outl(ctrl_inl(ioaddr + EESIPR) |
  531. DMAC_M_ECI, ioaddr + EESIPR);
  532. /* enable tx and rx */
  533. ctrl_outl(ctrl_inl(ioaddr + ECMR) |
  534. (ECMR_RE | ECMR_TE), ioaddr + ECMR);
  535. }
  536. }
  537. }
  538. if (intr_status & EESR_TWB) {
  539. /* Write buck end. unused write back interrupt */
  540. if (intr_status & EESR_TABT) /* Transmit Abort int */
  541. mdp->stats.tx_aborted_errors++;
  542. }
  543. if (intr_status & EESR_RABT) {
  544. /* Receive Abort int */
  545. if (intr_status & EESR_RFRMER) {
  546. /* Receive Frame Overflow int */
  547. mdp->stats.rx_frame_errors++;
  548. printk(KERN_ERR "Receive Frame Overflow\n");
  549. }
  550. }
  551. #if !defined(CONFIG_CPU_SUBTYPE_SH7763)
  552. if (intr_status & EESR_ADE) {
  553. if (intr_status & EESR_TDE) {
  554. if (intr_status & EESR_TFE)
  555. mdp->stats.tx_fifo_errors++;
  556. }
  557. }
  558. #endif
  559. if (intr_status & EESR_RDE) {
  560. /* Receive Descriptor Empty int */
  561. mdp->stats.rx_over_errors++;
  562. if (ctrl_inl(ioaddr + EDRRR) ^ EDRRR_R)
  563. ctrl_outl(EDRRR_R, ioaddr + EDRRR);
  564. printk(KERN_ERR "Receive Descriptor Empty\n");
  565. }
  566. if (intr_status & EESR_RFE) {
  567. /* Receive FIFO Overflow int */
  568. mdp->stats.rx_fifo_errors++;
  569. printk(KERN_ERR "Receive FIFO Overflow\n");
  570. }
  571. if (intr_status & (EESR_TWB | EESR_TABT |
  572. #if !defined(CONFIG_CPU_SUBTYPE_SH7763)
  573. EESR_ADE |
  574. #endif
  575. EESR_TDE | EESR_TFE)) {
  576. /* Tx error */
  577. u32 edtrr = ctrl_inl(ndev->base_addr + EDTRR);
  578. /* dmesg */
  579. printk(KERN_ERR "%s:TX error. status=%8.8x cur_tx=%8.8x ",
  580. ndev->name, intr_status, mdp->cur_tx);
  581. printk(KERN_ERR "dirty_tx=%8.8x state=%8.8x EDTRR=%8.8x.\n",
  582. mdp->dirty_tx, (u32) ndev->state, edtrr);
  583. /* dirty buffer free */
  584. sh_eth_txfree(ndev);
  585. /* SH7712 BUG */
  586. if (edtrr ^ EDTRR_TRNS) {
  587. /* tx dma start */
  588. ctrl_outl(EDTRR_TRNS, ndev->base_addr + EDTRR);
  589. }
  590. /* wakeup */
  591. netif_wake_queue(ndev);
  592. }
  593. }
  594. static irqreturn_t sh_eth_interrupt(int irq, void *netdev)
  595. {
  596. struct net_device *ndev = netdev;
  597. struct sh_eth_private *mdp = netdev_priv(ndev);
  598. irqreturn_t ret = IRQ_NONE;
  599. u32 ioaddr, boguscnt = RX_RING_SIZE;
  600. u32 intr_status = 0;
  601. ioaddr = ndev->base_addr;
  602. spin_lock(&mdp->lock);
  603. /* Get interrpt stat */
  604. intr_status = ctrl_inl(ioaddr + EESR);
  605. /* Clear interrupt */
  606. if (intr_status & (EESR_FRC | EESR_RMAF | EESR_RRF |
  607. EESR_RTLF | EESR_RTSF | EESR_PRE | EESR_CERF |
  608. TX_CHECK | EESR_ERR_CHECK)) {
  609. ctrl_outl(intr_status, ioaddr + EESR);
  610. ret = IRQ_HANDLED;
  611. } else
  612. goto other_irq;
  613. if (intr_status & (EESR_FRC | /* Frame recv*/
  614. EESR_RMAF | /* Multi cast address recv*/
  615. EESR_RRF | /* Bit frame recv */
  616. EESR_RTLF | /* Long frame recv*/
  617. EESR_RTSF | /* short frame recv */
  618. EESR_PRE | /* PHY-LSI recv error */
  619. EESR_CERF)){ /* recv frame CRC error */
  620. sh_eth_rx(ndev);
  621. }
  622. /* Tx Check */
  623. if (intr_status & TX_CHECK) {
  624. sh_eth_txfree(ndev);
  625. netif_wake_queue(ndev);
  626. }
  627. if (intr_status & EESR_ERR_CHECK)
  628. sh_eth_error(ndev, intr_status);
  629. if (--boguscnt < 0) {
  630. printk(KERN_WARNING
  631. "%s: Too much work at interrupt, status=0x%4.4x.\n",
  632. ndev->name, intr_status);
  633. }
  634. other_irq:
  635. spin_unlock(&mdp->lock);
  636. return ret;
  637. }
  638. static void sh_eth_timer(unsigned long data)
  639. {
  640. struct net_device *ndev = (struct net_device *)data;
  641. struct sh_eth_private *mdp = netdev_priv(ndev);
  642. mod_timer(&mdp->timer, jiffies + (10 * HZ));
  643. }
  644. /* PHY state control function */
  645. static void sh_eth_adjust_link(struct net_device *ndev)
  646. {
  647. struct sh_eth_private *mdp = netdev_priv(ndev);
  648. struct phy_device *phydev = mdp->phydev;
  649. u32 ioaddr = ndev->base_addr;
  650. int new_state = 0;
  651. if (phydev->link != PHY_DOWN) {
  652. if (phydev->duplex != mdp->duplex) {
  653. new_state = 1;
  654. mdp->duplex = phydev->duplex;
  655. #if defined(CONFIG_CPU_SUBTYPE_SH7763)
  656. if (mdp->duplex) { /* FULL */
  657. ctrl_outl(ctrl_inl(ioaddr + ECMR) | ECMR_DM,
  658. ioaddr + ECMR);
  659. } else { /* Half */
  660. ctrl_outl(ctrl_inl(ioaddr + ECMR) & ~ECMR_DM,
  661. ioaddr + ECMR);
  662. }
  663. #endif
  664. }
  665. if (phydev->speed != mdp->speed) {
  666. new_state = 1;
  667. mdp->speed = phydev->speed;
  668. #if defined(CONFIG_CPU_SUBTYPE_SH7763)
  669. switch (mdp->speed) {
  670. case 10: /* 10BASE */
  671. ctrl_outl(GECMR_10, ioaddr + GECMR); break;
  672. case 100:/* 100BASE */
  673. ctrl_outl(GECMR_100, ioaddr + GECMR); break;
  674. case 1000: /* 1000BASE */
  675. ctrl_outl(GECMR_1000, ioaddr + GECMR); break;
  676. default:
  677. break;
  678. }
  679. #endif
  680. }
  681. if (mdp->link == PHY_DOWN) {
  682. ctrl_outl((ctrl_inl(ioaddr + ECMR) & ~ECMR_TXF)
  683. | ECMR_DM, ioaddr + ECMR);
  684. new_state = 1;
  685. mdp->link = phydev->link;
  686. }
  687. } else if (mdp->link) {
  688. new_state = 1;
  689. mdp->link = PHY_DOWN;
  690. mdp->speed = 0;
  691. mdp->duplex = -1;
  692. }
  693. if (new_state)
  694. phy_print_status(phydev);
  695. }
  696. /* PHY init function */
  697. static int sh_eth_phy_init(struct net_device *ndev)
  698. {
  699. struct sh_eth_private *mdp = netdev_priv(ndev);
  700. char phy_id[BUS_ID_SIZE];
  701. struct phy_device *phydev = NULL;
  702. snprintf(phy_id, sizeof(phy_id), PHY_ID_FMT,
  703. mdp->mii_bus->id , mdp->phy_id);
  704. mdp->link = PHY_DOWN;
  705. mdp->speed = 0;
  706. mdp->duplex = -1;
  707. /* Try connect to PHY */
  708. phydev = phy_connect(ndev, phy_id, &sh_eth_adjust_link,
  709. 0, PHY_INTERFACE_MODE_MII);
  710. if (IS_ERR(phydev)) {
  711. dev_err(&ndev->dev, "phy_connect failed\n");
  712. return PTR_ERR(phydev);
  713. }
  714. dev_info(&ndev->dev, "attached phy %i to driver %s\n",
  715. phydev->addr, phydev->drv->name);
  716. mdp->phydev = phydev;
  717. return 0;
  718. }
  719. /* PHY control start function */
  720. static int sh_eth_phy_start(struct net_device *ndev)
  721. {
  722. struct sh_eth_private *mdp = netdev_priv(ndev);
  723. int ret;
  724. ret = sh_eth_phy_init(ndev);
  725. if (ret)
  726. return ret;
  727. /* reset phy - this also wakes it from PDOWN */
  728. phy_write(mdp->phydev, MII_BMCR, BMCR_RESET);
  729. phy_start(mdp->phydev);
  730. return 0;
  731. }
  732. /* network device open function */
  733. static int sh_eth_open(struct net_device *ndev)
  734. {
  735. int ret = 0;
  736. struct sh_eth_private *mdp = netdev_priv(ndev);
  737. ret = request_irq(ndev->irq, &sh_eth_interrupt,
  738. #if defined(CONFIG_CPU_SUBTYPE_SH7763) || defined(CONFIG_CPU_SUBTYPE_SH7764)
  739. IRQF_SHARED,
  740. #else
  741. 0,
  742. #endif
  743. ndev->name, ndev);
  744. if (ret) {
  745. printk(KERN_ERR "Can not assign IRQ number to %s\n", CARDNAME);
  746. return ret;
  747. }
  748. /* Descriptor set */
  749. ret = sh_eth_ring_init(ndev);
  750. if (ret)
  751. goto out_free_irq;
  752. /* device init */
  753. ret = sh_eth_dev_init(ndev);
  754. if (ret)
  755. goto out_free_irq;
  756. /* PHY control start*/
  757. ret = sh_eth_phy_start(ndev);
  758. if (ret)
  759. goto out_free_irq;
  760. /* Set the timer to check for link beat. */
  761. init_timer(&mdp->timer);
  762. mdp->timer.expires = (jiffies + (24 * HZ)) / 10;/* 2.4 sec. */
  763. setup_timer(&mdp->timer, sh_eth_timer, (unsigned long)ndev);
  764. return ret;
  765. out_free_irq:
  766. free_irq(ndev->irq, ndev);
  767. return ret;
  768. }
  769. /* Timeout function */
  770. static void sh_eth_tx_timeout(struct net_device *ndev)
  771. {
  772. struct sh_eth_private *mdp = netdev_priv(ndev);
  773. u32 ioaddr = ndev->base_addr;
  774. struct sh_eth_rxdesc *rxdesc;
  775. int i;
  776. netif_stop_queue(ndev);
  777. /* worning message out. */
  778. printk(KERN_WARNING "%s: transmit timed out, status %8.8x,"
  779. " resetting...\n", ndev->name, (int)ctrl_inl(ioaddr + EESR));
  780. /* tx_errors count up */
  781. mdp->stats.tx_errors++;
  782. /* timer off */
  783. del_timer_sync(&mdp->timer);
  784. /* Free all the skbuffs in the Rx queue. */
  785. for (i = 0; i < RX_RING_SIZE; i++) {
  786. rxdesc = &mdp->rx_ring[i];
  787. rxdesc->status = 0;
  788. rxdesc->addr = 0xBADF00D0;
  789. if (mdp->rx_skbuff[i])
  790. dev_kfree_skb(mdp->rx_skbuff[i]);
  791. mdp->rx_skbuff[i] = NULL;
  792. }
  793. for (i = 0; i < TX_RING_SIZE; i++) {
  794. if (mdp->tx_skbuff[i])
  795. dev_kfree_skb(mdp->tx_skbuff[i]);
  796. mdp->tx_skbuff[i] = NULL;
  797. }
  798. /* device init */
  799. sh_eth_dev_init(ndev);
  800. /* timer on */
  801. mdp->timer.expires = (jiffies + (24 * HZ)) / 10;/* 2.4 sec. */
  802. add_timer(&mdp->timer);
  803. }
  804. /* Packet transmit function */
  805. static int sh_eth_start_xmit(struct sk_buff *skb, struct net_device *ndev)
  806. {
  807. struct sh_eth_private *mdp = netdev_priv(ndev);
  808. struct sh_eth_txdesc *txdesc;
  809. u32 entry;
  810. unsigned long flags;
  811. spin_lock_irqsave(&mdp->lock, flags);
  812. if ((mdp->cur_tx - mdp->dirty_tx) >= (TX_RING_SIZE - 4)) {
  813. if (!sh_eth_txfree(ndev)) {
  814. netif_stop_queue(ndev);
  815. spin_unlock_irqrestore(&mdp->lock, flags);
  816. return 1;
  817. }
  818. }
  819. spin_unlock_irqrestore(&mdp->lock, flags);
  820. entry = mdp->cur_tx % TX_RING_SIZE;
  821. mdp->tx_skbuff[entry] = skb;
  822. txdesc = &mdp->tx_ring[entry];
  823. txdesc->addr = (u32)(skb->data);
  824. /* soft swap. */
  825. swaps((char *)(txdesc->addr & ~0x3), skb->len + 2);
  826. /* write back */
  827. __flush_purge_region(skb->data, skb->len);
  828. if (skb->len < ETHERSMALL)
  829. txdesc->buffer_length = ETHERSMALL;
  830. else
  831. txdesc->buffer_length = skb->len;
  832. if (entry >= TX_RING_SIZE - 1)
  833. txdesc->status |= cpu_to_edmac(mdp, TD_TACT | TD_TDLE);
  834. else
  835. txdesc->status |= cpu_to_edmac(mdp, TD_TACT);
  836. mdp->cur_tx++;
  837. if (!(ctrl_inl(ndev->base_addr + EDTRR) & EDTRR_TRNS))
  838. ctrl_outl(EDTRR_TRNS, ndev->base_addr + EDTRR);
  839. ndev->trans_start = jiffies;
  840. return 0;
  841. }
  842. /* device close function */
  843. static int sh_eth_close(struct net_device *ndev)
  844. {
  845. struct sh_eth_private *mdp = netdev_priv(ndev);
  846. u32 ioaddr = ndev->base_addr;
  847. int ringsize;
  848. netif_stop_queue(ndev);
  849. /* Disable interrupts by clearing the interrupt mask. */
  850. ctrl_outl(0x0000, ioaddr + EESIPR);
  851. /* Stop the chip's Tx and Rx processes. */
  852. ctrl_outl(0, ioaddr + EDTRR);
  853. ctrl_outl(0, ioaddr + EDRRR);
  854. /* PHY Disconnect */
  855. if (mdp->phydev) {
  856. phy_stop(mdp->phydev);
  857. phy_disconnect(mdp->phydev);
  858. }
  859. free_irq(ndev->irq, ndev);
  860. del_timer_sync(&mdp->timer);
  861. /* Free all the skbuffs in the Rx queue. */
  862. sh_eth_ring_free(ndev);
  863. /* free DMA buffer */
  864. ringsize = sizeof(struct sh_eth_rxdesc) * RX_RING_SIZE;
  865. dma_free_coherent(NULL, ringsize, mdp->rx_ring, mdp->rx_desc_dma);
  866. /* free DMA buffer */
  867. ringsize = sizeof(struct sh_eth_txdesc) * TX_RING_SIZE;
  868. dma_free_coherent(NULL, ringsize, mdp->tx_ring, mdp->tx_desc_dma);
  869. return 0;
  870. }
  871. static struct net_device_stats *sh_eth_get_stats(struct net_device *ndev)
  872. {
  873. struct sh_eth_private *mdp = netdev_priv(ndev);
  874. u32 ioaddr = ndev->base_addr;
  875. mdp->stats.tx_dropped += ctrl_inl(ioaddr + TROCR);
  876. ctrl_outl(0, ioaddr + TROCR); /* (write clear) */
  877. mdp->stats.collisions += ctrl_inl(ioaddr + CDCR);
  878. ctrl_outl(0, ioaddr + CDCR); /* (write clear) */
  879. mdp->stats.tx_carrier_errors += ctrl_inl(ioaddr + LCCR);
  880. ctrl_outl(0, ioaddr + LCCR); /* (write clear) */
  881. #if defined(CONFIG_CPU_SUBTYPE_SH7763)
  882. mdp->stats.tx_carrier_errors += ctrl_inl(ioaddr + CERCR);/* CERCR */
  883. ctrl_outl(0, ioaddr + CERCR); /* (write clear) */
  884. mdp->stats.tx_carrier_errors += ctrl_inl(ioaddr + CEECR);/* CEECR */
  885. ctrl_outl(0, ioaddr + CEECR); /* (write clear) */
  886. #else
  887. mdp->stats.tx_carrier_errors += ctrl_inl(ioaddr + CNDCR);
  888. ctrl_outl(0, ioaddr + CNDCR); /* (write clear) */
  889. #endif
  890. return &mdp->stats;
  891. }
  892. /* ioctl to device funciotn*/
  893. static int sh_eth_do_ioctl(struct net_device *ndev, struct ifreq *rq,
  894. int cmd)
  895. {
  896. struct sh_eth_private *mdp = netdev_priv(ndev);
  897. struct phy_device *phydev = mdp->phydev;
  898. if (!netif_running(ndev))
  899. return -EINVAL;
  900. if (!phydev)
  901. return -ENODEV;
  902. return phy_mii_ioctl(phydev, if_mii(rq), cmd);
  903. }
  904. /* Multicast reception directions set */
  905. static void sh_eth_set_multicast_list(struct net_device *ndev)
  906. {
  907. u32 ioaddr = ndev->base_addr;
  908. if (ndev->flags & IFF_PROMISC) {
  909. /* Set promiscuous. */
  910. ctrl_outl((ctrl_inl(ioaddr + ECMR) & ~ECMR_MCT) | ECMR_PRM,
  911. ioaddr + ECMR);
  912. } else {
  913. /* Normal, unicast/broadcast-only mode. */
  914. ctrl_outl((ctrl_inl(ioaddr + ECMR) & ~ECMR_PRM) | ECMR_MCT,
  915. ioaddr + ECMR);
  916. }
  917. }
  918. /* SuperH's TSU register init function */
  919. static void sh_eth_tsu_init(u32 ioaddr)
  920. {
  921. ctrl_outl(0, ioaddr + TSU_FWEN0); /* Disable forward(0->1) */
  922. ctrl_outl(0, ioaddr + TSU_FWEN1); /* Disable forward(1->0) */
  923. ctrl_outl(0, ioaddr + TSU_FCM); /* forward fifo 3k-3k */
  924. ctrl_outl(0xc, ioaddr + TSU_BSYSL0);
  925. ctrl_outl(0xc, ioaddr + TSU_BSYSL1);
  926. ctrl_outl(0, ioaddr + TSU_PRISL0);
  927. ctrl_outl(0, ioaddr + TSU_PRISL1);
  928. ctrl_outl(0, ioaddr + TSU_FWSL0);
  929. ctrl_outl(0, ioaddr + TSU_FWSL1);
  930. ctrl_outl(TSU_FWSLC_POSTENU | TSU_FWSLC_POSTENL, ioaddr + TSU_FWSLC);
  931. #if defined(CONFIG_CPU_SUBTYPE_SH7763)
  932. ctrl_outl(0, ioaddr + TSU_QTAG0); /* Disable QTAG(0->1) */
  933. ctrl_outl(0, ioaddr + TSU_QTAG1); /* Disable QTAG(1->0) */
  934. #else
  935. ctrl_outl(0, ioaddr + TSU_QTAGM0); /* Disable QTAG(0->1) */
  936. ctrl_outl(0, ioaddr + TSU_QTAGM1); /* Disable QTAG(1->0) */
  937. #endif
  938. ctrl_outl(0, ioaddr + TSU_FWSR); /* all interrupt status clear */
  939. ctrl_outl(0, ioaddr + TSU_FWINMK); /* Disable all interrupt */
  940. ctrl_outl(0, ioaddr + TSU_TEN); /* Disable all CAM entry */
  941. ctrl_outl(0, ioaddr + TSU_POST1); /* Disable CAM entry [ 0- 7] */
  942. ctrl_outl(0, ioaddr + TSU_POST2); /* Disable CAM entry [ 8-15] */
  943. ctrl_outl(0, ioaddr + TSU_POST3); /* Disable CAM entry [16-23] */
  944. ctrl_outl(0, ioaddr + TSU_POST4); /* Disable CAM entry [24-31] */
  945. }
  946. /* MDIO bus release function */
  947. static int sh_mdio_release(struct net_device *ndev)
  948. {
  949. struct mii_bus *bus = dev_get_drvdata(&ndev->dev);
  950. /* unregister mdio bus */
  951. mdiobus_unregister(bus);
  952. /* remove mdio bus info from net_device */
  953. dev_set_drvdata(&ndev->dev, NULL);
  954. /* free bitbang info */
  955. free_mdio_bitbang(bus);
  956. return 0;
  957. }
  958. /* MDIO bus init function */
  959. static int sh_mdio_init(struct net_device *ndev, int id)
  960. {
  961. int ret, i;
  962. struct bb_info *bitbang;
  963. struct sh_eth_private *mdp = netdev_priv(ndev);
  964. /* create bit control struct for PHY */
  965. bitbang = kzalloc(sizeof(struct bb_info), GFP_KERNEL);
  966. if (!bitbang) {
  967. ret = -ENOMEM;
  968. goto out;
  969. }
  970. /* bitbang init */
  971. bitbang->addr = ndev->base_addr + PIR;
  972. bitbang->mdi_msk = 0x08;
  973. bitbang->mdo_msk = 0x04;
  974. bitbang->mmd_msk = 0x02;/* MMD */
  975. bitbang->mdc_msk = 0x01;
  976. bitbang->ctrl.ops = &bb_ops;
  977. /* MII contorller setting */
  978. mdp->mii_bus = alloc_mdio_bitbang(&bitbang->ctrl);
  979. if (!mdp->mii_bus) {
  980. ret = -ENOMEM;
  981. goto out_free_bitbang;
  982. }
  983. /* Hook up MII support for ethtool */
  984. mdp->mii_bus->name = "sh_mii";
  985. mdp->mii_bus->parent = &ndev->dev;
  986. snprintf(mdp->mii_bus->id, MII_BUS_ID_SIZE, "%x", id);
  987. /* PHY IRQ */
  988. mdp->mii_bus->irq = kmalloc(sizeof(int)*PHY_MAX_ADDR, GFP_KERNEL);
  989. if (!mdp->mii_bus->irq) {
  990. ret = -ENOMEM;
  991. goto out_free_bus;
  992. }
  993. for (i = 0; i < PHY_MAX_ADDR; i++)
  994. mdp->mii_bus->irq[i] = PHY_POLL;
  995. /* regist mdio bus */
  996. ret = mdiobus_register(mdp->mii_bus);
  997. if (ret)
  998. goto out_free_irq;
  999. dev_set_drvdata(&ndev->dev, mdp->mii_bus);
  1000. return 0;
  1001. out_free_irq:
  1002. kfree(mdp->mii_bus->irq);
  1003. out_free_bus:
  1004. free_mdio_bitbang(mdp->mii_bus);
  1005. out_free_bitbang:
  1006. kfree(bitbang);
  1007. out:
  1008. return ret;
  1009. }
  1010. static const struct net_device_ops sh_eth_netdev_ops = {
  1011. .ndo_open = sh_eth_open,
  1012. .ndo_stop = sh_eth_close,
  1013. .ndo_start_xmit = sh_eth_start_xmit,
  1014. .ndo_get_stats = sh_eth_get_stats,
  1015. .ndo_set_multicast_list = sh_eth_set_multicast_list,
  1016. .ndo_tx_timeout = sh_eth_tx_timeout,
  1017. .ndo_do_ioctl = sh_eth_do_ioctl,
  1018. .ndo_validate_addr = eth_validate_addr,
  1019. .ndo_set_mac_address = eth_mac_addr,
  1020. .ndo_change_mtu = eth_change_mtu,
  1021. };
  1022. static int sh_eth_drv_probe(struct platform_device *pdev)
  1023. {
  1024. int ret, i, devno = 0;
  1025. struct resource *res;
  1026. struct net_device *ndev = NULL;
  1027. struct sh_eth_private *mdp;
  1028. struct sh_eth_plat_data *pd;
  1029. /* get base addr */
  1030. res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  1031. if (unlikely(res == NULL)) {
  1032. dev_err(&pdev->dev, "invalid resource\n");
  1033. ret = -EINVAL;
  1034. goto out;
  1035. }
  1036. ndev = alloc_etherdev(sizeof(struct sh_eth_private));
  1037. if (!ndev) {
  1038. printk(KERN_ERR "%s: could not allocate device.\n", CARDNAME);
  1039. ret = -ENOMEM;
  1040. goto out;
  1041. }
  1042. /* The sh Ether-specific entries in the device structure. */
  1043. ndev->base_addr = res->start;
  1044. devno = pdev->id;
  1045. if (devno < 0)
  1046. devno = 0;
  1047. ndev->dma = -1;
  1048. ret = platform_get_irq(pdev, 0);
  1049. if (ret < 0) {
  1050. ret = -ENODEV;
  1051. goto out_release;
  1052. }
  1053. ndev->irq = ret;
  1054. SET_NETDEV_DEV(ndev, &pdev->dev);
  1055. /* Fill in the fields of the device structure with ethernet values. */
  1056. ether_setup(ndev);
  1057. mdp = netdev_priv(ndev);
  1058. spin_lock_init(&mdp->lock);
  1059. pd = (struct sh_eth_plat_data *)(pdev->dev.platform_data);
  1060. /* get PHY ID */
  1061. mdp->phy_id = pd->phy;
  1062. /* EDMAC endian */
  1063. mdp->edmac_endian = pd->edmac_endian;
  1064. /* set function */
  1065. ndev->netdev_ops = &sh_eth_netdev_ops;
  1066. ndev->watchdog_timeo = TX_TIMEOUT;
  1067. mdp->post_rx = POST_RX >> (devno << 1);
  1068. mdp->post_fw = POST_FW >> (devno << 1);
  1069. /* read and set MAC address */
  1070. read_mac_address(ndev);
  1071. /* First device only init */
  1072. if (!devno) {
  1073. #if defined(ARSTR)
  1074. /* reset device */
  1075. ctrl_outl(ARSTR_ARSTR, ARSTR);
  1076. mdelay(1);
  1077. #endif
  1078. #if defined(SH_TSU_ADDR)
  1079. /* TSU init (Init only)*/
  1080. sh_eth_tsu_init(SH_TSU_ADDR);
  1081. #endif
  1082. }
  1083. /* network device register */
  1084. ret = register_netdev(ndev);
  1085. if (ret)
  1086. goto out_release;
  1087. /* mdio bus init */
  1088. ret = sh_mdio_init(ndev, pdev->id);
  1089. if (ret)
  1090. goto out_unregister;
  1091. /* pritnt device infomation */
  1092. printk(KERN_INFO "%s: %s at 0x%x, ",
  1093. ndev->name, CARDNAME, (u32) ndev->base_addr);
  1094. for (i = 0; i < 5; i++)
  1095. printk("%02X:", ndev->dev_addr[i]);
  1096. printk("%02X, IRQ %d.\n", ndev->dev_addr[i], ndev->irq);
  1097. platform_set_drvdata(pdev, ndev);
  1098. return ret;
  1099. out_unregister:
  1100. unregister_netdev(ndev);
  1101. out_release:
  1102. /* net_dev free */
  1103. if (ndev)
  1104. free_netdev(ndev);
  1105. out:
  1106. return ret;
  1107. }
  1108. static int sh_eth_drv_remove(struct platform_device *pdev)
  1109. {
  1110. struct net_device *ndev = platform_get_drvdata(pdev);
  1111. sh_mdio_release(ndev);
  1112. unregister_netdev(ndev);
  1113. flush_scheduled_work();
  1114. free_netdev(ndev);
  1115. platform_set_drvdata(pdev, NULL);
  1116. return 0;
  1117. }
  1118. static struct platform_driver sh_eth_driver = {
  1119. .probe = sh_eth_drv_probe,
  1120. .remove = sh_eth_drv_remove,
  1121. .driver = {
  1122. .name = CARDNAME,
  1123. },
  1124. };
  1125. static int __init sh_eth_init(void)
  1126. {
  1127. return platform_driver_register(&sh_eth_driver);
  1128. }
  1129. static void __exit sh_eth_cleanup(void)
  1130. {
  1131. platform_driver_unregister(&sh_eth_driver);
  1132. }
  1133. module_init(sh_eth_init);
  1134. module_exit(sh_eth_cleanup);
  1135. MODULE_AUTHOR("Nobuhiro Iwamatsu, Yoshihiro Shimoda");
  1136. MODULE_DESCRIPTION("Renesas SuperH Ethernet driver");
  1137. MODULE_LICENSE("GPL v2");