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