1
2
3
4
5
6
7
8#include <common.h>
9#include <clk.h>
10#include <dm.h>
11#include <linux/err.h>
12#include <malloc.h>
13#include <miiphy.h>
14#include <net.h>
15#include <asm/io.h>
16#include <asm/arch/clock.h>
17#include <asm/arch/gpio.h>
18
19
20struct emac_regs {
21 u32 ctl;
22 u32 tx_mode;
23 u32 tx_flow;
24 u32 tx_ctl0;
25 u32 tx_ctl1;
26 u32 tx_ins;
27 u32 tx_pl0;
28 u32 tx_pl1;
29 u32 tx_sta;
30 u32 tx_io_data;
31 u32 tx_io_data1;
32 u32 tx_tsvl0;
33 u32 tx_tsvh0;
34 u32 tx_tsvl1;
35 u32 tx_tsvh1;
36 u32 rx_ctl;
37 u32 rx_hash0;
38 u32 rx_hash1;
39 u32 rx_sta;
40 u32 rx_io_data;
41 u32 rx_fbc;
42 u32 int_ctl;
43 u32 int_sta;
44 u32 mac_ctl0;
45 u32 mac_ctl1;
46 u32 mac_ipgt;
47 u32 mac_ipgr;
48 u32 mac_clrt;
49 u32 mac_maxf;
50 u32 mac_supp;
51 u32 mac_test;
52 u32 mac_mcfg;
53 u32 mac_mcmd;
54 u32 mac_madr;
55 u32 mac_mwtd;
56 u32 mac_mrdd;
57 u32 mac_mind;
58 u32 mac_ssrr;
59 u32 mac_a0;
60 u32 mac_a1;
61};
62
63
64struct sunxi_sramc_regs {
65 u32 ctrl0;
66 u32 ctrl1;
67};
68
69
70#define EMAC_TX_AB_M (0x1 << 0)
71
72#define EMAC_TX_TM (0x1 << 1)
73
74#define EMAC_TX_SETUP (0)
75
76
77#define EMAC_RX_DRQ_MODE (0x1 << 1)
78
79#define EMAC_RX_TM (0x1 << 2)
80
81#define EMAC_RX_PA (0x1 << 4)
82
83#define EMAC_RX_PCF (0x1 << 5)
84
85#define EMAC_RX_PCRCE (0x1 << 6)
86
87#define EMAC_RX_PLE (0x1 << 7)
88
89#define EMAC_RX_POR (0x1 << 8)
90
91#define EMAC_RX_UCAD (0x1 << 16)
92
93#define EMAC_RX_DAF (0x1 << 17)
94
95#define EMAC_RX_MCO (0x1 << 20)
96
97#define EMAC_RX_MHF (0x1 << 21)
98
99#define EMAC_RX_BCO (0x1 << 22)
100
101#define EMAC_RX_SAF (0x1 << 24)
102
103#define EMAC_RX_SAIF (0x1 << 25)
104
105#define EMAC_RX_SETUP (EMAC_RX_POR | EMAC_RX_UCAD | EMAC_RX_DAF | \
106 EMAC_RX_MCO | EMAC_RX_BCO)
107
108
109#define EMAC_MAC_CTL0_RFC (0x1 << 2)
110
111#define EMAC_MAC_CTL0_TFC (0x1 << 3)
112
113#define EMAC_MAC_CTL0_SETUP (EMAC_MAC_CTL0_RFC | EMAC_MAC_CTL0_TFC)
114
115
116#define EMAC_MAC_CTL1_FLC (0x1 << 1)
117
118#define EMAC_MAC_CTL1_HF (0x1 << 2)
119
120#define EMAC_MAC_CTL1_DCRC (0x1 << 3)
121
122#define EMAC_MAC_CTL1_CRC (0x1 << 4)
123
124#define EMAC_MAC_CTL1_PC (0x1 << 5)
125
126#define EMAC_MAC_CTL1_VC (0x1 << 6)
127
128#define EMAC_MAC_CTL1_ADP (0x1 << 7)
129
130#define EMAC_MAC_CTL1_PRE (0x1 << 8)
131
132#define EMAC_MAC_CTL1_LPE (0x1 << 9)
133
134#define EMAC_MAC_CTL1_NB (0x1 << 12)
135
136#define EMAC_MAC_CTL1_BNB (0x1 << 13)
137
138#define EMAC_MAC_CTL1_ED (0x1 << 14)
139
140#define EMAC_MAC_CTL1_SETUP (EMAC_MAC_CTL1_FLC | EMAC_MAC_CTL1_CRC | \
141 EMAC_MAC_CTL1_PC)
142
143#define EMAC_MAC_IPGT 0x15
144
145#define EMAC_MAC_NBTB_IPG1 0xc
146#define EMAC_MAC_NBTB_IPG2 0x12
147
148#define EMAC_MAC_CW 0x37
149#define EMAC_MAC_RM 0xf
150
151#define EMAC_MAC_MFL 0x0600
152
153
154#define EMAC_CRCERR (0x1 << 4)
155#define EMAC_LENERR (0x3 << 5)
156
157#define EMAC_RX_BUFSIZE 2000
158
159struct emac_eth_dev {
160 struct emac_regs *regs;
161 struct clk clk;
162 struct mii_dev *bus;
163 struct phy_device *phydev;
164 int link_printed;
165#ifdef CONFIG_DM_ETH
166 uchar rx_buf[EMAC_RX_BUFSIZE];
167#endif
168};
169
170struct emac_rxhdr {
171 s16 rx_len;
172 u16 rx_status;
173};
174
175static void emac_inblk_32bit(void *reg, void *data, int count)
176{
177 int cnt = (count + 3) >> 2;
178
179 if (cnt) {
180 u32 *buf = data;
181
182 do {
183 u32 x = readl(reg);
184 *buf++ = x;
185 } while (--cnt);
186 }
187}
188
189static void emac_outblk_32bit(void *reg, void *data, int count)
190{
191 int cnt = (count + 3) >> 2;
192
193 if (cnt) {
194 const u32 *buf = data;
195
196 do {
197 writel(*buf++, reg);
198 } while (--cnt);
199 }
200}
201
202
203static int emac_mdio_read(struct mii_dev *bus, int addr, int devad, int reg)
204{
205 struct emac_eth_dev *priv = bus->priv;
206 struct emac_regs *regs = priv->regs;
207
208
209 writel(addr << 8 | reg, ®s->mac_madr);
210
211
212 writel(0x1, ®s->mac_mcmd);
213
214
215 mdelay(1);
216
217
218 writel(0x0, ®s->mac_mcmd);
219
220
221 return readl(®s->mac_mrdd);
222}
223
224
225static int emac_mdio_write(struct mii_dev *bus, int addr, int devad, int reg,
226 u16 value)
227{
228 struct emac_eth_dev *priv = bus->priv;
229 struct emac_regs *regs = priv->regs;
230
231
232 writel(addr << 8 | reg, ®s->mac_madr);
233
234
235 writel(0x1, ®s->mac_mcmd);
236
237
238 mdelay(1);
239
240
241 writel(0x0, ®s->mac_mcmd);
242
243
244 writel(value, ®s->mac_mwtd);
245
246 return 0;
247}
248
249static int sunxi_emac_init_phy(struct emac_eth_dev *priv, void *dev)
250{
251 int ret, mask = 0xffffffff;
252
253#ifdef CONFIG_PHY_ADDR
254 mask = 1 << CONFIG_PHY_ADDR;
255#endif
256
257 priv->bus = mdio_alloc();
258 if (!priv->bus) {
259 printf("Failed to allocate MDIO bus\n");
260 return -ENOMEM;
261 }
262
263 priv->bus->read = emac_mdio_read;
264 priv->bus->write = emac_mdio_write;
265 priv->bus->priv = priv;
266 strcpy(priv->bus->name, "emac");
267
268 ret = mdio_register(priv->bus);
269 if (ret)
270 return ret;
271
272 priv->phydev = phy_find_by_mask(priv->bus, mask,
273 PHY_INTERFACE_MODE_MII);
274 if (!priv->phydev)
275 return -ENODEV;
276
277 phy_connect_dev(priv->phydev, dev);
278 phy_config(priv->phydev);
279
280 return 0;
281}
282
283static void emac_setup(struct emac_eth_dev *priv)
284{
285 struct emac_regs *regs = priv->regs;
286 u32 reg_val;
287
288
289 writel(EMAC_TX_SETUP, ®s->tx_mode);
290
291
292 writel(EMAC_RX_SETUP, ®s->rx_ctl);
293
294
295
296 writel(EMAC_MAC_CTL0_SETUP, ®s->mac_ctl0);
297
298
299 reg_val = 0;
300 if (priv->phydev->duplex == DUPLEX_FULL)
301 reg_val = (0x1 << 0);
302 writel(EMAC_MAC_CTL1_SETUP | reg_val, ®s->mac_ctl1);
303
304
305 writel(EMAC_MAC_IPGT, ®s->mac_ipgt);
306
307
308 writel(EMAC_MAC_NBTB_IPG2 | (EMAC_MAC_NBTB_IPG1 << 8), ®s->mac_ipgr);
309
310
311 writel(EMAC_MAC_RM | (EMAC_MAC_CW << 8), ®s->mac_clrt);
312
313
314 writel(EMAC_MAC_MFL, ®s->mac_maxf);
315}
316
317static void emac_reset(struct emac_eth_dev *priv)
318{
319 struct emac_regs *regs = priv->regs;
320
321 debug("resetting device\n");
322
323
324 writel(0, ®s->ctl);
325 udelay(200);
326
327 writel(1, ®s->ctl);
328 udelay(200);
329}
330
331static int _sunxi_write_hwaddr(struct emac_eth_dev *priv, u8 *enetaddr)
332{
333 struct emac_regs *regs = priv->regs;
334 u32 enetaddr_lo, enetaddr_hi;
335
336 enetaddr_lo = enetaddr[2] | (enetaddr[1] << 8) | (enetaddr[0] << 16);
337 enetaddr_hi = enetaddr[5] | (enetaddr[4] << 8) | (enetaddr[3] << 16);
338
339 writel(enetaddr_hi, ®s->mac_a0);
340 writel(enetaddr_lo, ®s->mac_a1);
341
342 return 0;
343}
344
345static int _sunxi_emac_eth_init(struct emac_eth_dev *priv, u8 *enetaddr)
346{
347 struct emac_regs *regs = priv->regs;
348 int ret;
349
350
351
352
353 setbits_le32(®s->rx_ctl, 0x8);
354 udelay(1);
355
356
357
358
359 clrbits_le32(®s->mac_ctl0, 0x1 << 15);
360
361
362 writel(0x0, ®s->rx_fbc);
363 udelay(1);
364
365
366 emac_setup(priv);
367
368 _sunxi_write_hwaddr(priv, enetaddr);
369
370 mdelay(1);
371
372 emac_reset(priv);
373
374
375 ret = phy_startup(priv->phydev);
376 if (ret) {
377 printf("Could not initialize PHY %s\n",
378 priv->phydev->dev->name);
379 return ret;
380 }
381
382
383 if (!priv->link_printed) {
384 printf("ENET Speed is %d Mbps - %s duplex connection\n",
385 priv->phydev->speed,
386 priv->phydev->duplex ? "FULL" : "HALF");
387 priv->link_printed = 1;
388 }
389
390
391 if (priv->phydev->speed == SPEED_100)
392 setbits_le32(®s->mac_supp, 1 << 8);
393 else
394 clrbits_le32(®s->mac_supp, 1 << 8);
395
396
397 if (priv->phydev->duplex == DUPLEX_FULL)
398 setbits_le32(®s->mac_ctl1, 1 << 0);
399 else
400 clrbits_le32(®s->mac_ctl1, 1 << 0);
401
402
403 setbits_le32(®s->ctl, 0x7);
404
405 return 0;
406}
407
408static int _sunxi_emac_eth_recv(struct emac_eth_dev *priv, void *packet)
409{
410 struct emac_regs *regs = priv->regs;
411 struct emac_rxhdr rxhdr;
412 u32 rxcount;
413 u32 reg_val;
414 int rx_len;
415 int rx_status;
416 int good_packet;
417
418
419
420
421
422
423 rxcount = readl(®s->rx_fbc);
424 if (!rxcount) {
425
426 rxcount = readl(®s->rx_fbc);
427 if (!rxcount)
428 return -EAGAIN;
429 }
430
431 reg_val = readl(®s->rx_io_data);
432 if (reg_val != 0x0143414d) {
433
434 clrbits_le32(®s->ctl, 0x1 << 2);
435
436
437 setbits_le32(®s->rx_ctl, 0x1 << 3);
438 while (readl(®s->rx_ctl) & (0x1 << 3))
439 ;
440
441
442 setbits_le32(®s->ctl, 0x1 << 2);
443
444 return -EAGAIN;
445 }
446
447
448
449
450 good_packet = 1;
451
452 emac_inblk_32bit(®s->rx_io_data, &rxhdr, sizeof(rxhdr));
453
454 rx_len = rxhdr.rx_len;
455 rx_status = rxhdr.rx_status;
456
457
458 if (rx_len < 0x40) {
459 good_packet = 0;
460 debug("RX: Bad Packet (runt)\n");
461 }
462
463
464 if (0 & rx_status & (EMAC_CRCERR | EMAC_LENERR)) {
465 good_packet = 0;
466 if (rx_status & EMAC_CRCERR)
467 printf("crc error\n");
468 if (rx_status & EMAC_LENERR)
469 printf("length error\n");
470 }
471
472
473 if (good_packet) {
474 if (rx_len > EMAC_RX_BUFSIZE) {
475 printf("Received packet is too big (len=%d)\n", rx_len);
476 return -EMSGSIZE;
477 }
478 emac_inblk_32bit((void *)®s->rx_io_data, packet, rx_len);
479 return rx_len;
480 }
481
482 return -EIO;
483}
484
485static int _sunxi_emac_eth_send(struct emac_eth_dev *priv, void *packet,
486 int len)
487{
488 struct emac_regs *regs = priv->regs;
489
490
491 writel(0, ®s->tx_ins);
492
493
494 emac_outblk_32bit((void *)®s->tx_io_data, packet, len);
495
496
497 writel(len, ®s->tx_pl0);
498
499
500 setbits_le32(®s->tx_ctl0, 1);
501
502 return 0;
503}
504
505static int sunxi_emac_board_setup(struct emac_eth_dev *priv)
506{
507 struct sunxi_sramc_regs *sram =
508 (struct sunxi_sramc_regs *)SUNXI_SRAMC_BASE;
509 struct emac_regs *regs = priv->regs;
510 int pin, ret;
511
512
513 setbits_le32(&sram->ctrl1, 0x5 << 2);
514
515
516 for (pin = SUNXI_GPA(0); pin <= SUNXI_GPA(17); pin++)
517 sunxi_gpio_set_cfgpin(pin, SUNXI_GPA_EMAC);
518
519
520 ret = clk_enable(&priv->clk);
521 if (ret) {
522 dev_err(dev, "failed to enable emac clock\n");
523 return ret;
524 }
525
526
527 clrsetbits_le32(®s->mac_mcfg, 0xf << 2, 0xd << 2);
528
529 return 0;
530}
531
532static int sunxi_emac_eth_start(struct udevice *dev)
533{
534 struct eth_pdata *pdata = dev_get_platdata(dev);
535
536 return _sunxi_emac_eth_init(dev->priv, pdata->enetaddr);
537}
538
539static int sunxi_emac_eth_send(struct udevice *dev, void *packet, int length)
540{
541 struct emac_eth_dev *priv = dev_get_priv(dev);
542
543 return _sunxi_emac_eth_send(priv, packet, length);
544}
545
546static int sunxi_emac_eth_recv(struct udevice *dev, int flags, uchar **packetp)
547{
548 struct emac_eth_dev *priv = dev_get_priv(dev);
549 int rx_len;
550
551 rx_len = _sunxi_emac_eth_recv(priv, priv->rx_buf);
552 *packetp = priv->rx_buf;
553
554 return rx_len;
555}
556
557static void sunxi_emac_eth_stop(struct udevice *dev)
558{
559
560}
561
562static int sunxi_emac_eth_probe(struct udevice *dev)
563{
564 struct eth_pdata *pdata = dev_get_platdata(dev);
565 struct emac_eth_dev *priv = dev_get_priv(dev);
566 int ret;
567
568 priv->regs = (struct emac_regs *)pdata->iobase;
569
570 ret = clk_get_by_index(dev, 0, &priv->clk);
571 if (ret) {
572 dev_err(dev, "failed to get emac clock\n");
573 return ret;
574 }
575
576 ret = sunxi_emac_board_setup(priv);
577 if (ret)
578 return ret;
579
580 return sunxi_emac_init_phy(priv, dev);
581}
582
583static const struct eth_ops sunxi_emac_eth_ops = {
584 .start = sunxi_emac_eth_start,
585 .send = sunxi_emac_eth_send,
586 .recv = sunxi_emac_eth_recv,
587 .stop = sunxi_emac_eth_stop,
588};
589
590static int sunxi_emac_eth_ofdata_to_platdata(struct udevice *dev)
591{
592 struct eth_pdata *pdata = dev_get_platdata(dev);
593
594 pdata->iobase = devfdt_get_addr(dev);
595
596 return 0;
597}
598
599static const struct udevice_id sunxi_emac_eth_ids[] = {
600 { .compatible = "allwinner,sun4i-a10-emac" },
601 { }
602};
603
604U_BOOT_DRIVER(eth_sunxi_emac) = {
605 .name = "eth_sunxi_emac",
606 .id = UCLASS_ETH,
607 .of_match = sunxi_emac_eth_ids,
608 .ofdata_to_platdata = sunxi_emac_eth_ofdata_to_platdata,
609 .probe = sunxi_emac_eth_probe,
610 .ops = &sunxi_emac_eth_ops,
611 .priv_auto_alloc_size = sizeof(struct emac_eth_dev),
612 .platdata_auto_alloc_size = sizeof(struct eth_pdata),
613};
614