blob: 64d4c56ac56ac3b996b3659a3c9b81e473f8ec14 [file] [log] [blame]
Jens Scharsigc041e9d2010-01-23 12:03:45 +01001/*
2 * Copyright (C) 2009 BuS Elektronik GmbH & Co. KG
3 * Jens Scharsig (esw@bus-elektronik.de)
4 *
5 * (C) Copyright 2003
6 * Author : Hamid Ikdoumi (Atmel)
7
Wolfgang Denk1a459662013-07-08 09:37:19 +02008 * SPDX-License-Identifier: GPL-2.0+
Jens Scharsigc041e9d2010-01-23 12:03:45 +01009 */
10
11#include <common.h>
12#include <asm/io.h>
Jens Scharsigc041e9d2010-01-23 12:03:45 +010013#include <asm/arch/hardware.h>
14#include <asm/arch/at91_emac.h>
15#include <asm/arch/at91_pmc.h>
16#include <asm/arch/at91_pio.h>
Jens Scharsigc041e9d2010-01-23 12:03:45 +010017#include <net.h>
18#include <netdev.h>
19#include <malloc.h>
20#include <miiphy.h>
21#include <linux/mii.h>
22
23#undef MII_DEBUG
24#undef ET_DEBUG
25
26#if (CONFIG_SYS_RX_ETH_BUFFER > 1024)
27#error AT91 EMAC supports max 1024 RX buffers. \
28 Please decrease the CONFIG_SYS_RX_ETH_BUFFER value
29#endif
30
Eric Bénard836cd452010-06-21 09:40:43 +020031#ifndef CONFIG_DRIVER_AT91EMAC_PHYADDR
32#define CONFIG_DRIVER_AT91EMAC_PHYADDR 0
33#endif
34
Jens Scharsigc041e9d2010-01-23 12:03:45 +010035/* MDIO clock must not exceed 2.5 MHz, so enable MCK divider */
36#if (AT91C_MASTER_CLOCK > 80000000)
37 #define HCLK_DIV AT91_EMAC_CFG_MCLK_64
38#elif (AT91C_MASTER_CLOCK > 40000000)
39 #define HCLK_DIV AT91_EMAC_CFG_MCLK_32
40#elif (AT91C_MASTER_CLOCK > 20000000)
41 #define HCLK_DIV AT91_EMAC_CFG_MCLK_16
42#else
43 #define HCLK_DIV AT91_EMAC_CFG_MCLK_8
44#endif
45
46#ifdef ET_DEBUG
Wolfgang Denkf4962062011-12-09 12:14:21 +010047#define DEBUG_AT91EMAC 1
Jens Scharsigc041e9d2010-01-23 12:03:45 +010048#else
Wolfgang Denkf4962062011-12-09 12:14:21 +010049#define DEBUG_AT91EMAC 0
Jens Scharsigc041e9d2010-01-23 12:03:45 +010050#endif
51
52#ifdef MII_DEBUG
Wolfgang Denkf4962062011-12-09 12:14:21 +010053#define DEBUG_AT91PHY 1
Jens Scharsigc041e9d2010-01-23 12:03:45 +010054#else
Wolfgang Denkf4962062011-12-09 12:14:21 +010055#define DEBUG_AT91PHY 0
Jens Scharsigc041e9d2010-01-23 12:03:45 +010056#endif
57
58#ifndef CONFIG_DRIVER_AT91EMAC_QUIET
Wolfgang Denkf4962062011-12-09 12:14:21 +010059#define VERBOSEP 1
Jens Scharsigc041e9d2010-01-23 12:03:45 +010060#else
Wolfgang Denkf4962062011-12-09 12:14:21 +010061#define VERBOSEP 0
Jens Scharsigc041e9d2010-01-23 12:03:45 +010062#endif
63
64#define RBF_ADDR 0xfffffffc
65#define RBF_OWNER (1<<0)
66#define RBF_WRAP (1<<1)
67#define RBF_BROADCAST (1<<31)
68#define RBF_MULTICAST (1<<30)
69#define RBF_UNICAST (1<<29)
70#define RBF_EXTERNAL (1<<28)
Loïc Minier6052cba2011-02-03 22:04:26 +010071#define RBF_UNKNOWN (1<<27)
Jens Scharsigc041e9d2010-01-23 12:03:45 +010072#define RBF_SIZE 0x07ff
73#define RBF_LOCAL4 (1<<26)
74#define RBF_LOCAL3 (1<<25)
75#define RBF_LOCAL2 (1<<24)
76#define RBF_LOCAL1 (1<<23)
77
78#define RBF_FRAMEMAX CONFIG_SYS_RX_ETH_BUFFER
79#define RBF_FRAMELEN 0x600
80
81typedef struct {
82 unsigned long addr, size;
83} rbf_t;
84
85typedef struct {
86 rbf_t rbfdt[RBF_FRAMEMAX];
87 unsigned long rbindex;
88} emac_device;
89
90void at91emac_EnableMDIO(at91_emac_t *at91mac)
91{
92 /* Mac CTRL reg set for MDIO enable */
93 writel(readl(&at91mac->ctl) | AT91_EMAC_CTL_MPE, &at91mac->ctl);
94}
95
96void at91emac_DisableMDIO(at91_emac_t *at91mac)
97{
98 /* Mac CTRL reg set for MDIO disable */
99 writel(readl(&at91mac->ctl) & ~AT91_EMAC_CTL_MPE, &at91mac->ctl);
100}
101
102int at91emac_read(at91_emac_t *at91mac, unsigned char addr,
103 unsigned char reg, unsigned short *value)
104{
Andreas Bießmann38bda012010-09-07 19:10:34 +0200105 unsigned long netstat;
Jens Scharsigc041e9d2010-01-23 12:03:45 +0100106 at91emac_EnableMDIO(at91mac);
107
108 writel(AT91_EMAC_MAN_HIGH | AT91_EMAC_MAN_RW_R |
109 AT91_EMAC_MAN_REGA(reg) | AT91_EMAC_MAN_CODE_802_3 |
110 AT91_EMAC_MAN_PHYA(addr),
111 &at91mac->man);
Andreas Bießmann38bda012010-09-07 19:10:34 +0200112
113 do {
114 netstat = readl(&at91mac->sr);
Wolfgang Denkf4962062011-12-09 12:14:21 +0100115 debug_cond(DEBUG_AT91PHY, "poll SR %08lx\n", netstat);
Andreas Bießmann38bda012010-09-07 19:10:34 +0200116 } while (!(netstat & AT91_EMAC_SR_IDLE));
117
Jens Scharsigc041e9d2010-01-23 12:03:45 +0100118 *value = readl(&at91mac->man) & AT91_EMAC_MAN_DATA_MASK;
119
120 at91emac_DisableMDIO(at91mac);
121
Wolfgang Denkf4962062011-12-09 12:14:21 +0100122 debug_cond(DEBUG_AT91PHY,
123 "AT91PHY read %p REG(%d)=%x\n", at91mac, reg, *value);
Jens Scharsigc041e9d2010-01-23 12:03:45 +0100124
125 return 0;
126}
127
128int at91emac_write(at91_emac_t *at91mac, unsigned char addr,
129 unsigned char reg, unsigned short value)
130{
Andreas Bießmann38bda012010-09-07 19:10:34 +0200131 unsigned long netstat;
Wolfgang Denkf4962062011-12-09 12:14:21 +0100132 debug_cond(DEBUG_AT91PHY,
133 "AT91PHY write %p REG(%d)=%p\n", at91mac, reg, &value);
Jens Scharsigc041e9d2010-01-23 12:03:45 +0100134
135 at91emac_EnableMDIO(at91mac);
136
137 writel(AT91_EMAC_MAN_HIGH | AT91_EMAC_MAN_RW_W |
138 AT91_EMAC_MAN_REGA(reg) | AT91_EMAC_MAN_CODE_802_3 |
139 AT91_EMAC_MAN_PHYA(addr) | (value & AT91_EMAC_MAN_DATA_MASK),
140 &at91mac->man);
Andreas Bießmann38bda012010-09-07 19:10:34 +0200141
142 do {
143 netstat = readl(&at91mac->sr);
Wolfgang Denkf4962062011-12-09 12:14:21 +0100144 debug_cond(DEBUG_AT91PHY, "poll SR %08lx\n", netstat);
Andreas Bießmann38bda012010-09-07 19:10:34 +0200145 } while (!(netstat & AT91_EMAC_SR_IDLE));
Jens Scharsigc041e9d2010-01-23 12:03:45 +0100146
147 at91emac_DisableMDIO(at91mac);
Andreas Bießmann38bda012010-09-07 19:10:34 +0200148
Jens Scharsigc041e9d2010-01-23 12:03:45 +0100149 return 0;
150}
151
152#if defined(CONFIG_MII) || defined(CONFIG_CMD_MII)
153
Ben Warrend7fb9bc2010-07-29 12:56:11 -0700154at91_emac_t *get_emacbase_by_name(const char *devname)
Jens Scharsigc041e9d2010-01-23 12:03:45 +0100155{
156 struct eth_device *netdev;
157
158 netdev = eth_get_dev_by_name(devname);
159 return (at91_emac_t *) netdev->iobase;
160}
161
Mike Frysinger5700bb62010-07-27 18:35:08 -0400162int at91emac_mii_read(const char *devname, unsigned char addr,
Jens Scharsigc041e9d2010-01-23 12:03:45 +0100163 unsigned char reg, unsigned short *value)
164{
165 at91_emac_t *emac;
166
167 emac = get_emacbase_by_name(devname);
168 at91emac_read(emac , addr, reg, value);
169 return 0;
170}
171
172
Mike Frysinger5700bb62010-07-27 18:35:08 -0400173int at91emac_mii_write(const char *devname, unsigned char addr,
Jens Scharsigc041e9d2010-01-23 12:03:45 +0100174 unsigned char reg, unsigned short value)
175{
176 at91_emac_t *emac;
177
178 emac = get_emacbase_by_name(devname);
179 at91emac_write(emac, addr, reg, value);
180 return 0;
181}
182
183#endif
184
185static int at91emac_phy_reset(struct eth_device *netdev)
186{
187 int i;
188 u16 status, adv;
189 at91_emac_t *emac;
190
191 emac = (at91_emac_t *) netdev->iobase;
192
193 adv = ADVERTISE_CSMA | ADVERTISE_ALL;
Eric Bénard836cd452010-06-21 09:40:43 +0200194 at91emac_write(emac, CONFIG_DRIVER_AT91EMAC_PHYADDR,
195 MII_ADVERTISE, adv);
Wolfgang Denkf4962062011-12-09 12:14:21 +0100196 debug_cond(VERBOSEP, "%s: Starting autonegotiation...\n", netdev->name);
Eric Bénard836cd452010-06-21 09:40:43 +0200197 at91emac_write(emac, CONFIG_DRIVER_AT91EMAC_PHYADDR, MII_BMCR,
198 (BMCR_ANENABLE | BMCR_ANRESTART));
Jens Scharsigc041e9d2010-01-23 12:03:45 +0100199
Andreas Bießmanne63ac4c2010-10-07 09:44:46 +0200200 for (i = 0; i < 30000; i++) {
Eric Bénard836cd452010-06-21 09:40:43 +0200201 at91emac_read(emac, CONFIG_DRIVER_AT91EMAC_PHYADDR,
202 MII_BMSR, &status);
Jens Scharsigc041e9d2010-01-23 12:03:45 +0100203 if (status & BMSR_ANEGCOMPLETE)
204 break;
205 udelay(100);
206 }
207
208 if (status & BMSR_ANEGCOMPLETE) {
Wolfgang Denkf4962062011-12-09 12:14:21 +0100209 debug_cond(VERBOSEP,
210 "%s: Autonegotiation complete\n", netdev->name);
Jens Scharsigc041e9d2010-01-23 12:03:45 +0100211 } else {
212 printf("%s: Autonegotiation timed out (status=0x%04x)\n",
213 netdev->name, status);
Andreas Bießmann77179062010-10-07 09:44:47 +0200214 return -1;
Jens Scharsigc041e9d2010-01-23 12:03:45 +0100215 }
216 return 0;
217}
218
219static int at91emac_phy_init(struct eth_device *netdev)
220{
221 u16 phy_id, status, adv, lpa;
222 int media, speed, duplex;
223 int i;
224 at91_emac_t *emac;
225
226 emac = (at91_emac_t *) netdev->iobase;
227
228 /* Check if the PHY is up to snuff... */
Eric Bénard836cd452010-06-21 09:40:43 +0200229 at91emac_read(emac, CONFIG_DRIVER_AT91EMAC_PHYADDR,
230 MII_PHYSID1, &phy_id);
Jens Scharsigc041e9d2010-01-23 12:03:45 +0100231 if (phy_id == 0xffff) {
232 printf("%s: No PHY present\n", netdev->name);
Andreas Bießmann77179062010-10-07 09:44:47 +0200233 return -1;
Jens Scharsigc041e9d2010-01-23 12:03:45 +0100234 }
235
Eric Bénard836cd452010-06-21 09:40:43 +0200236 at91emac_read(emac, CONFIG_DRIVER_AT91EMAC_PHYADDR,
237 MII_BMSR, &status);
Jens Scharsigc041e9d2010-01-23 12:03:45 +0100238
239 if (!(status & BMSR_LSTATUS)) {
240 /* Try to re-negotiate if we don't have link already. */
241 if (at91emac_phy_reset(netdev))
Andreas Bießmann77179062010-10-07 09:44:47 +0200242 return -2;
Jens Scharsigc041e9d2010-01-23 12:03:45 +0100243
244 for (i = 0; i < 100000 / 100; i++) {
Eric Bénard836cd452010-06-21 09:40:43 +0200245 at91emac_read(emac, CONFIG_DRIVER_AT91EMAC_PHYADDR,
246 MII_BMSR, &status);
Jens Scharsigc041e9d2010-01-23 12:03:45 +0100247 if (status & BMSR_LSTATUS)
248 break;
249 udelay(100);
250 }
251 }
252 if (!(status & BMSR_LSTATUS)) {
Wolfgang Denkf4962062011-12-09 12:14:21 +0100253 debug_cond(VERBOSEP, "%s: link down\n", netdev->name);
Andreas Bießmann77179062010-10-07 09:44:47 +0200254 return -3;
Jens Scharsigc041e9d2010-01-23 12:03:45 +0100255 } else {
Eric Bénard836cd452010-06-21 09:40:43 +0200256 at91emac_read(emac, CONFIG_DRIVER_AT91EMAC_PHYADDR,
257 MII_ADVERTISE, &adv);
258 at91emac_read(emac, CONFIG_DRIVER_AT91EMAC_PHYADDR,
259 MII_LPA, &lpa);
Jens Scharsigc041e9d2010-01-23 12:03:45 +0100260 media = mii_nway_result(lpa & adv);
261 speed = (media & (ADVERTISE_100FULL | ADVERTISE_100HALF)
262 ? 1 : 0);
263 duplex = (media & ADVERTISE_FULL) ? 1 : 0;
Wolfgang Denkf4962062011-12-09 12:14:21 +0100264 debug_cond(VERBOSEP, "%s: link up, %sMbps %s-duplex\n",
Jens Scharsigc041e9d2010-01-23 12:03:45 +0100265 netdev->name,
266 speed ? "100" : "10",
267 duplex ? "full" : "half");
268 }
269 return 0;
270}
271
272int at91emac_UpdateLinkSpeed(at91_emac_t *emac)
273{
274 unsigned short stat1;
275
Eric Bénard836cd452010-06-21 09:40:43 +0200276 at91emac_read(emac, CONFIG_DRIVER_AT91EMAC_PHYADDR, MII_BMSR, &stat1);
Jens Scharsigc041e9d2010-01-23 12:03:45 +0100277
278 if (!(stat1 & BMSR_LSTATUS)) /* link status up? */
Andreas Bießmann77179062010-10-07 09:44:47 +0200279 return -1;
Jens Scharsigc041e9d2010-01-23 12:03:45 +0100280
281 if (stat1 & BMSR_100FULL) {
282 /*set Emac for 100BaseTX and Full Duplex */
283 writel(readl(&emac->cfg) |
284 AT91_EMAC_CFG_SPD | AT91_EMAC_CFG_FD,
285 &emac->cfg);
286 return 0;
287 }
288
289 if (stat1 & BMSR_10FULL) {
290 /*set MII for 10BaseT and Full Duplex */
291 writel((readl(&emac->cfg) &
292 ~(AT91_EMAC_CFG_SPD | AT91_EMAC_CFG_FD)
293 ) | AT91_EMAC_CFG_FD,
294 &emac->cfg);
295 return 0;
296 }
297
298 if (stat1 & BMSR_100HALF) {
299 /*set MII for 100BaseTX and Half Duplex */
300 writel((readl(&emac->cfg) &
301 ~(AT91_EMAC_CFG_SPD | AT91_EMAC_CFG_FD)
302 ) | AT91_EMAC_CFG_SPD,
303 &emac->cfg);
304 return 0;
305 }
306
307 if (stat1 & BMSR_10HALF) {
308 /*set MII for 10BaseT and Half Duplex */
309 writel((readl(&emac->cfg) &
310 ~(AT91_EMAC_CFG_SPD | AT91_EMAC_CFG_FD)),
311 &emac->cfg);
312 return 0;
313 }
Andreas Bießmann77179062010-10-07 09:44:47 +0200314 return 0;
Jens Scharsigc041e9d2010-01-23 12:03:45 +0100315}
316
317static int at91emac_init(struct eth_device *netdev, bd_t *bd)
318{
319 int i;
320 u32 value;
321 emac_device *dev;
322 at91_emac_t *emac;
Jens Scharsig80733992011-02-19 06:17:02 +0000323 at91_pio_t *pio = (at91_pio_t *) ATMEL_BASE_PIO;
324 at91_pmc_t *pmc = (at91_pmc_t *) ATMEL_BASE_PMC;
Jens Scharsigc041e9d2010-01-23 12:03:45 +0100325
326 emac = (at91_emac_t *) netdev->iobase;
327 dev = (emac_device *) netdev->priv;
328
329 /* PIO Disable Register */
Jens Scharsig80733992011-02-19 06:17:02 +0000330 value = ATMEL_PMX_AA_EMDIO | ATMEL_PMX_AA_EMDC |
331 ATMEL_PMX_AA_ERXER | ATMEL_PMX_AA_ERX1 |
332 ATMEL_PMX_AA_ERX0 | ATMEL_PMX_AA_ECRS |
333 ATMEL_PMX_AA_ETX1 | ATMEL_PMX_AA_ETX0 |
334 ATMEL_PMX_AA_ETXEN | ATMEL_PMX_AA_EREFCK;
Jens Scharsigc041e9d2010-01-23 12:03:45 +0100335
336 writel(value, &pio->pioa.pdr);
337 writel(value, &pio->pioa.asr);
338
339#ifdef CONFIG_RMII
Jens Scharsig80733992011-02-19 06:17:02 +0000340 value = ATMEL_PMX_BA_ERXCK;
Jens Scharsigc041e9d2010-01-23 12:03:45 +0100341#else
Jens Scharsig80733992011-02-19 06:17:02 +0000342 value = ATMEL_PMX_BA_ERXCK | ATMEL_PMX_BA_ECOL |
343 ATMEL_PMX_BA_ERXDV | ATMEL_PMX_BA_ERX3 |
344 ATMEL_PMX_BA_ERX2 | ATMEL_PMX_BA_ETXER |
345 ATMEL_PMX_BA_ETX3 | ATMEL_PMX_BA_ETX2;
Jens Scharsigc041e9d2010-01-23 12:03:45 +0100346#endif
347 writel(value, &pio->piob.pdr);
348 writel(value, &pio->piob.bsr);
349
Jens Scharsig80733992011-02-19 06:17:02 +0000350 writel(1 << ATMEL_ID_EMAC, &pmc->pcer);
Jens Scharsigc041e9d2010-01-23 12:03:45 +0100351 writel(readl(&emac->ctl) | AT91_EMAC_CTL_CSR, &emac->ctl);
352
Jens Scharsigc041e9d2010-01-23 12:03:45 +0100353 /* Init Ethernet buffers */
354 for (i = 0; i < RBF_FRAMEMAX; i++) {
355 dev->rbfdt[i].addr = (unsigned long) NetRxPackets[i];
356 dev->rbfdt[i].size = 0;
357 }
358 dev->rbfdt[RBF_FRAMEMAX - 1].addr |= RBF_WRAP;
359 dev->rbindex = 0;
360 writel((u32) &(dev->rbfdt[0]), &emac->rbqp);
361
362 writel(readl(&emac->rsr) &
363 ~(AT91_EMAC_RSR_OVR | AT91_EMAC_RSR_REC | AT91_EMAC_RSR_BNA),
364 &emac->rsr);
365
366 value = AT91_EMAC_CFG_CAF | AT91_EMAC_CFG_NBC |
367 HCLK_DIV;
368#ifdef CONFIG_RMII
Eric Bénard836cd452010-06-21 09:40:43 +0200369 value |= AT91_EMAC_CFG_RMII;
Jens Scharsigc041e9d2010-01-23 12:03:45 +0100370#endif
371 writel(value, &emac->cfg);
372
373 writel(readl(&emac->ctl) | AT91_EMAC_CTL_TE | AT91_EMAC_CTL_RE,
374 &emac->ctl);
375
376 if (!at91emac_phy_init(netdev)) {
377 at91emac_UpdateLinkSpeed(emac);
378 return 0;
379 }
Andreas Bießmann77179062010-10-07 09:44:47 +0200380 return -1;
Jens Scharsigc041e9d2010-01-23 12:03:45 +0100381}
382
383static void at91emac_halt(struct eth_device *netdev)
384{
385 at91_emac_t *emac;
386
387 emac = (at91_emac_t *) netdev->iobase;
388 writel(readl(&emac->ctl) & ~(AT91_EMAC_CTL_TE | AT91_EMAC_CTL_RE),
389 &emac->ctl);
Wolfgang Denkf4962062011-12-09 12:14:21 +0100390 debug_cond(DEBUG_AT91EMAC, "halt MAC\n");
Jens Scharsigc041e9d2010-01-23 12:03:45 +0100391}
392
Joe Hershberger95775012012-05-21 14:45:19 +0000393static int at91emac_send(struct eth_device *netdev, void *packet, int length)
Jens Scharsigc041e9d2010-01-23 12:03:45 +0100394{
395 at91_emac_t *emac;
396
397 emac = (at91_emac_t *) netdev->iobase;
398
399 while (!(readl(&emac->tsr) & AT91_EMAC_TSR_BNQ))
400 ;
401 writel((u32) packet, &emac->tar);
402 writel(AT91_EMAC_TCR_LEN(length), &emac->tcr);
403 while (AT91_EMAC_TCR_LEN(readl(&emac->tcr)))
404 ;
Wolfgang Denkf4962062011-12-09 12:14:21 +0100405 debug_cond(DEBUG_AT91EMAC, "Send %d\n", length);
Jens Scharsigc041e9d2010-01-23 12:03:45 +0100406 writel(readl(&emac->tsr) | AT91_EMAC_TSR_COMP, &emac->tsr);
407 return 0;
408}
409
410static int at91emac_recv(struct eth_device *netdev)
411{
412 emac_device *dev;
413 at91_emac_t *emac;
414 rbf_t *rbfp;
415 int size;
416
417 emac = (at91_emac_t *) netdev->iobase;
418 dev = (emac_device *) netdev->priv;
419
420 rbfp = &dev->rbfdt[dev->rbindex];
421 while (rbfp->addr & RBF_OWNER) {
422 size = rbfp->size & RBF_SIZE;
423 NetReceive(NetRxPackets[dev->rbindex], size);
424
Wolfgang Denkf4962062011-12-09 12:14:21 +0100425 debug_cond(DEBUG_AT91EMAC, "Recv[%ld]: %d bytes @ %lx\n",
Jens Scharsigc041e9d2010-01-23 12:03:45 +0100426 dev->rbindex, size, rbfp->addr);
427
428 rbfp->addr &= ~RBF_OWNER;
429 rbfp->size = 0;
430 if (dev->rbindex < (RBF_FRAMEMAX-1))
431 dev->rbindex++;
432 else
433 dev->rbindex = 0;
434
435 rbfp = &(dev->rbfdt[dev->rbindex]);
436 if (!(rbfp->addr & RBF_OWNER))
437 writel(readl(&emac->rsr) | AT91_EMAC_RSR_REC,
438 &emac->rsr);
439 }
440
441 if (readl(&emac->isr) & AT91_EMAC_IxR_RBNA) {
442 /* EMAC silicon bug 41.3.1 workaround 1 */
443 writel(readl(&emac->ctl) & ~AT91_EMAC_CTL_RE, &emac->ctl);
444 writel(readl(&emac->ctl) | AT91_EMAC_CTL_RE, &emac->ctl);
445 dev->rbindex = 0;
446 printf("%s: reset receiver (EMAC dead lock bug)\n",
447 netdev->name);
448 }
449 return 0;
450}
451
Eric Bénard409943a2010-06-21 09:41:16 +0200452static int at91emac_write_hwaddr(struct eth_device *netdev)
453{
Eric Bénard409943a2010-06-21 09:41:16 +0200454 at91_emac_t *emac;
Jens Scharsig80733992011-02-19 06:17:02 +0000455 at91_pmc_t *pmc = (at91_pmc_t *) ATMEL_BASE_PMC;
Eric Bénard409943a2010-06-21 09:41:16 +0200456 emac = (at91_emac_t *) netdev->iobase;
Eric Bénard409943a2010-06-21 09:41:16 +0200457
Jens Scharsig80733992011-02-19 06:17:02 +0000458 writel(1 << ATMEL_ID_EMAC, &pmc->pcer);
Wolfgang Denkf4962062011-12-09 12:14:21 +0100459 debug_cond(DEBUG_AT91EMAC,
460 "init MAC-ADDR %02x:%02x:%02x:%02x:%02x:%02x\n",
andreas.devel@googlemail.com2321bfe2011-06-09 00:22:54 +0000461 netdev->enetaddr[5], netdev->enetaddr[4], netdev->enetaddr[3],
462 netdev->enetaddr[2], netdev->enetaddr[1], netdev->enetaddr[0]);
463 writel( (netdev->enetaddr[0] | netdev->enetaddr[1] << 8 |
464 netdev->enetaddr[2] << 16 | netdev->enetaddr[3] << 24),
465 &emac->sa2l);
466 writel((netdev->enetaddr[4] | netdev->enetaddr[5] << 8), &emac->sa2h);
Wolfgang Denkf4962062011-12-09 12:14:21 +0100467 debug_cond(DEBUG_AT91EMAC, "init MAC-ADDR %x%x\n",
Eric Bénard409943a2010-06-21 09:41:16 +0200468 readl(&emac->sa2h), readl(&emac->sa2l));
469 return 0;
470}
471
Jens Scharsigc041e9d2010-01-23 12:03:45 +0100472int at91emac_register(bd_t *bis, unsigned long iobase)
473{
474 emac_device *emac;
475 emac_device *emacfix;
476 struct eth_device *dev;
477
478 if (iobase == 0)
Jens Scharsig80733992011-02-19 06:17:02 +0000479 iobase = ATMEL_BASE_EMAC;
Jens Scharsigc041e9d2010-01-23 12:03:45 +0100480 emac = malloc(sizeof(*emac)+512);
481 if (emac == NULL)
Andreas Bießmann77179062010-10-07 09:44:47 +0200482 return -1;
Jens Scharsigc041e9d2010-01-23 12:03:45 +0100483 dev = malloc(sizeof(*dev));
484 if (dev == NULL) {
485 free(emac);
Andreas Bießmann77179062010-10-07 09:44:47 +0200486 return -1;
Jens Scharsigc041e9d2010-01-23 12:03:45 +0100487 }
488 /* alignment as per Errata (64 bytes) is insufficient! */
489 emacfix = (emac_device *) (((unsigned long) emac + 0x1ff) & 0xFFFFFE00);
490 memset(emacfix, 0, sizeof(emac_device));
491
492 memset(dev, 0, sizeof(*dev));
Andreas Bießmann4b8d77b2010-09-07 19:10:33 +0200493 sprintf(dev->name, "emac");
Jens Scharsigc041e9d2010-01-23 12:03:45 +0100494 dev->iobase = iobase;
495 dev->priv = emacfix;
496 dev->init = at91emac_init;
497 dev->halt = at91emac_halt;
498 dev->send = at91emac_send;
499 dev->recv = at91emac_recv;
Eric Bénard409943a2010-06-21 09:41:16 +0200500 dev->write_hwaddr = at91emac_write_hwaddr;
Jens Scharsigc041e9d2010-01-23 12:03:45 +0100501
502 eth_register(dev);
503
504#if defined(CONFIG_MII) || defined(CONFIG_CMD_MII)
505 miiphy_register(dev->name, at91emac_mii_read, at91emac_mii_write);
506#endif
507 return 1;
508}