Blame view
drivers/net/zynq_gem.c
15.4 KB
185f7d9af net: Add driver f... |
1 2 3 4 5 6 7 8 |
/* * (C) Copyright 2011 Michal Simek * * Michal SIMEK <monstr@monstr.eu> * * Based on Xilinx gmac driver: * (C) Copyright 2011 Xilinx * |
3765b3e7b Coding Style clea... |
9 |
* SPDX-License-Identifier: GPL-2.0+ |
185f7d9af net: Add driver f... |
10 11 12 13 |
*/ #include <common.h> #include <net.h> |
2fd2489b7 net: zynq: Fix sp... |
14 |
#include <netdev.h> |
185f7d9af net: Add driver f... |
15 |
#include <config.h> |
f88a6869a net: gem: Add OF ... |
16 17 |
#include <fdtdec.h> #include <libfdt.h> |
185f7d9af net: Add driver f... |
18 19 20 21 22 |
#include <malloc.h> #include <asm/io.h> #include <phy.h> #include <miiphy.h> #include <watchdog.h> |
01fbf3104 net: gem: Preserv... |
23 |
#include <asm/arch/hardware.h> |
80243528e net: gem: Fix gem... |
24 |
#include <asm/arch/sys_proto.h> |
185f7d9af net: Add driver f... |
25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 |
#if !defined(CONFIG_PHYLIB) # error XILINX_GEM_ETHERNET requires PHYLIB #endif /* Bit/mask specification */ #define ZYNQ_GEM_PHYMNTNC_OP_MASK 0x40020000 /* operation mask bits */ #define ZYNQ_GEM_PHYMNTNC_OP_R_MASK 0x20000000 /* read operation */ #define ZYNQ_GEM_PHYMNTNC_OP_W_MASK 0x10000000 /* write operation */ #define ZYNQ_GEM_PHYMNTNC_PHYAD_SHIFT_MASK 23 /* Shift bits for PHYAD */ #define ZYNQ_GEM_PHYMNTNC_PHREG_SHIFT_MASK 18 /* Shift bits for PHREG */ #define ZYNQ_GEM_RXBUF_EOF_MASK 0x00008000 /* End of frame. */ #define ZYNQ_GEM_RXBUF_SOF_MASK 0x00004000 /* Start of frame. */ #define ZYNQ_GEM_RXBUF_LEN_MASK 0x00003FFF /* Mask for length field */ #define ZYNQ_GEM_RXBUF_WRAP_MASK 0x00000002 /* Wrap bit, last BD */ #define ZYNQ_GEM_RXBUF_NEW_MASK 0x00000001 /* Used bit.. */ #define ZYNQ_GEM_RXBUF_ADD_MASK 0xFFFFFFFC /* Mask for address */ /* Wrap bit, last descriptor */ #define ZYNQ_GEM_TXBUF_WRAP_MASK 0x40000000 #define ZYNQ_GEM_TXBUF_LAST_MASK 0x00008000 /* Last buffer */ |
185f7d9af net: Add driver f... |
48 49 50 51 |
#define ZYNQ_GEM_NWCTRL_TXEN_MASK 0x00000008 /* Enable transmit */ #define ZYNQ_GEM_NWCTRL_RXEN_MASK 0x00000004 /* Enable receive */ #define ZYNQ_GEM_NWCTRL_MDEN_MASK 0x00000010 /* Enable MDIO port */ #define ZYNQ_GEM_NWCTRL_STARTTX_MASK 0x00000200 /* Start tx (tx_go) */ |
80243528e net: gem: Fix gem... |
52 53 54 55 |
#define ZYNQ_GEM_NWCFG_SPEED100 0x000000001 /* 100 Mbps operation */ #define ZYNQ_GEM_NWCFG_SPEED1000 0x000000400 /* 1Gbps operation */ #define ZYNQ_GEM_NWCFG_FDEN 0x000000002 /* Full Duplex mode */ #define ZYNQ_GEM_NWCFG_FSREM 0x000020000 /* FCS removal */ |
185f7d9af net: Add driver f... |
56 |
#define ZYNQ_GEM_NWCFG_MDCCLKDIV 0x000080000 /* Div pclk by 32, 80MHz */ |
80243528e net: gem: Fix gem... |
57 |
#define ZYNQ_GEM_NWCFG_MDCCLKDIV2 0x0000c0000 /* Div pclk by 48, 120MHz */ |
185f7d9af net: Add driver f... |
58 |
|
80243528e net: gem: Fix gem... |
59 |
#define ZYNQ_GEM_NWCFG_INIT (ZYNQ_GEM_NWCFG_FDEN | \ |
185f7d9af net: Add driver f... |
60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 |
ZYNQ_GEM_NWCFG_FSREM | \ ZYNQ_GEM_NWCFG_MDCCLKDIV) #define ZYNQ_GEM_NWSR_MDIOIDLE_MASK 0x00000004 /* PHY management idle */ #define ZYNQ_GEM_DMACR_BLENGTH 0x00000004 /* INCR4 AHB bursts */ /* Use full configured addressable space (8 Kb) */ #define ZYNQ_GEM_DMACR_RXSIZE 0x00000300 /* Use full configured addressable space (4 Kb) */ #define ZYNQ_GEM_DMACR_TXSIZE 0x00000400 /* Set with binary 00011000 to use 1536 byte(1*max length frame/buffer) */ #define ZYNQ_GEM_DMACR_RXBUF 0x00180000 #define ZYNQ_GEM_DMACR_INIT (ZYNQ_GEM_DMACR_BLENGTH | \ ZYNQ_GEM_DMACR_RXSIZE | \ ZYNQ_GEM_DMACR_TXSIZE | \ ZYNQ_GEM_DMACR_RXBUF) |
f97d7e8be net: gem: Add sup... |
77 78 79 80 81 82 83 84 85 86 |
/* Use MII register 1 (MII status register) to detect PHY */ #define PHY_DETECT_REG 1 /* Mask used to verify certain PHY features (or register contents) * in the register above: * 0x1000: 10Mbps full duplex support * 0x0800: 10Mbps half duplex support * 0x0008: Auto-negotiation support */ #define PHY_DETECT_MASK 0x1808 |
a5144237a net: zynq_gem: Ad... |
87 88 89 90 |
/* TX BD status masks */ #define ZYNQ_GEM_TXBUF_FRMLEN_MASK 0x000007ff #define ZYNQ_GEM_TXBUF_EXHAUSTED 0x08000000 #define ZYNQ_GEM_TXBUF_UNDERRUN 0x10000000 |
97598fcf1 net: zynq_gem: Ca... |
91 92 93 94 |
/* Clock frequencies for different speeds */ #define ZYNQ_GEM_FREQUENCY_10 2500000UL #define ZYNQ_GEM_FREQUENCY_100 25000000UL #define ZYNQ_GEM_FREQUENCY_1000 125000000UL |
185f7d9af net: Add driver f... |
95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 |
/* Device registers */ struct zynq_gem_regs { u32 nwctrl; /* Network Control reg */ u32 nwcfg; /* Network Config reg */ u32 nwsr; /* Network Status reg */ u32 reserved1; u32 dmacr; /* DMA Control reg */ u32 txsr; /* TX Status reg */ u32 rxqbase; /* RX Q Base address reg */ u32 txqbase; /* TX Q Base address reg */ u32 rxsr; /* RX Status reg */ u32 reserved2[2]; u32 idr; /* Interrupt Disable reg */ u32 reserved3; u32 phymntnc; /* Phy Maintaince reg */ u32 reserved4[18]; u32 hashl; /* Hash Low address reg */ u32 hashh; /* Hash High address reg */ #define LADDR_LOW 0 #define LADDR_HIGH 1 u32 laddr[4][LADDR_HIGH + 1]; /* Specific1 addr low/high reg */ u32 match[4]; /* Type ID1 Match reg */ u32 reserved6[18]; u32 stat[44]; /* Octects transmitted Low reg - stat start */ }; /* BD descriptors */ struct emac_bd { u32 addr; /* Next descriptor pointer */ u32 status; }; #define RX_BUF 3 |
a5144237a net: zynq_gem: Ad... |
128 129 130 131 132 133 |
/* Page table entries are set to 1MB, or multiples of 1MB * (not < 1MB). driver uses less bd's so use 1MB bdspace. */ #define BD_SPACE 0x100000 /* BD separation space */ #define BD_SEPRN_SPACE 64 |
185f7d9af net: Add driver f... |
134 135 136 |
/* Initialized, rxbd_current, rx_first_buf must be 0 after init */ struct zynq_gem_priv { |
a5144237a net: zynq_gem: Ad... |
137 138 139 |
struct emac_bd *tx_bd; struct emac_bd *rx_bd; char *rxbuffers; |
185f7d9af net: Add driver f... |
140 141 142 |
u32 rxbd_current; u32 rx_first_buf; int phyaddr; |
01fbf3104 net: gem: Preserv... |
143 |
u32 emio; |
058687597 net: gem: Do not ... |
144 |
int init; |
185f7d9af net: Add driver f... |
145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 |
struct phy_device *phydev; struct mii_dev *bus; }; static inline int mdio_wait(struct eth_device *dev) { struct zynq_gem_regs *regs = (struct zynq_gem_regs *)dev->iobase; u32 timeout = 200; /* Wait till MDIO interface is ready to accept a new transaction. */ while (--timeout) { if (readl(®s->nwsr) & ZYNQ_GEM_NWSR_MDIOIDLE_MASK) break; WATCHDOG_RESET(); } if (!timeout) { printf("%s: Timeout ", __func__); return 1; } return 0; } static u32 phy_setup_op(struct eth_device *dev, u32 phy_addr, u32 regnum, u32 op, u16 *data) { u32 mgtcr; struct zynq_gem_regs *regs = (struct zynq_gem_regs *)dev->iobase; if (mdio_wait(dev)) return 1; /* Construct mgtcr mask for the operation */ mgtcr = ZYNQ_GEM_PHYMNTNC_OP_MASK | op | (phy_addr << ZYNQ_GEM_PHYMNTNC_PHYAD_SHIFT_MASK) | (regnum << ZYNQ_GEM_PHYMNTNC_PHREG_SHIFT_MASK) | *data; /* Write mgtcr and wait for completion */ writel(mgtcr, ®s->phymntnc); if (mdio_wait(dev)) return 1; if (op == ZYNQ_GEM_PHYMNTNC_OP_R_MASK) *data = readl(®s->phymntnc); return 0; } static u32 phyread(struct eth_device *dev, u32 phy_addr, u32 regnum, u16 *val) { return phy_setup_op(dev, phy_addr, regnum, ZYNQ_GEM_PHYMNTNC_OP_R_MASK, val); } static u32 phywrite(struct eth_device *dev, u32 phy_addr, u32 regnum, u16 data) { return phy_setup_op(dev, phy_addr, regnum, ZYNQ_GEM_PHYMNTNC_OP_W_MASK, &data); } |
f97d7e8be net: gem: Add sup... |
207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 |
static void phy_detection(struct eth_device *dev) { int i; u16 phyreg; struct zynq_gem_priv *priv = dev->priv; if (priv->phyaddr != -1) { phyread(dev, priv->phyaddr, PHY_DETECT_REG, &phyreg); if ((phyreg != 0xFFFF) && ((phyreg & PHY_DETECT_MASK) == PHY_DETECT_MASK)) { /* Found a valid PHY address */ debug("Default phy address %d is valid ", priv->phyaddr); return; } else { debug("PHY address is not setup correctly %d ", priv->phyaddr); priv->phyaddr = -1; } } debug("detecting phy address "); if (priv->phyaddr == -1) { /* detect the PHY address */ for (i = 31; i >= 0; i--) { phyread(dev, i, PHY_DETECT_REG, &phyreg); if ((phyreg != 0xFFFF) && ((phyreg & PHY_DETECT_MASK) == PHY_DETECT_MASK)) { /* Found a valid PHY address */ priv->phyaddr = i; debug("Found valid phy address, %d ", i); return; } } } printf("PHY is not detected "); } |
185f7d9af net: Add driver f... |
249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 |
static int zynq_gem_setup_mac(struct eth_device *dev) { u32 i, macaddrlow, macaddrhigh; struct zynq_gem_regs *regs = (struct zynq_gem_regs *)dev->iobase; /* Set the MAC bits [31:0] in BOT */ macaddrlow = dev->enetaddr[0]; macaddrlow |= dev->enetaddr[1] << 8; macaddrlow |= dev->enetaddr[2] << 16; macaddrlow |= dev->enetaddr[3] << 24; /* Set MAC bits [47:32] in TOP */ macaddrhigh = dev->enetaddr[4]; macaddrhigh |= dev->enetaddr[5] << 8; for (i = 0; i < 4; i++) { writel(0, ®s->laddr[i][LADDR_LOW]); writel(0, ®s->laddr[i][LADDR_HIGH]); /* Do not use MATCHx register */ writel(0, ®s->match[i]); } writel(macaddrlow, ®s->laddr[0][LADDR_LOW]); writel(macaddrhigh, ®s->laddr[0][LADDR_HIGH]); return 0; } static int zynq_gem_init(struct eth_device *dev, bd_t * bis) { |
97598fcf1 net: zynq_gem: Ca... |
279 280 |
u32 i; unsigned long clk_rate = 0; |
185f7d9af net: Add driver f... |
281 282 283 284 285 286 287 288 289 290 291 |
struct phy_device *phydev; const u32 stat_size = (sizeof(struct zynq_gem_regs) - offsetof(struct zynq_gem_regs, stat)) / 4; struct zynq_gem_regs *regs = (struct zynq_gem_regs *)dev->iobase; struct zynq_gem_priv *priv = dev->priv; const u32 supported = SUPPORTED_10baseT_Half | SUPPORTED_10baseT_Full | SUPPORTED_100baseT_Half | SUPPORTED_100baseT_Full | SUPPORTED_1000baseT_Half | SUPPORTED_1000baseT_Full; |
058687597 net: gem: Do not ... |
292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 |
if (!priv->init) { /* Disable all interrupts */ writel(0xFFFFFFFF, ®s->idr); /* Disable the receiver & transmitter */ writel(0, ®s->nwctrl); writel(0, ®s->txsr); writel(0, ®s->rxsr); writel(0, ®s->phymntnc); /* Clear the Hash registers for the mac address * pointed by AddressPtr */ writel(0x0, ®s->hashl); /* Write bits [63:32] in TOP */ writel(0x0, ®s->hashh); /* Clear all counters */ for (i = 0; i <= stat_size; i++) readl(®s->stat[i]); /* Setup RxBD space */ |
a5144237a net: zynq_gem: Ad... |
314 |
memset(priv->rx_bd, 0, RX_BUF * sizeof(struct emac_bd)); |
058687597 net: gem: Do not ... |
315 316 317 318 |
for (i = 0; i < RX_BUF; i++) { priv->rx_bd[i].status = 0xF0000000; priv->rx_bd[i].addr = |
a5144237a net: zynq_gem: Ad... |
319 |
((u32)(priv->rxbuffers) + |
185f7d9af net: Add driver f... |
320 |
(i * PKTSIZE_ALIGN)); |
058687597 net: gem: Do not ... |
321 322 323 324 |
} /* WRAP bit to last BD */ priv->rx_bd[--i].addr |= ZYNQ_GEM_RXBUF_WRAP_MASK; /* Write RxBDs to IP */ |
a5144237a net: zynq_gem: Ad... |
325 |
writel((u32)priv->rx_bd, ®s->rxqbase); |
185f7d9af net: Add driver f... |
326 |
|
058687597 net: gem: Do not ... |
327 328 |
/* Setup for DMA Configuration register */ writel(ZYNQ_GEM_DMACR_INIT, ®s->dmacr); |
185f7d9af net: Add driver f... |
329 |
|
058687597 net: gem: Do not ... |
330 |
/* Setup for Network Control register, MDIO, Rx and Tx enable */ |
80243528e net: gem: Fix gem... |
331 |
setbits_le32(®s->nwctrl, ZYNQ_GEM_NWCTRL_MDEN_MASK); |
185f7d9af net: Add driver f... |
332 |
|
058687597 net: gem: Do not ... |
333 334 |
priv->init++; } |
f97d7e8be net: gem: Add sup... |
335 |
phy_detection(dev); |
185f7d9af net: Add driver f... |
336 |
/* interface - look at tsec */ |
c1a9fa4ba net: zynq: Use pr... |
337 338 |
phydev = phy_connect(priv->bus, priv->phyaddr, dev, PHY_INTERFACE_MODE_MII); |
185f7d9af net: Add driver f... |
339 |
|
80243528e net: gem: Fix gem... |
340 341 |
phydev->supported = supported | ADVERTISED_Pause | ADVERTISED_Asym_Pause; |
185f7d9af net: Add driver f... |
342 343 344 345 |
phydev->advertising = phydev->supported; priv->phydev = phydev; phy_config(phydev); phy_startup(phydev); |
4ed4aa20d net: gem: Check i... |
346 347 348 349 350 |
if (!phydev->link) { printf("%s: No link. ", phydev->dev->name); return -1; } |
80243528e net: gem: Fix gem... |
351 352 353 354 |
switch (phydev->speed) { case SPEED_1000: writel(ZYNQ_GEM_NWCFG_INIT | ZYNQ_GEM_NWCFG_SPEED1000, ®s->nwcfg); |
97598fcf1 net: zynq_gem: Ca... |
355 |
clk_rate = ZYNQ_GEM_FREQUENCY_1000; |
80243528e net: gem: Fix gem... |
356 357 358 359 |
break; case SPEED_100: clrsetbits_le32(®s->nwcfg, ZYNQ_GEM_NWCFG_SPEED1000, ZYNQ_GEM_NWCFG_INIT | ZYNQ_GEM_NWCFG_SPEED100); |
97598fcf1 net: zynq_gem: Ca... |
360 |
clk_rate = ZYNQ_GEM_FREQUENCY_100; |
80243528e net: gem: Fix gem... |
361 362 |
break; case SPEED_10: |
97598fcf1 net: zynq_gem: Ca... |
363 |
clk_rate = ZYNQ_GEM_FREQUENCY_10; |
80243528e net: gem: Fix gem... |
364 365 |
break; } |
01fbf3104 net: gem: Preserv... |
366 367 368 369 |
/* Change the rclk and clk only not using EMIO interface */ if (!priv->emio) zynq_slcr_gem_clk_setup(dev->iobase != |
97598fcf1 net: zynq_gem: Ca... |
370 |
ZYNQ_GEM_BASEADDR0, clk_rate); |
80243528e net: gem: Fix gem... |
371 372 373 |
setbits_le32(®s->nwctrl, ZYNQ_GEM_NWCTRL_RXEN_MASK | ZYNQ_GEM_NWCTRL_TXEN_MASK); |
185f7d9af net: Add driver f... |
374 375 376 377 378 |
return 0; } static int zynq_gem_send(struct eth_device *dev, void *ptr, int len) { |
a5144237a net: zynq_gem: Ad... |
379 |
u32 addr, size; |
185f7d9af net: Add driver f... |
380 381 |
struct zynq_gem_priv *priv = dev->priv; struct zynq_gem_regs *regs = (struct zynq_gem_regs *)dev->iobase; |
185f7d9af net: Add driver f... |
382 383 |
/* setup BD */ |
a5144237a net: zynq_gem: Ad... |
384 |
writel((u32)priv->tx_bd, ®s->txqbase); |
185f7d9af net: Add driver f... |
385 386 |
/* Setup Tx BD */ |
a5144237a net: zynq_gem: Ad... |
387 388 389 390 391 |
memset(priv->tx_bd, 0, sizeof(struct emac_bd)); priv->tx_bd->addr = (u32)ptr; priv->tx_bd->status = (len & ZYNQ_GEM_TXBUF_FRMLEN_MASK) | ZYNQ_GEM_TXBUF_LAST_MASK; |
185f7d9af net: Add driver f... |
392 |
|
a5144237a net: zynq_gem: Ad... |
393 394 395 396 397 |
addr = (u32) ptr; addr &= ~(ARCH_DMA_MINALIGN - 1); size = roundup(len, ARCH_DMA_MINALIGN); flush_dcache_range(addr, addr + size); barrier(); |
185f7d9af net: Add driver f... |
398 399 400 |
/* Start transmit */ setbits_le32(®s->nwctrl, ZYNQ_GEM_NWCTRL_STARTTX_MASK); |
a5144237a net: zynq_gem: Ad... |
401 402 403 404 405 406 407 |
/* Read TX BD status */ if (priv->tx_bd->status & ZYNQ_GEM_TXBUF_UNDERRUN) printf("TX underrun "); if (priv->tx_bd->status & ZYNQ_GEM_TXBUF_EXHAUSTED) printf("TX buffers exhausted in mid frame "); |
185f7d9af net: Add driver f... |
408 |
|
185f7d9af net: Add driver f... |
409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 428 429 430 431 |
return 0; } /* Do not check frame_recd flag in rx_status register 0x20 - just poll BD */ static int zynq_gem_recv(struct eth_device *dev) { int frame_len; struct zynq_gem_priv *priv = dev->priv; struct emac_bd *current_bd = &priv->rx_bd[priv->rxbd_current]; struct emac_bd *first_bd; if (!(current_bd->addr & ZYNQ_GEM_RXBUF_NEW_MASK)) return 0; if (!(current_bd->status & (ZYNQ_GEM_RXBUF_SOF_MASK | ZYNQ_GEM_RXBUF_EOF_MASK))) { printf("GEM: SOF or EOF not set for last buffer received! "); return 0; } frame_len = current_bd->status & ZYNQ_GEM_RXBUF_LEN_MASK; if (frame_len) { |
a5144237a net: zynq_gem: Ad... |
432 433 434 435 436 437 |
u32 addr = current_bd->addr & ZYNQ_GEM_RXBUF_ADD_MASK; addr &= ~(ARCH_DMA_MINALIGN - 1); u32 size = roundup(frame_len, ARCH_DMA_MINALIGN); invalidate_dcache_range(addr, addr + size); NetReceive((u8 *)addr, frame_len); |
185f7d9af net: Add driver f... |
438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 |
if (current_bd->status & ZYNQ_GEM_RXBUF_SOF_MASK) priv->rx_first_buf = priv->rxbd_current; else { current_bd->addr &= ~ZYNQ_GEM_RXBUF_NEW_MASK; current_bd->status = 0xF0000000; /* FIXME */ } if (current_bd->status & ZYNQ_GEM_RXBUF_EOF_MASK) { first_bd = &priv->rx_bd[priv->rx_first_buf]; first_bd->addr &= ~ZYNQ_GEM_RXBUF_NEW_MASK; first_bd->status = 0xF0000000; } if ((++priv->rxbd_current) >= RX_BUF) priv->rxbd_current = 0; |
185f7d9af net: Add driver f... |
454 |
} |
3b90d0afe net: gem: Simplif... |
455 |
return frame_len; |
185f7d9af net: Add driver f... |
456 457 458 459 460 |
} static void zynq_gem_halt(struct eth_device *dev) { struct zynq_gem_regs *regs = (struct zynq_gem_regs *)dev->iobase; |
80243528e net: gem: Fix gem... |
461 462 |
clrsetbits_le32(®s->nwctrl, ZYNQ_GEM_NWCTRL_RXEN_MASK | ZYNQ_GEM_NWCTRL_TXEN_MASK, 0); |
185f7d9af net: Add driver f... |
463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480 481 482 483 484 485 |
} static int zynq_gem_miiphyread(const char *devname, uchar addr, uchar reg, ushort *val) { struct eth_device *dev = eth_get_dev(); int ret; ret = phyread(dev, addr, reg, val); debug("%s 0x%x, 0x%x, 0x%x ", __func__, addr, reg, *val); return ret; } static int zynq_gem_miiphy_write(const char *devname, uchar addr, uchar reg, ushort val) { struct eth_device *dev = eth_get_dev(); debug("%s 0x%x, 0x%x, 0x%x ", __func__, addr, reg, val); return phywrite(dev, addr, reg, val); } |
01fbf3104 net: gem: Preserv... |
486 |
int zynq_gem_initialize(bd_t *bis, int base_addr, int phy_addr, u32 emio) |
185f7d9af net: Add driver f... |
487 488 489 |
{ struct eth_device *dev; struct zynq_gem_priv *priv; |
a5144237a net: zynq_gem: Ad... |
490 |
void *bd_space; |
185f7d9af net: Add driver f... |
491 492 493 494 495 496 497 498 499 500 501 |
dev = calloc(1, sizeof(*dev)); if (dev == NULL) return -1; dev->priv = calloc(1, sizeof(struct zynq_gem_priv)); if (dev->priv == NULL) { free(dev); return -1; } priv = dev->priv; |
a5144237a net: zynq_gem: Ad... |
502 503 504 505 506 507 508 509 510 511 512 |
/* Align rxbuffers to ARCH_DMA_MINALIGN */ priv->rxbuffers = memalign(ARCH_DMA_MINALIGN, RX_BUF * PKTSIZE_ALIGN); memset(priv->rxbuffers, 0, RX_BUF * PKTSIZE_ALIGN); /* Align bd_space to 1MB */ bd_space = memalign(1 << MMU_SECTION_SHIFT, BD_SPACE); mmu_set_region_dcache_behaviour((u32)bd_space, BD_SPACE, DCACHE_OFF); /* Initialize the bd spaces for tx and rx bd's */ priv->tx_bd = (struct emac_bd *)bd_space; priv->rx_bd = (struct emac_bd *)((u32)bd_space + BD_SEPRN_SPACE); |
117cd4cc1 net: gem: Pass ph... |
513 |
priv->phyaddr = phy_addr; |
01fbf3104 net: gem: Preserv... |
514 |
priv->emio = emio; |
185f7d9af net: Add driver f... |
515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 |
sprintf(dev->name, "Gem.%x", base_addr); dev->iobase = base_addr; dev->init = zynq_gem_init; dev->halt = zynq_gem_halt; dev->send = zynq_gem_send; dev->recv = zynq_gem_recv; dev->write_hwaddr = zynq_gem_setup_mac; eth_register(dev); miiphy_register(dev->name, zynq_gem_miiphyread, zynq_gem_miiphy_write); priv->bus = miiphy_get_dev_by_name(dev->name); return 1; } |
f88a6869a net: gem: Add OF ... |
533 534 535 536 537 538 539 540 541 542 543 544 545 546 547 548 549 550 551 552 553 554 555 556 557 558 559 560 561 562 563 564 565 566 567 568 569 570 571 572 573 574 575 |
#ifdef CONFIG_OF_CONTROL int zynq_gem_of_init(const void *blob) { int offset = 0; u32 ret = 0; u32 reg, phy_reg; debug("ZYNQ GEM: Initialization "); do { offset = fdt_node_offset_by_compatible(blob, offset, "xlnx,ps7-ethernet-1.00.a"); if (offset != -1) { reg = fdtdec_get_addr(blob, offset, "reg"); if (reg != FDT_ADDR_T_NONE) { offset = fdtdec_lookup_phandle(blob, offset, "phy-handle"); if (offset != -1) phy_reg = fdtdec_get_addr(blob, offset, "reg"); else phy_reg = 0; debug("ZYNQ GEM: addr %x, phyaddr %x ", reg, phy_reg); ret |= zynq_gem_initialize(NULL, reg, phy_reg, 0); } else { debug("ZYNQ GEM: Can't get base address "); return -1; } } } while (offset != -1); return ret; } #endif |