cpmac.c 35 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301
  1. /*
  2. * Copyright (C) 2006, 2007 Eugene Konev
  3. *
  4. * This program is free software; you can redistribute it and/or modify
  5. * it under the terms of the GNU General Public License as published by
  6. * the Free Software Foundation; either version 2 of the License, or
  7. * (at your option) any later version.
  8. *
  9. * This program is distributed in the hope that it will be useful,
  10. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  11. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  12. * GNU General Public License for more details.
  13. *
  14. * You should have received a copy of the GNU General Public License
  15. * along with this program; if not, write to the Free Software
  16. * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
  17. */
  18. #include <linux/module.h>
  19. #include <linux/init.h>
  20. #include <linux/interrupt.h>
  21. #include <linux/moduleparam.h>
  22. #include <linux/sched.h>
  23. #include <linux/kernel.h>
  24. #include <linux/slab.h>
  25. #include <linux/errno.h>
  26. #include <linux/types.h>
  27. #include <linux/delay.h>
  28. #include <linux/netdevice.h>
  29. #include <linux/if_vlan.h>
  30. #include <linux/etherdevice.h>
  31. #include <linux/ethtool.h>
  32. #include <linux/skbuff.h>
  33. #include <linux/mii.h>
  34. #include <linux/phy.h>
  35. #include <linux/phy_fixed.h>
  36. #include <linux/platform_device.h>
  37. #include <linux/dma-mapping.h>
  38. #include <linux/clk.h>
  39. #include <linux/gpio.h>
  40. #include <linux/atomic.h>
  41. MODULE_AUTHOR("Eugene Konev <ejka@imfi.kspu.ru>");
  42. MODULE_DESCRIPTION("TI AR7 ethernet driver (CPMAC)");
  43. MODULE_LICENSE("GPL");
  44. MODULE_ALIAS("platform:cpmac");
  45. static int debug_level = 8;
  46. static int dumb_switch;
  47. /* Next 2 are only used in cpmac_probe, so it's pointless to change them */
  48. module_param(debug_level, int, 0444);
  49. module_param(dumb_switch, int, 0444);
  50. MODULE_PARM_DESC(debug_level, "Number of NETIF_MSG bits to enable");
  51. MODULE_PARM_DESC(dumb_switch, "Assume switch is not connected to MDIO bus");
  52. #define CPMAC_VERSION "0.5.2"
  53. /* frame size + 802.1q tag + FCS size */
  54. #define CPMAC_SKB_SIZE (ETH_FRAME_LEN + ETH_FCS_LEN + VLAN_HLEN)
  55. #define CPMAC_QUEUES 8
  56. /* Ethernet registers */
  57. #define CPMAC_TX_CONTROL 0x0004
  58. #define CPMAC_TX_TEARDOWN 0x0008
  59. #define CPMAC_RX_CONTROL 0x0014
  60. #define CPMAC_RX_TEARDOWN 0x0018
  61. #define CPMAC_MBP 0x0100
  62. # define MBP_RXPASSCRC 0x40000000
  63. # define MBP_RXQOS 0x20000000
  64. # define MBP_RXNOCHAIN 0x10000000
  65. # define MBP_RXCMF 0x01000000
  66. # define MBP_RXSHORT 0x00800000
  67. # define MBP_RXCEF 0x00400000
  68. # define MBP_RXPROMISC 0x00200000
  69. # define MBP_PROMISCCHAN(channel) (((channel) & 0x7) << 16)
  70. # define MBP_RXBCAST 0x00002000
  71. # define MBP_BCASTCHAN(channel) (((channel) & 0x7) << 8)
  72. # define MBP_RXMCAST 0x00000020
  73. # define MBP_MCASTCHAN(channel) ((channel) & 0x7)
  74. #define CPMAC_UNICAST_ENABLE 0x0104
  75. #define CPMAC_UNICAST_CLEAR 0x0108
  76. #define CPMAC_MAX_LENGTH 0x010c
  77. #define CPMAC_BUFFER_OFFSET 0x0110
  78. #define CPMAC_MAC_CONTROL 0x0160
  79. # define MAC_TXPTYPE 0x00000200
  80. # define MAC_TXPACE 0x00000040
  81. # define MAC_MII 0x00000020
  82. # define MAC_TXFLOW 0x00000010
  83. # define MAC_RXFLOW 0x00000008
  84. # define MAC_MTEST 0x00000004
  85. # define MAC_LOOPBACK 0x00000002
  86. # define MAC_FDX 0x00000001
  87. #define CPMAC_MAC_STATUS 0x0164
  88. # define MAC_STATUS_QOS 0x00000004
  89. # define MAC_STATUS_RXFLOW 0x00000002
  90. # define MAC_STATUS_TXFLOW 0x00000001
  91. #define CPMAC_TX_INT_ENABLE 0x0178
  92. #define CPMAC_TX_INT_CLEAR 0x017c
  93. #define CPMAC_MAC_INT_VECTOR 0x0180
  94. # define MAC_INT_STATUS 0x00080000
  95. # define MAC_INT_HOST 0x00040000
  96. # define MAC_INT_RX 0x00020000
  97. # define MAC_INT_TX 0x00010000
  98. #define CPMAC_MAC_EOI_VECTOR 0x0184
  99. #define CPMAC_RX_INT_ENABLE 0x0198
  100. #define CPMAC_RX_INT_CLEAR 0x019c
  101. #define CPMAC_MAC_INT_ENABLE 0x01a8
  102. #define CPMAC_MAC_INT_CLEAR 0x01ac
  103. #define CPMAC_MAC_ADDR_LO(channel) (0x01b0 + (channel) * 4)
  104. #define CPMAC_MAC_ADDR_MID 0x01d0
  105. #define CPMAC_MAC_ADDR_HI 0x01d4
  106. #define CPMAC_MAC_HASH_LO 0x01d8
  107. #define CPMAC_MAC_HASH_HI 0x01dc
  108. #define CPMAC_TX_PTR(channel) (0x0600 + (channel) * 4)
  109. #define CPMAC_RX_PTR(channel) (0x0620 + (channel) * 4)
  110. #define CPMAC_TX_ACK(channel) (0x0640 + (channel) * 4)
  111. #define CPMAC_RX_ACK(channel) (0x0660 + (channel) * 4)
  112. #define CPMAC_REG_END 0x0680
  113. /*
  114. * Rx/Tx statistics
  115. * TODO: use some of them to fill stats in cpmac_stats()
  116. */
  117. #define CPMAC_STATS_RX_GOOD 0x0200
  118. #define CPMAC_STATS_RX_BCAST 0x0204
  119. #define CPMAC_STATS_RX_MCAST 0x0208
  120. #define CPMAC_STATS_RX_PAUSE 0x020c
  121. #define CPMAC_STATS_RX_CRC 0x0210
  122. #define CPMAC_STATS_RX_ALIGN 0x0214
  123. #define CPMAC_STATS_RX_OVER 0x0218
  124. #define CPMAC_STATS_RX_JABBER 0x021c
  125. #define CPMAC_STATS_RX_UNDER 0x0220
  126. #define CPMAC_STATS_RX_FRAG 0x0224
  127. #define CPMAC_STATS_RX_FILTER 0x0228
  128. #define CPMAC_STATS_RX_QOSFILTER 0x022c
  129. #define CPMAC_STATS_RX_OCTETS 0x0230
  130. #define CPMAC_STATS_TX_GOOD 0x0234
  131. #define CPMAC_STATS_TX_BCAST 0x0238
  132. #define CPMAC_STATS_TX_MCAST 0x023c
  133. #define CPMAC_STATS_TX_PAUSE 0x0240
  134. #define CPMAC_STATS_TX_DEFER 0x0244
  135. #define CPMAC_STATS_TX_COLLISION 0x0248
  136. #define CPMAC_STATS_TX_SINGLECOLL 0x024c
  137. #define CPMAC_STATS_TX_MULTICOLL 0x0250
  138. #define CPMAC_STATS_TX_EXCESSCOLL 0x0254
  139. #define CPMAC_STATS_TX_LATECOLL 0x0258
  140. #define CPMAC_STATS_TX_UNDERRUN 0x025c
  141. #define CPMAC_STATS_TX_CARRIERSENSE 0x0260
  142. #define CPMAC_STATS_TX_OCTETS 0x0264
  143. #define cpmac_read(base, reg) (readl((void __iomem *)(base) + (reg)))
  144. #define cpmac_write(base, reg, val) (writel(val, (void __iomem *)(base) + \
  145. (reg)))
  146. /* MDIO bus */
  147. #define CPMAC_MDIO_VERSION 0x0000
  148. #define CPMAC_MDIO_CONTROL 0x0004
  149. # define MDIOC_IDLE 0x80000000
  150. # define MDIOC_ENABLE 0x40000000
  151. # define MDIOC_PREAMBLE 0x00100000
  152. # define MDIOC_FAULT 0x00080000
  153. # define MDIOC_FAULTDETECT 0x00040000
  154. # define MDIOC_INTTEST 0x00020000
  155. # define MDIOC_CLKDIV(div) ((div) & 0xff)
  156. #define CPMAC_MDIO_ALIVE 0x0008
  157. #define CPMAC_MDIO_LINK 0x000c
  158. #define CPMAC_MDIO_ACCESS(channel) (0x0080 + (channel) * 8)
  159. # define MDIO_BUSY 0x80000000
  160. # define MDIO_WRITE 0x40000000
  161. # define MDIO_REG(reg) (((reg) & 0x1f) << 21)
  162. # define MDIO_PHY(phy) (((phy) & 0x1f) << 16)
  163. # define MDIO_DATA(data) ((data) & 0xffff)
  164. #define CPMAC_MDIO_PHYSEL(channel) (0x0084 + (channel) * 8)
  165. # define PHYSEL_LINKSEL 0x00000040
  166. # define PHYSEL_LINKINT 0x00000020
  167. struct cpmac_desc {
  168. u32 hw_next;
  169. u32 hw_data;
  170. u16 buflen;
  171. u16 bufflags;
  172. u16 datalen;
  173. u16 dataflags;
  174. #define CPMAC_SOP 0x8000
  175. #define CPMAC_EOP 0x4000
  176. #define CPMAC_OWN 0x2000
  177. #define CPMAC_EOQ 0x1000
  178. struct sk_buff *skb;
  179. struct cpmac_desc *next;
  180. struct cpmac_desc *prev;
  181. dma_addr_t mapping;
  182. dma_addr_t data_mapping;
  183. };
  184. struct cpmac_priv {
  185. spinlock_t lock;
  186. spinlock_t rx_lock;
  187. struct cpmac_desc *rx_head;
  188. int ring_size;
  189. struct cpmac_desc *desc_ring;
  190. dma_addr_t dma_ring;
  191. void __iomem *regs;
  192. struct mii_bus *mii_bus;
  193. struct phy_device *phy;
  194. char phy_name[MII_BUS_ID_SIZE + 3];
  195. int oldlink, oldspeed, oldduplex;
  196. u32 msg_enable;
  197. struct net_device *dev;
  198. struct work_struct reset_work;
  199. struct platform_device *pdev;
  200. struct napi_struct napi;
  201. atomic_t reset_pending;
  202. };
  203. static irqreturn_t cpmac_irq(int, void *);
  204. static void cpmac_hw_start(struct net_device *dev);
  205. static void cpmac_hw_stop(struct net_device *dev);
  206. static int cpmac_stop(struct net_device *dev);
  207. static int cpmac_open(struct net_device *dev);
  208. static void cpmac_dump_regs(struct net_device *dev)
  209. {
  210. int i;
  211. struct cpmac_priv *priv = netdev_priv(dev);
  212. for (i = 0; i < CPMAC_REG_END; i += 4) {
  213. if (i % 16 == 0) {
  214. if (i)
  215. pr_cont("\n");
  216. printk(KERN_DEBUG "%s: reg[%p]:", dev->name,
  217. priv->regs + i);
  218. }
  219. printk(" %08x", cpmac_read(priv->regs, i));
  220. }
  221. printk("\n");
  222. }
  223. static void cpmac_dump_desc(struct net_device *dev, struct cpmac_desc *desc)
  224. {
  225. int i;
  226. printk(KERN_DEBUG "%s: desc[%p]:", dev->name, desc);
  227. for (i = 0; i < sizeof(*desc) / 4; i++)
  228. printk(" %08x", ((u32 *)desc)[i]);
  229. printk("\n");
  230. }
  231. static void cpmac_dump_all_desc(struct net_device *dev)
  232. {
  233. struct cpmac_priv *priv = netdev_priv(dev);
  234. struct cpmac_desc *dump = priv->rx_head;
  235. do {
  236. cpmac_dump_desc(dev, dump);
  237. dump = dump->next;
  238. } while (dump != priv->rx_head);
  239. }
  240. static void cpmac_dump_skb(struct net_device *dev, struct sk_buff *skb)
  241. {
  242. int i;
  243. printk(KERN_DEBUG "%s: skb 0x%p, len=%d\n", dev->name, skb, skb->len);
  244. for (i = 0; i < skb->len; i++) {
  245. if (i % 16 == 0) {
  246. if (i)
  247. pr_cont("\n");
  248. printk(KERN_DEBUG "%s: data[%p]:", dev->name,
  249. skb->data + i);
  250. }
  251. printk(" %02x", ((u8 *)skb->data)[i]);
  252. }
  253. printk("\n");
  254. }
  255. static int cpmac_mdio_read(struct mii_bus *bus, int phy_id, int reg)
  256. {
  257. u32 val;
  258. while (cpmac_read(bus->priv, CPMAC_MDIO_ACCESS(0)) & MDIO_BUSY)
  259. cpu_relax();
  260. cpmac_write(bus->priv, CPMAC_MDIO_ACCESS(0), MDIO_BUSY | MDIO_REG(reg) |
  261. MDIO_PHY(phy_id));
  262. while ((val = cpmac_read(bus->priv, CPMAC_MDIO_ACCESS(0))) & MDIO_BUSY)
  263. cpu_relax();
  264. return MDIO_DATA(val);
  265. }
  266. static int cpmac_mdio_write(struct mii_bus *bus, int phy_id,
  267. int reg, u16 val)
  268. {
  269. while (cpmac_read(bus->priv, CPMAC_MDIO_ACCESS(0)) & MDIO_BUSY)
  270. cpu_relax();
  271. cpmac_write(bus->priv, CPMAC_MDIO_ACCESS(0), MDIO_BUSY | MDIO_WRITE |
  272. MDIO_REG(reg) | MDIO_PHY(phy_id) | MDIO_DATA(val));
  273. return 0;
  274. }
  275. static int cpmac_mdio_reset(struct mii_bus *bus)
  276. {
  277. struct clk *cpmac_clk;
  278. cpmac_clk = clk_get(&bus->dev, "cpmac");
  279. if (IS_ERR(cpmac_clk)) {
  280. printk(KERN_ERR "unable to get cpmac clock\n");
  281. return -1;
  282. }
  283. ar7_device_reset(AR7_RESET_BIT_MDIO);
  284. cpmac_write(bus->priv, CPMAC_MDIO_CONTROL, MDIOC_ENABLE |
  285. MDIOC_CLKDIV(clk_get_rate(cpmac_clk) / 2200000 - 1));
  286. return 0;
  287. }
  288. static int mii_irqs[PHY_MAX_ADDR] = { PHY_POLL, };
  289. static struct mii_bus *cpmac_mii;
  290. static int cpmac_config(struct net_device *dev, struct ifmap *map)
  291. {
  292. if (dev->flags & IFF_UP)
  293. return -EBUSY;
  294. /* Don't allow changing the I/O address */
  295. if (map->base_addr != dev->base_addr)
  296. return -EOPNOTSUPP;
  297. /* ignore other fields */
  298. return 0;
  299. }
  300. static void cpmac_set_multicast_list(struct net_device *dev)
  301. {
  302. struct netdev_hw_addr *ha;
  303. u8 tmp;
  304. u32 mbp, bit, hash[2] = { 0, };
  305. struct cpmac_priv *priv = netdev_priv(dev);
  306. mbp = cpmac_read(priv->regs, CPMAC_MBP);
  307. if (dev->flags & IFF_PROMISC) {
  308. cpmac_write(priv->regs, CPMAC_MBP, (mbp & ~MBP_PROMISCCHAN(0)) |
  309. MBP_RXPROMISC);
  310. } else {
  311. cpmac_write(priv->regs, CPMAC_MBP, mbp & ~MBP_RXPROMISC);
  312. if (dev->flags & IFF_ALLMULTI) {
  313. /* enable all multicast mode */
  314. cpmac_write(priv->regs, CPMAC_MAC_HASH_LO, 0xffffffff);
  315. cpmac_write(priv->regs, CPMAC_MAC_HASH_HI, 0xffffffff);
  316. } else {
  317. /*
  318. * cpmac uses some strange mac address hashing
  319. * (not crc32)
  320. */
  321. netdev_for_each_mc_addr(ha, dev) {
  322. bit = 0;
  323. tmp = ha->addr[0];
  324. bit ^= (tmp >> 2) ^ (tmp << 4);
  325. tmp = ha->addr[1];
  326. bit ^= (tmp >> 4) ^ (tmp << 2);
  327. tmp = ha->addr[2];
  328. bit ^= (tmp >> 6) ^ tmp;
  329. tmp = ha->addr[3];
  330. bit ^= (tmp >> 2) ^ (tmp << 4);
  331. tmp = ha->addr[4];
  332. bit ^= (tmp >> 4) ^ (tmp << 2);
  333. tmp = ha->addr[5];
  334. bit ^= (tmp >> 6) ^ tmp;
  335. bit &= 0x3f;
  336. hash[bit / 32] |= 1 << (bit % 32);
  337. }
  338. cpmac_write(priv->regs, CPMAC_MAC_HASH_LO, hash[0]);
  339. cpmac_write(priv->regs, CPMAC_MAC_HASH_HI, hash[1]);
  340. }
  341. }
  342. }
  343. static struct sk_buff *cpmac_rx_one(struct cpmac_priv *priv,
  344. struct cpmac_desc *desc)
  345. {
  346. struct sk_buff *skb, *result = NULL;
  347. if (unlikely(netif_msg_hw(priv)))
  348. cpmac_dump_desc(priv->dev, desc);
  349. cpmac_write(priv->regs, CPMAC_RX_ACK(0), (u32)desc->mapping);
  350. if (unlikely(!desc->datalen)) {
  351. if (netif_msg_rx_err(priv) && net_ratelimit())
  352. printk(KERN_WARNING "%s: rx: spurious interrupt\n",
  353. priv->dev->name);
  354. return NULL;
  355. }
  356. skb = netdev_alloc_skb_ip_align(priv->dev, CPMAC_SKB_SIZE);
  357. if (likely(skb)) {
  358. skb_put(desc->skb, desc->datalen);
  359. desc->skb->protocol = eth_type_trans(desc->skb, priv->dev);
  360. skb_checksum_none_assert(desc->skb);
  361. priv->dev->stats.rx_packets++;
  362. priv->dev->stats.rx_bytes += desc->datalen;
  363. result = desc->skb;
  364. dma_unmap_single(&priv->dev->dev, desc->data_mapping,
  365. CPMAC_SKB_SIZE, DMA_FROM_DEVICE);
  366. desc->skb = skb;
  367. desc->data_mapping = dma_map_single(&priv->dev->dev, skb->data,
  368. CPMAC_SKB_SIZE,
  369. DMA_FROM_DEVICE);
  370. desc->hw_data = (u32)desc->data_mapping;
  371. if (unlikely(netif_msg_pktdata(priv))) {
  372. printk(KERN_DEBUG "%s: received packet:\n",
  373. priv->dev->name);
  374. cpmac_dump_skb(priv->dev, result);
  375. }
  376. } else {
  377. if (netif_msg_rx_err(priv) && net_ratelimit())
  378. printk(KERN_WARNING
  379. "%s: low on skbs, dropping packet\n",
  380. priv->dev->name);
  381. priv->dev->stats.rx_dropped++;
  382. }
  383. desc->buflen = CPMAC_SKB_SIZE;
  384. desc->dataflags = CPMAC_OWN;
  385. return result;
  386. }
  387. static int cpmac_poll(struct napi_struct *napi, int budget)
  388. {
  389. struct sk_buff *skb;
  390. struct cpmac_desc *desc, *restart;
  391. struct cpmac_priv *priv = container_of(napi, struct cpmac_priv, napi);
  392. int received = 0, processed = 0;
  393. spin_lock(&priv->rx_lock);
  394. if (unlikely(!priv->rx_head)) {
  395. if (netif_msg_rx_err(priv) && net_ratelimit())
  396. printk(KERN_WARNING "%s: rx: polling, but no queue\n",
  397. priv->dev->name);
  398. spin_unlock(&priv->rx_lock);
  399. napi_complete(napi);
  400. return 0;
  401. }
  402. desc = priv->rx_head;
  403. restart = NULL;
  404. while (((desc->dataflags & CPMAC_OWN) == 0) && (received < budget)) {
  405. processed++;
  406. if ((desc->dataflags & CPMAC_EOQ) != 0) {
  407. /* The last update to eoq->hw_next didn't happen
  408. * soon enough, and the receiver stopped here.
  409. *Remember this descriptor so we can restart
  410. * the receiver after freeing some space.
  411. */
  412. if (unlikely(restart)) {
  413. if (netif_msg_rx_err(priv))
  414. printk(KERN_ERR "%s: poll found a"
  415. " duplicate EOQ: %p and %p\n",
  416. priv->dev->name, restart, desc);
  417. goto fatal_error;
  418. }
  419. restart = desc->next;
  420. }
  421. skb = cpmac_rx_one(priv, desc);
  422. if (likely(skb)) {
  423. netif_receive_skb(skb);
  424. received++;
  425. }
  426. desc = desc->next;
  427. }
  428. if (desc != priv->rx_head) {
  429. /* We freed some buffers, but not the whole ring,
  430. * add what we did free to the rx list */
  431. desc->prev->hw_next = (u32)0;
  432. priv->rx_head->prev->hw_next = priv->rx_head->mapping;
  433. }
  434. /* Optimization: If we did not actually process an EOQ (perhaps because
  435. * of quota limits), check to see if the tail of the queue has EOQ set.
  436. * We should immediately restart in that case so that the receiver can
  437. * restart and run in parallel with more packet processing.
  438. * This lets us handle slightly larger bursts before running
  439. * out of ring space (assuming dev->weight < ring_size) */
  440. if (!restart &&
  441. (priv->rx_head->prev->dataflags & (CPMAC_OWN|CPMAC_EOQ))
  442. == CPMAC_EOQ &&
  443. (priv->rx_head->dataflags & CPMAC_OWN) != 0) {
  444. /* reset EOQ so the poll loop (above) doesn't try to
  445. * restart this when it eventually gets to this descriptor.
  446. */
  447. priv->rx_head->prev->dataflags &= ~CPMAC_EOQ;
  448. restart = priv->rx_head;
  449. }
  450. if (restart) {
  451. priv->dev->stats.rx_errors++;
  452. priv->dev->stats.rx_fifo_errors++;
  453. if (netif_msg_rx_err(priv) && net_ratelimit())
  454. printk(KERN_WARNING "%s: rx dma ring overrun\n",
  455. priv->dev->name);
  456. if (unlikely((restart->dataflags & CPMAC_OWN) == 0)) {
  457. if (netif_msg_drv(priv))
  458. printk(KERN_ERR "%s: cpmac_poll is trying to "
  459. "restart rx from a descriptor that's "
  460. "not free: %p\n",
  461. priv->dev->name, restart);
  462. goto fatal_error;
  463. }
  464. cpmac_write(priv->regs, CPMAC_RX_PTR(0), restart->mapping);
  465. }
  466. priv->rx_head = desc;
  467. spin_unlock(&priv->rx_lock);
  468. if (unlikely(netif_msg_rx_status(priv)))
  469. printk(KERN_DEBUG "%s: poll processed %d packets\n",
  470. priv->dev->name, received);
  471. if (processed == 0) {
  472. /* we ran out of packets to read,
  473. * revert to interrupt-driven mode */
  474. napi_complete(napi);
  475. cpmac_write(priv->regs, CPMAC_RX_INT_ENABLE, 1);
  476. return 0;
  477. }
  478. return 1;
  479. fatal_error:
  480. /* Something went horribly wrong.
  481. * Reset hardware to try to recover rather than wedging. */
  482. if (netif_msg_drv(priv)) {
  483. printk(KERN_ERR "%s: cpmac_poll is confused. "
  484. "Resetting hardware\n", priv->dev->name);
  485. cpmac_dump_all_desc(priv->dev);
  486. printk(KERN_DEBUG "%s: RX_PTR(0)=0x%08x RX_ACK(0)=0x%08x\n",
  487. priv->dev->name,
  488. cpmac_read(priv->regs, CPMAC_RX_PTR(0)),
  489. cpmac_read(priv->regs, CPMAC_RX_ACK(0)));
  490. }
  491. spin_unlock(&priv->rx_lock);
  492. napi_complete(napi);
  493. netif_tx_stop_all_queues(priv->dev);
  494. napi_disable(&priv->napi);
  495. atomic_inc(&priv->reset_pending);
  496. cpmac_hw_stop(priv->dev);
  497. if (!schedule_work(&priv->reset_work))
  498. atomic_dec(&priv->reset_pending);
  499. return 0;
  500. }
  501. static int cpmac_start_xmit(struct sk_buff *skb, struct net_device *dev)
  502. {
  503. int queue, len;
  504. struct cpmac_desc *desc;
  505. struct cpmac_priv *priv = netdev_priv(dev);
  506. if (unlikely(atomic_read(&priv->reset_pending)))
  507. return NETDEV_TX_BUSY;
  508. if (unlikely(skb_padto(skb, ETH_ZLEN)))
  509. return NETDEV_TX_OK;
  510. len = max(skb->len, ETH_ZLEN);
  511. queue = skb_get_queue_mapping(skb);
  512. netif_stop_subqueue(dev, queue);
  513. desc = &priv->desc_ring[queue];
  514. if (unlikely(desc->dataflags & CPMAC_OWN)) {
  515. if (netif_msg_tx_err(priv) && net_ratelimit())
  516. printk(KERN_WARNING "%s: tx dma ring full\n",
  517. dev->name);
  518. return NETDEV_TX_BUSY;
  519. }
  520. spin_lock(&priv->lock);
  521. spin_unlock(&priv->lock);
  522. desc->dataflags = CPMAC_SOP | CPMAC_EOP | CPMAC_OWN;
  523. desc->skb = skb;
  524. desc->data_mapping = dma_map_single(&dev->dev, skb->data, len,
  525. DMA_TO_DEVICE);
  526. desc->hw_data = (u32)desc->data_mapping;
  527. desc->datalen = len;
  528. desc->buflen = len;
  529. if (unlikely(netif_msg_tx_queued(priv)))
  530. printk(KERN_DEBUG "%s: sending 0x%p, len=%d\n", dev->name, skb,
  531. skb->len);
  532. if (unlikely(netif_msg_hw(priv)))
  533. cpmac_dump_desc(dev, desc);
  534. if (unlikely(netif_msg_pktdata(priv)))
  535. cpmac_dump_skb(dev, skb);
  536. cpmac_write(priv->regs, CPMAC_TX_PTR(queue), (u32)desc->mapping);
  537. return NETDEV_TX_OK;
  538. }
  539. static void cpmac_end_xmit(struct net_device *dev, int queue)
  540. {
  541. struct cpmac_desc *desc;
  542. struct cpmac_priv *priv = netdev_priv(dev);
  543. desc = &priv->desc_ring[queue];
  544. cpmac_write(priv->regs, CPMAC_TX_ACK(queue), (u32)desc->mapping);
  545. if (likely(desc->skb)) {
  546. spin_lock(&priv->lock);
  547. dev->stats.tx_packets++;
  548. dev->stats.tx_bytes += desc->skb->len;
  549. spin_unlock(&priv->lock);
  550. dma_unmap_single(&dev->dev, desc->data_mapping, desc->skb->len,
  551. DMA_TO_DEVICE);
  552. if (unlikely(netif_msg_tx_done(priv)))
  553. printk(KERN_DEBUG "%s: sent 0x%p, len=%d\n", dev->name,
  554. desc->skb, desc->skb->len);
  555. dev_kfree_skb_irq(desc->skb);
  556. desc->skb = NULL;
  557. if (__netif_subqueue_stopped(dev, queue))
  558. netif_wake_subqueue(dev, queue);
  559. } else {
  560. if (netif_msg_tx_err(priv) && net_ratelimit())
  561. printk(KERN_WARNING
  562. "%s: end_xmit: spurious interrupt\n", dev->name);
  563. if (__netif_subqueue_stopped(dev, queue))
  564. netif_wake_subqueue(dev, queue);
  565. }
  566. }
  567. static void cpmac_hw_stop(struct net_device *dev)
  568. {
  569. int i;
  570. struct cpmac_priv *priv = netdev_priv(dev);
  571. struct plat_cpmac_data *pdata = priv->pdev->dev.platform_data;
  572. ar7_device_reset(pdata->reset_bit);
  573. cpmac_write(priv->regs, CPMAC_RX_CONTROL,
  574. cpmac_read(priv->regs, CPMAC_RX_CONTROL) & ~1);
  575. cpmac_write(priv->regs, CPMAC_TX_CONTROL,
  576. cpmac_read(priv->regs, CPMAC_TX_CONTROL) & ~1);
  577. for (i = 0; i < 8; i++) {
  578. cpmac_write(priv->regs, CPMAC_TX_PTR(i), 0);
  579. cpmac_write(priv->regs, CPMAC_RX_PTR(i), 0);
  580. }
  581. cpmac_write(priv->regs, CPMAC_UNICAST_CLEAR, 0xff);
  582. cpmac_write(priv->regs, CPMAC_RX_INT_CLEAR, 0xff);
  583. cpmac_write(priv->regs, CPMAC_TX_INT_CLEAR, 0xff);
  584. cpmac_write(priv->regs, CPMAC_MAC_INT_CLEAR, 0xff);
  585. cpmac_write(priv->regs, CPMAC_MAC_CONTROL,
  586. cpmac_read(priv->regs, CPMAC_MAC_CONTROL) & ~MAC_MII);
  587. }
  588. static void cpmac_hw_start(struct net_device *dev)
  589. {
  590. int i;
  591. struct cpmac_priv *priv = netdev_priv(dev);
  592. struct plat_cpmac_data *pdata = priv->pdev->dev.platform_data;
  593. ar7_device_reset(pdata->reset_bit);
  594. for (i = 0; i < 8; i++) {
  595. cpmac_write(priv->regs, CPMAC_TX_PTR(i), 0);
  596. cpmac_write(priv->regs, CPMAC_RX_PTR(i), 0);
  597. }
  598. cpmac_write(priv->regs, CPMAC_RX_PTR(0), priv->rx_head->mapping);
  599. cpmac_write(priv->regs, CPMAC_MBP, MBP_RXSHORT | MBP_RXBCAST |
  600. MBP_RXMCAST);
  601. cpmac_write(priv->regs, CPMAC_BUFFER_OFFSET, 0);
  602. for (i = 0; i < 8; i++)
  603. cpmac_write(priv->regs, CPMAC_MAC_ADDR_LO(i), dev->dev_addr[5]);
  604. cpmac_write(priv->regs, CPMAC_MAC_ADDR_MID, dev->dev_addr[4]);
  605. cpmac_write(priv->regs, CPMAC_MAC_ADDR_HI, dev->dev_addr[0] |
  606. (dev->dev_addr[1] << 8) | (dev->dev_addr[2] << 16) |
  607. (dev->dev_addr[3] << 24));
  608. cpmac_write(priv->regs, CPMAC_MAX_LENGTH, CPMAC_SKB_SIZE);
  609. cpmac_write(priv->regs, CPMAC_UNICAST_CLEAR, 0xff);
  610. cpmac_write(priv->regs, CPMAC_RX_INT_CLEAR, 0xff);
  611. cpmac_write(priv->regs, CPMAC_TX_INT_CLEAR, 0xff);
  612. cpmac_write(priv->regs, CPMAC_MAC_INT_CLEAR, 0xff);
  613. cpmac_write(priv->regs, CPMAC_UNICAST_ENABLE, 1);
  614. cpmac_write(priv->regs, CPMAC_RX_INT_ENABLE, 1);
  615. cpmac_write(priv->regs, CPMAC_TX_INT_ENABLE, 0xff);
  616. cpmac_write(priv->regs, CPMAC_MAC_INT_ENABLE, 3);
  617. cpmac_write(priv->regs, CPMAC_RX_CONTROL,
  618. cpmac_read(priv->regs, CPMAC_RX_CONTROL) | 1);
  619. cpmac_write(priv->regs, CPMAC_TX_CONTROL,
  620. cpmac_read(priv->regs, CPMAC_TX_CONTROL) | 1);
  621. cpmac_write(priv->regs, CPMAC_MAC_CONTROL,
  622. cpmac_read(priv->regs, CPMAC_MAC_CONTROL) | MAC_MII |
  623. MAC_FDX);
  624. }
  625. static void cpmac_clear_rx(struct net_device *dev)
  626. {
  627. struct cpmac_priv *priv = netdev_priv(dev);
  628. struct cpmac_desc *desc;
  629. int i;
  630. if (unlikely(!priv->rx_head))
  631. return;
  632. desc = priv->rx_head;
  633. for (i = 0; i < priv->ring_size; i++) {
  634. if ((desc->dataflags & CPMAC_OWN) == 0) {
  635. if (netif_msg_rx_err(priv) && net_ratelimit())
  636. printk(KERN_WARNING "%s: packet dropped\n",
  637. dev->name);
  638. if (unlikely(netif_msg_hw(priv)))
  639. cpmac_dump_desc(dev, desc);
  640. desc->dataflags = CPMAC_OWN;
  641. dev->stats.rx_dropped++;
  642. }
  643. desc->hw_next = desc->next->mapping;
  644. desc = desc->next;
  645. }
  646. priv->rx_head->prev->hw_next = 0;
  647. }
  648. static void cpmac_clear_tx(struct net_device *dev)
  649. {
  650. struct cpmac_priv *priv = netdev_priv(dev);
  651. int i;
  652. if (unlikely(!priv->desc_ring))
  653. return;
  654. for (i = 0; i < CPMAC_QUEUES; i++) {
  655. priv->desc_ring[i].dataflags = 0;
  656. if (priv->desc_ring[i].skb) {
  657. dev_kfree_skb_any(priv->desc_ring[i].skb);
  658. priv->desc_ring[i].skb = NULL;
  659. }
  660. }
  661. }
  662. static void cpmac_hw_error(struct work_struct *work)
  663. {
  664. struct cpmac_priv *priv =
  665. container_of(work, struct cpmac_priv, reset_work);
  666. spin_lock(&priv->rx_lock);
  667. cpmac_clear_rx(priv->dev);
  668. spin_unlock(&priv->rx_lock);
  669. cpmac_clear_tx(priv->dev);
  670. cpmac_hw_start(priv->dev);
  671. barrier();
  672. atomic_dec(&priv->reset_pending);
  673. netif_tx_wake_all_queues(priv->dev);
  674. cpmac_write(priv->regs, CPMAC_MAC_INT_ENABLE, 3);
  675. }
  676. static void cpmac_check_status(struct net_device *dev)
  677. {
  678. struct cpmac_priv *priv = netdev_priv(dev);
  679. u32 macstatus = cpmac_read(priv->regs, CPMAC_MAC_STATUS);
  680. int rx_channel = (macstatus >> 8) & 7;
  681. int rx_code = (macstatus >> 12) & 15;
  682. int tx_channel = (macstatus >> 16) & 7;
  683. int tx_code = (macstatus >> 20) & 15;
  684. if (rx_code || tx_code) {
  685. if (netif_msg_drv(priv) && net_ratelimit()) {
  686. /* Can't find any documentation on what these
  687. *error codes actually are. So just log them and hope..
  688. */
  689. if (rx_code)
  690. printk(KERN_WARNING "%s: host error %d on rx "
  691. "channel %d (macstatus %08x), resetting\n",
  692. dev->name, rx_code, rx_channel, macstatus);
  693. if (tx_code)
  694. printk(KERN_WARNING "%s: host error %d on tx "
  695. "channel %d (macstatus %08x), resetting\n",
  696. dev->name, tx_code, tx_channel, macstatus);
  697. }
  698. netif_tx_stop_all_queues(dev);
  699. cpmac_hw_stop(dev);
  700. if (schedule_work(&priv->reset_work))
  701. atomic_inc(&priv->reset_pending);
  702. if (unlikely(netif_msg_hw(priv)))
  703. cpmac_dump_regs(dev);
  704. }
  705. cpmac_write(priv->regs, CPMAC_MAC_INT_CLEAR, 0xff);
  706. }
  707. static irqreturn_t cpmac_irq(int irq, void *dev_id)
  708. {
  709. struct net_device *dev = dev_id;
  710. struct cpmac_priv *priv;
  711. int queue;
  712. u32 status;
  713. priv = netdev_priv(dev);
  714. status = cpmac_read(priv->regs, CPMAC_MAC_INT_VECTOR);
  715. if (unlikely(netif_msg_intr(priv)))
  716. printk(KERN_DEBUG "%s: interrupt status: 0x%08x\n", dev->name,
  717. status);
  718. if (status & MAC_INT_TX)
  719. cpmac_end_xmit(dev, (status & 7));
  720. if (status & MAC_INT_RX) {
  721. queue = (status >> 8) & 7;
  722. if (napi_schedule_prep(&priv->napi)) {
  723. cpmac_write(priv->regs, CPMAC_RX_INT_CLEAR, 1 << queue);
  724. __napi_schedule(&priv->napi);
  725. }
  726. }
  727. cpmac_write(priv->regs, CPMAC_MAC_EOI_VECTOR, 0);
  728. if (unlikely(status & (MAC_INT_HOST | MAC_INT_STATUS)))
  729. cpmac_check_status(dev);
  730. return IRQ_HANDLED;
  731. }
  732. static void cpmac_tx_timeout(struct net_device *dev)
  733. {
  734. struct cpmac_priv *priv = netdev_priv(dev);
  735. spin_lock(&priv->lock);
  736. dev->stats.tx_errors++;
  737. spin_unlock(&priv->lock);
  738. if (netif_msg_tx_err(priv) && net_ratelimit())
  739. printk(KERN_WARNING "%s: transmit timeout\n", dev->name);
  740. atomic_inc(&priv->reset_pending);
  741. barrier();
  742. cpmac_clear_tx(dev);
  743. barrier();
  744. atomic_dec(&priv->reset_pending);
  745. netif_tx_wake_all_queues(priv->dev);
  746. }
  747. static int cpmac_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd)
  748. {
  749. struct cpmac_priv *priv = netdev_priv(dev);
  750. if (!(netif_running(dev)))
  751. return -EINVAL;
  752. if (!priv->phy)
  753. return -EINVAL;
  754. return phy_mii_ioctl(priv->phy, ifr, cmd);
  755. }
  756. static int cpmac_get_settings(struct net_device *dev, struct ethtool_cmd *cmd)
  757. {
  758. struct cpmac_priv *priv = netdev_priv(dev);
  759. if (priv->phy)
  760. return phy_ethtool_gset(priv->phy, cmd);
  761. return -EINVAL;
  762. }
  763. static int cpmac_set_settings(struct net_device *dev, struct ethtool_cmd *cmd)
  764. {
  765. struct cpmac_priv *priv = netdev_priv(dev);
  766. if (!capable(CAP_NET_ADMIN))
  767. return -EPERM;
  768. if (priv->phy)
  769. return phy_ethtool_sset(priv->phy, cmd);
  770. return -EINVAL;
  771. }
  772. static void cpmac_get_ringparam(struct net_device *dev,
  773. struct ethtool_ringparam *ring)
  774. {
  775. struct cpmac_priv *priv = netdev_priv(dev);
  776. ring->rx_max_pending = 1024;
  777. ring->rx_mini_max_pending = 1;
  778. ring->rx_jumbo_max_pending = 1;
  779. ring->tx_max_pending = 1;
  780. ring->rx_pending = priv->ring_size;
  781. ring->rx_mini_pending = 1;
  782. ring->rx_jumbo_pending = 1;
  783. ring->tx_pending = 1;
  784. }
  785. static int cpmac_set_ringparam(struct net_device *dev,
  786. struct ethtool_ringparam *ring)
  787. {
  788. struct cpmac_priv *priv = netdev_priv(dev);
  789. if (netif_running(dev))
  790. return -EBUSY;
  791. priv->ring_size = ring->rx_pending;
  792. return 0;
  793. }
  794. static void cpmac_get_drvinfo(struct net_device *dev,
  795. struct ethtool_drvinfo *info)
  796. {
  797. strlcpy(info->driver, "cpmac", sizeof(info->driver));
  798. strlcpy(info->version, CPMAC_VERSION, sizeof(info->version));
  799. snprintf(info->bus_info, sizeof(info->bus_info), "%s", "cpmac");
  800. info->regdump_len = 0;
  801. }
  802. static const struct ethtool_ops cpmac_ethtool_ops = {
  803. .get_settings = cpmac_get_settings,
  804. .set_settings = cpmac_set_settings,
  805. .get_drvinfo = cpmac_get_drvinfo,
  806. .get_link = ethtool_op_get_link,
  807. .get_ringparam = cpmac_get_ringparam,
  808. .set_ringparam = cpmac_set_ringparam,
  809. };
  810. static void cpmac_adjust_link(struct net_device *dev)
  811. {
  812. struct cpmac_priv *priv = netdev_priv(dev);
  813. int new_state = 0;
  814. spin_lock(&priv->lock);
  815. if (priv->phy->link) {
  816. netif_tx_start_all_queues(dev);
  817. if (priv->phy->duplex != priv->oldduplex) {
  818. new_state = 1;
  819. priv->oldduplex = priv->phy->duplex;
  820. }
  821. if (priv->phy->speed != priv->oldspeed) {
  822. new_state = 1;
  823. priv->oldspeed = priv->phy->speed;
  824. }
  825. if (!priv->oldlink) {
  826. new_state = 1;
  827. priv->oldlink = 1;
  828. }
  829. } else if (priv->oldlink) {
  830. new_state = 1;
  831. priv->oldlink = 0;
  832. priv->oldspeed = 0;
  833. priv->oldduplex = -1;
  834. }
  835. if (new_state && netif_msg_link(priv) && net_ratelimit())
  836. phy_print_status(priv->phy);
  837. spin_unlock(&priv->lock);
  838. }
  839. static int cpmac_open(struct net_device *dev)
  840. {
  841. int i, size, res;
  842. struct cpmac_priv *priv = netdev_priv(dev);
  843. struct resource *mem;
  844. struct cpmac_desc *desc;
  845. struct sk_buff *skb;
  846. mem = platform_get_resource_byname(priv->pdev, IORESOURCE_MEM, "regs");
  847. if (!request_mem_region(mem->start, resource_size(mem), dev->name)) {
  848. if (netif_msg_drv(priv))
  849. printk(KERN_ERR "%s: failed to request registers\n",
  850. dev->name);
  851. res = -ENXIO;
  852. goto fail_reserve;
  853. }
  854. priv->regs = ioremap(mem->start, resource_size(mem));
  855. if (!priv->regs) {
  856. if (netif_msg_drv(priv))
  857. printk(KERN_ERR "%s: failed to remap registers\n",
  858. dev->name);
  859. res = -ENXIO;
  860. goto fail_remap;
  861. }
  862. size = priv->ring_size + CPMAC_QUEUES;
  863. priv->desc_ring = dma_alloc_coherent(&dev->dev,
  864. sizeof(struct cpmac_desc) * size,
  865. &priv->dma_ring,
  866. GFP_KERNEL);
  867. if (!priv->desc_ring) {
  868. res = -ENOMEM;
  869. goto fail_alloc;
  870. }
  871. for (i = 0; i < size; i++)
  872. priv->desc_ring[i].mapping = priv->dma_ring + sizeof(*desc) * i;
  873. priv->rx_head = &priv->desc_ring[CPMAC_QUEUES];
  874. for (i = 0, desc = priv->rx_head; i < priv->ring_size; i++, desc++) {
  875. skb = netdev_alloc_skb_ip_align(dev, CPMAC_SKB_SIZE);
  876. if (unlikely(!skb)) {
  877. res = -ENOMEM;
  878. goto fail_desc;
  879. }
  880. desc->skb = skb;
  881. desc->data_mapping = dma_map_single(&dev->dev, skb->data,
  882. CPMAC_SKB_SIZE,
  883. DMA_FROM_DEVICE);
  884. desc->hw_data = (u32)desc->data_mapping;
  885. desc->buflen = CPMAC_SKB_SIZE;
  886. desc->dataflags = CPMAC_OWN;
  887. desc->next = &priv->rx_head[(i + 1) % priv->ring_size];
  888. desc->next->prev = desc;
  889. desc->hw_next = (u32)desc->next->mapping;
  890. }
  891. priv->rx_head->prev->hw_next = (u32)0;
  892. res = request_irq(dev->irq, cpmac_irq, IRQF_SHARED, dev->name, dev);
  893. if (res) {
  894. if (netif_msg_drv(priv))
  895. printk(KERN_ERR "%s: failed to obtain irq\n",
  896. dev->name);
  897. goto fail_irq;
  898. }
  899. atomic_set(&priv->reset_pending, 0);
  900. INIT_WORK(&priv->reset_work, cpmac_hw_error);
  901. cpmac_hw_start(dev);
  902. napi_enable(&priv->napi);
  903. priv->phy->state = PHY_CHANGELINK;
  904. phy_start(priv->phy);
  905. return 0;
  906. fail_irq:
  907. fail_desc:
  908. for (i = 0; i < priv->ring_size; i++) {
  909. if (priv->rx_head[i].skb) {
  910. dma_unmap_single(&dev->dev,
  911. priv->rx_head[i].data_mapping,
  912. CPMAC_SKB_SIZE,
  913. DMA_FROM_DEVICE);
  914. kfree_skb(priv->rx_head[i].skb);
  915. }
  916. }
  917. fail_alloc:
  918. kfree(priv->desc_ring);
  919. iounmap(priv->regs);
  920. fail_remap:
  921. release_mem_region(mem->start, resource_size(mem));
  922. fail_reserve:
  923. return res;
  924. }
  925. static int cpmac_stop(struct net_device *dev)
  926. {
  927. int i;
  928. struct cpmac_priv *priv = netdev_priv(dev);
  929. struct resource *mem;
  930. netif_tx_stop_all_queues(dev);
  931. cancel_work_sync(&priv->reset_work);
  932. napi_disable(&priv->napi);
  933. phy_stop(priv->phy);
  934. cpmac_hw_stop(dev);
  935. for (i = 0; i < 8; i++)
  936. cpmac_write(priv->regs, CPMAC_TX_PTR(i), 0);
  937. cpmac_write(priv->regs, CPMAC_RX_PTR(0), 0);
  938. cpmac_write(priv->regs, CPMAC_MBP, 0);
  939. free_irq(dev->irq, dev);
  940. iounmap(priv->regs);
  941. mem = platform_get_resource_byname(priv->pdev, IORESOURCE_MEM, "regs");
  942. release_mem_region(mem->start, resource_size(mem));
  943. priv->rx_head = &priv->desc_ring[CPMAC_QUEUES];
  944. for (i = 0; i < priv->ring_size; i++) {
  945. if (priv->rx_head[i].skb) {
  946. dma_unmap_single(&dev->dev,
  947. priv->rx_head[i].data_mapping,
  948. CPMAC_SKB_SIZE,
  949. DMA_FROM_DEVICE);
  950. kfree_skb(priv->rx_head[i].skb);
  951. }
  952. }
  953. dma_free_coherent(&dev->dev, sizeof(struct cpmac_desc) *
  954. (CPMAC_QUEUES + priv->ring_size),
  955. priv->desc_ring, priv->dma_ring);
  956. return 0;
  957. }
  958. static const struct net_device_ops cpmac_netdev_ops = {
  959. .ndo_open = cpmac_open,
  960. .ndo_stop = cpmac_stop,
  961. .ndo_start_xmit = cpmac_start_xmit,
  962. .ndo_tx_timeout = cpmac_tx_timeout,
  963. .ndo_set_rx_mode = cpmac_set_multicast_list,
  964. .ndo_do_ioctl = cpmac_ioctl,
  965. .ndo_set_config = cpmac_config,
  966. .ndo_change_mtu = eth_change_mtu,
  967. .ndo_validate_addr = eth_validate_addr,
  968. .ndo_set_mac_address = eth_mac_addr,
  969. };
  970. static int external_switch;
  971. static int cpmac_probe(struct platform_device *pdev)
  972. {
  973. int rc, phy_id;
  974. char mdio_bus_id[MII_BUS_ID_SIZE];
  975. struct resource *mem;
  976. struct cpmac_priv *priv;
  977. struct net_device *dev;
  978. struct plat_cpmac_data *pdata;
  979. pdata = pdev->dev.platform_data;
  980. if (external_switch || dumb_switch) {
  981. strncpy(mdio_bus_id, "fixed-0", MII_BUS_ID_SIZE); /* fixed phys bus */
  982. phy_id = pdev->id;
  983. } else {
  984. for (phy_id = 0; phy_id < PHY_MAX_ADDR; phy_id++) {
  985. if (!(pdata->phy_mask & (1 << phy_id)))
  986. continue;
  987. if (!cpmac_mii->phy_map[phy_id])
  988. continue;
  989. strncpy(mdio_bus_id, cpmac_mii->id, MII_BUS_ID_SIZE);
  990. break;
  991. }
  992. }
  993. if (phy_id == PHY_MAX_ADDR) {
  994. dev_err(&pdev->dev, "no PHY present, falling back "
  995. "to switch on MDIO bus 0\n");
  996. strncpy(mdio_bus_id, "fixed-0", MII_BUS_ID_SIZE); /* fixed phys bus */
  997. phy_id = pdev->id;
  998. }
  999. dev = alloc_etherdev_mq(sizeof(*priv), CPMAC_QUEUES);
  1000. if (!dev)
  1001. return -ENOMEM;
  1002. platform_set_drvdata(pdev, dev);
  1003. priv = netdev_priv(dev);
  1004. priv->pdev = pdev;
  1005. mem = platform_get_resource_byname(pdev, IORESOURCE_MEM, "regs");
  1006. if (!mem) {
  1007. rc = -ENODEV;
  1008. goto fail;
  1009. }
  1010. dev->irq = platform_get_irq_byname(pdev, "irq");
  1011. dev->netdev_ops = &cpmac_netdev_ops;
  1012. dev->ethtool_ops = &cpmac_ethtool_ops;
  1013. netif_napi_add(dev, &priv->napi, cpmac_poll, 64);
  1014. spin_lock_init(&priv->lock);
  1015. spin_lock_init(&priv->rx_lock);
  1016. priv->dev = dev;
  1017. priv->ring_size = 64;
  1018. priv->msg_enable = netif_msg_init(debug_level, 0xff);
  1019. memcpy(dev->dev_addr, pdata->dev_addr, sizeof(pdata->dev_addr));
  1020. snprintf(priv->phy_name, MII_BUS_ID_SIZE, PHY_ID_FMT,
  1021. mdio_bus_id, phy_id);
  1022. priv->phy = phy_connect(dev, priv->phy_name, cpmac_adjust_link,
  1023. PHY_INTERFACE_MODE_MII);
  1024. if (IS_ERR(priv->phy)) {
  1025. if (netif_msg_drv(priv))
  1026. printk(KERN_ERR "%s: Could not attach to PHY\n",
  1027. dev->name);
  1028. rc = PTR_ERR(priv->phy);
  1029. goto fail;
  1030. }
  1031. rc = register_netdev(dev);
  1032. if (rc) {
  1033. printk(KERN_ERR "cpmac: error %i registering device %s\n", rc,
  1034. dev->name);
  1035. goto fail;
  1036. }
  1037. if (netif_msg_probe(priv)) {
  1038. printk(KERN_INFO
  1039. "cpmac: device %s (regs: %p, irq: %d, phy: %s, "
  1040. "mac: %pM)\n", dev->name, (void *)mem->start, dev->irq,
  1041. priv->phy_name, dev->dev_addr);
  1042. }
  1043. return 0;
  1044. fail:
  1045. free_netdev(dev);
  1046. return rc;
  1047. }
  1048. static int cpmac_remove(struct platform_device *pdev)
  1049. {
  1050. struct net_device *dev = platform_get_drvdata(pdev);
  1051. unregister_netdev(dev);
  1052. free_netdev(dev);
  1053. return 0;
  1054. }
  1055. static struct platform_driver cpmac_driver = {
  1056. .driver.name = "cpmac",
  1057. .driver.owner = THIS_MODULE,
  1058. .probe = cpmac_probe,
  1059. .remove = cpmac_remove,
  1060. };
  1061. int cpmac_init(void)
  1062. {
  1063. u32 mask;
  1064. int i, res;
  1065. cpmac_mii = mdiobus_alloc();
  1066. if (cpmac_mii == NULL)
  1067. return -ENOMEM;
  1068. cpmac_mii->name = "cpmac-mii";
  1069. cpmac_mii->read = cpmac_mdio_read;
  1070. cpmac_mii->write = cpmac_mdio_write;
  1071. cpmac_mii->reset = cpmac_mdio_reset;
  1072. cpmac_mii->irq = mii_irqs;
  1073. cpmac_mii->priv = ioremap(AR7_REGS_MDIO, 256);
  1074. if (!cpmac_mii->priv) {
  1075. printk(KERN_ERR "Can't ioremap mdio registers\n");
  1076. res = -ENXIO;
  1077. goto fail_alloc;
  1078. }
  1079. #warning FIXME: unhardcode gpio&reset bits
  1080. ar7_gpio_disable(26);
  1081. ar7_gpio_disable(27);
  1082. ar7_device_reset(AR7_RESET_BIT_CPMAC_LO);
  1083. ar7_device_reset(AR7_RESET_BIT_CPMAC_HI);
  1084. ar7_device_reset(AR7_RESET_BIT_EPHY);
  1085. cpmac_mii->reset(cpmac_mii);
  1086. for (i = 0; i < 300; i++) {
  1087. mask = cpmac_read(cpmac_mii->priv, CPMAC_MDIO_ALIVE);
  1088. if (mask)
  1089. break;
  1090. else
  1091. msleep(10);
  1092. }
  1093. mask &= 0x7fffffff;
  1094. if (mask & (mask - 1)) {
  1095. external_switch = 1;
  1096. mask = 0;
  1097. }
  1098. cpmac_mii->phy_mask = ~(mask | 0x80000000);
  1099. snprintf(cpmac_mii->id, MII_BUS_ID_SIZE, "cpmac-1");
  1100. res = mdiobus_register(cpmac_mii);
  1101. if (res)
  1102. goto fail_mii;
  1103. res = platform_driver_register(&cpmac_driver);
  1104. if (res)
  1105. goto fail_cpmac;
  1106. return 0;
  1107. fail_cpmac:
  1108. mdiobus_unregister(cpmac_mii);
  1109. fail_mii:
  1110. iounmap(cpmac_mii->priv);
  1111. fail_alloc:
  1112. mdiobus_free(cpmac_mii);
  1113. return res;
  1114. }
  1115. void cpmac_exit(void)
  1116. {
  1117. platform_driver_unregister(&cpmac_driver);
  1118. mdiobus_unregister(cpmac_mii);
  1119. iounmap(cpmac_mii->priv);
  1120. mdiobus_free(cpmac_mii);
  1121. }
  1122. module_init(cpmac_init);
  1123. module_exit(cpmac_exit);