blob: 6702f5a5202809a56ef9c73c1c2c60fd86a78f34 [file] [log] [blame]
Kumar Galac916d7c2011-04-13 08:37:44 -05001/*
Roy Zang111fd192012-10-08 07:44:21 +00002 * Copyright 2009-2012 Freescale Semiconductor, Inc.
Kumar Galac916d7c2011-04-13 08:37:44 -05003 * Dave Liu <daveliu@freescale.com>
4 *
Wolfgang Denk1a459662013-07-08 09:37:19 +02005 * SPDX-License-Identifier: GPL-2.0+
Kumar Galac916d7c2011-04-13 08:37:44 -05006 */
7#include <common.h>
8#include <asm/io.h>
9#include <malloc.h>
10#include <net.h>
11#include <hwconfig.h>
12#include <fm_eth.h>
13#include <fsl_mdio.h>
14#include <miiphy.h>
15#include <phy.h>
16#include <asm/fsl_dtsec.h>
17#include <asm/fsl_tgec.h>
Shaohui Xiecd348ef2015-03-20 19:28:19 -070018#include <fsl_memac.h>
Kumar Galac916d7c2011-04-13 08:37:44 -050019
20#include "fm.h"
21
22static struct eth_device *devlist[NUM_FM_PORTS];
23static int num_controllers;
24
25#if defined(CONFIG_MII) || defined(CONFIG_CMD_MII) && !defined(BITBANGMII)
26
27#define TBIANA_SETTINGS (TBIANA_ASYMMETRIC_PAUSE | TBIANA_SYMMETRIC_PAUSE | \
28 TBIANA_FULL_DUPLEX)
29
30#define TBIANA_SGMII_ACK 0x4001
31
32#define TBICR_SETTINGS (TBICR_ANEG_ENABLE | TBICR_RESTART_ANEG | \
33 TBICR_FULL_DUPLEX | TBICR_SPEED1_SET)
34
35/* Configure the TBI for SGMII operation */
Kim Phillips960d70c2012-10-29 13:34:34 +000036static void dtsec_configure_serdes(struct fm_eth *priv)
Kumar Galac916d7c2011-04-13 08:37:44 -050037{
Roy Zang111fd192012-10-08 07:44:21 +000038#ifdef CONFIG_SYS_FMAN_V3
39 u32 value;
40 struct mii_dev bus;
41 bus.priv = priv->mac->phyregs;
Shengzhou Liuc35f8692014-10-23 17:20:57 +080042 bool sgmii_2500 = (priv->enet_if ==
43 PHY_INTERFACE_MODE_SGMII_2500) ? true : false;
Roy Zang111fd192012-10-08 07:44:21 +000044
Shengzhou Liuc35f8692014-10-23 17:20:57 +080045 /* SGMII IF mode + AN enable only for 1G SGMII, not for 2.5G */
46 value = PHY_SGMII_IF_MODE_SGMII;
47 if (!sgmii_2500)
48 value |= PHY_SGMII_IF_MODE_AN;
49
Roy Zang111fd192012-10-08 07:44:21 +000050 memac_mdio_write(&bus, 0, MDIO_DEVAD_NONE, 0x14, value);
51
52 /* Dev ability according to SGMII specification */
53 value = PHY_SGMII_DEV_ABILITY_SGMII;
54 memac_mdio_write(&bus, 0, MDIO_DEVAD_NONE, 0x4, value);
55
56 /* Adjust link timer for SGMII -
57 1.6 ms in units of 8 ns = 2 * 10^5 = 0x30d40 */
58 memac_mdio_write(&bus, 0, MDIO_DEVAD_NONE, 0x13, 0x3);
59 memac_mdio_write(&bus, 0, MDIO_DEVAD_NONE, 0x12, 0xd40);
60
61 /* Restart AN */
Shengzhou Liuc35f8692014-10-23 17:20:57 +080062 value = PHY_SGMII_CR_DEF_VAL;
63 if (!sgmii_2500)
64 value |= PHY_SGMII_CR_RESET_AN;
Roy Zang111fd192012-10-08 07:44:21 +000065 memac_mdio_write(&bus, 0, MDIO_DEVAD_NONE, 0, value);
66#else
Kumar Galac916d7c2011-04-13 08:37:44 -050067 struct dtsec *regs = priv->mac->base;
68 struct tsec_mii_mng *phyregs = priv->mac->phyregs;
69
70 /*
71 * Access TBI PHY registers at given TSEC register offset as
72 * opposed to the register offset used for external PHY accesses
73 */
74 tsec_local_mdio_write(phyregs, in_be32(&regs->tbipa), 0, TBI_TBICON,
75 TBICON_CLK_SELECT);
76 tsec_local_mdio_write(phyregs, in_be32(&regs->tbipa), 0, TBI_ANA,
77 TBIANA_SGMII_ACK);
78 tsec_local_mdio_write(phyregs, in_be32(&regs->tbipa), 0,
79 TBI_CR, TBICR_SETTINGS);
Roy Zang111fd192012-10-08 07:44:21 +000080#endif
Kumar Galac916d7c2011-04-13 08:37:44 -050081}
82
83static void dtsec_init_phy(struct eth_device *dev)
84{
85 struct fm_eth *fm_eth = dev->priv;
Roy Zang111fd192012-10-08 07:44:21 +000086#ifndef CONFIG_SYS_FMAN_V3
shaohui xie1f3bd3e2012-10-11 20:25:36 +000087 struct dtsec *regs = (struct dtsec *)CONFIG_SYS_FSL_FM1_DTSEC1_ADDR;
88
Kumar Galac916d7c2011-04-13 08:37:44 -050089 /* Assign a Physical address to the TBI */
90 out_be32(&regs->tbipa, CONFIG_SYS_TBIPA_VALUE);
Roy Zang111fd192012-10-08 07:44:21 +000091#endif
Kumar Galac916d7c2011-04-13 08:37:44 -050092
Shengzhou Liuc35f8692014-10-23 17:20:57 +080093 if (fm_eth->enet_if == PHY_INTERFACE_MODE_SGMII ||
94 fm_eth->enet_if == PHY_INTERFACE_MODE_SGMII_2500)
Kumar Galac916d7c2011-04-13 08:37:44 -050095 dtsec_configure_serdes(fm_eth);
96}
97
98static int tgec_is_fibre(struct eth_device *dev)
99{
100 struct fm_eth *fm = dev->priv;
101 char phyopt[20];
102
103 sprintf(phyopt, "fsl_fm%d_xaui_phy", fm->fm_index + 1);
104
105 return hwconfig_arg_cmp(phyopt, "xfi");
106}
107#endif
108
109static u16 muram_readw(u16 *addr)
110{
111 u32 base = (u32)addr & ~0x3;
112 u32 val32 = *(u32 *)base;
113 int byte_pos;
114 u16 ret;
115
116 byte_pos = (u32)addr & 0x3;
117 if (byte_pos)
118 ret = (u16)(val32 & 0x0000ffff);
119 else
120 ret = (u16)((val32 & 0xffff0000) >> 16);
121
122 return ret;
123}
124
125static void muram_writew(u16 *addr, u16 val)
126{
127 u32 base = (u32)addr & ~0x3;
128 u32 org32 = *(u32 *)base;
129 u32 val32;
130 int byte_pos;
131
132 byte_pos = (u32)addr & 0x3;
133 if (byte_pos)
134 val32 = (org32 & 0xffff0000) | val;
135 else
136 val32 = (org32 & 0x0000ffff) | ((u32)val << 16);
137
138 *(u32 *)base = val32;
139}
140
141static void bmi_rx_port_disable(struct fm_bmi_rx_port *rx_port)
142{
143 int timeout = 1000000;
144
145 clrbits_be32(&rx_port->fmbm_rcfg, FMBM_RCFG_EN);
146
147 /* wait until the rx port is not busy */
148 while ((in_be32(&rx_port->fmbm_rst) & FMBM_RST_BSY) && timeout--)
149 ;
150}
151
152static void bmi_rx_port_init(struct fm_bmi_rx_port *rx_port)
153{
154 /* set BMI to independent mode, Rx port disable */
155 out_be32(&rx_port->fmbm_rcfg, FMBM_RCFG_IM);
156 /* clear FOF in IM case */
157 out_be32(&rx_port->fmbm_rim, 0);
158 /* Rx frame next engine -RISC */
159 out_be32(&rx_port->fmbm_rfne, NIA_ENG_RISC | NIA_RISC_AC_IM_RX);
160 /* Rx command attribute - no order, MR[3] = 1 */
161 clrbits_be32(&rx_port->fmbm_rfca, FMBM_RFCA_ORDER | FMBM_RFCA_MR_MASK);
162 setbits_be32(&rx_port->fmbm_rfca, FMBM_RFCA_MR(4));
163 /* enable Rx statistic counters */
164 out_be32(&rx_port->fmbm_rstc, FMBM_RSTC_EN);
165 /* disable Rx performance counters */
166 out_be32(&rx_port->fmbm_rpc, 0);
167}
168
169static void bmi_tx_port_disable(struct fm_bmi_tx_port *tx_port)
170{
171 int timeout = 1000000;
172
173 clrbits_be32(&tx_port->fmbm_tcfg, FMBM_TCFG_EN);
174
175 /* wait until the tx port is not busy */
176 while ((in_be32(&tx_port->fmbm_tst) & FMBM_TST_BSY) && timeout--)
177 ;
178}
179
180static void bmi_tx_port_init(struct fm_bmi_tx_port *tx_port)
181{
182 /* set BMI to independent mode, Tx port disable */
183 out_be32(&tx_port->fmbm_tcfg, FMBM_TCFG_IM);
184 /* Tx frame next engine -RISC */
185 out_be32(&tx_port->fmbm_tfne, NIA_ENG_RISC | NIA_RISC_AC_IM_TX);
186 out_be32(&tx_port->fmbm_tfene, NIA_ENG_RISC | NIA_RISC_AC_IM_TX);
187 /* Tx command attribute - no order, MR[3] = 1 */
188 clrbits_be32(&tx_port->fmbm_tfca, FMBM_TFCA_ORDER | FMBM_TFCA_MR_MASK);
189 setbits_be32(&tx_port->fmbm_tfca, FMBM_TFCA_MR(4));
190 /* enable Tx statistic counters */
191 out_be32(&tx_port->fmbm_tstc, FMBM_TSTC_EN);
192 /* disable Tx performance counters */
193 out_be32(&tx_port->fmbm_tpc, 0);
194}
195
196static int fm_eth_rx_port_parameter_init(struct fm_eth *fm_eth)
197{
198 struct fm_port_global_pram *pram;
199 u32 pram_page_offset;
200 void *rx_bd_ring_base;
201 void *rx_buf_pool;
202 struct fm_port_bd *rxbd;
203 struct fm_port_qd *rxqd;
204 struct fm_bmi_rx_port *bmi_rx_port = fm_eth->rx_port;
205 int i;
206
207 /* alloc global parameter ram at MURAM */
208 pram = (struct fm_port_global_pram *)fm_muram_alloc(fm_eth->fm_index,
209 FM_PRAM_SIZE, FM_PRAM_ALIGN);
210 fm_eth->rx_pram = pram;
211
212 /* parameter page offset to MURAM */
213 pram_page_offset = (u32)pram - fm_muram_base(fm_eth->fm_index);
214
215 /* enable global mode- snooping data buffers and BDs */
216 pram->mode = PRAM_MODE_GLOBAL;
217
218 /* init the Rx queue descriptor pionter */
219 pram->rxqd_ptr = pram_page_offset + 0x20;
220
221 /* set the max receive buffer length, power of 2 */
222 muram_writew(&pram->mrblr, MAX_RXBUF_LOG2);
223
224 /* alloc Rx buffer descriptors from main memory */
225 rx_bd_ring_base = malloc(sizeof(struct fm_port_bd)
226 * RX_BD_RING_SIZE);
227 if (!rx_bd_ring_base)
228 return 0;
229 memset(rx_bd_ring_base, 0, sizeof(struct fm_port_bd)
230 * RX_BD_RING_SIZE);
231
232 /* alloc Rx buffer from main memory */
233 rx_buf_pool = malloc(MAX_RXBUF_LEN * RX_BD_RING_SIZE);
234 if (!rx_buf_pool)
235 return 0;
236 memset(rx_buf_pool, 0, MAX_RXBUF_LEN * RX_BD_RING_SIZE);
237
238 /* save them to fm_eth */
239 fm_eth->rx_bd_ring = rx_bd_ring_base;
240 fm_eth->cur_rxbd = rx_bd_ring_base;
241 fm_eth->rx_buf = rx_buf_pool;
242
243 /* init Rx BDs ring */
244 rxbd = (struct fm_port_bd *)rx_bd_ring_base;
245 for (i = 0; i < RX_BD_RING_SIZE; i++) {
246 rxbd->status = RxBD_EMPTY;
247 rxbd->len = 0;
248 rxbd->buf_ptr_hi = 0;
249 rxbd->buf_ptr_lo = (u32)rx_buf_pool + i * MAX_RXBUF_LEN;
250 rxbd++;
251 }
252
253 /* set the Rx queue descriptor */
254 rxqd = &pram->rxqd;
255 muram_writew(&rxqd->gen, 0);
256 muram_writew(&rxqd->bd_ring_base_hi, 0);
257 rxqd->bd_ring_base_lo = (u32)rx_bd_ring_base;
258 muram_writew(&rxqd->bd_ring_size, sizeof(struct fm_port_bd)
259 * RX_BD_RING_SIZE);
260 muram_writew(&rxqd->offset_in, 0);
261 muram_writew(&rxqd->offset_out, 0);
262
263 /* set IM parameter ram pointer to Rx Frame Queue ID */
264 out_be32(&bmi_rx_port->fmbm_rfqid, pram_page_offset);
265
266 return 1;
267}
268
269static int fm_eth_tx_port_parameter_init(struct fm_eth *fm_eth)
270{
271 struct fm_port_global_pram *pram;
272 u32 pram_page_offset;
273 void *tx_bd_ring_base;
274 struct fm_port_bd *txbd;
275 struct fm_port_qd *txqd;
276 struct fm_bmi_tx_port *bmi_tx_port = fm_eth->tx_port;
277 int i;
278
279 /* alloc global parameter ram at MURAM */
280 pram = (struct fm_port_global_pram *)fm_muram_alloc(fm_eth->fm_index,
281 FM_PRAM_SIZE, FM_PRAM_ALIGN);
282 fm_eth->tx_pram = pram;
283
284 /* parameter page offset to MURAM */
285 pram_page_offset = (u32)pram - fm_muram_base(fm_eth->fm_index);
286
287 /* enable global mode- snooping data buffers and BDs */
288 pram->mode = PRAM_MODE_GLOBAL;
289
290 /* init the Tx queue descriptor pionter */
291 pram->txqd_ptr = pram_page_offset + 0x40;
292
293 /* alloc Tx buffer descriptors from main memory */
294 tx_bd_ring_base = malloc(sizeof(struct fm_port_bd)
295 * TX_BD_RING_SIZE);
296 if (!tx_bd_ring_base)
297 return 0;
298 memset(tx_bd_ring_base, 0, sizeof(struct fm_port_bd)
299 * TX_BD_RING_SIZE);
300 /* save it to fm_eth */
301 fm_eth->tx_bd_ring = tx_bd_ring_base;
302 fm_eth->cur_txbd = tx_bd_ring_base;
303
304 /* init Tx BDs ring */
305 txbd = (struct fm_port_bd *)tx_bd_ring_base;
306 for (i = 0; i < TX_BD_RING_SIZE; i++) {
307 txbd->status = TxBD_LAST;
308 txbd->len = 0;
309 txbd->buf_ptr_hi = 0;
310 txbd->buf_ptr_lo = 0;
311 }
312
313 /* set the Tx queue decriptor */
314 txqd = &pram->txqd;
315 muram_writew(&txqd->bd_ring_base_hi, 0);
316 txqd->bd_ring_base_lo = (u32)tx_bd_ring_base;
317 muram_writew(&txqd->bd_ring_size, sizeof(struct fm_port_bd)
318 * TX_BD_RING_SIZE);
319 muram_writew(&txqd->offset_in, 0);
320 muram_writew(&txqd->offset_out, 0);
321
322 /* set IM parameter ram pointer to Tx Confirmation Frame Queue ID */
323 out_be32(&bmi_tx_port->fmbm_tcfqid, pram_page_offset);
324
325 return 1;
326}
327
328static int fm_eth_init(struct fm_eth *fm_eth)
329{
330
331 if (!fm_eth_rx_port_parameter_init(fm_eth))
332 return 0;
333
334 if (!fm_eth_tx_port_parameter_init(fm_eth))
335 return 0;
336
337 return 1;
338}
339
340static int fm_eth_startup(struct fm_eth *fm_eth)
341{
342 struct fsl_enet_mac *mac;
343 mac = fm_eth->mac;
344
345 /* Rx/TxBDs, Rx/TxQDs, Rx buff and parameter ram init */
346 if (!fm_eth_init(fm_eth))
347 return 0;
348 /* setup the MAC controller */
349 mac->init_mac(mac);
350
351 /* For some reason we need to set SPEED_100 */
Shaohui Xie1c68d012013-08-19 18:58:52 +0800352 if (((fm_eth->enet_if == PHY_INTERFACE_MODE_SGMII) ||
353 (fm_eth->enet_if == PHY_INTERFACE_MODE_QSGMII)) &&
354 mac->set_if_mode)
Kumar Galac916d7c2011-04-13 08:37:44 -0500355 mac->set_if_mode(mac, fm_eth->enet_if, SPEED_100);
356
357 /* init bmi rx port, IM mode and disable */
358 bmi_rx_port_init(fm_eth->rx_port);
359 /* init bmi tx port, IM mode and disable */
360 bmi_tx_port_init(fm_eth->tx_port);
361
362 return 1;
363}
364
365static void fmc_tx_port_graceful_stop_enable(struct fm_eth *fm_eth)
366{
367 struct fm_port_global_pram *pram;
368
369 pram = fm_eth->tx_pram;
370 /* graceful stop transmission of frames */
371 pram->mode |= PRAM_MODE_GRACEFUL_STOP;
372 sync();
373}
374
375static void fmc_tx_port_graceful_stop_disable(struct fm_eth *fm_eth)
376{
377 struct fm_port_global_pram *pram;
378
379 pram = fm_eth->tx_pram;
380 /* re-enable transmission of frames */
381 pram->mode &= ~PRAM_MODE_GRACEFUL_STOP;
382 sync();
383}
384
385static int fm_eth_open(struct eth_device *dev, bd_t *bd)
386{
387 struct fm_eth *fm_eth;
388 struct fsl_enet_mac *mac;
Timur Tabi11af8d62012-07-09 08:52:43 +0000389#ifdef CONFIG_PHYLIB
390 int ret;
391#endif
Kumar Galac916d7c2011-04-13 08:37:44 -0500392
393 fm_eth = (struct fm_eth *)dev->priv;
394 mac = fm_eth->mac;
395
396 /* setup the MAC address */
397 if (dev->enetaddr[0] & 0x01) {
398 printf("%s: MacAddress is multcast address\n", __func__);
399 return 1;
400 }
401 mac->set_mac_addr(mac, dev->enetaddr);
402
403 /* enable bmi Rx port */
404 setbits_be32(&fm_eth->rx_port->fmbm_rcfg, FMBM_RCFG_EN);
405 /* enable MAC rx/tx port */
406 mac->enable_mac(mac);
407 /* enable bmi Tx port */
408 setbits_be32(&fm_eth->tx_port->fmbm_tcfg, FMBM_TCFG_EN);
409 /* re-enable transmission of frame */
410 fmc_tx_port_graceful_stop_disable(fm_eth);
411
412#ifdef CONFIG_PHYLIB
Codrin Ciubotariu6798c322015-01-12 14:08:29 +0200413 if (fm_eth->phydev) {
414 ret = phy_startup(fm_eth->phydev);
415 if (ret) {
416 printf("%s: Could not initialize\n",
417 fm_eth->phydev->dev->name);
418 return ret;
419 }
420 } else {
421 return 0;
Timur Tabi11af8d62012-07-09 08:52:43 +0000422 }
Kumar Galac916d7c2011-04-13 08:37:44 -0500423#else
424 fm_eth->phydev->speed = SPEED_1000;
425 fm_eth->phydev->link = 1;
426 fm_eth->phydev->duplex = DUPLEX_FULL;
427#endif
428
429 /* set the MAC-PHY mode */
430 mac->set_if_mode(mac, fm_eth->enet_if, fm_eth->phydev->speed);
431
432 if (!fm_eth->phydev->link)
433 printf("%s: No link.\n", fm_eth->phydev->dev->name);
434
435 return fm_eth->phydev->link ? 0 : -1;
436}
437
438static void fm_eth_halt(struct eth_device *dev)
439{
440 struct fm_eth *fm_eth;
441 struct fsl_enet_mac *mac;
442
443 fm_eth = (struct fm_eth *)dev->priv;
444 mac = fm_eth->mac;
445
446 /* graceful stop the transmission of frames */
447 fmc_tx_port_graceful_stop_enable(fm_eth);
448 /* disable bmi Tx port */
449 bmi_tx_port_disable(fm_eth->tx_port);
450 /* disable MAC rx/tx port */
451 mac->disable_mac(mac);
452 /* disable bmi Rx port */
453 bmi_rx_port_disable(fm_eth->rx_port);
454
Codrin Ciubotariu6798c322015-01-12 14:08:29 +0200455 if (fm_eth->phydev)
456 phy_shutdown(fm_eth->phydev);
Kumar Galac916d7c2011-04-13 08:37:44 -0500457}
458
Joe Hershbergere9df2012012-05-22 07:56:15 +0000459static int fm_eth_send(struct eth_device *dev, void *buf, int len)
Kumar Galac916d7c2011-04-13 08:37:44 -0500460{
461 struct fm_eth *fm_eth;
462 struct fm_port_global_pram *pram;
463 struct fm_port_bd *txbd, *txbd_base;
464 u16 offset_in;
465 int i;
466
467 fm_eth = (struct fm_eth *)dev->priv;
468 pram = fm_eth->tx_pram;
469 txbd = fm_eth->cur_txbd;
470
471 /* find one empty TxBD */
472 for (i = 0; txbd->status & TxBD_READY; i++) {
473 udelay(100);
474 if (i > 0x1000) {
475 printf("%s: Tx buffer not ready\n", dev->name);
476 return 0;
477 }
478 }
479 /* setup TxBD */
480 txbd->buf_ptr_hi = 0;
481 txbd->buf_ptr_lo = (u32)buf;
482 txbd->len = len;
483 sync();
484 txbd->status = TxBD_READY | TxBD_LAST;
485 sync();
486
487 /* update TxQD, let RISC to send the packet */
488 offset_in = muram_readw(&pram->txqd.offset_in);
489 offset_in += sizeof(struct fm_port_bd);
490 if (offset_in >= muram_readw(&pram->txqd.bd_ring_size))
491 offset_in = 0;
492 muram_writew(&pram->txqd.offset_in, offset_in);
493 sync();
494
495 /* wait for buffer to be transmitted */
496 for (i = 0; txbd->status & TxBD_READY; i++) {
497 udelay(100);
498 if (i > 0x10000) {
499 printf("%s: Tx error\n", dev->name);
500 return 0;
501 }
502 }
503
504 /* advance the TxBD */
505 txbd++;
506 txbd_base = (struct fm_port_bd *)fm_eth->tx_bd_ring;
507 if (txbd >= (txbd_base + TX_BD_RING_SIZE))
508 txbd = txbd_base;
509 /* update current txbd */
510 fm_eth->cur_txbd = (void *)txbd;
511
512 return 1;
513}
514
515static int fm_eth_recv(struct eth_device *dev)
516{
517 struct fm_eth *fm_eth;
518 struct fm_port_global_pram *pram;
519 struct fm_port_bd *rxbd, *rxbd_base;
520 u16 status, len;
521 u8 *data;
522 u16 offset_out;
Daniel Inderbitzin466f7752015-07-10 14:06:02 +0200523 int ret = 1;
Kumar Galac916d7c2011-04-13 08:37:44 -0500524
525 fm_eth = (struct fm_eth *)dev->priv;
526 pram = fm_eth->rx_pram;
527 rxbd = fm_eth->cur_rxbd;
528 status = rxbd->status;
529
530 while (!(status & RxBD_EMPTY)) {
531 if (!(status & RxBD_ERROR)) {
532 data = (u8 *)rxbd->buf_ptr_lo;
533 len = rxbd->len;
Joe Hershberger1fd92db2015-04-08 01:41:06 -0500534 net_process_received_packet(data, len);
Kumar Galac916d7c2011-04-13 08:37:44 -0500535 } else {
536 printf("%s: Rx error\n", dev->name);
Daniel Inderbitzin466f7752015-07-10 14:06:02 +0200537 ret = 0;
Kumar Galac916d7c2011-04-13 08:37:44 -0500538 }
539
540 /* clear the RxBDs */
541 rxbd->status = RxBD_EMPTY;
542 rxbd->len = 0;
543 sync();
544
545 /* advance RxBD */
546 rxbd++;
547 rxbd_base = (struct fm_port_bd *)fm_eth->rx_bd_ring;
548 if (rxbd >= (rxbd_base + RX_BD_RING_SIZE))
549 rxbd = rxbd_base;
550 /* read next status */
551 status = rxbd->status;
552
553 /* update RxQD */
554 offset_out = muram_readw(&pram->rxqd.offset_out);
555 offset_out += sizeof(struct fm_port_bd);
556 if (offset_out >= muram_readw(&pram->rxqd.bd_ring_size))
557 offset_out = 0;
558 muram_writew(&pram->rxqd.offset_out, offset_out);
559 sync();
560 }
561 fm_eth->cur_rxbd = (void *)rxbd;
562
Daniel Inderbitzin466f7752015-07-10 14:06:02 +0200563 return ret;
Kumar Galac916d7c2011-04-13 08:37:44 -0500564}
565
566static int fm_eth_init_mac(struct fm_eth *fm_eth, struct ccsr_fman *reg)
567{
568 struct fsl_enet_mac *mac;
569 int num;
570 void *base, *phyregs = NULL;
571
572 num = fm_eth->num;
573
Roy Zang111fd192012-10-08 07:44:21 +0000574#ifdef CONFIG_SYS_FMAN_V3
Shengzhou Liucc19c252014-11-24 17:11:57 +0800575#ifndef CONFIG_FSL_FM_10GEC_REGULAR_NOTATION
Shengzhou Liu82a55c12013-11-22 17:39:09 +0800576 if (fm_eth->type == FM_ETH_10G_E) {
Shengzhou Liucc19c252014-11-24 17:11:57 +0800577 /* 10GEC1/10GEC2 use mEMAC9/mEMAC10 on T2080/T4240.
578 * 10GEC3/10GEC4 use mEMAC1/mEMAC2 on T2080.
579 * 10GEC1 uses mEMAC1 on T1024.
Shengzhou Liu82a55c12013-11-22 17:39:09 +0800580 * so it needs to change the num.
581 */
582 if (fm_eth->num >= 2)
583 num -= 2;
584 else
585 num += 8;
586 }
Shengzhou Liucc19c252014-11-24 17:11:57 +0800587#endif
Roy Zang111fd192012-10-08 07:44:21 +0000588 base = &reg->memac[num].fm_memac;
589 phyregs = &reg->memac[num].fm_memac_mdio;
590#else
Kumar Galac916d7c2011-04-13 08:37:44 -0500591 /* Get the mac registers base address */
592 if (fm_eth->type == FM_ETH_1G_E) {
593 base = &reg->mac_1g[num].fm_dtesc;
Timur Tabi30381712011-10-04 16:44:43 -0500594 phyregs = &reg->mac_1g[num].fm_mdio.miimcfg;
Kumar Galac916d7c2011-04-13 08:37:44 -0500595 } else {
596 base = &reg->mac_10g[num].fm_10gec;
597 phyregs = &reg->mac_10g[num].fm_10gec_mdio;
598 }
Roy Zang111fd192012-10-08 07:44:21 +0000599#endif
Kumar Galac916d7c2011-04-13 08:37:44 -0500600
601 /* alloc mac controller */
602 mac = malloc(sizeof(struct fsl_enet_mac));
603 if (!mac)
604 return 0;
605 memset(mac, 0, sizeof(struct fsl_enet_mac));
606
607 /* save the mac to fm_eth struct */
608 fm_eth->mac = mac;
609
Roy Zang111fd192012-10-08 07:44:21 +0000610#ifdef CONFIG_SYS_FMAN_V3
611 init_memac(mac, base, phyregs, MAX_RXBUF_LEN);
612#else
Kumar Galac916d7c2011-04-13 08:37:44 -0500613 if (fm_eth->type == FM_ETH_1G_E)
Timur Tabi30381712011-10-04 16:44:43 -0500614 init_dtsec(mac, base, phyregs, MAX_RXBUF_LEN);
Kumar Galac916d7c2011-04-13 08:37:44 -0500615 else
616 init_tgec(mac, base, phyregs, MAX_RXBUF_LEN);
Roy Zang111fd192012-10-08 07:44:21 +0000617#endif
Kumar Galac916d7c2011-04-13 08:37:44 -0500618
619 return 1;
620}
621
622static int init_phy(struct eth_device *dev)
623{
624 struct fm_eth *fm_eth = dev->priv;
625 struct phy_device *phydev = NULL;
626 u32 supported;
627
628#ifdef CONFIG_PHYLIB
629 if (fm_eth->type == FM_ETH_1G_E)
630 dtsec_init_phy(dev);
631
632 if (fm_eth->bus) {
633 phydev = phy_connect(fm_eth->bus, fm_eth->phyaddr, dev,
634 fm_eth->enet_if);
Codrin Ciubotariu6798c322015-01-12 14:08:29 +0200635 if (!phydev) {
636 printf("Failed to connect\n");
637 return -1;
638 }
639 } else {
640 return 0;
Kumar Galac916d7c2011-04-13 08:37:44 -0500641 }
642
643 if (fm_eth->type == FM_ETH_1G_E) {
644 supported = (SUPPORTED_10baseT_Half |
645 SUPPORTED_10baseT_Full |
646 SUPPORTED_100baseT_Half |
647 SUPPORTED_100baseT_Full |
648 SUPPORTED_1000baseT_Full);
649 } else {
650 supported = SUPPORTED_10000baseT_Full;
651
652 if (tgec_is_fibre(dev))
653 phydev->port = PORT_FIBRE;
654 }
655
656 phydev->supported &= supported;
657 phydev->advertising = phydev->supported;
658
659 fm_eth->phydev = phydev;
660
661 phy_config(phydev);
662#endif
663
664 return 0;
665}
666
667int fm_eth_initialize(struct ccsr_fman *reg, struct fm_eth_info *info)
668{
669 struct eth_device *dev;
670 struct fm_eth *fm_eth;
671 int i, num = info->num;
672
673 /* alloc eth device */
674 dev = (struct eth_device *)malloc(sizeof(struct eth_device));
675 if (!dev)
676 return 0;
677 memset(dev, 0, sizeof(struct eth_device));
678
679 /* alloc the FMan ethernet private struct */
680 fm_eth = (struct fm_eth *)malloc(sizeof(struct fm_eth));
681 if (!fm_eth)
682 return 0;
683 memset(fm_eth, 0, sizeof(struct fm_eth));
684
685 /* save off some things we need from the info struct */
686 fm_eth->fm_index = info->index - 1; /* keep as 0 based for muram */
687 fm_eth->num = num;
688 fm_eth->type = info->type;
689
690 fm_eth->rx_port = (void *)&reg->port[info->rx_port_id - 1].fm_bmi;
691 fm_eth->tx_port = (void *)&reg->port[info->tx_port_id - 1].fm_bmi;
692
693 /* set the ethernet max receive length */
694 fm_eth->max_rx_len = MAX_RXBUF_LEN;
695
696 /* init global mac structure */
697 if (!fm_eth_init_mac(fm_eth, reg))
698 return 0;
699
700 /* keep same as the manual, we call FMAN1, FMAN2, DTSEC1, DTSEC2, etc */
701 if (fm_eth->type == FM_ETH_1G_E)
702 sprintf(dev->name, "FM%d@DTSEC%d", info->index, num + 1);
703 else
704 sprintf(dev->name, "FM%d@TGEC%d", info->index, num + 1);
705
706 devlist[num_controllers++] = dev;
707 dev->iobase = 0;
708 dev->priv = (void *)fm_eth;
709 dev->init = fm_eth_open;
710 dev->halt = fm_eth_halt;
711 dev->send = fm_eth_send;
712 dev->recv = fm_eth_recv;
713 fm_eth->dev = dev;
714 fm_eth->bus = info->bus;
715 fm_eth->phyaddr = info->phy_addr;
716 fm_eth->enet_if = info->enet_if;
717
718 /* startup the FM im */
719 if (!fm_eth_startup(fm_eth))
720 return 0;
721
Codrin Ciubotariu6798c322015-01-12 14:08:29 +0200722 init_phy(dev);
Kumar Galac916d7c2011-04-13 08:37:44 -0500723
724 /* clear the ethernet address */
725 for (i = 0; i < 6; i++)
726 dev->enetaddr[i] = 0;
727 eth_register(dev);
728
729 return 1;
730}