xref: /rk3399_rockchip-uboot/drivers/net/fm/eth.c (revision 82a55c1ef87bb6c596b19e83685cc4cbf0344cb3)
1c916d7c9SKumar Gala /*
2111fd19eSRoy Zang  * Copyright 2009-2012 Freescale Semiconductor, Inc.
3c916d7c9SKumar Gala  *	Dave Liu <daveliu@freescale.com>
4c916d7c9SKumar Gala  *
51a459660SWolfgang Denk  * SPDX-License-Identifier:	GPL-2.0+
6c916d7c9SKumar Gala  */
7c916d7c9SKumar Gala #include <common.h>
8c916d7c9SKumar Gala #include <asm/io.h>
9c916d7c9SKumar Gala #include <malloc.h>
10c916d7c9SKumar Gala #include <net.h>
11c916d7c9SKumar Gala #include <hwconfig.h>
12c916d7c9SKumar Gala #include <fm_eth.h>
13c916d7c9SKumar Gala #include <fsl_mdio.h>
14c916d7c9SKumar Gala #include <miiphy.h>
15c916d7c9SKumar Gala #include <phy.h>
16c916d7c9SKumar Gala #include <asm/fsl_dtsec.h>
17c916d7c9SKumar Gala #include <asm/fsl_tgec.h>
18111fd19eSRoy Zang #include <asm/fsl_memac.h>
19c916d7c9SKumar Gala 
20c916d7c9SKumar Gala #include "fm.h"
21c916d7c9SKumar Gala 
22c916d7c9SKumar Gala static struct eth_device *devlist[NUM_FM_PORTS];
23c916d7c9SKumar Gala static int num_controllers;
24c916d7c9SKumar Gala 
25c916d7c9SKumar Gala #if defined(CONFIG_MII) || defined(CONFIG_CMD_MII) && !defined(BITBANGMII)
26c916d7c9SKumar Gala 
27c916d7c9SKumar Gala #define TBIANA_SETTINGS (TBIANA_ASYMMETRIC_PAUSE | TBIANA_SYMMETRIC_PAUSE | \
28c916d7c9SKumar Gala 			 TBIANA_FULL_DUPLEX)
29c916d7c9SKumar Gala 
30c916d7c9SKumar Gala #define TBIANA_SGMII_ACK 0x4001
31c916d7c9SKumar Gala 
32c916d7c9SKumar Gala #define TBICR_SETTINGS (TBICR_ANEG_ENABLE | TBICR_RESTART_ANEG | \
33c916d7c9SKumar Gala 			TBICR_FULL_DUPLEX | TBICR_SPEED1_SET)
34c916d7c9SKumar Gala 
35c916d7c9SKumar Gala /* Configure the TBI for SGMII operation */
36960d70c6SKim Phillips static void dtsec_configure_serdes(struct fm_eth *priv)
37c916d7c9SKumar Gala {
38111fd19eSRoy Zang #ifdef CONFIG_SYS_FMAN_V3
39111fd19eSRoy Zang 	u32 value;
40111fd19eSRoy Zang 	struct mii_dev bus;
41111fd19eSRoy Zang 	bus.priv = priv->mac->phyregs;
42111fd19eSRoy Zang 
43111fd19eSRoy Zang 	/* SGMII IF mode + AN enable */
44111fd19eSRoy Zang 	value = PHY_SGMII_IF_MODE_AN | PHY_SGMII_IF_MODE_SGMII;
45111fd19eSRoy Zang 	memac_mdio_write(&bus, 0, MDIO_DEVAD_NONE, 0x14, value);
46111fd19eSRoy Zang 
47111fd19eSRoy Zang 	/* Dev ability according to SGMII specification */
48111fd19eSRoy Zang 	value = PHY_SGMII_DEV_ABILITY_SGMII;
49111fd19eSRoy Zang 	memac_mdio_write(&bus, 0, MDIO_DEVAD_NONE, 0x4, value);
50111fd19eSRoy Zang 
51111fd19eSRoy Zang 	/* Adjust link timer for SGMII  -
52111fd19eSRoy Zang 	1.6 ms in units of 8 ns = 2 * 10^5 = 0x30d40 */
53111fd19eSRoy Zang 	memac_mdio_write(&bus, 0, MDIO_DEVAD_NONE, 0x13, 0x3);
54111fd19eSRoy Zang 	memac_mdio_write(&bus, 0, MDIO_DEVAD_NONE, 0x12, 0xd40);
55111fd19eSRoy Zang 
56111fd19eSRoy Zang 	/* Restart AN */
57111fd19eSRoy Zang 	value = PHY_SGMII_CR_DEF_VAL | PHY_SGMII_CR_RESET_AN;
58111fd19eSRoy Zang 	memac_mdio_write(&bus, 0, MDIO_DEVAD_NONE, 0, value);
59111fd19eSRoy Zang #else
60c916d7c9SKumar Gala 	struct dtsec *regs = priv->mac->base;
61c916d7c9SKumar Gala 	struct tsec_mii_mng *phyregs = priv->mac->phyregs;
62c916d7c9SKumar Gala 
63c916d7c9SKumar Gala 	/*
64c916d7c9SKumar Gala 	 * Access TBI PHY registers at given TSEC register offset as
65c916d7c9SKumar Gala 	 * opposed to the register offset used for external PHY accesses
66c916d7c9SKumar Gala 	 */
67c916d7c9SKumar Gala 	tsec_local_mdio_write(phyregs, in_be32(&regs->tbipa), 0, TBI_TBICON,
68c916d7c9SKumar Gala 			TBICON_CLK_SELECT);
69c916d7c9SKumar Gala 	tsec_local_mdio_write(phyregs, in_be32(&regs->tbipa), 0, TBI_ANA,
70c916d7c9SKumar Gala 			TBIANA_SGMII_ACK);
71c916d7c9SKumar Gala 	tsec_local_mdio_write(phyregs, in_be32(&regs->tbipa), 0,
72c916d7c9SKumar Gala 			TBI_CR, TBICR_SETTINGS);
73111fd19eSRoy Zang #endif
74c916d7c9SKumar Gala }
75c916d7c9SKumar Gala 
76c916d7c9SKumar Gala static void dtsec_init_phy(struct eth_device *dev)
77c916d7c9SKumar Gala {
78c916d7c9SKumar Gala 	struct fm_eth *fm_eth = dev->priv;
79111fd19eSRoy Zang #ifndef CONFIG_SYS_FMAN_V3
801f3bd3e2Sshaohui xie 	struct dtsec *regs = (struct dtsec *)CONFIG_SYS_FSL_FM1_DTSEC1_ADDR;
811f3bd3e2Sshaohui xie 
82c916d7c9SKumar Gala 	/* Assign a Physical address to the TBI */
83c916d7c9SKumar Gala 	out_be32(&regs->tbipa, CONFIG_SYS_TBIPA_VALUE);
84111fd19eSRoy Zang #endif
85c916d7c9SKumar Gala 
86c916d7c9SKumar Gala 	if (fm_eth->enet_if == PHY_INTERFACE_MODE_SGMII)
87c916d7c9SKumar Gala 		dtsec_configure_serdes(fm_eth);
88c916d7c9SKumar Gala }
89c916d7c9SKumar Gala 
90c916d7c9SKumar Gala static int tgec_is_fibre(struct eth_device *dev)
91c916d7c9SKumar Gala {
92c916d7c9SKumar Gala 	struct fm_eth *fm = dev->priv;
93c916d7c9SKumar Gala 	char phyopt[20];
94c916d7c9SKumar Gala 
95c916d7c9SKumar Gala 	sprintf(phyopt, "fsl_fm%d_xaui_phy", fm->fm_index + 1);
96c916d7c9SKumar Gala 
97c916d7c9SKumar Gala 	return hwconfig_arg_cmp(phyopt, "xfi");
98c916d7c9SKumar Gala }
99c916d7c9SKumar Gala #endif
100c916d7c9SKumar Gala 
101c916d7c9SKumar Gala static u16 muram_readw(u16 *addr)
102c916d7c9SKumar Gala {
103c916d7c9SKumar Gala 	u32 base = (u32)addr & ~0x3;
104c916d7c9SKumar Gala 	u32 val32 = *(u32 *)base;
105c916d7c9SKumar Gala 	int byte_pos;
106c916d7c9SKumar Gala 	u16 ret;
107c916d7c9SKumar Gala 
108c916d7c9SKumar Gala 	byte_pos = (u32)addr & 0x3;
109c916d7c9SKumar Gala 	if (byte_pos)
110c916d7c9SKumar Gala 		ret = (u16)(val32 & 0x0000ffff);
111c916d7c9SKumar Gala 	else
112c916d7c9SKumar Gala 		ret = (u16)((val32 & 0xffff0000) >> 16);
113c916d7c9SKumar Gala 
114c916d7c9SKumar Gala 	return ret;
115c916d7c9SKumar Gala }
116c916d7c9SKumar Gala 
117c916d7c9SKumar Gala static void muram_writew(u16 *addr, u16 val)
118c916d7c9SKumar Gala {
119c916d7c9SKumar Gala 	u32 base = (u32)addr & ~0x3;
120c916d7c9SKumar Gala 	u32 org32 = *(u32 *)base;
121c916d7c9SKumar Gala 	u32 val32;
122c916d7c9SKumar Gala 	int byte_pos;
123c916d7c9SKumar Gala 
124c916d7c9SKumar Gala 	byte_pos = (u32)addr & 0x3;
125c916d7c9SKumar Gala 	if (byte_pos)
126c916d7c9SKumar Gala 		val32 = (org32 & 0xffff0000) | val;
127c916d7c9SKumar Gala 	else
128c916d7c9SKumar Gala 		val32 = (org32 & 0x0000ffff) | ((u32)val << 16);
129c916d7c9SKumar Gala 
130c916d7c9SKumar Gala 	*(u32 *)base = val32;
131c916d7c9SKumar Gala }
132c916d7c9SKumar Gala 
133c916d7c9SKumar Gala static void bmi_rx_port_disable(struct fm_bmi_rx_port *rx_port)
134c916d7c9SKumar Gala {
135c916d7c9SKumar Gala 	int timeout = 1000000;
136c916d7c9SKumar Gala 
137c916d7c9SKumar Gala 	clrbits_be32(&rx_port->fmbm_rcfg, FMBM_RCFG_EN);
138c916d7c9SKumar Gala 
139c916d7c9SKumar Gala 	/* wait until the rx port is not busy */
140c916d7c9SKumar Gala 	while ((in_be32(&rx_port->fmbm_rst) & FMBM_RST_BSY) && timeout--)
141c916d7c9SKumar Gala 		;
142c916d7c9SKumar Gala }
143c916d7c9SKumar Gala 
144c916d7c9SKumar Gala static void bmi_rx_port_init(struct fm_bmi_rx_port *rx_port)
145c916d7c9SKumar Gala {
146c916d7c9SKumar Gala 	/* set BMI to independent mode, Rx port disable */
147c916d7c9SKumar Gala 	out_be32(&rx_port->fmbm_rcfg, FMBM_RCFG_IM);
148c916d7c9SKumar Gala 	/* clear FOF in IM case */
149c916d7c9SKumar Gala 	out_be32(&rx_port->fmbm_rim, 0);
150c916d7c9SKumar Gala 	/* Rx frame next engine -RISC */
151c916d7c9SKumar Gala 	out_be32(&rx_port->fmbm_rfne, NIA_ENG_RISC | NIA_RISC_AC_IM_RX);
152c916d7c9SKumar Gala 	/* Rx command attribute - no order, MR[3] = 1 */
153c916d7c9SKumar Gala 	clrbits_be32(&rx_port->fmbm_rfca, FMBM_RFCA_ORDER | FMBM_RFCA_MR_MASK);
154c916d7c9SKumar Gala 	setbits_be32(&rx_port->fmbm_rfca, FMBM_RFCA_MR(4));
155c916d7c9SKumar Gala 	/* enable Rx statistic counters */
156c916d7c9SKumar Gala 	out_be32(&rx_port->fmbm_rstc, FMBM_RSTC_EN);
157c916d7c9SKumar Gala 	/* disable Rx performance counters */
158c916d7c9SKumar Gala 	out_be32(&rx_port->fmbm_rpc, 0);
159c916d7c9SKumar Gala }
160c916d7c9SKumar Gala 
161c916d7c9SKumar Gala static void bmi_tx_port_disable(struct fm_bmi_tx_port *tx_port)
162c916d7c9SKumar Gala {
163c916d7c9SKumar Gala 	int timeout = 1000000;
164c916d7c9SKumar Gala 
165c916d7c9SKumar Gala 	clrbits_be32(&tx_port->fmbm_tcfg, FMBM_TCFG_EN);
166c916d7c9SKumar Gala 
167c916d7c9SKumar Gala 	/* wait until the tx port is not busy */
168c916d7c9SKumar Gala 	while ((in_be32(&tx_port->fmbm_tst) & FMBM_TST_BSY) && timeout--)
169c916d7c9SKumar Gala 		;
170c916d7c9SKumar Gala }
171c916d7c9SKumar Gala 
172c916d7c9SKumar Gala static void bmi_tx_port_init(struct fm_bmi_tx_port *tx_port)
173c916d7c9SKumar Gala {
174c916d7c9SKumar Gala 	/* set BMI to independent mode, Tx port disable */
175c916d7c9SKumar Gala 	out_be32(&tx_port->fmbm_tcfg, FMBM_TCFG_IM);
176c916d7c9SKumar Gala 	/* Tx frame next engine -RISC */
177c916d7c9SKumar Gala 	out_be32(&tx_port->fmbm_tfne, NIA_ENG_RISC | NIA_RISC_AC_IM_TX);
178c916d7c9SKumar Gala 	out_be32(&tx_port->fmbm_tfene, NIA_ENG_RISC | NIA_RISC_AC_IM_TX);
179c916d7c9SKumar Gala 	/* Tx command attribute - no order, MR[3] = 1 */
180c916d7c9SKumar Gala 	clrbits_be32(&tx_port->fmbm_tfca, FMBM_TFCA_ORDER | FMBM_TFCA_MR_MASK);
181c916d7c9SKumar Gala 	setbits_be32(&tx_port->fmbm_tfca, FMBM_TFCA_MR(4));
182c916d7c9SKumar Gala 	/* enable Tx statistic counters */
183c916d7c9SKumar Gala 	out_be32(&tx_port->fmbm_tstc, FMBM_TSTC_EN);
184c916d7c9SKumar Gala 	/* disable Tx performance counters */
185c916d7c9SKumar Gala 	out_be32(&tx_port->fmbm_tpc, 0);
186c916d7c9SKumar Gala }
187c916d7c9SKumar Gala 
188c916d7c9SKumar Gala static int fm_eth_rx_port_parameter_init(struct fm_eth *fm_eth)
189c916d7c9SKumar Gala {
190c916d7c9SKumar Gala 	struct fm_port_global_pram *pram;
191c916d7c9SKumar Gala 	u32 pram_page_offset;
192c916d7c9SKumar Gala 	void *rx_bd_ring_base;
193c916d7c9SKumar Gala 	void *rx_buf_pool;
194c916d7c9SKumar Gala 	struct fm_port_bd *rxbd;
195c916d7c9SKumar Gala 	struct fm_port_qd *rxqd;
196c916d7c9SKumar Gala 	struct fm_bmi_rx_port *bmi_rx_port = fm_eth->rx_port;
197c916d7c9SKumar Gala 	int i;
198c916d7c9SKumar Gala 
199c916d7c9SKumar Gala 	/* alloc global parameter ram at MURAM */
200c916d7c9SKumar Gala 	pram = (struct fm_port_global_pram *)fm_muram_alloc(fm_eth->fm_index,
201c916d7c9SKumar Gala 		FM_PRAM_SIZE, FM_PRAM_ALIGN);
202c916d7c9SKumar Gala 	fm_eth->rx_pram = pram;
203c916d7c9SKumar Gala 
204c916d7c9SKumar Gala 	/* parameter page offset to MURAM */
205c916d7c9SKumar Gala 	pram_page_offset = (u32)pram - fm_muram_base(fm_eth->fm_index);
206c916d7c9SKumar Gala 
207c916d7c9SKumar Gala 	/* enable global mode- snooping data buffers and BDs */
208c916d7c9SKumar Gala 	pram->mode = PRAM_MODE_GLOBAL;
209c916d7c9SKumar Gala 
210c916d7c9SKumar Gala 	/* init the Rx queue descriptor pionter */
211c916d7c9SKumar Gala 	pram->rxqd_ptr = pram_page_offset + 0x20;
212c916d7c9SKumar Gala 
213c916d7c9SKumar Gala 	/* set the max receive buffer length, power of 2 */
214c916d7c9SKumar Gala 	muram_writew(&pram->mrblr, MAX_RXBUF_LOG2);
215c916d7c9SKumar Gala 
216c916d7c9SKumar Gala 	/* alloc Rx buffer descriptors from main memory */
217c916d7c9SKumar Gala 	rx_bd_ring_base = malloc(sizeof(struct fm_port_bd)
218c916d7c9SKumar Gala 			* RX_BD_RING_SIZE);
219c916d7c9SKumar Gala 	if (!rx_bd_ring_base)
220c916d7c9SKumar Gala 		return 0;
221c916d7c9SKumar Gala 	memset(rx_bd_ring_base, 0, sizeof(struct fm_port_bd)
222c916d7c9SKumar Gala 			* RX_BD_RING_SIZE);
223c916d7c9SKumar Gala 
224c916d7c9SKumar Gala 	/* alloc Rx buffer from main memory */
225c916d7c9SKumar Gala 	rx_buf_pool = malloc(MAX_RXBUF_LEN * RX_BD_RING_SIZE);
226c916d7c9SKumar Gala 	if (!rx_buf_pool)
227c916d7c9SKumar Gala 		return 0;
228c916d7c9SKumar Gala 	memset(rx_buf_pool, 0, MAX_RXBUF_LEN * RX_BD_RING_SIZE);
229c916d7c9SKumar Gala 
230c916d7c9SKumar Gala 	/* save them to fm_eth */
231c916d7c9SKumar Gala 	fm_eth->rx_bd_ring = rx_bd_ring_base;
232c916d7c9SKumar Gala 	fm_eth->cur_rxbd = rx_bd_ring_base;
233c916d7c9SKumar Gala 	fm_eth->rx_buf = rx_buf_pool;
234c916d7c9SKumar Gala 
235c916d7c9SKumar Gala 	/* init Rx BDs ring */
236c916d7c9SKumar Gala 	rxbd = (struct fm_port_bd *)rx_bd_ring_base;
237c916d7c9SKumar Gala 	for (i = 0; i < RX_BD_RING_SIZE; i++) {
238c916d7c9SKumar Gala 		rxbd->status = RxBD_EMPTY;
239c916d7c9SKumar Gala 		rxbd->len = 0;
240c916d7c9SKumar Gala 		rxbd->buf_ptr_hi = 0;
241c916d7c9SKumar Gala 		rxbd->buf_ptr_lo = (u32)rx_buf_pool + i * MAX_RXBUF_LEN;
242c916d7c9SKumar Gala 		rxbd++;
243c916d7c9SKumar Gala 	}
244c916d7c9SKumar Gala 
245c916d7c9SKumar Gala 	/* set the Rx queue descriptor */
246c916d7c9SKumar Gala 	rxqd = &pram->rxqd;
247c916d7c9SKumar Gala 	muram_writew(&rxqd->gen, 0);
248c916d7c9SKumar Gala 	muram_writew(&rxqd->bd_ring_base_hi, 0);
249c916d7c9SKumar Gala 	rxqd->bd_ring_base_lo = (u32)rx_bd_ring_base;
250c916d7c9SKumar Gala 	muram_writew(&rxqd->bd_ring_size, sizeof(struct fm_port_bd)
251c916d7c9SKumar Gala 			* RX_BD_RING_SIZE);
252c916d7c9SKumar Gala 	muram_writew(&rxqd->offset_in, 0);
253c916d7c9SKumar Gala 	muram_writew(&rxqd->offset_out, 0);
254c916d7c9SKumar Gala 
255c916d7c9SKumar Gala 	/* set IM parameter ram pointer to Rx Frame Queue ID */
256c916d7c9SKumar Gala 	out_be32(&bmi_rx_port->fmbm_rfqid, pram_page_offset);
257c916d7c9SKumar Gala 
258c916d7c9SKumar Gala 	return 1;
259c916d7c9SKumar Gala }
260c916d7c9SKumar Gala 
261c916d7c9SKumar Gala static int fm_eth_tx_port_parameter_init(struct fm_eth *fm_eth)
262c916d7c9SKumar Gala {
263c916d7c9SKumar Gala 	struct fm_port_global_pram *pram;
264c916d7c9SKumar Gala 	u32 pram_page_offset;
265c916d7c9SKumar Gala 	void *tx_bd_ring_base;
266c916d7c9SKumar Gala 	struct fm_port_bd *txbd;
267c916d7c9SKumar Gala 	struct fm_port_qd *txqd;
268c916d7c9SKumar Gala 	struct fm_bmi_tx_port *bmi_tx_port = fm_eth->tx_port;
269c916d7c9SKumar Gala 	int i;
270c916d7c9SKumar Gala 
271c916d7c9SKumar Gala 	/* alloc global parameter ram at MURAM */
272c916d7c9SKumar Gala 	pram = (struct fm_port_global_pram *)fm_muram_alloc(fm_eth->fm_index,
273c916d7c9SKumar Gala 		FM_PRAM_SIZE, FM_PRAM_ALIGN);
274c916d7c9SKumar Gala 	fm_eth->tx_pram = pram;
275c916d7c9SKumar Gala 
276c916d7c9SKumar Gala 	/* parameter page offset to MURAM */
277c916d7c9SKumar Gala 	pram_page_offset = (u32)pram - fm_muram_base(fm_eth->fm_index);
278c916d7c9SKumar Gala 
279c916d7c9SKumar Gala 	/* enable global mode- snooping data buffers and BDs */
280c916d7c9SKumar Gala 	pram->mode = PRAM_MODE_GLOBAL;
281c916d7c9SKumar Gala 
282c916d7c9SKumar Gala 	/* init the Tx queue descriptor pionter */
283c916d7c9SKumar Gala 	pram->txqd_ptr = pram_page_offset + 0x40;
284c916d7c9SKumar Gala 
285c916d7c9SKumar Gala 	/* alloc Tx buffer descriptors from main memory */
286c916d7c9SKumar Gala 	tx_bd_ring_base = malloc(sizeof(struct fm_port_bd)
287c916d7c9SKumar Gala 			* TX_BD_RING_SIZE);
288c916d7c9SKumar Gala 	if (!tx_bd_ring_base)
289c916d7c9SKumar Gala 		return 0;
290c916d7c9SKumar Gala 	memset(tx_bd_ring_base, 0, sizeof(struct fm_port_bd)
291c916d7c9SKumar Gala 			* TX_BD_RING_SIZE);
292c916d7c9SKumar Gala 	/* save it to fm_eth */
293c916d7c9SKumar Gala 	fm_eth->tx_bd_ring = tx_bd_ring_base;
294c916d7c9SKumar Gala 	fm_eth->cur_txbd = tx_bd_ring_base;
295c916d7c9SKumar Gala 
296c916d7c9SKumar Gala 	/* init Tx BDs ring */
297c916d7c9SKumar Gala 	txbd = (struct fm_port_bd *)tx_bd_ring_base;
298c916d7c9SKumar Gala 	for (i = 0; i < TX_BD_RING_SIZE; i++) {
299c916d7c9SKumar Gala 		txbd->status = TxBD_LAST;
300c916d7c9SKumar Gala 		txbd->len = 0;
301c916d7c9SKumar Gala 		txbd->buf_ptr_hi = 0;
302c916d7c9SKumar Gala 		txbd->buf_ptr_lo = 0;
303c916d7c9SKumar Gala 	}
304c916d7c9SKumar Gala 
305c916d7c9SKumar Gala 	/* set the Tx queue decriptor */
306c916d7c9SKumar Gala 	txqd = &pram->txqd;
307c916d7c9SKumar Gala 	muram_writew(&txqd->bd_ring_base_hi, 0);
308c916d7c9SKumar Gala 	txqd->bd_ring_base_lo = (u32)tx_bd_ring_base;
309c916d7c9SKumar Gala 	muram_writew(&txqd->bd_ring_size, sizeof(struct fm_port_bd)
310c916d7c9SKumar Gala 			* TX_BD_RING_SIZE);
311c916d7c9SKumar Gala 	muram_writew(&txqd->offset_in, 0);
312c916d7c9SKumar Gala 	muram_writew(&txqd->offset_out, 0);
313c916d7c9SKumar Gala 
314c916d7c9SKumar Gala 	/* set IM parameter ram pointer to Tx Confirmation Frame Queue ID */
315c916d7c9SKumar Gala 	out_be32(&bmi_tx_port->fmbm_tcfqid, pram_page_offset);
316c916d7c9SKumar Gala 
317c916d7c9SKumar Gala 	return 1;
318c916d7c9SKumar Gala }
319c916d7c9SKumar Gala 
320c916d7c9SKumar Gala static int fm_eth_init(struct fm_eth *fm_eth)
321c916d7c9SKumar Gala {
322c916d7c9SKumar Gala 
323c916d7c9SKumar Gala 	if (!fm_eth_rx_port_parameter_init(fm_eth))
324c916d7c9SKumar Gala 		return 0;
325c916d7c9SKumar Gala 
326c916d7c9SKumar Gala 	if (!fm_eth_tx_port_parameter_init(fm_eth))
327c916d7c9SKumar Gala 		return 0;
328c916d7c9SKumar Gala 
329c916d7c9SKumar Gala 	return 1;
330c916d7c9SKumar Gala }
331c916d7c9SKumar Gala 
332c916d7c9SKumar Gala static int fm_eth_startup(struct fm_eth *fm_eth)
333c916d7c9SKumar Gala {
334c916d7c9SKumar Gala 	struct fsl_enet_mac *mac;
335c916d7c9SKumar Gala 	mac = fm_eth->mac;
336c916d7c9SKumar Gala 
337c916d7c9SKumar Gala 	/* Rx/TxBDs, Rx/TxQDs, Rx buff and parameter ram init */
338c916d7c9SKumar Gala 	if (!fm_eth_init(fm_eth))
339c916d7c9SKumar Gala 		return 0;
340c916d7c9SKumar Gala 	/* setup the MAC controller */
341c916d7c9SKumar Gala 	mac->init_mac(mac);
342c916d7c9SKumar Gala 
343c916d7c9SKumar Gala 	/* For some reason we need to set SPEED_100 */
3441c68d01eSShaohui Xie 	if (((fm_eth->enet_if == PHY_INTERFACE_MODE_SGMII) ||
3451c68d01eSShaohui Xie 	     (fm_eth->enet_if == PHY_INTERFACE_MODE_QSGMII)) &&
3461c68d01eSShaohui Xie 	      mac->set_if_mode)
347c916d7c9SKumar Gala 		mac->set_if_mode(mac, fm_eth->enet_if, SPEED_100);
348c916d7c9SKumar Gala 
349c916d7c9SKumar Gala 	/* init bmi rx port, IM mode and disable */
350c916d7c9SKumar Gala 	bmi_rx_port_init(fm_eth->rx_port);
351c916d7c9SKumar Gala 	/* init bmi tx port, IM mode and disable */
352c916d7c9SKumar Gala 	bmi_tx_port_init(fm_eth->tx_port);
353c916d7c9SKumar Gala 
354c916d7c9SKumar Gala 	return 1;
355c916d7c9SKumar Gala }
356c916d7c9SKumar Gala 
357c916d7c9SKumar Gala static void fmc_tx_port_graceful_stop_enable(struct fm_eth *fm_eth)
358c916d7c9SKumar Gala {
359c916d7c9SKumar Gala 	struct fm_port_global_pram *pram;
360c916d7c9SKumar Gala 
361c916d7c9SKumar Gala 	pram = fm_eth->tx_pram;
362c916d7c9SKumar Gala 	/* graceful stop transmission of frames */
363c916d7c9SKumar Gala 	pram->mode |= PRAM_MODE_GRACEFUL_STOP;
364c916d7c9SKumar Gala 	sync();
365c916d7c9SKumar Gala }
366c916d7c9SKumar Gala 
367c916d7c9SKumar Gala static void fmc_tx_port_graceful_stop_disable(struct fm_eth *fm_eth)
368c916d7c9SKumar Gala {
369c916d7c9SKumar Gala 	struct fm_port_global_pram *pram;
370c916d7c9SKumar Gala 
371c916d7c9SKumar Gala 	pram = fm_eth->tx_pram;
372c916d7c9SKumar Gala 	/* re-enable transmission of frames */
373c916d7c9SKumar Gala 	pram->mode &= ~PRAM_MODE_GRACEFUL_STOP;
374c916d7c9SKumar Gala 	sync();
375c916d7c9SKumar Gala }
376c916d7c9SKumar Gala 
377c916d7c9SKumar Gala static int fm_eth_open(struct eth_device *dev, bd_t *bd)
378c916d7c9SKumar Gala {
379c916d7c9SKumar Gala 	struct fm_eth *fm_eth;
380c916d7c9SKumar Gala 	struct fsl_enet_mac *mac;
38111af8d65STimur Tabi #ifdef CONFIG_PHYLIB
38211af8d65STimur Tabi 	int ret;
38311af8d65STimur Tabi #endif
384c916d7c9SKumar Gala 
385c916d7c9SKumar Gala 	fm_eth = (struct fm_eth *)dev->priv;
386c916d7c9SKumar Gala 	mac = fm_eth->mac;
387c916d7c9SKumar Gala 
388c916d7c9SKumar Gala 	/* setup the MAC address */
389c916d7c9SKumar Gala 	if (dev->enetaddr[0] & 0x01) {
390c916d7c9SKumar Gala 		printf("%s: MacAddress is multcast address\n",	__func__);
391c916d7c9SKumar Gala 		return 1;
392c916d7c9SKumar Gala 	}
393c916d7c9SKumar Gala 	mac->set_mac_addr(mac, dev->enetaddr);
394c916d7c9SKumar Gala 
395c916d7c9SKumar Gala 	/* enable bmi Rx port */
396c916d7c9SKumar Gala 	setbits_be32(&fm_eth->rx_port->fmbm_rcfg, FMBM_RCFG_EN);
397c916d7c9SKumar Gala 	/* enable MAC rx/tx port */
398c916d7c9SKumar Gala 	mac->enable_mac(mac);
399c916d7c9SKumar Gala 	/* enable bmi Tx port */
400c916d7c9SKumar Gala 	setbits_be32(&fm_eth->tx_port->fmbm_tcfg, FMBM_TCFG_EN);
401c916d7c9SKumar Gala 	/* re-enable transmission of frame */
402c916d7c9SKumar Gala 	fmc_tx_port_graceful_stop_disable(fm_eth);
403c916d7c9SKumar Gala 
404c916d7c9SKumar Gala #ifdef CONFIG_PHYLIB
40511af8d65STimur Tabi 	ret = phy_startup(fm_eth->phydev);
40611af8d65STimur Tabi 	if (ret) {
40711af8d65STimur Tabi 		printf("%s: Could not initialize\n", fm_eth->phydev->dev->name);
40811af8d65STimur Tabi 		return ret;
40911af8d65STimur Tabi 	}
410c916d7c9SKumar Gala #else
411c916d7c9SKumar Gala 	fm_eth->phydev->speed = SPEED_1000;
412c916d7c9SKumar Gala 	fm_eth->phydev->link = 1;
413c916d7c9SKumar Gala 	fm_eth->phydev->duplex = DUPLEX_FULL;
414c916d7c9SKumar Gala #endif
415c916d7c9SKumar Gala 
416c916d7c9SKumar Gala 	/* set the MAC-PHY mode */
417c916d7c9SKumar Gala 	mac->set_if_mode(mac, fm_eth->enet_if, fm_eth->phydev->speed);
418c916d7c9SKumar Gala 
419c916d7c9SKumar Gala 	if (!fm_eth->phydev->link)
420c916d7c9SKumar Gala 		printf("%s: No link.\n", fm_eth->phydev->dev->name);
421c916d7c9SKumar Gala 
422c916d7c9SKumar Gala 	return fm_eth->phydev->link ? 0 : -1;
423c916d7c9SKumar Gala }
424c916d7c9SKumar Gala 
425c916d7c9SKumar Gala static void fm_eth_halt(struct eth_device *dev)
426c916d7c9SKumar Gala {
427c916d7c9SKumar Gala 	struct fm_eth *fm_eth;
428c916d7c9SKumar Gala 	struct fsl_enet_mac *mac;
429c916d7c9SKumar Gala 
430c916d7c9SKumar Gala 	fm_eth = (struct fm_eth *)dev->priv;
431c916d7c9SKumar Gala 	mac = fm_eth->mac;
432c916d7c9SKumar Gala 
433c916d7c9SKumar Gala 	/* graceful stop the transmission of frames */
434c916d7c9SKumar Gala 	fmc_tx_port_graceful_stop_enable(fm_eth);
435c916d7c9SKumar Gala 	/* disable bmi Tx port */
436c916d7c9SKumar Gala 	bmi_tx_port_disable(fm_eth->tx_port);
437c916d7c9SKumar Gala 	/* disable MAC rx/tx port */
438c916d7c9SKumar Gala 	mac->disable_mac(mac);
439c916d7c9SKumar Gala 	/* disable bmi Rx port */
440c916d7c9SKumar Gala 	bmi_rx_port_disable(fm_eth->rx_port);
441c916d7c9SKumar Gala 
442c916d7c9SKumar Gala 	phy_shutdown(fm_eth->phydev);
443c916d7c9SKumar Gala }
444c916d7c9SKumar Gala 
445e9df2018SJoe Hershberger static int fm_eth_send(struct eth_device *dev, void *buf, int len)
446c916d7c9SKumar Gala {
447c916d7c9SKumar Gala 	struct fm_eth *fm_eth;
448c916d7c9SKumar Gala 	struct fm_port_global_pram *pram;
449c916d7c9SKumar Gala 	struct fm_port_bd *txbd, *txbd_base;
450c916d7c9SKumar Gala 	u16 offset_in;
451c916d7c9SKumar Gala 	int i;
452c916d7c9SKumar Gala 
453c916d7c9SKumar Gala 	fm_eth = (struct fm_eth *)dev->priv;
454c916d7c9SKumar Gala 	pram = fm_eth->tx_pram;
455c916d7c9SKumar Gala 	txbd = fm_eth->cur_txbd;
456c916d7c9SKumar Gala 
457c916d7c9SKumar Gala 	/* find one empty TxBD */
458c916d7c9SKumar Gala 	for (i = 0; txbd->status & TxBD_READY; i++) {
459c916d7c9SKumar Gala 		udelay(100);
460c916d7c9SKumar Gala 		if (i > 0x1000) {
461c916d7c9SKumar Gala 			printf("%s: Tx buffer not ready\n", dev->name);
462c916d7c9SKumar Gala 			return 0;
463c916d7c9SKumar Gala 		}
464c916d7c9SKumar Gala 	}
465c916d7c9SKumar Gala 	/* setup TxBD */
466c916d7c9SKumar Gala 	txbd->buf_ptr_hi = 0;
467c916d7c9SKumar Gala 	txbd->buf_ptr_lo = (u32)buf;
468c916d7c9SKumar Gala 	txbd->len = len;
469c916d7c9SKumar Gala 	sync();
470c916d7c9SKumar Gala 	txbd->status = TxBD_READY | TxBD_LAST;
471c916d7c9SKumar Gala 	sync();
472c916d7c9SKumar Gala 
473c916d7c9SKumar Gala 	/* update TxQD, let RISC to send the packet */
474c916d7c9SKumar Gala 	offset_in = muram_readw(&pram->txqd.offset_in);
475c916d7c9SKumar Gala 	offset_in += sizeof(struct fm_port_bd);
476c916d7c9SKumar Gala 	if (offset_in >= muram_readw(&pram->txqd.bd_ring_size))
477c916d7c9SKumar Gala 		offset_in = 0;
478c916d7c9SKumar Gala 	muram_writew(&pram->txqd.offset_in, offset_in);
479c916d7c9SKumar Gala 	sync();
480c916d7c9SKumar Gala 
481c916d7c9SKumar Gala 	/* wait for buffer to be transmitted */
482c916d7c9SKumar Gala 	for (i = 0; txbd->status & TxBD_READY; i++) {
483c916d7c9SKumar Gala 		udelay(100);
484c916d7c9SKumar Gala 		if (i > 0x10000) {
485c916d7c9SKumar Gala 			printf("%s: Tx error\n", dev->name);
486c916d7c9SKumar Gala 			return 0;
487c916d7c9SKumar Gala 		}
488c916d7c9SKumar Gala 	}
489c916d7c9SKumar Gala 
490c916d7c9SKumar Gala 	/* advance the TxBD */
491c916d7c9SKumar Gala 	txbd++;
492c916d7c9SKumar Gala 	txbd_base = (struct fm_port_bd *)fm_eth->tx_bd_ring;
493c916d7c9SKumar Gala 	if (txbd >= (txbd_base + TX_BD_RING_SIZE))
494c916d7c9SKumar Gala 		txbd = txbd_base;
495c916d7c9SKumar Gala 	/* update current txbd */
496c916d7c9SKumar Gala 	fm_eth->cur_txbd = (void *)txbd;
497c916d7c9SKumar Gala 
498c916d7c9SKumar Gala 	return 1;
499c916d7c9SKumar Gala }
500c916d7c9SKumar Gala 
501c916d7c9SKumar Gala static int fm_eth_recv(struct eth_device *dev)
502c916d7c9SKumar Gala {
503c916d7c9SKumar Gala 	struct fm_eth *fm_eth;
504c916d7c9SKumar Gala 	struct fm_port_global_pram *pram;
505c916d7c9SKumar Gala 	struct fm_port_bd *rxbd, *rxbd_base;
506c916d7c9SKumar Gala 	u16 status, len;
507c916d7c9SKumar Gala 	u8 *data;
508c916d7c9SKumar Gala 	u16 offset_out;
509c916d7c9SKumar Gala 
510c916d7c9SKumar Gala 	fm_eth = (struct fm_eth *)dev->priv;
511c916d7c9SKumar Gala 	pram = fm_eth->rx_pram;
512c916d7c9SKumar Gala 	rxbd = fm_eth->cur_rxbd;
513c916d7c9SKumar Gala 	status = rxbd->status;
514c916d7c9SKumar Gala 
515c916d7c9SKumar Gala 	while (!(status & RxBD_EMPTY)) {
516c916d7c9SKumar Gala 		if (!(status & RxBD_ERROR)) {
517c916d7c9SKumar Gala 			data = (u8 *)rxbd->buf_ptr_lo;
518c916d7c9SKumar Gala 			len = rxbd->len;
519c916d7c9SKumar Gala 			NetReceive(data, len);
520c916d7c9SKumar Gala 		} else {
521c916d7c9SKumar Gala 			printf("%s: Rx error\n", dev->name);
522c916d7c9SKumar Gala 			return 0;
523c916d7c9SKumar Gala 		}
524c916d7c9SKumar Gala 
525c916d7c9SKumar Gala 		/* clear the RxBDs */
526c916d7c9SKumar Gala 		rxbd->status = RxBD_EMPTY;
527c916d7c9SKumar Gala 		rxbd->len = 0;
528c916d7c9SKumar Gala 		sync();
529c916d7c9SKumar Gala 
530c916d7c9SKumar Gala 		/* advance RxBD */
531c916d7c9SKumar Gala 		rxbd++;
532c916d7c9SKumar Gala 		rxbd_base = (struct fm_port_bd *)fm_eth->rx_bd_ring;
533c916d7c9SKumar Gala 		if (rxbd >= (rxbd_base + RX_BD_RING_SIZE))
534c916d7c9SKumar Gala 			rxbd = rxbd_base;
535c916d7c9SKumar Gala 		/* read next status */
536c916d7c9SKumar Gala 		status = rxbd->status;
537c916d7c9SKumar Gala 
538c916d7c9SKumar Gala 		/* update RxQD */
539c916d7c9SKumar Gala 		offset_out = muram_readw(&pram->rxqd.offset_out);
540c916d7c9SKumar Gala 		offset_out += sizeof(struct fm_port_bd);
541c916d7c9SKumar Gala 		if (offset_out >= muram_readw(&pram->rxqd.bd_ring_size))
542c916d7c9SKumar Gala 			offset_out = 0;
543c916d7c9SKumar Gala 		muram_writew(&pram->rxqd.offset_out, offset_out);
544c916d7c9SKumar Gala 		sync();
545c916d7c9SKumar Gala 	}
546c916d7c9SKumar Gala 	fm_eth->cur_rxbd = (void *)rxbd;
547c916d7c9SKumar Gala 
548c916d7c9SKumar Gala 	return 1;
549c916d7c9SKumar Gala }
550c916d7c9SKumar Gala 
551c916d7c9SKumar Gala static int fm_eth_init_mac(struct fm_eth *fm_eth, struct ccsr_fman *reg)
552c916d7c9SKumar Gala {
553c916d7c9SKumar Gala 	struct fsl_enet_mac *mac;
554c916d7c9SKumar Gala 	int num;
555c916d7c9SKumar Gala 	void *base, *phyregs = NULL;
556c916d7c9SKumar Gala 
557c916d7c9SKumar Gala 	num = fm_eth->num;
558c916d7c9SKumar Gala 
559111fd19eSRoy Zang #ifdef CONFIG_SYS_FMAN_V3
560*82a55c1eSShengzhou Liu 	if (fm_eth->type == FM_ETH_10G_E) {
561*82a55c1eSShengzhou Liu 		/* 10GEC1/10GEC2 use mEMAC9/mEMAC10
562*82a55c1eSShengzhou Liu 		 * 10GEC3/10GEC4 use mEMAC1/mEMAC2
563*82a55c1eSShengzhou Liu 		 * so it needs to change the num.
564*82a55c1eSShengzhou Liu 		 */
565*82a55c1eSShengzhou Liu 		if (fm_eth->num >= 2)
566*82a55c1eSShengzhou Liu 			num -= 2;
567*82a55c1eSShengzhou Liu 		else
568944b6ccfSShaohui Xie 			num += 8;
569*82a55c1eSShengzhou Liu 	}
570111fd19eSRoy Zang 	base = &reg->memac[num].fm_memac;
571111fd19eSRoy Zang 	phyregs = &reg->memac[num].fm_memac_mdio;
572111fd19eSRoy Zang #else
573c916d7c9SKumar Gala 	/* Get the mac registers base address */
574c916d7c9SKumar Gala 	if (fm_eth->type == FM_ETH_1G_E) {
575c916d7c9SKumar Gala 		base = &reg->mac_1g[num].fm_dtesc;
57630381716STimur Tabi 		phyregs = &reg->mac_1g[num].fm_mdio.miimcfg;
577c916d7c9SKumar Gala 	} else {
578c916d7c9SKumar Gala 		base = &reg->mac_10g[num].fm_10gec;
579c916d7c9SKumar Gala 		phyregs = &reg->mac_10g[num].fm_10gec_mdio;
580c916d7c9SKumar Gala 	}
581111fd19eSRoy Zang #endif
582c916d7c9SKumar Gala 
583c916d7c9SKumar Gala 	/* alloc mac controller */
584c916d7c9SKumar Gala 	mac = malloc(sizeof(struct fsl_enet_mac));
585c916d7c9SKumar Gala 	if (!mac)
586c916d7c9SKumar Gala 		return 0;
587c916d7c9SKumar Gala 	memset(mac, 0, sizeof(struct fsl_enet_mac));
588c916d7c9SKumar Gala 
589c916d7c9SKumar Gala 	/* save the mac to fm_eth struct */
590c916d7c9SKumar Gala 	fm_eth->mac = mac;
591c916d7c9SKumar Gala 
592111fd19eSRoy Zang #ifdef CONFIG_SYS_FMAN_V3
593111fd19eSRoy Zang 	init_memac(mac, base, phyregs, MAX_RXBUF_LEN);
594111fd19eSRoy Zang #else
595c916d7c9SKumar Gala 	if (fm_eth->type == FM_ETH_1G_E)
59630381716STimur Tabi 		init_dtsec(mac, base, phyregs, MAX_RXBUF_LEN);
597c916d7c9SKumar Gala 	else
598c916d7c9SKumar Gala 		init_tgec(mac, base, phyregs, MAX_RXBUF_LEN);
599111fd19eSRoy Zang #endif
600c916d7c9SKumar Gala 
601c916d7c9SKumar Gala 	return 1;
602c916d7c9SKumar Gala }
603c916d7c9SKumar Gala 
604c916d7c9SKumar Gala static int init_phy(struct eth_device *dev)
605c916d7c9SKumar Gala {
606c916d7c9SKumar Gala 	struct fm_eth *fm_eth = dev->priv;
607c916d7c9SKumar Gala 	struct phy_device *phydev = NULL;
608c916d7c9SKumar Gala 	u32 supported;
609c916d7c9SKumar Gala 
610c916d7c9SKumar Gala #ifdef CONFIG_PHYLIB
611c916d7c9SKumar Gala 	if (fm_eth->type == FM_ETH_1G_E)
612c916d7c9SKumar Gala 		dtsec_init_phy(dev);
613c916d7c9SKumar Gala 
614c916d7c9SKumar Gala 	if (fm_eth->bus) {
615c916d7c9SKumar Gala 		phydev = phy_connect(fm_eth->bus, fm_eth->phyaddr, dev,
616c916d7c9SKumar Gala 					fm_eth->enet_if);
617c916d7c9SKumar Gala 	}
618c916d7c9SKumar Gala 
619c916d7c9SKumar Gala 	if (!phydev) {
620c916d7c9SKumar Gala 		printf("Failed to connect\n");
621c916d7c9SKumar Gala 		return -1;
622c916d7c9SKumar Gala 	}
623c916d7c9SKumar Gala 
624c916d7c9SKumar Gala 	if (fm_eth->type == FM_ETH_1G_E) {
625c916d7c9SKumar Gala 		supported = (SUPPORTED_10baseT_Half |
626c916d7c9SKumar Gala 				SUPPORTED_10baseT_Full |
627c916d7c9SKumar Gala 				SUPPORTED_100baseT_Half |
628c916d7c9SKumar Gala 				SUPPORTED_100baseT_Full |
629c916d7c9SKumar Gala 				SUPPORTED_1000baseT_Full);
630c916d7c9SKumar Gala 	} else {
631c916d7c9SKumar Gala 		supported = SUPPORTED_10000baseT_Full;
632c916d7c9SKumar Gala 
633c916d7c9SKumar Gala 		if (tgec_is_fibre(dev))
634c916d7c9SKumar Gala 			phydev->port = PORT_FIBRE;
635c916d7c9SKumar Gala 	}
636c916d7c9SKumar Gala 
637c916d7c9SKumar Gala 	phydev->supported &= supported;
638c916d7c9SKumar Gala 	phydev->advertising = phydev->supported;
639c916d7c9SKumar Gala 
640c916d7c9SKumar Gala 	fm_eth->phydev = phydev;
641c916d7c9SKumar Gala 
642c916d7c9SKumar Gala 	phy_config(phydev);
643c916d7c9SKumar Gala #endif
644c916d7c9SKumar Gala 
645c916d7c9SKumar Gala 	return 0;
646c916d7c9SKumar Gala }
647c916d7c9SKumar Gala 
648c916d7c9SKumar Gala int fm_eth_initialize(struct ccsr_fman *reg, struct fm_eth_info *info)
649c916d7c9SKumar Gala {
650c916d7c9SKumar Gala 	struct eth_device *dev;
651c916d7c9SKumar Gala 	struct fm_eth *fm_eth;
652c916d7c9SKumar Gala 	int i, num = info->num;
653c916d7c9SKumar Gala 
654c916d7c9SKumar Gala 	/* alloc eth device */
655c916d7c9SKumar Gala 	dev = (struct eth_device *)malloc(sizeof(struct eth_device));
656c916d7c9SKumar Gala 	if (!dev)
657c916d7c9SKumar Gala 		return 0;
658c916d7c9SKumar Gala 	memset(dev, 0, sizeof(struct eth_device));
659c916d7c9SKumar Gala 
660c916d7c9SKumar Gala 	/* alloc the FMan ethernet private struct */
661c916d7c9SKumar Gala 	fm_eth = (struct fm_eth *)malloc(sizeof(struct fm_eth));
662c916d7c9SKumar Gala 	if (!fm_eth)
663c916d7c9SKumar Gala 		return 0;
664c916d7c9SKumar Gala 	memset(fm_eth, 0, sizeof(struct fm_eth));
665c916d7c9SKumar Gala 
666c916d7c9SKumar Gala 	/* save off some things we need from the info struct */
667c916d7c9SKumar Gala 	fm_eth->fm_index = info->index - 1; /* keep as 0 based for muram */
668c916d7c9SKumar Gala 	fm_eth->num = num;
669c916d7c9SKumar Gala 	fm_eth->type = info->type;
670c916d7c9SKumar Gala 
671c916d7c9SKumar Gala 	fm_eth->rx_port = (void *)&reg->port[info->rx_port_id - 1].fm_bmi;
672c916d7c9SKumar Gala 	fm_eth->tx_port = (void *)&reg->port[info->tx_port_id - 1].fm_bmi;
673c916d7c9SKumar Gala 
674c916d7c9SKumar Gala 	/* set the ethernet max receive length */
675c916d7c9SKumar Gala 	fm_eth->max_rx_len = MAX_RXBUF_LEN;
676c916d7c9SKumar Gala 
677c916d7c9SKumar Gala 	/* init global mac structure */
678c916d7c9SKumar Gala 	if (!fm_eth_init_mac(fm_eth, reg))
679c916d7c9SKumar Gala 		return 0;
680c916d7c9SKumar Gala 
681c916d7c9SKumar Gala 	/* keep same as the manual, we call FMAN1, FMAN2, DTSEC1, DTSEC2, etc */
682c916d7c9SKumar Gala 	if (fm_eth->type == FM_ETH_1G_E)
683c916d7c9SKumar Gala 		sprintf(dev->name, "FM%d@DTSEC%d", info->index, num + 1);
684c916d7c9SKumar Gala 	else
685c916d7c9SKumar Gala 		sprintf(dev->name, "FM%d@TGEC%d", info->index, num + 1);
686c916d7c9SKumar Gala 
687c916d7c9SKumar Gala 	devlist[num_controllers++] = dev;
688c916d7c9SKumar Gala 	dev->iobase = 0;
689c916d7c9SKumar Gala 	dev->priv = (void *)fm_eth;
690c916d7c9SKumar Gala 	dev->init = fm_eth_open;
691c916d7c9SKumar Gala 	dev->halt = fm_eth_halt;
692c916d7c9SKumar Gala 	dev->send = fm_eth_send;
693c916d7c9SKumar Gala 	dev->recv = fm_eth_recv;
694c916d7c9SKumar Gala 	fm_eth->dev = dev;
695c916d7c9SKumar Gala 	fm_eth->bus = info->bus;
696c916d7c9SKumar Gala 	fm_eth->phyaddr = info->phy_addr;
697c916d7c9SKumar Gala 	fm_eth->enet_if = info->enet_if;
698c916d7c9SKumar Gala 
699c916d7c9SKumar Gala 	/* startup the FM im */
700c916d7c9SKumar Gala 	if (!fm_eth_startup(fm_eth))
701c916d7c9SKumar Gala 		return 0;
702c916d7c9SKumar Gala 
703c916d7c9SKumar Gala 	if (init_phy(dev))
704c916d7c9SKumar Gala 		return 0;
705c916d7c9SKumar Gala 
706c916d7c9SKumar Gala 	/* clear the ethernet address */
707c916d7c9SKumar Gala 	for (i = 0; i < 6; i++)
708c916d7c9SKumar Gala 		dev->enetaddr[i] = 0;
709c916d7c9SKumar Gala 	eth_register(dev);
710c916d7c9SKumar Gala 
711c916d7c9SKumar Gala 	return 1;
712c916d7c9SKumar Gala }
713