xref: /rk3399_rockchip-uboot/drivers/qe/uec.c (revision 6b29a395b62965eef6b5065d3a526a8588a92038)
17737d5c6SDave Liu /*
2a52d2f81SHaiying Wang  * Copyright (C) 2006-2011 Freescale Semiconductor, Inc.
37737d5c6SDave Liu  *
47737d5c6SDave Liu  * Dave Liu <daveliu@freescale.com>
57737d5c6SDave Liu  *
61a459660SWolfgang Denk  * SPDX-License-Identifier:	GPL-2.0+
77737d5c6SDave Liu  */
87737d5c6SDave Liu 
9b5bf5cb3SMasahiro Yamada #include <common.h>
10b5bf5cb3SMasahiro Yamada #include <net.h>
11b5bf5cb3SMasahiro Yamada #include <malloc.h>
121221ce45SMasahiro Yamada #include <linux/errno.h>
13b5bf5cb3SMasahiro Yamada #include <asm/io.h>
14b5bf5cb3SMasahiro Yamada #include <linux/immap_qe.h>
157737d5c6SDave Liu #include "uccf.h"
167737d5c6SDave Liu #include "uec.h"
177737d5c6SDave Liu #include "uec_phy.h"
18d5d28fe4SDavid Saada #include "miiphy.h"
192459afb1SQianyu Gong #include <fsl_qe.h>
20865ff856SAndy Fleming #include <phy.h>
217737d5c6SDave Liu 
221a951937SRichard Retanubun /* Default UTBIPAR SMI address */
231a951937SRichard Retanubun #ifndef CONFIG_UTBIPAR_INIT_TBIPA
241a951937SRichard Retanubun #define CONFIG_UTBIPAR_INIT_TBIPA 0x1F
251a951937SRichard Retanubun #endif
261a951937SRichard Retanubun 
278e55258fSHaiying Wang static uec_info_t uec_info[] = {
287737d5c6SDave Liu #ifdef CONFIG_UEC_ETH1
298e55258fSHaiying Wang 	STD_UEC_INFO(1),	/* UEC1 */
307737d5c6SDave Liu #endif
317737d5c6SDave Liu #ifdef CONFIG_UEC_ETH2
328e55258fSHaiying Wang 	STD_UEC_INFO(2),	/* UEC2 */
337737d5c6SDave Liu #endif
34ccf21c31SJoakim Tjernlund #ifdef CONFIG_UEC_ETH3
358e55258fSHaiying Wang 	STD_UEC_INFO(3),	/* UEC3 */
36ccf21c31SJoakim Tjernlund #endif
372465665bSDavid Saada #ifdef CONFIG_UEC_ETH4
388e55258fSHaiying Wang 	STD_UEC_INFO(4),	/* UEC4 */
392465665bSDavid Saada #endif
40c68a05feSrichardretanubun #ifdef CONFIG_UEC_ETH5
418e55258fSHaiying Wang 	STD_UEC_INFO(5),	/* UEC5 */
42c68a05feSrichardretanubun #endif
43c68a05feSrichardretanubun #ifdef CONFIG_UEC_ETH6
448e55258fSHaiying Wang 	STD_UEC_INFO(6),	/* UEC6 */
45c68a05feSrichardretanubun #endif
468e55258fSHaiying Wang #ifdef CONFIG_UEC_ETH7
478e55258fSHaiying Wang 	STD_UEC_INFO(7),	/* UEC7 */
487211fbfaSHaiying Wang #endif
498e55258fSHaiying Wang #ifdef CONFIG_UEC_ETH8
508e55258fSHaiying Wang 	STD_UEC_INFO(8),	/* UEC8 */
518e55258fSHaiying Wang #endif
52c68a05feSrichardretanubun };
53ccf21c31SJoakim Tjernlund 
548e55258fSHaiying Wang #define MAXCONTROLLERS	(8)
55d5d28fe4SDavid Saada 
56d5d28fe4SDavid Saada static struct eth_device *devlist[MAXCONTROLLERS];
57d5d28fe4SDavid Saada 
uec_mac_enable(uec_private_t * uec,comm_dir_e mode)587737d5c6SDave Liu static int uec_mac_enable(uec_private_t *uec, comm_dir_e mode)
597737d5c6SDave Liu {
607737d5c6SDave Liu 	uec_t		*uec_regs;
617737d5c6SDave Liu 	u32		maccfg1;
627737d5c6SDave Liu 
637737d5c6SDave Liu 	if (!uec) {
647737d5c6SDave Liu 		printf("%s: uec not initial\n", __FUNCTION__);
657737d5c6SDave Liu 		return -EINVAL;
667737d5c6SDave Liu 	}
677737d5c6SDave Liu 	uec_regs = uec->uec_regs;
687737d5c6SDave Liu 
697737d5c6SDave Liu 	maccfg1 = in_be32(&uec_regs->maccfg1);
707737d5c6SDave Liu 
717737d5c6SDave Liu 	if (mode & COMM_DIR_TX)	{
727737d5c6SDave Liu 		maccfg1 |= MACCFG1_ENABLE_TX;
737737d5c6SDave Liu 		out_be32(&uec_regs->maccfg1, maccfg1);
747737d5c6SDave Liu 		uec->mac_tx_enabled = 1;
757737d5c6SDave Liu 	}
767737d5c6SDave Liu 
777737d5c6SDave Liu 	if (mode & COMM_DIR_RX)	{
787737d5c6SDave Liu 		maccfg1 |= MACCFG1_ENABLE_RX;
797737d5c6SDave Liu 		out_be32(&uec_regs->maccfg1, maccfg1);
807737d5c6SDave Liu 		uec->mac_rx_enabled = 1;
817737d5c6SDave Liu 	}
827737d5c6SDave Liu 
837737d5c6SDave Liu 	return 0;
847737d5c6SDave Liu }
857737d5c6SDave Liu 
uec_mac_disable(uec_private_t * uec,comm_dir_e mode)867737d5c6SDave Liu static int uec_mac_disable(uec_private_t *uec, comm_dir_e mode)
877737d5c6SDave Liu {
887737d5c6SDave Liu 	uec_t		*uec_regs;
897737d5c6SDave Liu 	u32		maccfg1;
907737d5c6SDave Liu 
917737d5c6SDave Liu 	if (!uec) {
927737d5c6SDave Liu 		printf("%s: uec not initial\n", __FUNCTION__);
937737d5c6SDave Liu 		return -EINVAL;
947737d5c6SDave Liu 	}
957737d5c6SDave Liu 	uec_regs = uec->uec_regs;
967737d5c6SDave Liu 
977737d5c6SDave Liu 	maccfg1 = in_be32(&uec_regs->maccfg1);
987737d5c6SDave Liu 
997737d5c6SDave Liu 	if (mode & COMM_DIR_TX)	{
1007737d5c6SDave Liu 		maccfg1 &= ~MACCFG1_ENABLE_TX;
1017737d5c6SDave Liu 		out_be32(&uec_regs->maccfg1, maccfg1);
1027737d5c6SDave Liu 		uec->mac_tx_enabled = 0;
1037737d5c6SDave Liu 	}
1047737d5c6SDave Liu 
1057737d5c6SDave Liu 	if (mode & COMM_DIR_RX)	{
1067737d5c6SDave Liu 		maccfg1 &= ~MACCFG1_ENABLE_RX;
1077737d5c6SDave Liu 		out_be32(&uec_regs->maccfg1, maccfg1);
1087737d5c6SDave Liu 		uec->mac_rx_enabled = 0;
1097737d5c6SDave Liu 	}
1107737d5c6SDave Liu 
1117737d5c6SDave Liu 	return 0;
1127737d5c6SDave Liu }
1137737d5c6SDave Liu 
uec_graceful_stop_tx(uec_private_t * uec)1147737d5c6SDave Liu static int uec_graceful_stop_tx(uec_private_t *uec)
1157737d5c6SDave Liu {
1167737d5c6SDave Liu 	ucc_fast_t		*uf_regs;
1177737d5c6SDave Liu 	u32			cecr_subblock;
1187737d5c6SDave Liu 	u32			ucce;
1197737d5c6SDave Liu 
1207737d5c6SDave Liu 	if (!uec || !uec->uccf) {
1217737d5c6SDave Liu 		printf("%s: No handle passed.\n", __FUNCTION__);
1227737d5c6SDave Liu 		return -EINVAL;
1237737d5c6SDave Liu 	}
1247737d5c6SDave Liu 
1257737d5c6SDave Liu 	uf_regs = uec->uccf->uf_regs;
1267737d5c6SDave Liu 
1277737d5c6SDave Liu 	/* Clear the grace stop event */
1287737d5c6SDave Liu 	out_be32(&uf_regs->ucce, UCCE_GRA);
1297737d5c6SDave Liu 
1307737d5c6SDave Liu 	/* Issue host command */
1317737d5c6SDave Liu 	cecr_subblock =
1327737d5c6SDave Liu 		 ucc_fast_get_qe_cr_subblock(uec->uec_info->uf_info.ucc_num);
1337737d5c6SDave Liu 	qe_issue_cmd(QE_GRACEFUL_STOP_TX, cecr_subblock,
1347737d5c6SDave Liu 			 (u8)QE_CR_PROTOCOL_ETHERNET, 0);
1357737d5c6SDave Liu 
1367737d5c6SDave Liu 	/* Wait for command to complete */
1377737d5c6SDave Liu 	do {
1387737d5c6SDave Liu 		ucce = in_be32(&uf_regs->ucce);
1397737d5c6SDave Liu 	} while (! (ucce & UCCE_GRA));
1407737d5c6SDave Liu 
1417737d5c6SDave Liu 	uec->grace_stopped_tx = 1;
1427737d5c6SDave Liu 
1437737d5c6SDave Liu 	return 0;
1447737d5c6SDave Liu }
1457737d5c6SDave Liu 
uec_graceful_stop_rx(uec_private_t * uec)1467737d5c6SDave Liu static int uec_graceful_stop_rx(uec_private_t *uec)
1477737d5c6SDave Liu {
1487737d5c6SDave Liu 	u32		cecr_subblock;
1497737d5c6SDave Liu 	u8		ack;
1507737d5c6SDave Liu 
1517737d5c6SDave Liu 	if (!uec) {
1527737d5c6SDave Liu 		printf("%s: No handle passed.\n", __FUNCTION__);
1537737d5c6SDave Liu 		return -EINVAL;
1547737d5c6SDave Liu 	}
1557737d5c6SDave Liu 
1567737d5c6SDave Liu 	if (!uec->p_rx_glbl_pram) {
1577737d5c6SDave Liu 		printf("%s: No init rx global parameter\n", __FUNCTION__);
1587737d5c6SDave Liu 		return -EINVAL;
1597737d5c6SDave Liu 	}
1607737d5c6SDave Liu 
1617737d5c6SDave Liu 	/* Clear acknowledge bit */
1627737d5c6SDave Liu 	ack = uec->p_rx_glbl_pram->rxgstpack;
1637737d5c6SDave Liu 	ack &= ~GRACEFUL_STOP_ACKNOWLEDGE_RX;
1647737d5c6SDave Liu 	uec->p_rx_glbl_pram->rxgstpack = ack;
1657737d5c6SDave Liu 
1667737d5c6SDave Liu 	/* Keep issuing cmd and checking ack bit until it is asserted */
1677737d5c6SDave Liu 	do {
1687737d5c6SDave Liu 		/* Issue host command */
1697737d5c6SDave Liu 		cecr_subblock =
1707737d5c6SDave Liu 		 ucc_fast_get_qe_cr_subblock(uec->uec_info->uf_info.ucc_num);
1717737d5c6SDave Liu 		qe_issue_cmd(QE_GRACEFUL_STOP_RX, cecr_subblock,
1727737d5c6SDave Liu 				 (u8)QE_CR_PROTOCOL_ETHERNET, 0);
1737737d5c6SDave Liu 		ack = uec->p_rx_glbl_pram->rxgstpack;
1747737d5c6SDave Liu 	} while (! (ack & GRACEFUL_STOP_ACKNOWLEDGE_RX ));
1757737d5c6SDave Liu 
1767737d5c6SDave Liu 	uec->grace_stopped_rx = 1;
1777737d5c6SDave Liu 
1787737d5c6SDave Liu 	return 0;
1797737d5c6SDave Liu }
1807737d5c6SDave Liu 
uec_restart_tx(uec_private_t * uec)1817737d5c6SDave Liu static int uec_restart_tx(uec_private_t *uec)
1827737d5c6SDave Liu {
1837737d5c6SDave Liu 	u32		cecr_subblock;
1847737d5c6SDave Liu 
1857737d5c6SDave Liu 	if (!uec || !uec->uec_info) {
1867737d5c6SDave Liu 		printf("%s: No handle passed.\n", __FUNCTION__);
1877737d5c6SDave Liu 		return -EINVAL;
1887737d5c6SDave Liu 	}
1897737d5c6SDave Liu 
1907737d5c6SDave Liu 	cecr_subblock =
1917737d5c6SDave Liu 	 ucc_fast_get_qe_cr_subblock(uec->uec_info->uf_info.ucc_num);
1927737d5c6SDave Liu 	qe_issue_cmd(QE_RESTART_TX, cecr_subblock,
1937737d5c6SDave Liu 			 (u8)QE_CR_PROTOCOL_ETHERNET, 0);
1947737d5c6SDave Liu 
1957737d5c6SDave Liu 	uec->grace_stopped_tx = 0;
1967737d5c6SDave Liu 
1977737d5c6SDave Liu 	return 0;
1987737d5c6SDave Liu }
1997737d5c6SDave Liu 
uec_restart_rx(uec_private_t * uec)2007737d5c6SDave Liu static int uec_restart_rx(uec_private_t *uec)
2017737d5c6SDave Liu {
2027737d5c6SDave Liu 	u32		cecr_subblock;
2037737d5c6SDave Liu 
2047737d5c6SDave Liu 	if (!uec || !uec->uec_info) {
2057737d5c6SDave Liu 		printf("%s: No handle passed.\n", __FUNCTION__);
2067737d5c6SDave Liu 		return -EINVAL;
2077737d5c6SDave Liu 	}
2087737d5c6SDave Liu 
2097737d5c6SDave Liu 	cecr_subblock =
2107737d5c6SDave Liu 	 ucc_fast_get_qe_cr_subblock(uec->uec_info->uf_info.ucc_num);
2117737d5c6SDave Liu 	qe_issue_cmd(QE_RESTART_RX, cecr_subblock,
2127737d5c6SDave Liu 			 (u8)QE_CR_PROTOCOL_ETHERNET, 0);
2137737d5c6SDave Liu 
2147737d5c6SDave Liu 	uec->grace_stopped_rx = 0;
2157737d5c6SDave Liu 
2167737d5c6SDave Liu 	return 0;
2177737d5c6SDave Liu }
2187737d5c6SDave Liu 
uec_open(uec_private_t * uec,comm_dir_e mode)2197737d5c6SDave Liu static int uec_open(uec_private_t *uec, comm_dir_e mode)
2207737d5c6SDave Liu {
2217737d5c6SDave Liu 	ucc_fast_private_t	*uccf;
2227737d5c6SDave Liu 
2237737d5c6SDave Liu 	if (!uec || !uec->uccf) {
2247737d5c6SDave Liu 		printf("%s: No handle passed.\n", __FUNCTION__);
2257737d5c6SDave Liu 		return -EINVAL;
2267737d5c6SDave Liu 	}
2277737d5c6SDave Liu 	uccf = uec->uccf;
2287737d5c6SDave Liu 
2297737d5c6SDave Liu 	/* check if the UCC number is in range. */
2307737d5c6SDave Liu 	if (uec->uec_info->uf_info.ucc_num >= UCC_MAX_NUM) {
2317737d5c6SDave Liu 		printf("%s: ucc_num out of range.\n", __FUNCTION__);
2327737d5c6SDave Liu 		return -EINVAL;
2337737d5c6SDave Liu 	}
2347737d5c6SDave Liu 
2357737d5c6SDave Liu 	/* Enable MAC */
2367737d5c6SDave Liu 	uec_mac_enable(uec, mode);
2377737d5c6SDave Liu 
2387737d5c6SDave Liu 	/* Enable UCC fast */
2397737d5c6SDave Liu 	ucc_fast_enable(uccf, mode);
2407737d5c6SDave Liu 
2417737d5c6SDave Liu 	/* RISC microcode start */
2427737d5c6SDave Liu 	if ((mode & COMM_DIR_TX) && uec->grace_stopped_tx) {
2437737d5c6SDave Liu 		uec_restart_tx(uec);
2447737d5c6SDave Liu 	}
2457737d5c6SDave Liu 	if ((mode & COMM_DIR_RX) && uec->grace_stopped_rx) {
2467737d5c6SDave Liu 		uec_restart_rx(uec);
2477737d5c6SDave Liu 	}
2487737d5c6SDave Liu 
2497737d5c6SDave Liu 	return 0;
2507737d5c6SDave Liu }
2517737d5c6SDave Liu 
uec_stop(uec_private_t * uec,comm_dir_e mode)2527737d5c6SDave Liu static int uec_stop(uec_private_t *uec, comm_dir_e mode)
2537737d5c6SDave Liu {
2547737d5c6SDave Liu 	if (!uec || !uec->uccf) {
2557737d5c6SDave Liu 		printf("%s: No handle passed.\n", __FUNCTION__);
2567737d5c6SDave Liu 		return -EINVAL;
2577737d5c6SDave Liu 	}
2587737d5c6SDave Liu 
2597737d5c6SDave Liu 	/* check if the UCC number is in range. */
2607737d5c6SDave Liu 	if (uec->uec_info->uf_info.ucc_num >= UCC_MAX_NUM) {
2617737d5c6SDave Liu 		printf("%s: ucc_num out of range.\n", __FUNCTION__);
2627737d5c6SDave Liu 		return -EINVAL;
2637737d5c6SDave Liu 	}
2647737d5c6SDave Liu 	/* Stop any transmissions */
2657737d5c6SDave Liu 	if ((mode & COMM_DIR_TX) && !uec->grace_stopped_tx) {
2667737d5c6SDave Liu 		uec_graceful_stop_tx(uec);
2677737d5c6SDave Liu 	}
2687737d5c6SDave Liu 	/* Stop any receptions */
2697737d5c6SDave Liu 	if ((mode & COMM_DIR_RX) && !uec->grace_stopped_rx) {
2707737d5c6SDave Liu 		uec_graceful_stop_rx(uec);
2717737d5c6SDave Liu 	}
2727737d5c6SDave Liu 
2737737d5c6SDave Liu 	/* Disable the UCC fast */
2747737d5c6SDave Liu 	ucc_fast_disable(uec->uccf, mode);
2757737d5c6SDave Liu 
2767737d5c6SDave Liu 	/* Disable the MAC */
2777737d5c6SDave Liu 	uec_mac_disable(uec, mode);
2787737d5c6SDave Liu 
2797737d5c6SDave Liu 	return 0;
2807737d5c6SDave Liu }
2817737d5c6SDave Liu 
uec_set_mac_duplex(uec_private_t * uec,int duplex)2827737d5c6SDave Liu static int uec_set_mac_duplex(uec_private_t *uec, int duplex)
2837737d5c6SDave Liu {
2847737d5c6SDave Liu 	uec_t		*uec_regs;
2857737d5c6SDave Liu 	u32		maccfg2;
2867737d5c6SDave Liu 
2877737d5c6SDave Liu 	if (!uec) {
2887737d5c6SDave Liu 		printf("%s: uec not initial\n", __FUNCTION__);
2897737d5c6SDave Liu 		return -EINVAL;
2907737d5c6SDave Liu 	}
2917737d5c6SDave Liu 	uec_regs = uec->uec_regs;
2927737d5c6SDave Liu 
2937737d5c6SDave Liu 	if (duplex == DUPLEX_HALF) {
2947737d5c6SDave Liu 		maccfg2 = in_be32(&uec_regs->maccfg2);
2957737d5c6SDave Liu 		maccfg2 &= ~MACCFG2_FDX;
2967737d5c6SDave Liu 		out_be32(&uec_regs->maccfg2, maccfg2);
2977737d5c6SDave Liu 	}
2987737d5c6SDave Liu 
2997737d5c6SDave Liu 	if (duplex == DUPLEX_FULL) {
3007737d5c6SDave Liu 		maccfg2 = in_be32(&uec_regs->maccfg2);
3017737d5c6SDave Liu 		maccfg2 |= MACCFG2_FDX;
3027737d5c6SDave Liu 		out_be32(&uec_regs->maccfg2, maccfg2);
3037737d5c6SDave Liu 	}
3047737d5c6SDave Liu 
3057737d5c6SDave Liu 	return 0;
3067737d5c6SDave Liu }
3077737d5c6SDave Liu 
uec_set_mac_if_mode(uec_private_t * uec,phy_interface_t if_mode,int speed)308582c55a0SHeiko Schocher static int uec_set_mac_if_mode(uec_private_t *uec,
309865ff856SAndy Fleming 		phy_interface_t if_mode, int speed)
3107737d5c6SDave Liu {
311865ff856SAndy Fleming 	phy_interface_t		enet_if_mode;
3127737d5c6SDave Liu 	uec_t			*uec_regs;
3137737d5c6SDave Liu 	u32			upsmr;
3147737d5c6SDave Liu 	u32			maccfg2;
3157737d5c6SDave Liu 
3167737d5c6SDave Liu 	if (!uec) {
3177737d5c6SDave Liu 		printf("%s: uec not initial\n", __FUNCTION__);
3187737d5c6SDave Liu 		return -EINVAL;
3197737d5c6SDave Liu 	}
3207737d5c6SDave Liu 
3217737d5c6SDave Liu 	uec_regs = uec->uec_regs;
3227737d5c6SDave Liu 	enet_if_mode = if_mode;
3237737d5c6SDave Liu 
3247737d5c6SDave Liu 	maccfg2 = in_be32(&uec_regs->maccfg2);
3257737d5c6SDave Liu 	maccfg2 &= ~MACCFG2_INTERFACE_MODE_MASK;
3267737d5c6SDave Liu 
3277737d5c6SDave Liu 	upsmr = in_be32(&uec->uccf->uf_regs->upsmr);
3287737d5c6SDave Liu 	upsmr &= ~(UPSMR_RPM | UPSMR_TBIM | UPSMR_R10M | UPSMR_RMM);
3297737d5c6SDave Liu 
330582c55a0SHeiko Schocher 	switch (speed) {
331865ff856SAndy Fleming 		case SPEED_10:
332582c55a0SHeiko Schocher 			maccfg2 |= MACCFG2_INTERFACE_MODE_NIBBLE;
3337737d5c6SDave Liu 			switch (enet_if_mode) {
334865ff856SAndy Fleming 				case PHY_INTERFACE_MODE_MII:
3357737d5c6SDave Liu 					break;
336865ff856SAndy Fleming 				case PHY_INTERFACE_MODE_RGMII:
3377737d5c6SDave Liu 					upsmr |= (UPSMR_RPM | UPSMR_R10M);
3387737d5c6SDave Liu 					break;
339865ff856SAndy Fleming 				case PHY_INTERFACE_MODE_RMII:
3407737d5c6SDave Liu 					upsmr |= (UPSMR_R10M | UPSMR_RMM);
3417737d5c6SDave Liu 					break;
342582c55a0SHeiko Schocher 				default:
343582c55a0SHeiko Schocher 					return -EINVAL;
344582c55a0SHeiko Schocher 					break;
345582c55a0SHeiko Schocher 			}
346582c55a0SHeiko Schocher 			break;
347865ff856SAndy Fleming 		case SPEED_100:
348582c55a0SHeiko Schocher 			maccfg2 |= MACCFG2_INTERFACE_MODE_NIBBLE;
349582c55a0SHeiko Schocher 			switch (enet_if_mode) {
350865ff856SAndy Fleming 				case PHY_INTERFACE_MODE_MII:
351582c55a0SHeiko Schocher 					break;
352865ff856SAndy Fleming 				case PHY_INTERFACE_MODE_RGMII:
353582c55a0SHeiko Schocher 					upsmr |= UPSMR_RPM;
354582c55a0SHeiko Schocher 					break;
355865ff856SAndy Fleming 				case PHY_INTERFACE_MODE_RMII:
356582c55a0SHeiko Schocher 					upsmr |= UPSMR_RMM;
357582c55a0SHeiko Schocher 					break;
358582c55a0SHeiko Schocher 				default:
359582c55a0SHeiko Schocher 					return -EINVAL;
360582c55a0SHeiko Schocher 					break;
361582c55a0SHeiko Schocher 			}
362582c55a0SHeiko Schocher 			break;
363865ff856SAndy Fleming 		case SPEED_1000:
364e8efef7cSHaiying Wang 			maccfg2 |= MACCFG2_INTERFACE_MODE_BYTE;
365582c55a0SHeiko Schocher 			switch (enet_if_mode) {
366865ff856SAndy Fleming 				case PHY_INTERFACE_MODE_GMII:
367582c55a0SHeiko Schocher 					break;
368865ff856SAndy Fleming 				case PHY_INTERFACE_MODE_TBI:
369582c55a0SHeiko Schocher 					upsmr |= UPSMR_TBIM;
370582c55a0SHeiko Schocher 					break;
371865ff856SAndy Fleming 				case PHY_INTERFACE_MODE_RTBI:
372582c55a0SHeiko Schocher 					upsmr |= (UPSMR_RPM | UPSMR_TBIM);
373582c55a0SHeiko Schocher 					break;
374865ff856SAndy Fleming 				case PHY_INTERFACE_MODE_RGMII_RXID:
375865ff856SAndy Fleming 				case PHY_INTERFACE_MODE_RGMII_TXID:
376865ff856SAndy Fleming 				case PHY_INTERFACE_MODE_RGMII_ID:
377865ff856SAndy Fleming 				case PHY_INTERFACE_MODE_RGMII:
378582c55a0SHeiko Schocher 					upsmr |= UPSMR_RPM;
379582c55a0SHeiko Schocher 					break;
380865ff856SAndy Fleming 				case PHY_INTERFACE_MODE_SGMII:
381e8efef7cSHaiying Wang 					upsmr |= UPSMR_SGMM;
382e8efef7cSHaiying Wang 					break;
3837737d5c6SDave Liu 				default:
3847737d5c6SDave Liu 					return -EINVAL;
3857737d5c6SDave Liu 					break;
3867737d5c6SDave Liu 			}
387582c55a0SHeiko Schocher 			break;
388582c55a0SHeiko Schocher 		default:
389582c55a0SHeiko Schocher 			return -EINVAL;
390582c55a0SHeiko Schocher 			break;
391582c55a0SHeiko Schocher 	}
392582c55a0SHeiko Schocher 
3937737d5c6SDave Liu 	out_be32(&uec_regs->maccfg2, maccfg2);
3947737d5c6SDave Liu 	out_be32(&uec->uccf->uf_regs->upsmr, upsmr);
3957737d5c6SDave Liu 
3967737d5c6SDave Liu 	return 0;
3977737d5c6SDave Liu }
3987737d5c6SDave Liu 
init_mii_management_configuration(uec_mii_t * uec_mii_regs)399da9d4610SAndy Fleming static int init_mii_management_configuration(uec_mii_t *uec_mii_regs)
4007737d5c6SDave Liu {
4017737d5c6SDave Liu 	uint		timeout = 0x1000;
4027737d5c6SDave Liu 	u32		miimcfg = 0;
4037737d5c6SDave Liu 
404da9d4610SAndy Fleming 	miimcfg = in_be32(&uec_mii_regs->miimcfg);
4057737d5c6SDave Liu 	miimcfg |= MIIMCFG_MNGMNT_CLC_DIV_INIT_VALUE;
406da9d4610SAndy Fleming 	out_be32(&uec_mii_regs->miimcfg, miimcfg);
4077737d5c6SDave Liu 
4087737d5c6SDave Liu 	/* Wait until the bus is free */
409da9d4610SAndy Fleming 	while ((in_be32(&uec_mii_regs->miimcfg) & MIIMIND_BUSY) && timeout--);
4107737d5c6SDave Liu 	if (timeout <= 0) {
4117737d5c6SDave Liu 		printf("%s: The MII Bus is stuck!", __FUNCTION__);
4127737d5c6SDave Liu 		return -ETIMEDOUT;
4137737d5c6SDave Liu 	}
4147737d5c6SDave Liu 
4157737d5c6SDave Liu 	return 0;
4167737d5c6SDave Liu }
4177737d5c6SDave Liu 
init_phy(struct eth_device * dev)4187737d5c6SDave Liu static int init_phy(struct eth_device *dev)
4197737d5c6SDave Liu {
4207737d5c6SDave Liu 	uec_private_t		*uec;
421da9d4610SAndy Fleming 	uec_mii_t		*umii_regs;
4227737d5c6SDave Liu 	struct uec_mii_info	*mii_info;
4237737d5c6SDave Liu 	struct phy_info		*curphy;
4247737d5c6SDave Liu 	int			err;
4257737d5c6SDave Liu 
4267737d5c6SDave Liu 	uec = (uec_private_t *)dev->priv;
427da9d4610SAndy Fleming 	umii_regs = uec->uec_mii_regs;
4287737d5c6SDave Liu 
4297737d5c6SDave Liu 	uec->oldlink = 0;
4307737d5c6SDave Liu 	uec->oldspeed = 0;
4317737d5c6SDave Liu 	uec->oldduplex = -1;
4327737d5c6SDave Liu 
4337737d5c6SDave Liu 	mii_info = malloc(sizeof(*mii_info));
4347737d5c6SDave Liu 	if (!mii_info) {
4357737d5c6SDave Liu 		printf("%s: Could not allocate mii_info", dev->name);
4367737d5c6SDave Liu 		return -ENOMEM;
4377737d5c6SDave Liu 	}
4387737d5c6SDave Liu 	memset(mii_info, 0, sizeof(*mii_info));
4397737d5c6SDave Liu 
44024c3aca3SDave Liu 	if (uec->uec_info->uf_info.eth_type == GIGA_ETH) {
4417737d5c6SDave Liu 		mii_info->speed = SPEED_1000;
44224c3aca3SDave Liu 	} else {
44324c3aca3SDave Liu 		mii_info->speed = SPEED_100;
44424c3aca3SDave Liu 	}
44524c3aca3SDave Liu 
4467737d5c6SDave Liu 	mii_info->duplex = DUPLEX_FULL;
4477737d5c6SDave Liu 	mii_info->pause = 0;
4487737d5c6SDave Liu 	mii_info->link = 1;
4497737d5c6SDave Liu 
4507737d5c6SDave Liu 	mii_info->advertising = (ADVERTISED_10baseT_Half |
4517737d5c6SDave Liu 				ADVERTISED_10baseT_Full |
4527737d5c6SDave Liu 				ADVERTISED_100baseT_Half |
4537737d5c6SDave Liu 				ADVERTISED_100baseT_Full |
4547737d5c6SDave Liu 				ADVERTISED_1000baseT_Full);
4557737d5c6SDave Liu 	mii_info->autoneg = 1;
4567737d5c6SDave Liu 	mii_info->mii_id = uec->uec_info->phy_address;
4577737d5c6SDave Liu 	mii_info->dev = dev;
4587737d5c6SDave Liu 
459da9d4610SAndy Fleming 	mii_info->mdio_read = &uec_read_phy_reg;
460da9d4610SAndy Fleming 	mii_info->mdio_write = &uec_write_phy_reg;
4617737d5c6SDave Liu 
4627737d5c6SDave Liu 	uec->mii_info = mii_info;
4637737d5c6SDave Liu 
464ee62ed32SKim Phillips 	qe_set_mii_clk_src(uec->uec_info->uf_info.ucc_num);
465ee62ed32SKim Phillips 
466da9d4610SAndy Fleming 	if (init_mii_management_configuration(umii_regs)) {
4677737d5c6SDave Liu 		printf("%s: The MII Bus is stuck!", dev->name);
4687737d5c6SDave Liu 		err = -1;
4697737d5c6SDave Liu 		goto bus_fail;
4707737d5c6SDave Liu 	}
4717737d5c6SDave Liu 
4727737d5c6SDave Liu 	/* get info for this PHY */
473da9d4610SAndy Fleming 	curphy = uec_get_phy_info(uec->mii_info);
4747737d5c6SDave Liu 	if (!curphy) {
4757737d5c6SDave Liu 		printf("%s: No PHY found", dev->name);
4767737d5c6SDave Liu 		err = -1;
4777737d5c6SDave Liu 		goto no_phy;
4787737d5c6SDave Liu 	}
4797737d5c6SDave Liu 
4807737d5c6SDave Liu 	mii_info->phyinfo = curphy;
4817737d5c6SDave Liu 
4827737d5c6SDave Liu 	/* Run the commands which initialize the PHY */
4837737d5c6SDave Liu 	if (curphy->init) {
4847737d5c6SDave Liu 		err = curphy->init(uec->mii_info);
4857737d5c6SDave Liu 		if (err)
4867737d5c6SDave Liu 			goto phy_init_fail;
4877737d5c6SDave Liu 	}
4887737d5c6SDave Liu 
4897737d5c6SDave Liu 	return 0;
4907737d5c6SDave Liu 
4917737d5c6SDave Liu phy_init_fail:
4927737d5c6SDave Liu no_phy:
4937737d5c6SDave Liu bus_fail:
4947737d5c6SDave Liu 	free(mii_info);
4957737d5c6SDave Liu 	return err;
4967737d5c6SDave Liu }
4977737d5c6SDave Liu 
adjust_link(struct eth_device * dev)4987737d5c6SDave Liu static void adjust_link(struct eth_device *dev)
4997737d5c6SDave Liu {
5007737d5c6SDave Liu 	uec_private_t		*uec = (uec_private_t *)dev->priv;
5017737d5c6SDave Liu 	struct uec_mii_info	*mii_info = uec->mii_info;
5027737d5c6SDave Liu 
5037737d5c6SDave Liu 	extern void change_phy_interface_mode(struct eth_device *dev,
504865ff856SAndy Fleming 				 phy_interface_t mode, int speed);
5057737d5c6SDave Liu 
5067737d5c6SDave Liu 	if (mii_info->link) {
5077737d5c6SDave Liu 		/* Now we make sure that we can be in full duplex mode.
5087737d5c6SDave Liu 		* If not, we operate in half-duplex mode. */
5097737d5c6SDave Liu 		if (mii_info->duplex != uec->oldduplex) {
5107737d5c6SDave Liu 			if (!(mii_info->duplex)) {
5117737d5c6SDave Liu 				uec_set_mac_duplex(uec, DUPLEX_HALF);
5127737d5c6SDave Liu 				printf("%s: Half Duplex\n", dev->name);
5137737d5c6SDave Liu 			} else {
5147737d5c6SDave Liu 				uec_set_mac_duplex(uec, DUPLEX_FULL);
5157737d5c6SDave Liu 				printf("%s: Full Duplex\n", dev->name);
5167737d5c6SDave Liu 			}
5177737d5c6SDave Liu 			uec->oldduplex = mii_info->duplex;
5187737d5c6SDave Liu 		}
5197737d5c6SDave Liu 
5207737d5c6SDave Liu 		if (mii_info->speed != uec->oldspeed) {
521865ff856SAndy Fleming 			phy_interface_t mode =
522582c55a0SHeiko Schocher 				uec->uec_info->enet_interface_type;
52324c3aca3SDave Liu 			if (uec->uec_info->uf_info.eth_type == GIGA_ETH) {
5247737d5c6SDave Liu 				switch (mii_info->speed) {
525865ff856SAndy Fleming 				case SPEED_1000:
5267737d5c6SDave Liu 					break;
527865ff856SAndy Fleming 				case SPEED_100:
5287737d5c6SDave Liu 					printf ("switching to rgmii 100\n");
529865ff856SAndy Fleming 					mode = PHY_INTERFACE_MODE_RGMII;
5307737d5c6SDave Liu 					break;
531865ff856SAndy Fleming 				case SPEED_10:
5327737d5c6SDave Liu 					printf ("switching to rgmii 10\n");
533865ff856SAndy Fleming 					mode = PHY_INTERFACE_MODE_RGMII;
5347737d5c6SDave Liu 					break;
5357737d5c6SDave Liu 				default:
5367737d5c6SDave Liu 					printf("%s: Ack,Speed(%d)is illegal\n",
5377737d5c6SDave Liu 						dev->name, mii_info->speed);
5387737d5c6SDave Liu 					break;
5397737d5c6SDave Liu 				}
54024c3aca3SDave Liu 			}
5417737d5c6SDave Liu 
542582c55a0SHeiko Schocher 			/* change phy */
543582c55a0SHeiko Schocher 			change_phy_interface_mode(dev, mode, mii_info->speed);
544582c55a0SHeiko Schocher 			/* change the MAC interface mode */
545582c55a0SHeiko Schocher 			uec_set_mac_if_mode(uec, mode, mii_info->speed);
546582c55a0SHeiko Schocher 
5477737d5c6SDave Liu 			printf("%s: Speed %dBT\n", dev->name, mii_info->speed);
5487737d5c6SDave Liu 			uec->oldspeed = mii_info->speed;
5497737d5c6SDave Liu 		}
5507737d5c6SDave Liu 
5517737d5c6SDave Liu 		if (!uec->oldlink) {
5527737d5c6SDave Liu 			printf("%s: Link is up\n", dev->name);
5537737d5c6SDave Liu 			uec->oldlink = 1;
5547737d5c6SDave Liu 		}
5557737d5c6SDave Liu 
5567737d5c6SDave Liu 	} else { /* if (mii_info->link) */
5577737d5c6SDave Liu 		if (uec->oldlink) {
5587737d5c6SDave Liu 			printf("%s: Link is down\n", dev->name);
5597737d5c6SDave Liu 			uec->oldlink = 0;
5607737d5c6SDave Liu 			uec->oldspeed = 0;
5617737d5c6SDave Liu 			uec->oldduplex = -1;
5627737d5c6SDave Liu 		}
5637737d5c6SDave Liu 	}
5647737d5c6SDave Liu }
5657737d5c6SDave Liu 
phy_change(struct eth_device * dev)5667737d5c6SDave Liu static void phy_change(struct eth_device *dev)
5677737d5c6SDave Liu {
5687737d5c6SDave Liu 	uec_private_t	*uec = (uec_private_t *)dev->priv;
5697737d5c6SDave Liu 
570*4167a67dSYork Sun #if defined(CONFIG_ARCH_P1021) || defined(CONFIG_ARCH_P1025)
571a52d2f81SHaiying Wang 	ccsr_gur_t *gur = (void *)(CONFIG_SYS_MPC85xx_GUTS_ADDR);
572a52d2f81SHaiying Wang 
573a52d2f81SHaiying Wang 	/* QE9 and QE12 need to be set for enabling QE MII managment signals */
574a52d2f81SHaiying Wang 	setbits_be32(&gur->pmuxcr, MPC85xx_PMUXCR_QE9);
575a52d2f81SHaiying Wang 	setbits_be32(&gur->pmuxcr, MPC85xx_PMUXCR_QE12);
576a52d2f81SHaiying Wang #endif
577a52d2f81SHaiying Wang 
5787737d5c6SDave Liu 	/* Update the link, speed, duplex */
579ee62ed32SKim Phillips 	uec->mii_info->phyinfo->read_status(uec->mii_info);
5807737d5c6SDave Liu 
581*4167a67dSYork Sun #if defined(CONFIG_ARCH_P1021) || defined(CONFIG_ARCH_P1025)
582a52d2f81SHaiying Wang 	/*
583a52d2f81SHaiying Wang 	 * QE12 is muxed with LBCTL, it needs to be released for enabling
584a52d2f81SHaiying Wang 	 * LBCTL signal for LBC usage.
585a52d2f81SHaiying Wang 	 */
586a52d2f81SHaiying Wang 	clrbits_be32(&gur->pmuxcr, MPC85xx_PMUXCR_QE12);
587a52d2f81SHaiying Wang #endif
588a52d2f81SHaiying Wang 
5897737d5c6SDave Liu 	/* Adjust the interface according to speed */
5907737d5c6SDave Liu 	adjust_link(dev);
5917737d5c6SDave Liu }
5927737d5c6SDave Liu 
59323c34af4SRichard Retanubun #if defined(CONFIG_MII) || defined(CONFIG_CMD_MII)
594d9d78ee4SBen Warren 
595d9d78ee4SBen Warren /*
5960115b195Srichardretanubun  * Find a device index from the devlist by name
5970115b195Srichardretanubun  *
5980115b195Srichardretanubun  * Returns:
5990115b195Srichardretanubun  *  The index where the device is located, -1 on error
6000115b195Srichardretanubun  */
uec_miiphy_find_dev_by_name(const char * devname)6015700bb63SMike Frysinger static int uec_miiphy_find_dev_by_name(const char *devname)
6020115b195Srichardretanubun {
6030115b195Srichardretanubun 	int i;
6040115b195Srichardretanubun 
6050115b195Srichardretanubun 	for (i = 0; i < MAXCONTROLLERS; i++) {
6060115b195Srichardretanubun 		if (strncmp(devname, devlist[i]->name, strlen(devname)) == 0) {
6070115b195Srichardretanubun 			break;
6080115b195Srichardretanubun 		}
6090115b195Srichardretanubun 	}
6100115b195Srichardretanubun 
6110115b195Srichardretanubun 	/* If device cannot be found, returns -1 */
6120115b195Srichardretanubun 	if (i == MAXCONTROLLERS) {
6130115b195Srichardretanubun 		debug ("%s: device %s not found in devlist\n", __FUNCTION__, devname);
6140115b195Srichardretanubun 		i = -1;
6150115b195Srichardretanubun 	}
6160115b195Srichardretanubun 
6170115b195Srichardretanubun 	return i;
6180115b195Srichardretanubun }
6190115b195Srichardretanubun 
6200115b195Srichardretanubun /*
621d9d78ee4SBen Warren  * Read a MII PHY register.
622d9d78ee4SBen Warren  *
623d9d78ee4SBen Warren  * Returns:
624d9d78ee4SBen Warren  *  0 on success
625d9d78ee4SBen Warren  */
uec_miiphy_read(struct mii_dev * bus,int addr,int devad,int reg)6265a49f174SJoe Hershberger static int uec_miiphy_read(struct mii_dev *bus, int addr, int devad, int reg)
627d9d78ee4SBen Warren {
6285a49f174SJoe Hershberger 	unsigned short value = 0;
6290115b195Srichardretanubun 	int devindex = 0;
630d9d78ee4SBen Warren 
631875e0bc6SJoe Hershberger 	if (bus->name == NULL) {
6320115b195Srichardretanubun 		debug("%s: NULL pointer given\n", __FUNCTION__);
6330115b195Srichardretanubun 	} else {
6345a49f174SJoe Hershberger 		devindex = uec_miiphy_find_dev_by_name(bus->name);
6350115b195Srichardretanubun 		if (devindex >= 0) {
6365a49f174SJoe Hershberger 			value = uec_read_phy_reg(devlist[devindex], addr, reg);
6370115b195Srichardretanubun 		}
6380115b195Srichardretanubun 	}
6395a49f174SJoe Hershberger 	return value;
640d9d78ee4SBen Warren }
641d9d78ee4SBen Warren 
642d9d78ee4SBen Warren /*
643d9d78ee4SBen Warren  * Write a MII PHY register.
644d9d78ee4SBen Warren  *
645d9d78ee4SBen Warren  * Returns:
646d9d78ee4SBen Warren  *  0 on success
647d9d78ee4SBen Warren  */
uec_miiphy_write(struct mii_dev * bus,int addr,int devad,int reg,u16 value)6485a49f174SJoe Hershberger static int uec_miiphy_write(struct mii_dev *bus, int addr, int devad, int reg,
6495a49f174SJoe Hershberger 			    u16 value)
650d9d78ee4SBen Warren {
6510115b195Srichardretanubun 	int devindex = 0;
652d9d78ee4SBen Warren 
6535a49f174SJoe Hershberger 	if (bus->name == NULL) {
6540115b195Srichardretanubun 		debug("%s: NULL pointer given\n", __FUNCTION__);
6550115b195Srichardretanubun 	} else {
6565a49f174SJoe Hershberger 		devindex = uec_miiphy_find_dev_by_name(bus->name);
6570115b195Srichardretanubun 		if (devindex >= 0) {
6580115b195Srichardretanubun 			uec_write_phy_reg(devlist[devindex], addr, reg, value);
6590115b195Srichardretanubun 		}
6600115b195Srichardretanubun 	}
661d9d78ee4SBen Warren 	return 0;
662d9d78ee4SBen Warren }
663d9d78ee4SBen Warren #endif
664d9d78ee4SBen Warren 
uec_set_mac_address(uec_private_t * uec,u8 * mac_addr)6657737d5c6SDave Liu static int uec_set_mac_address(uec_private_t *uec, u8 *mac_addr)
6667737d5c6SDave Liu {
6677737d5c6SDave Liu 	uec_t		*uec_regs;
6687737d5c6SDave Liu 	u32		mac_addr1;
6697737d5c6SDave Liu 	u32		mac_addr2;
6707737d5c6SDave Liu 
6717737d5c6SDave Liu 	if (!uec) {
6727737d5c6SDave Liu 		printf("%s: uec not initial\n", __FUNCTION__);
6737737d5c6SDave Liu 		return -EINVAL;
6747737d5c6SDave Liu 	}
6757737d5c6SDave Liu 
6767737d5c6SDave Liu 	uec_regs = uec->uec_regs;
6777737d5c6SDave Liu 
6787737d5c6SDave Liu 	/* if a station address of 0x12345678ABCD, perform a write to
6797737d5c6SDave Liu 	MACSTNADDR1 of 0xCDAB7856,
6807737d5c6SDave Liu 	MACSTNADDR2 of 0x34120000 */
6817737d5c6SDave Liu 
6827737d5c6SDave Liu 	mac_addr1 = (mac_addr[5] << 24) | (mac_addr[4] << 16) | \
6837737d5c6SDave Liu 			(mac_addr[3] << 8)  | (mac_addr[2]);
6847737d5c6SDave Liu 	out_be32(&uec_regs->macstnaddr1, mac_addr1);
6857737d5c6SDave Liu 
6867737d5c6SDave Liu 	mac_addr2 = ((mac_addr[1] << 24) | (mac_addr[0] << 16)) & 0xffff0000;
6877737d5c6SDave Liu 	out_be32(&uec_regs->macstnaddr2, mac_addr2);
6887737d5c6SDave Liu 
6897737d5c6SDave Liu 	return 0;
6907737d5c6SDave Liu }
6917737d5c6SDave Liu 
uec_convert_threads_num(uec_num_of_threads_e threads_num,int * threads_num_ret)6927737d5c6SDave Liu static int uec_convert_threads_num(uec_num_of_threads_e threads_num,
6937737d5c6SDave Liu 					 int *threads_num_ret)
6947737d5c6SDave Liu {
6957737d5c6SDave Liu 	int	num_threads_numerica;
6967737d5c6SDave Liu 
6977737d5c6SDave Liu 	switch (threads_num) {
6987737d5c6SDave Liu 		case UEC_NUM_OF_THREADS_1:
6997737d5c6SDave Liu 			num_threads_numerica = 1;
7007737d5c6SDave Liu 			break;
7017737d5c6SDave Liu 		case UEC_NUM_OF_THREADS_2:
7027737d5c6SDave Liu 			num_threads_numerica = 2;
7037737d5c6SDave Liu 			break;
7047737d5c6SDave Liu 		case UEC_NUM_OF_THREADS_4:
7057737d5c6SDave Liu 			num_threads_numerica = 4;
7067737d5c6SDave Liu 			break;
7077737d5c6SDave Liu 		case UEC_NUM_OF_THREADS_6:
7087737d5c6SDave Liu 			num_threads_numerica = 6;
7097737d5c6SDave Liu 			break;
7107737d5c6SDave Liu 		case UEC_NUM_OF_THREADS_8:
7117737d5c6SDave Liu 			num_threads_numerica = 8;
7127737d5c6SDave Liu 			break;
7137737d5c6SDave Liu 		default:
7147737d5c6SDave Liu 			printf("%s: Bad number of threads value.",
7157737d5c6SDave Liu 				 __FUNCTION__);
7167737d5c6SDave Liu 			return -EINVAL;
7177737d5c6SDave Liu 	}
7187737d5c6SDave Liu 
7197737d5c6SDave Liu 	*threads_num_ret = num_threads_numerica;
7207737d5c6SDave Liu 
7217737d5c6SDave Liu 	return 0;
7227737d5c6SDave Liu }
7237737d5c6SDave Liu 
uec_init_tx_parameter(uec_private_t * uec,int num_threads_tx)7247737d5c6SDave Liu static void uec_init_tx_parameter(uec_private_t *uec, int num_threads_tx)
7257737d5c6SDave Liu {
7267737d5c6SDave Liu 	uec_info_t	*uec_info;
7277737d5c6SDave Liu 	u32		end_bd;
7287737d5c6SDave Liu 	u8		bmrx = 0;
7297737d5c6SDave Liu 	int		i;
7307737d5c6SDave Liu 
7317737d5c6SDave Liu 	uec_info = uec->uec_info;
7327737d5c6SDave Liu 
7337737d5c6SDave Liu 	/* Alloc global Tx parameter RAM page */
7347737d5c6SDave Liu 	uec->tx_glbl_pram_offset = qe_muram_alloc(
7357737d5c6SDave Liu 				sizeof(uec_tx_global_pram_t),
7367737d5c6SDave Liu 				 UEC_TX_GLOBAL_PRAM_ALIGNMENT);
7377737d5c6SDave Liu 	uec->p_tx_glbl_pram = (uec_tx_global_pram_t *)
7387737d5c6SDave Liu 				qe_muram_addr(uec->tx_glbl_pram_offset);
7397737d5c6SDave Liu 
7407737d5c6SDave Liu 	/* Zero the global Tx prameter RAM */
7417737d5c6SDave Liu 	memset(uec->p_tx_glbl_pram, 0, sizeof(uec_tx_global_pram_t));
7427737d5c6SDave Liu 
7437737d5c6SDave Liu 	/* Init global Tx parameter RAM */
7447737d5c6SDave Liu 
7457737d5c6SDave Liu 	/* TEMODER, RMON statistics disable, one Tx queue */
7467737d5c6SDave Liu 	out_be16(&uec->p_tx_glbl_pram->temoder, TEMODER_INIT_VALUE);
7477737d5c6SDave Liu 
7487737d5c6SDave Liu 	/* SQPTR */
7497737d5c6SDave Liu 	uec->send_q_mem_reg_offset = qe_muram_alloc(
7507737d5c6SDave Liu 				sizeof(uec_send_queue_qd_t),
7517737d5c6SDave Liu 				 UEC_SEND_QUEUE_QUEUE_DESCRIPTOR_ALIGNMENT);
7527737d5c6SDave Liu 	uec->p_send_q_mem_reg = (uec_send_queue_mem_region_t *)
7537737d5c6SDave Liu 				qe_muram_addr(uec->send_q_mem_reg_offset);
7547737d5c6SDave Liu 	out_be32(&uec->p_tx_glbl_pram->sqptr, uec->send_q_mem_reg_offset);
7557737d5c6SDave Liu 
7567737d5c6SDave Liu 	/* Setup the table with TxBDs ring */
7577737d5c6SDave Liu 	end_bd = (u32)uec->p_tx_bd_ring + (uec_info->tx_bd_ring_len - 1)
7587737d5c6SDave Liu 					 * SIZEOFBD;
7597737d5c6SDave Liu 	out_be32(&uec->p_send_q_mem_reg->sqqd[0].bd_ring_base,
7607737d5c6SDave Liu 				 (u32)(uec->p_tx_bd_ring));
7617737d5c6SDave Liu 	out_be32(&uec->p_send_q_mem_reg->sqqd[0].last_bd_completed_address,
7627737d5c6SDave Liu 						 end_bd);
7637737d5c6SDave Liu 
7647737d5c6SDave Liu 	/* Scheduler Base Pointer, we have only one Tx queue, no need it */
7657737d5c6SDave Liu 	out_be32(&uec->p_tx_glbl_pram->schedulerbasepointer, 0);
7667737d5c6SDave Liu 
7677737d5c6SDave Liu 	/* TxRMON Base Pointer, TxRMON disable, we don't need it */
7687737d5c6SDave Liu 	out_be32(&uec->p_tx_glbl_pram->txrmonbaseptr, 0);
7697737d5c6SDave Liu 
7707737d5c6SDave Liu 	/* TSTATE, global snooping, big endian, the CSB bus selected */
7717737d5c6SDave Liu 	bmrx = BMR_INIT_VALUE;
7727737d5c6SDave Liu 	out_be32(&uec->p_tx_glbl_pram->tstate, ((u32)(bmrx) << BMR_SHIFT));
7737737d5c6SDave Liu 
7747737d5c6SDave Liu 	/* IPH_Offset */
7757737d5c6SDave Liu 	for (i = 0; i < MAX_IPH_OFFSET_ENTRY; i++) {
7767737d5c6SDave Liu 		out_8(&uec->p_tx_glbl_pram->iphoffset[i], 0);
7777737d5c6SDave Liu 	}
7787737d5c6SDave Liu 
7797737d5c6SDave Liu 	/* VTAG table */
7807737d5c6SDave Liu 	for (i = 0; i < UEC_TX_VTAG_TABLE_ENTRY_MAX; i++) {
7817737d5c6SDave Liu 		out_be32(&uec->p_tx_glbl_pram->vtagtable[i], 0);
7827737d5c6SDave Liu 	}
7837737d5c6SDave Liu 
7847737d5c6SDave Liu 	/* TQPTR */
7857737d5c6SDave Liu 	uec->thread_dat_tx_offset = qe_muram_alloc(
7867737d5c6SDave Liu 		num_threads_tx * sizeof(uec_thread_data_tx_t) +
7877737d5c6SDave Liu 		 32 *(num_threads_tx == 1), UEC_THREAD_DATA_ALIGNMENT);
7887737d5c6SDave Liu 
7897737d5c6SDave Liu 	uec->p_thread_data_tx = (uec_thread_data_tx_t *)
7907737d5c6SDave Liu 				qe_muram_addr(uec->thread_dat_tx_offset);
7917737d5c6SDave Liu 	out_be32(&uec->p_tx_glbl_pram->tqptr, uec->thread_dat_tx_offset);
7927737d5c6SDave Liu }
7937737d5c6SDave Liu 
uec_init_rx_parameter(uec_private_t * uec,int num_threads_rx)7947737d5c6SDave Liu static void uec_init_rx_parameter(uec_private_t *uec, int num_threads_rx)
7957737d5c6SDave Liu {
7967737d5c6SDave Liu 	u8	bmrx = 0;
7977737d5c6SDave Liu 	int	i;
7987737d5c6SDave Liu 	uec_82xx_address_filtering_pram_t	*p_af_pram;
7997737d5c6SDave Liu 
8007737d5c6SDave Liu 	/* Allocate global Rx parameter RAM page */
8017737d5c6SDave Liu 	uec->rx_glbl_pram_offset = qe_muram_alloc(
8027737d5c6SDave Liu 		sizeof(uec_rx_global_pram_t), UEC_RX_GLOBAL_PRAM_ALIGNMENT);
8037737d5c6SDave Liu 	uec->p_rx_glbl_pram = (uec_rx_global_pram_t *)
8047737d5c6SDave Liu 				qe_muram_addr(uec->rx_glbl_pram_offset);
8057737d5c6SDave Liu 
8067737d5c6SDave Liu 	/* Zero Global Rx parameter RAM */
8077737d5c6SDave Liu 	memset(uec->p_rx_glbl_pram, 0, sizeof(uec_rx_global_pram_t));
8087737d5c6SDave Liu 
8097737d5c6SDave Liu 	/* Init global Rx parameter RAM */
8107737d5c6SDave Liu 	/* REMODER, Extended feature mode disable, VLAN disable,
8117737d5c6SDave Liu 	 LossLess flow control disable, Receive firmware statisic disable,
8127737d5c6SDave Liu 	 Extended address parsing mode disable, One Rx queues,
8137737d5c6SDave Liu 	 Dynamic maximum/minimum frame length disable, IP checksum check
8147737d5c6SDave Liu 	 disable, IP address alignment disable
8157737d5c6SDave Liu 	*/
8167737d5c6SDave Liu 	out_be32(&uec->p_rx_glbl_pram->remoder, REMODER_INIT_VALUE);
8177737d5c6SDave Liu 
8187737d5c6SDave Liu 	/* RQPTR */
8197737d5c6SDave Liu 	uec->thread_dat_rx_offset = qe_muram_alloc(
8207737d5c6SDave Liu 			num_threads_rx * sizeof(uec_thread_data_rx_t),
8217737d5c6SDave Liu 			 UEC_THREAD_DATA_ALIGNMENT);
8227737d5c6SDave Liu 	uec->p_thread_data_rx = (uec_thread_data_rx_t *)
8237737d5c6SDave Liu 				qe_muram_addr(uec->thread_dat_rx_offset);
8247737d5c6SDave Liu 	out_be32(&uec->p_rx_glbl_pram->rqptr, uec->thread_dat_rx_offset);
8257737d5c6SDave Liu 
8267737d5c6SDave Liu 	/* Type_or_Len */
8277737d5c6SDave Liu 	out_be16(&uec->p_rx_glbl_pram->typeorlen, 3072);
8287737d5c6SDave Liu 
8297737d5c6SDave Liu 	/* RxRMON base pointer, we don't need it */
8307737d5c6SDave Liu 	out_be32(&uec->p_rx_glbl_pram->rxrmonbaseptr, 0);
8317737d5c6SDave Liu 
8327737d5c6SDave Liu 	/* IntCoalescingPTR, we don't need it, no interrupt */
8337737d5c6SDave Liu 	out_be32(&uec->p_rx_glbl_pram->intcoalescingptr, 0);
8347737d5c6SDave Liu 
8357737d5c6SDave Liu 	/* RSTATE, global snooping, big endian, the CSB bus selected */
8367737d5c6SDave Liu 	bmrx = BMR_INIT_VALUE;
8377737d5c6SDave Liu 	out_8(&uec->p_rx_glbl_pram->rstate, bmrx);
8387737d5c6SDave Liu 
8397737d5c6SDave Liu 	/* MRBLR */
8407737d5c6SDave Liu 	out_be16(&uec->p_rx_glbl_pram->mrblr, MAX_RXBUF_LEN);
8417737d5c6SDave Liu 
8427737d5c6SDave Liu 	/* RBDQPTR */
8437737d5c6SDave Liu 	uec->rx_bd_qs_tbl_offset = qe_muram_alloc(
8447737d5c6SDave Liu 				sizeof(uec_rx_bd_queues_entry_t) + \
8457737d5c6SDave Liu 				sizeof(uec_rx_prefetched_bds_t),
8467737d5c6SDave Liu 				 UEC_RX_BD_QUEUES_ALIGNMENT);
8477737d5c6SDave Liu 	uec->p_rx_bd_qs_tbl = (uec_rx_bd_queues_entry_t *)
8487737d5c6SDave Liu 				qe_muram_addr(uec->rx_bd_qs_tbl_offset);
8497737d5c6SDave Liu 
8507737d5c6SDave Liu 	/* Zero it */
8517737d5c6SDave Liu 	memset(uec->p_rx_bd_qs_tbl, 0, sizeof(uec_rx_bd_queues_entry_t) + \
8527737d5c6SDave Liu 					sizeof(uec_rx_prefetched_bds_t));
8537737d5c6SDave Liu 	out_be32(&uec->p_rx_glbl_pram->rbdqptr, uec->rx_bd_qs_tbl_offset);
8547737d5c6SDave Liu 	out_be32(&uec->p_rx_bd_qs_tbl->externalbdbaseptr,
8557737d5c6SDave Liu 		 (u32)uec->p_rx_bd_ring);
8567737d5c6SDave Liu 
8577737d5c6SDave Liu 	/* MFLR */
8587737d5c6SDave Liu 	out_be16(&uec->p_rx_glbl_pram->mflr, MAX_FRAME_LEN);
8597737d5c6SDave Liu 	/* MINFLR */
8607737d5c6SDave Liu 	out_be16(&uec->p_rx_glbl_pram->minflr, MIN_FRAME_LEN);
8617737d5c6SDave Liu 	/* MAXD1 */
8627737d5c6SDave Liu 	out_be16(&uec->p_rx_glbl_pram->maxd1, MAX_DMA1_LEN);
8637737d5c6SDave Liu 	/* MAXD2 */
8647737d5c6SDave Liu 	out_be16(&uec->p_rx_glbl_pram->maxd2, MAX_DMA2_LEN);
8657737d5c6SDave Liu 	/* ECAM_PTR */
8667737d5c6SDave Liu 	out_be32(&uec->p_rx_glbl_pram->ecamptr, 0);
8677737d5c6SDave Liu 	/* L2QT */
8687737d5c6SDave Liu 	out_be32(&uec->p_rx_glbl_pram->l2qt, 0);
8697737d5c6SDave Liu 	/* L3QT */
8707737d5c6SDave Liu 	for (i = 0; i < 8; i++)	{
8717737d5c6SDave Liu 		out_be32(&uec->p_rx_glbl_pram->l3qt[i], 0);
8727737d5c6SDave Liu 	}
8737737d5c6SDave Liu 
8747737d5c6SDave Liu 	/* VLAN_TYPE */
8757737d5c6SDave Liu 	out_be16(&uec->p_rx_glbl_pram->vlantype, 0x8100);
8767737d5c6SDave Liu 	/* TCI */
8777737d5c6SDave Liu 	out_be16(&uec->p_rx_glbl_pram->vlantci, 0);
8787737d5c6SDave Liu 
8797737d5c6SDave Liu 	/* Clear PQ2 style address filtering hash table */
8807737d5c6SDave Liu 	p_af_pram = (uec_82xx_address_filtering_pram_t *) \
8817737d5c6SDave Liu 			uec->p_rx_glbl_pram->addressfiltering;
8827737d5c6SDave Liu 
8837737d5c6SDave Liu 	p_af_pram->iaddr_h = 0;
8847737d5c6SDave Liu 	p_af_pram->iaddr_l = 0;
8857737d5c6SDave Liu 	p_af_pram->gaddr_h = 0;
8867737d5c6SDave Liu 	p_af_pram->gaddr_l = 0;
8877737d5c6SDave Liu }
8887737d5c6SDave Liu 
uec_issue_init_enet_rxtx_cmd(uec_private_t * uec,int thread_tx,int thread_rx)8897737d5c6SDave Liu static int uec_issue_init_enet_rxtx_cmd(uec_private_t *uec,
8907737d5c6SDave Liu 					 int thread_tx, int thread_rx)
8917737d5c6SDave Liu {
8927737d5c6SDave Liu 	uec_init_cmd_pram_t		*p_init_enet_param;
8937737d5c6SDave Liu 	u32				init_enet_param_offset;
8947737d5c6SDave Liu 	uec_info_t			*uec_info;
8957737d5c6SDave Liu 	int				i;
8967737d5c6SDave Liu 	int				snum;
8977737d5c6SDave Liu 	u32				init_enet_offset;
8987737d5c6SDave Liu 	u32				entry_val;
8997737d5c6SDave Liu 	u32				command;
9007737d5c6SDave Liu 	u32				cecr_subblock;
9017737d5c6SDave Liu 
9027737d5c6SDave Liu 	uec_info = uec->uec_info;
9037737d5c6SDave Liu 
9047737d5c6SDave Liu 	/* Allocate init enet command parameter */
9057737d5c6SDave Liu 	uec->init_enet_param_offset = qe_muram_alloc(
9067737d5c6SDave Liu 					sizeof(uec_init_cmd_pram_t), 4);
9077737d5c6SDave Liu 	init_enet_param_offset = uec->init_enet_param_offset;
9087737d5c6SDave Liu 	uec->p_init_enet_param = (uec_init_cmd_pram_t *)
9097737d5c6SDave Liu 				qe_muram_addr(uec->init_enet_param_offset);
9107737d5c6SDave Liu 
9117737d5c6SDave Liu 	/* Zero init enet command struct */
9127737d5c6SDave Liu 	memset((void *)uec->p_init_enet_param, 0, sizeof(uec_init_cmd_pram_t));
9137737d5c6SDave Liu 
9147737d5c6SDave Liu 	/* Init the command struct */
9157737d5c6SDave Liu 	p_init_enet_param = uec->p_init_enet_param;
9167737d5c6SDave Liu 	p_init_enet_param->resinit0 = ENET_INIT_PARAM_MAGIC_RES_INIT0;
9177737d5c6SDave Liu 	p_init_enet_param->resinit1 = ENET_INIT_PARAM_MAGIC_RES_INIT1;
9187737d5c6SDave Liu 	p_init_enet_param->resinit2 = ENET_INIT_PARAM_MAGIC_RES_INIT2;
9197737d5c6SDave Liu 	p_init_enet_param->resinit3 = ENET_INIT_PARAM_MAGIC_RES_INIT3;
9207737d5c6SDave Liu 	p_init_enet_param->resinit4 = ENET_INIT_PARAM_MAGIC_RES_INIT4;
9217737d5c6SDave Liu 	p_init_enet_param->largestexternallookupkeysize = 0;
9227737d5c6SDave Liu 
9237737d5c6SDave Liu 	p_init_enet_param->rgftgfrxglobal |= ((u32)uec_info->num_threads_rx)
9247737d5c6SDave Liu 					 << ENET_INIT_PARAM_RGF_SHIFT;
9257737d5c6SDave Liu 	p_init_enet_param->rgftgfrxglobal |= ((u32)uec_info->num_threads_tx)
9267737d5c6SDave Liu 					 << ENET_INIT_PARAM_TGF_SHIFT;
9277737d5c6SDave Liu 
9287737d5c6SDave Liu 	/* Init Rx global parameter pointer */
9297737d5c6SDave Liu 	p_init_enet_param->rgftgfrxglobal |= uec->rx_glbl_pram_offset |
93052d6ad5eSHaiying Wang 						 (u32)uec_info->risc_rx;
9317737d5c6SDave Liu 
9327737d5c6SDave Liu 	/* Init Rx threads */
9337737d5c6SDave Liu 	for (i = 0; i < (thread_rx + 1); i++) {
9347737d5c6SDave Liu 		if ((snum = qe_get_snum()) < 0) {
9357737d5c6SDave Liu 			printf("%s can not get snum\n", __FUNCTION__);
9367737d5c6SDave Liu 			return -ENOMEM;
9377737d5c6SDave Liu 		}
9387737d5c6SDave Liu 
9397737d5c6SDave Liu 		if (i==0) {
9407737d5c6SDave Liu 			init_enet_offset = 0;
9417737d5c6SDave Liu 		} else {
9427737d5c6SDave Liu 			init_enet_offset = qe_muram_alloc(
9437737d5c6SDave Liu 					sizeof(uec_thread_rx_pram_t),
9447737d5c6SDave Liu 					 UEC_THREAD_RX_PRAM_ALIGNMENT);
9457737d5c6SDave Liu 		}
9467737d5c6SDave Liu 
9477737d5c6SDave Liu 		entry_val = ((u32)snum << ENET_INIT_PARAM_SNUM_SHIFT) |
94852d6ad5eSHaiying Wang 				 init_enet_offset | (u32)uec_info->risc_rx;
9497737d5c6SDave Liu 		p_init_enet_param->rxthread[i] = entry_val;
9507737d5c6SDave Liu 	}
9517737d5c6SDave Liu 
9527737d5c6SDave Liu 	/* Init Tx global parameter pointer */
9537737d5c6SDave Liu 	p_init_enet_param->txglobal = uec->tx_glbl_pram_offset |
95452d6ad5eSHaiying Wang 					 (u32)uec_info->risc_tx;
9557737d5c6SDave Liu 
9567737d5c6SDave Liu 	/* Init Tx threads */
9577737d5c6SDave Liu 	for (i = 0; i < thread_tx; i++) {
9587737d5c6SDave Liu 		if ((snum = qe_get_snum()) < 0)	{
9597737d5c6SDave Liu 			printf("%s can not get snum\n", __FUNCTION__);
9607737d5c6SDave Liu 			return -ENOMEM;
9617737d5c6SDave Liu 		}
9627737d5c6SDave Liu 
9637737d5c6SDave Liu 		init_enet_offset = qe_muram_alloc(sizeof(uec_thread_tx_pram_t),
9647737d5c6SDave Liu 						 UEC_THREAD_TX_PRAM_ALIGNMENT);
9657737d5c6SDave Liu 
9667737d5c6SDave Liu 		entry_val = ((u32)snum << ENET_INIT_PARAM_SNUM_SHIFT) |
96752d6ad5eSHaiying Wang 				 init_enet_offset | (u32)uec_info->risc_tx;
9687737d5c6SDave Liu 		p_init_enet_param->txthread[i] = entry_val;
9697737d5c6SDave Liu 	}
9707737d5c6SDave Liu 
9717737d5c6SDave Liu 	__asm__ __volatile__("sync");
9727737d5c6SDave Liu 
9737737d5c6SDave Liu 	/* Issue QE command */
9747737d5c6SDave Liu 	command = QE_INIT_TX_RX;
9757737d5c6SDave Liu 	cecr_subblock =	ucc_fast_get_qe_cr_subblock(
9767737d5c6SDave Liu 				uec->uec_info->uf_info.ucc_num);
9777737d5c6SDave Liu 	qe_issue_cmd(command, cecr_subblock, (u8) QE_CR_PROTOCOL_ETHERNET,
9787737d5c6SDave Liu 						 init_enet_param_offset);
9797737d5c6SDave Liu 
9807737d5c6SDave Liu 	return 0;
9817737d5c6SDave Liu }
9827737d5c6SDave Liu 
uec_startup(uec_private_t * uec)9837737d5c6SDave Liu static int uec_startup(uec_private_t *uec)
9847737d5c6SDave Liu {
9857737d5c6SDave Liu 	uec_info_t			*uec_info;
9867737d5c6SDave Liu 	ucc_fast_info_t			*uf_info;
9877737d5c6SDave Liu 	ucc_fast_private_t		*uccf;
9887737d5c6SDave Liu 	ucc_fast_t			*uf_regs;
9897737d5c6SDave Liu 	uec_t				*uec_regs;
9907737d5c6SDave Liu 	int				num_threads_tx;
9917737d5c6SDave Liu 	int				num_threads_rx;
9927737d5c6SDave Liu 	u32				utbipar;
9937737d5c6SDave Liu 	u32				length;
9947737d5c6SDave Liu 	u32				align;
9957737d5c6SDave Liu 	qe_bd_t				*bd;
9967737d5c6SDave Liu 	u8				*buf;
9977737d5c6SDave Liu 	int				i;
9987737d5c6SDave Liu 
9997737d5c6SDave Liu 	if (!uec || !uec->uec_info) {
10007737d5c6SDave Liu 		printf("%s: uec or uec_info not initial\n", __FUNCTION__);
10017737d5c6SDave Liu 		return -EINVAL;
10027737d5c6SDave Liu 	}
10037737d5c6SDave Liu 
10047737d5c6SDave Liu 	uec_info = uec->uec_info;
10057737d5c6SDave Liu 	uf_info = &(uec_info->uf_info);
10067737d5c6SDave Liu 
10077737d5c6SDave Liu 	/* Check if Rx BD ring len is illegal */
10087737d5c6SDave Liu 	if ((uec_info->rx_bd_ring_len < UEC_RX_BD_RING_SIZE_MIN) || \
10097737d5c6SDave Liu 		(uec_info->rx_bd_ring_len % UEC_RX_BD_RING_SIZE_ALIGNMENT)) {
10107737d5c6SDave Liu 		printf("%s: Rx BD ring len must be multiple of 4, and > 8.\n",
10117737d5c6SDave Liu 			 __FUNCTION__);
10127737d5c6SDave Liu 		return -EINVAL;
10137737d5c6SDave Liu 	}
10147737d5c6SDave Liu 
10157737d5c6SDave Liu 	/* Check if Tx BD ring len is illegal */
10167737d5c6SDave Liu 	if (uec_info->tx_bd_ring_len < UEC_TX_BD_RING_SIZE_MIN) {
10177737d5c6SDave Liu 		printf("%s: Tx BD ring length must not be smaller than 2.\n",
10187737d5c6SDave Liu 			 __FUNCTION__);
10197737d5c6SDave Liu 		return -EINVAL;
10207737d5c6SDave Liu 	}
10217737d5c6SDave Liu 
10227737d5c6SDave Liu 	/* Check if MRBLR is illegal */
10237737d5c6SDave Liu 	if ((MAX_RXBUF_LEN == 0) || (MAX_RXBUF_LEN  % UEC_MRBLR_ALIGNMENT)) {
10247737d5c6SDave Liu 		printf("%s: max rx buffer length must be mutliple of 128.\n",
10257737d5c6SDave Liu 			 __FUNCTION__);
10267737d5c6SDave Liu 		return -EINVAL;
10277737d5c6SDave Liu 	}
10287737d5c6SDave Liu 
10297737d5c6SDave Liu 	/* Both Rx and Tx are stopped */
10307737d5c6SDave Liu 	uec->grace_stopped_rx = 1;
10317737d5c6SDave Liu 	uec->grace_stopped_tx = 1;
10327737d5c6SDave Liu 
10337737d5c6SDave Liu 	/* Init UCC fast */
10347737d5c6SDave Liu 	if (ucc_fast_init(uf_info, &uccf)) {
10357737d5c6SDave Liu 		printf("%s: failed to init ucc fast\n", __FUNCTION__);
10367737d5c6SDave Liu 		return -ENOMEM;
10377737d5c6SDave Liu 	}
10387737d5c6SDave Liu 
10397737d5c6SDave Liu 	/* Save uccf */
10407737d5c6SDave Liu 	uec->uccf = uccf;
10417737d5c6SDave Liu 
10427737d5c6SDave Liu 	/* Convert the Tx threads number */
10437737d5c6SDave Liu 	if (uec_convert_threads_num(uec_info->num_threads_tx,
10447737d5c6SDave Liu 					 &num_threads_tx)) {
10457737d5c6SDave Liu 		return -EINVAL;
10467737d5c6SDave Liu 	}
10477737d5c6SDave Liu 
10487737d5c6SDave Liu 	/* Convert the Rx threads number */
10497737d5c6SDave Liu 	if (uec_convert_threads_num(uec_info->num_threads_rx,
10507737d5c6SDave Liu 					 &num_threads_rx)) {
10517737d5c6SDave Liu 		return -EINVAL;
10527737d5c6SDave Liu 	}
10537737d5c6SDave Liu 
10547737d5c6SDave Liu 	uf_regs = uccf->uf_regs;
10557737d5c6SDave Liu 
10567737d5c6SDave Liu 	/* UEC register is following UCC fast registers */
10577737d5c6SDave Liu 	uec_regs = (uec_t *)(&uf_regs->ucc_eth);
10587737d5c6SDave Liu 
10597737d5c6SDave Liu 	/* Save the UEC register pointer to UEC private struct */
10607737d5c6SDave Liu 	uec->uec_regs = uec_regs;
10617737d5c6SDave Liu 
10627737d5c6SDave Liu 	/* Init UPSMR, enable hardware statistics (UCC) */
10637737d5c6SDave Liu 	out_be32(&uec->uccf->uf_regs->upsmr, UPSMR_INIT_VALUE);
10647737d5c6SDave Liu 
10657737d5c6SDave Liu 	/* Init MACCFG1, flow control disable, disable Tx and Rx */
10667737d5c6SDave Liu 	out_be32(&uec_regs->maccfg1, MACCFG1_INIT_VALUE);
10677737d5c6SDave Liu 
10687737d5c6SDave Liu 	/* Init MACCFG2, length check, MAC PAD and CRC enable */
10697737d5c6SDave Liu 	out_be32(&uec_regs->maccfg2, MACCFG2_INIT_VALUE);
10707737d5c6SDave Liu 
10717737d5c6SDave Liu 	/* Setup MAC interface mode */
1072582c55a0SHeiko Schocher 	uec_set_mac_if_mode(uec, uec_info->enet_interface_type, uec_info->speed);
10737737d5c6SDave Liu 
1074da9d4610SAndy Fleming 	/* Setup MII management base */
1075da9d4610SAndy Fleming #ifndef CONFIG_eTSEC_MDIO_BUS
1076da9d4610SAndy Fleming 	uec->uec_mii_regs = (uec_mii_t *)(&uec_regs->miimcfg);
1077da9d4610SAndy Fleming #else
1078da9d4610SAndy Fleming 	uec->uec_mii_regs = (uec_mii_t *) CONFIG_MIIM_ADDRESS;
1079da9d4610SAndy Fleming #endif
1080da9d4610SAndy Fleming 
10817737d5c6SDave Liu 	/* Setup MII master clock source */
10827737d5c6SDave Liu 	qe_set_mii_clk_src(uec_info->uf_info.ucc_num);
10837737d5c6SDave Liu 
10847737d5c6SDave Liu 	/* Setup UTBIPAR */
10857737d5c6SDave Liu 	utbipar = in_be32(&uec_regs->utbipar);
10867737d5c6SDave Liu 	utbipar &= ~UTBIPAR_PHY_ADDRESS_MASK;
10877737d5c6SDave Liu 
10881a951937SRichard Retanubun 	/* Initialize UTBIPAR address to CONFIG_UTBIPAR_INIT_TBIPA for ALL UEC.
10891a951937SRichard Retanubun 	 * This frees up the remaining SMI addresses for use.
10901a951937SRichard Retanubun 	 */
10911a951937SRichard Retanubun 	utbipar |= CONFIG_UTBIPAR_INIT_TBIPA << UTBIPAR_PHY_ADDRESS_SHIFT;
10927737d5c6SDave Liu 	out_be32(&uec_regs->utbipar, utbipar);
10937737d5c6SDave Liu 
1094e8efef7cSHaiying Wang 	/* Configure the TBI for SGMII operation */
1095865ff856SAndy Fleming 	if ((uec->uec_info->enet_interface_type == PHY_INTERFACE_MODE_SGMII) &&
1096865ff856SAndy Fleming 	   (uec->uec_info->speed == SPEED_1000)) {
1097e8efef7cSHaiying Wang 		uec_write_phy_reg(uec->dev, uec_regs->utbipar,
1098e8efef7cSHaiying Wang 			ENET_TBI_MII_ANA, TBIANA_SETTINGS);
1099e8efef7cSHaiying Wang 
1100e8efef7cSHaiying Wang 		uec_write_phy_reg(uec->dev, uec_regs->utbipar,
1101e8efef7cSHaiying Wang 			ENET_TBI_MII_TBICON, TBICON_CLK_SELECT);
1102e8efef7cSHaiying Wang 
1103e8efef7cSHaiying Wang 		uec_write_phy_reg(uec->dev, uec_regs->utbipar,
1104e8efef7cSHaiying Wang 			ENET_TBI_MII_CR, TBICR_SETTINGS);
1105e8efef7cSHaiying Wang 	}
1106e8efef7cSHaiying Wang 
11077737d5c6SDave Liu 	/* Allocate Tx BDs */
11087737d5c6SDave Liu 	length = ((uec_info->tx_bd_ring_len * SIZEOFBD) /
11097737d5c6SDave Liu 		 UEC_TX_BD_RING_SIZE_MEMORY_ALIGNMENT) *
11107737d5c6SDave Liu 		 UEC_TX_BD_RING_SIZE_MEMORY_ALIGNMENT;
11117737d5c6SDave Liu 	if ((uec_info->tx_bd_ring_len * SIZEOFBD) %
11127737d5c6SDave Liu 		 UEC_TX_BD_RING_SIZE_MEMORY_ALIGNMENT) {
11137737d5c6SDave Liu 		length += UEC_TX_BD_RING_SIZE_MEMORY_ALIGNMENT;
11147737d5c6SDave Liu 	}
11157737d5c6SDave Liu 
11167737d5c6SDave Liu 	align = UEC_TX_BD_RING_ALIGNMENT;
11177737d5c6SDave Liu 	uec->tx_bd_ring_offset = (u32)malloc((u32)(length + align));
11187737d5c6SDave Liu 	if (uec->tx_bd_ring_offset != 0) {
11197737d5c6SDave Liu 		uec->p_tx_bd_ring = (u8 *)((uec->tx_bd_ring_offset + align)
11207737d5c6SDave Liu 						 & ~(align - 1));
11217737d5c6SDave Liu 	}
11227737d5c6SDave Liu 
11237737d5c6SDave Liu 	/* Zero all of Tx BDs */
11247737d5c6SDave Liu 	memset((void *)(uec->tx_bd_ring_offset), 0, length + align);
11257737d5c6SDave Liu 
11267737d5c6SDave Liu 	/* Allocate Rx BDs */
11277737d5c6SDave Liu 	length = uec_info->rx_bd_ring_len * SIZEOFBD;
11287737d5c6SDave Liu 	align = UEC_RX_BD_RING_ALIGNMENT;
11297737d5c6SDave Liu 	uec->rx_bd_ring_offset = (u32)(malloc((u32)(length + align)));
11307737d5c6SDave Liu 	if (uec->rx_bd_ring_offset != 0) {
11317737d5c6SDave Liu 		uec->p_rx_bd_ring = (u8 *)((uec->rx_bd_ring_offset + align)
11327737d5c6SDave Liu 							 & ~(align - 1));
11337737d5c6SDave Liu 	}
11347737d5c6SDave Liu 
11357737d5c6SDave Liu 	/* Zero all of Rx BDs */
11367737d5c6SDave Liu 	memset((void *)(uec->rx_bd_ring_offset), 0, length + align);
11377737d5c6SDave Liu 
11387737d5c6SDave Liu 	/* Allocate Rx buffer */
11397737d5c6SDave Liu 	length = uec_info->rx_bd_ring_len * MAX_RXBUF_LEN;
11407737d5c6SDave Liu 	align = UEC_RX_DATA_BUF_ALIGNMENT;
11417737d5c6SDave Liu 	uec->rx_buf_offset = (u32)malloc(length + align);
11427737d5c6SDave Liu 	if (uec->rx_buf_offset != 0) {
11437737d5c6SDave Liu 		uec->p_rx_buf = (u8 *)((uec->rx_buf_offset + align)
11447737d5c6SDave Liu 						 & ~(align - 1));
11457737d5c6SDave Liu 	}
11467737d5c6SDave Liu 
11477737d5c6SDave Liu 	/* Zero all of the Rx buffer */
11487737d5c6SDave Liu 	memset((void *)(uec->rx_buf_offset), 0, length + align);
11497737d5c6SDave Liu 
11507737d5c6SDave Liu 	/* Init TxBD ring */
11517737d5c6SDave Liu 	bd = (qe_bd_t *)uec->p_tx_bd_ring;
11527737d5c6SDave Liu 	uec->txBd = bd;
11537737d5c6SDave Liu 
11547737d5c6SDave Liu 	for (i = 0; i < uec_info->tx_bd_ring_len; i++) {
11557737d5c6SDave Liu 		BD_DATA_CLEAR(bd);
11567737d5c6SDave Liu 		BD_STATUS_SET(bd, 0);
11577737d5c6SDave Liu 		BD_LENGTH_SET(bd, 0);
11587737d5c6SDave Liu 		bd ++;
11597737d5c6SDave Liu 	}
11607737d5c6SDave Liu 	BD_STATUS_SET((--bd), TxBD_WRAP);
11617737d5c6SDave Liu 
11627737d5c6SDave Liu 	/* Init RxBD ring */
11637737d5c6SDave Liu 	bd = (qe_bd_t *)uec->p_rx_bd_ring;
11647737d5c6SDave Liu 	uec->rxBd = bd;
11657737d5c6SDave Liu 	buf = uec->p_rx_buf;
11667737d5c6SDave Liu 	for (i = 0; i < uec_info->rx_bd_ring_len; i++) {
11677737d5c6SDave Liu 		BD_DATA_SET(bd, buf);
11687737d5c6SDave Liu 		BD_LENGTH_SET(bd, 0);
11697737d5c6SDave Liu 		BD_STATUS_SET(bd, RxBD_EMPTY);
11707737d5c6SDave Liu 		buf += MAX_RXBUF_LEN;
11717737d5c6SDave Liu 		bd ++;
11727737d5c6SDave Liu 	}
11737737d5c6SDave Liu 	BD_STATUS_SET((--bd), RxBD_WRAP | RxBD_EMPTY);
11747737d5c6SDave Liu 
11757737d5c6SDave Liu 	/* Init global Tx parameter RAM */
11767737d5c6SDave Liu 	uec_init_tx_parameter(uec, num_threads_tx);
11777737d5c6SDave Liu 
11787737d5c6SDave Liu 	/* Init global Rx parameter RAM */
11797737d5c6SDave Liu 	uec_init_rx_parameter(uec, num_threads_rx);
11807737d5c6SDave Liu 
11817737d5c6SDave Liu 	/* Init ethernet Tx and Rx parameter command */
11827737d5c6SDave Liu 	if (uec_issue_init_enet_rxtx_cmd(uec, num_threads_tx,
11837737d5c6SDave Liu 					 num_threads_rx)) {
11847737d5c6SDave Liu 		printf("%s issue init enet cmd failed\n", __FUNCTION__);
11857737d5c6SDave Liu 		return -ENOMEM;
11867737d5c6SDave Liu 	}
11877737d5c6SDave Liu 
11887737d5c6SDave Liu 	return 0;
11897737d5c6SDave Liu }
11907737d5c6SDave Liu 
uec_init(struct eth_device * dev,bd_t * bd)11917737d5c6SDave Liu static int uec_init(struct eth_device* dev, bd_t *bd)
11927737d5c6SDave Liu {
11937737d5c6SDave Liu 	uec_private_t		*uec;
1194ee62ed32SKim Phillips 	int			err, i;
1195ee62ed32SKim Phillips 	struct phy_info         *curphy;
1196*4167a67dSYork Sun #if defined(CONFIG_ARCH_P1021) || defined(CONFIG_ARCH_P1025)
1197a52d2f81SHaiying Wang 	ccsr_gur_t *gur = (void *)(CONFIG_SYS_MPC85xx_GUTS_ADDR);
1198a52d2f81SHaiying Wang #endif
11997737d5c6SDave Liu 
12007737d5c6SDave Liu 	uec = (uec_private_t *)dev->priv;
12017737d5c6SDave Liu 
12027737d5c6SDave Liu 	if (uec->the_first_run == 0) {
1203*4167a67dSYork Sun #if defined(CONFIG_ARCH_P1021) || defined(CONFIG_ARCH_P1025)
1204a52d2f81SHaiying Wang 	/* QE9 and QE12 need to be set for enabling QE MII managment signals */
1205a52d2f81SHaiying Wang 	setbits_be32(&gur->pmuxcr, MPC85xx_PMUXCR_QE9);
1206a52d2f81SHaiying Wang 	setbits_be32(&gur->pmuxcr, MPC85xx_PMUXCR_QE12);
1207a52d2f81SHaiying Wang #endif
1208a52d2f81SHaiying Wang 
1209ee62ed32SKim Phillips 		err = init_phy(dev);
1210ee62ed32SKim Phillips 		if (err) {
1211ee62ed32SKim Phillips 			printf("%s: Cannot initialize PHY, aborting.\n",
1212ee62ed32SKim Phillips 			       dev->name);
1213ee62ed32SKim Phillips 			return err;
1214ee62ed32SKim Phillips 		}
1215ee62ed32SKim Phillips 
1216ee62ed32SKim Phillips 		curphy = uec->mii_info->phyinfo;
1217ee62ed32SKim Phillips 
1218ee62ed32SKim Phillips 		if (curphy->config_aneg) {
1219ee62ed32SKim Phillips 			err = curphy->config_aneg(uec->mii_info);
1220ee62ed32SKim Phillips 			if (err) {
1221ee62ed32SKim Phillips 				printf("%s: Can't negotiate PHY\n", dev->name);
1222ee62ed32SKim Phillips 				return err;
1223ee62ed32SKim Phillips 			}
1224ee62ed32SKim Phillips 		}
1225ee62ed32SKim Phillips 
1226ee62ed32SKim Phillips 		/* Give PHYs up to 5 sec to report a link */
1227ee62ed32SKim Phillips 		i = 50;
1228ee62ed32SKim Phillips 		do {
1229ee62ed32SKim Phillips 			err = curphy->read_status(uec->mii_info);
1230bd6c25afSJoakim Tjernlund 			if (!(((i-- > 0) && !uec->mii_info->link) || err))
1231bd6c25afSJoakim Tjernlund 				break;
1232ee62ed32SKim Phillips 			udelay(100000);
1233bd6c25afSJoakim Tjernlund 		} while (1);
1234ee62ed32SKim Phillips 
1235*4167a67dSYork Sun #if defined(CONFIG_ARCH_P1021) || defined(CONFIG_ARCH_P1025)
1236a52d2f81SHaiying Wang 		/* QE12 needs to be released for enabling LBCTL signal*/
1237a52d2f81SHaiying Wang 		clrbits_be32(&gur->pmuxcr, MPC85xx_PMUXCR_QE12);
1238a52d2f81SHaiying Wang #endif
1239a52d2f81SHaiying Wang 
1240ee62ed32SKim Phillips 		if (err || i <= 0)
1241ee62ed32SKim Phillips 			printf("warning: %s: timeout on PHY link\n", dev->name);
1242ee62ed32SKim Phillips 
1243582c55a0SHeiko Schocher 		adjust_link(dev);
1244ee62ed32SKim Phillips 		uec->the_first_run = 1;
1245ee62ed32SKim Phillips 	}
1246ee62ed32SKim Phillips 
12477737d5c6SDave Liu 	/* Set up the MAC address */
12487737d5c6SDave Liu 	if (dev->enetaddr[0] & 0x01) {
12497737d5c6SDave Liu 		printf("%s: MacAddress is multcast address\n",
12507737d5c6SDave Liu 			 __FUNCTION__);
1251422b1a01SBen Warren 		return -1;
12527737d5c6SDave Liu 	}
12537737d5c6SDave Liu 	uec_set_mac_address(uec, dev->enetaddr);
1254ee62ed32SKim Phillips 
12557737d5c6SDave Liu 
12567737d5c6SDave Liu 	err = uec_open(uec, COMM_DIR_RX_AND_TX);
12577737d5c6SDave Liu 	if (err) {
12587737d5c6SDave Liu 		printf("%s: cannot enable UEC device\n", dev->name);
1259422b1a01SBen Warren 		return -1;
12607737d5c6SDave Liu 	}
12617737d5c6SDave Liu 
1262ee62ed32SKim Phillips 	phy_change(dev);
1263ee62ed32SKim Phillips 
1264422b1a01SBen Warren 	return (uec->mii_info->link ? 0 : -1);
12657737d5c6SDave Liu }
12667737d5c6SDave Liu 
uec_halt(struct eth_device * dev)12677737d5c6SDave Liu static void uec_halt(struct eth_device* dev)
12687737d5c6SDave Liu {
12697737d5c6SDave Liu 	uec_private_t	*uec = (uec_private_t *)dev->priv;
12707737d5c6SDave Liu 	uec_stop(uec, COMM_DIR_RX_AND_TX);
12717737d5c6SDave Liu }
12727737d5c6SDave Liu 
uec_send(struct eth_device * dev,void * buf,int len)12737ae84d56SJoe Hershberger static int uec_send(struct eth_device *dev, void *buf, int len)
12747737d5c6SDave Liu {
12757737d5c6SDave Liu 	uec_private_t		*uec;
12767737d5c6SDave Liu 	ucc_fast_private_t	*uccf;
12777737d5c6SDave Liu 	volatile qe_bd_t	*bd;
1278ddd02492SDave Liu 	u16			status;
12797737d5c6SDave Liu 	int			i;
12807737d5c6SDave Liu 	int			result = 0;
12817737d5c6SDave Liu 
12827737d5c6SDave Liu 	uec = (uec_private_t *)dev->priv;
12837737d5c6SDave Liu 	uccf = uec->uccf;
12847737d5c6SDave Liu 	bd = uec->txBd;
12857737d5c6SDave Liu 
12867737d5c6SDave Liu 	/* Find an empty TxBD */
1287ddd02492SDave Liu 	for (i = 0; bd->status & TxBD_READY; i++) {
12887737d5c6SDave Liu 		if (i > 0x100000) {
12897737d5c6SDave Liu 			printf("%s: tx buffer not ready\n", dev->name);
12907737d5c6SDave Liu 			return result;
12917737d5c6SDave Liu 		}
12927737d5c6SDave Liu 	}
12937737d5c6SDave Liu 
12947737d5c6SDave Liu 	/* Init TxBD */
12957737d5c6SDave Liu 	BD_DATA_SET(bd, buf);
12967737d5c6SDave Liu 	BD_LENGTH_SET(bd, len);
1297a28899c9SEmilian Medve 	status = bd->status;
12987737d5c6SDave Liu 	status &= BD_WRAP;
12997737d5c6SDave Liu 	status |= (TxBD_READY | TxBD_LAST);
13007737d5c6SDave Liu 	BD_STATUS_SET(bd, status);
13017737d5c6SDave Liu 
13027737d5c6SDave Liu 	/* Tell UCC to transmit the buffer */
13037737d5c6SDave Liu 	ucc_fast_transmit_on_demand(uccf);
13047737d5c6SDave Liu 
13057737d5c6SDave Liu 	/* Wait for buffer to be transmitted */
1306ddd02492SDave Liu 	for (i = 0; bd->status & TxBD_READY; i++) {
13077737d5c6SDave Liu 		if (i > 0x100000) {
13087737d5c6SDave Liu 			printf("%s: tx error\n", dev->name);
13097737d5c6SDave Liu 			return result;
13107737d5c6SDave Liu 		}
13117737d5c6SDave Liu 	}
13127737d5c6SDave Liu 
13137737d5c6SDave Liu 	/* Ok, the buffer be transimitted */
13147737d5c6SDave Liu 	BD_ADVANCE(bd, status, uec->p_tx_bd_ring);
13157737d5c6SDave Liu 	uec->txBd = bd;
13167737d5c6SDave Liu 	result = 1;
13177737d5c6SDave Liu 
13187737d5c6SDave Liu 	return result;
13197737d5c6SDave Liu }
13207737d5c6SDave Liu 
uec_recv(struct eth_device * dev)13217737d5c6SDave Liu static int uec_recv(struct eth_device* dev)
13227737d5c6SDave Liu {
13237737d5c6SDave Liu 	uec_private_t		*uec = dev->priv;
13247737d5c6SDave Liu 	volatile qe_bd_t	*bd;
1325ddd02492SDave Liu 	u16			status;
13267737d5c6SDave Liu 	u16			len;
13277737d5c6SDave Liu 	u8			*data;
13287737d5c6SDave Liu 
13297737d5c6SDave Liu 	bd = uec->rxBd;
1330ddd02492SDave Liu 	status = bd->status;
13317737d5c6SDave Liu 
13327737d5c6SDave Liu 	while (!(status & RxBD_EMPTY)) {
13337737d5c6SDave Liu 		if (!(status & RxBD_ERROR)) {
13347737d5c6SDave Liu 			data = BD_DATA(bd);
13357737d5c6SDave Liu 			len = BD_LENGTH(bd);
13361fd92db8SJoe Hershberger 			net_process_received_packet(data, len);
13377737d5c6SDave Liu 		} else {
13387737d5c6SDave Liu 			printf("%s: Rx error\n", dev->name);
13397737d5c6SDave Liu 		}
13407737d5c6SDave Liu 		status &= BD_CLEAN;
13417737d5c6SDave Liu 		BD_LENGTH_SET(bd, 0);
13427737d5c6SDave Liu 		BD_STATUS_SET(bd, status | RxBD_EMPTY);
13437737d5c6SDave Liu 		BD_ADVANCE(bd, status, uec->p_rx_bd_ring);
1344ddd02492SDave Liu 		status = bd->status;
13457737d5c6SDave Liu 	}
13467737d5c6SDave Liu 	uec->rxBd = bd;
13477737d5c6SDave Liu 
13487737d5c6SDave Liu 	return 1;
13497737d5c6SDave Liu }
13507737d5c6SDave Liu 
uec_initialize(bd_t * bis,uec_info_t * uec_info)13518e55258fSHaiying Wang int uec_initialize(bd_t *bis, uec_info_t *uec_info)
13527737d5c6SDave Liu {
13537737d5c6SDave Liu 	struct eth_device	*dev;
13547737d5c6SDave Liu 	int			i;
13557737d5c6SDave Liu 	uec_private_t		*uec;
13567737d5c6SDave Liu 	int			err;
13577737d5c6SDave Liu 
13587737d5c6SDave Liu 	dev = (struct eth_device *)malloc(sizeof(struct eth_device));
13597737d5c6SDave Liu 	if (!dev)
13607737d5c6SDave Liu 		return 0;
13617737d5c6SDave Liu 	memset(dev, 0, sizeof(struct eth_device));
13627737d5c6SDave Liu 
13637737d5c6SDave Liu 	/* Allocate the UEC private struct */
13647737d5c6SDave Liu 	uec = (uec_private_t *)malloc(sizeof(uec_private_t));
13657737d5c6SDave Liu 	if (!uec) {
13667737d5c6SDave Liu 		return -ENOMEM;
13677737d5c6SDave Liu 	}
13687737d5c6SDave Liu 	memset(uec, 0, sizeof(uec_private_t));
13697737d5c6SDave Liu 
13708e55258fSHaiying Wang 	/* Adjust uec_info */
13718e55258fSHaiying Wang #if (MAX_QE_RISC == 4)
13728e55258fSHaiying Wang 	uec_info->risc_tx = QE_RISC_ALLOCATION_FOUR_RISCS;
13738e55258fSHaiying Wang 	uec_info->risc_rx = QE_RISC_ALLOCATION_FOUR_RISCS;
13747737d5c6SDave Liu #endif
13757737d5c6SDave Liu 
13768e55258fSHaiying Wang 	devlist[uec_info->uf_info.ucc_num] = dev;
1377d5d28fe4SDavid Saada 
13787737d5c6SDave Liu 	uec->uec_info = uec_info;
1379e8efef7cSHaiying Wang 	uec->dev = dev;
13807737d5c6SDave Liu 
138178b7a8efSKim Phillips 	sprintf(dev->name, "UEC%d", uec_info->uf_info.ucc_num);
13827737d5c6SDave Liu 	dev->iobase = 0;
13837737d5c6SDave Liu 	dev->priv = (void *)uec;
13847737d5c6SDave Liu 	dev->init = uec_init;
13857737d5c6SDave Liu 	dev->halt = uec_halt;
13867737d5c6SDave Liu 	dev->send = uec_send;
13877737d5c6SDave Liu 	dev->recv = uec_recv;
13887737d5c6SDave Liu 
13897737d5c6SDave Liu 	/* Clear the ethnet address */
13907737d5c6SDave Liu 	for (i = 0; i < 6; i++)
13917737d5c6SDave Liu 		dev->enetaddr[i] = 0;
13927737d5c6SDave Liu 
13937737d5c6SDave Liu 	eth_register(dev);
13947737d5c6SDave Liu 
13957737d5c6SDave Liu 	err = uec_startup(uec);
13967737d5c6SDave Liu 	if (err) {
13977737d5c6SDave Liu 		printf("%s: Cannot configure net device, aborting.",dev->name);
13987737d5c6SDave Liu 		return err;
13997737d5c6SDave Liu 	}
14007737d5c6SDave Liu 
140123c34af4SRichard Retanubun #if defined(CONFIG_MII) || defined(CONFIG_CMD_MII)
14025a49f174SJoe Hershberger 	int retval;
14035a49f174SJoe Hershberger 	struct mii_dev *mdiodev = mdio_alloc();
14045a49f174SJoe Hershberger 	if (!mdiodev)
14055a49f174SJoe Hershberger 		return -ENOMEM;
14065a49f174SJoe Hershberger 	strncpy(mdiodev->name, dev->name, MDIO_NAME_LEN);
14075a49f174SJoe Hershberger 	mdiodev->read = uec_miiphy_read;
14085a49f174SJoe Hershberger 	mdiodev->write = uec_miiphy_write;
14095a49f174SJoe Hershberger 
14105a49f174SJoe Hershberger 	retval = mdio_register(mdiodev);
14115a49f174SJoe Hershberger 	if (retval < 0)
14125a49f174SJoe Hershberger 		return retval;
1413d5d28fe4SDavid Saada #endif
1414d5d28fe4SDavid Saada 
14157737d5c6SDave Liu 	return 1;
14167737d5c6SDave Liu }
14178e55258fSHaiying Wang 
uec_eth_init(bd_t * bis,uec_info_t * uecs,int num)14188e55258fSHaiying Wang int uec_eth_init(bd_t *bis, uec_info_t *uecs, int num)
14198e55258fSHaiying Wang {
14208e55258fSHaiying Wang 	int i;
14218e55258fSHaiying Wang 
14228e55258fSHaiying Wang 	for (i = 0; i < num; i++)
14238e55258fSHaiying Wang 		uec_initialize(bis, &uecs[i]);
14248e55258fSHaiying Wang 
14258e55258fSHaiying Wang 	return 0;
14268e55258fSHaiying Wang }
14278e55258fSHaiying Wang 
uec_standard_init(bd_t * bis)14288e55258fSHaiying Wang int uec_standard_init(bd_t *bis)
14298e55258fSHaiying Wang {
14308e55258fSHaiying Wang 	return uec_eth_init(bis, uec_info, ARRAY_SIZE(uec_info));
14318e55258fSHaiying Wang }
1432