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