mirror of
https://github.com/AsahiLinux/u-boot
synced 2024-12-22 11:13:07 +00:00
81844aced3
Migrate mpc8xx_fec driver to DM_ETH. Signed-off-by: Christophe Leroy <christophe.leroy@csgroup.eu> Reviewed-by: Ramon Fried <rfried.dev@gmail.com>
863 lines
22 KiB
C
863 lines
22 KiB
C
// SPDX-License-Identifier: GPL-2.0+
|
|
/*
|
|
* (C) Copyright 2000
|
|
* Wolfgang Denk, DENX Software Engineering, wd@denx.de.
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <command.h>
|
|
#include <hang.h>
|
|
#include <malloc.h>
|
|
#include <net.h>
|
|
#include <netdev.h>
|
|
#include <asm/cpm_8xx.h>
|
|
#include <asm/global_data.h>
|
|
#include <asm/io.h>
|
|
#include <linux/delay.h>
|
|
|
|
#include <phy.h>
|
|
#include <linux/mii.h>
|
|
|
|
DECLARE_GLOBAL_DATA_PTR;
|
|
|
|
/* define WANT_MII when MII support is required */
|
|
#if defined(CONFIG_SYS_DISCOVER_PHY) || defined(CONFIG_FEC1_PHY) || defined(CONFIG_FEC2_PHY)
|
|
#define WANT_MII
|
|
#else
|
|
#undef WANT_MII
|
|
#endif
|
|
|
|
#if defined(WANT_MII)
|
|
#include <miiphy.h>
|
|
|
|
#if !(defined(CONFIG_MII) || defined(CONFIG_CMD_MII))
|
|
#error "CONFIG_MII has to be defined!"
|
|
#endif
|
|
|
|
#endif
|
|
|
|
#if defined(CONFIG_RMII) && !defined(WANT_MII)
|
|
#error RMII support is unusable without a working PHY.
|
|
#endif
|
|
|
|
#ifdef CONFIG_SYS_DISCOVER_PHY
|
|
static int mii_discover_phy(struct udevice *dev);
|
|
#endif
|
|
|
|
int fec8xx_miiphy_read(struct mii_dev *bus, int addr, int devad, int reg);
|
|
int fec8xx_miiphy_write(struct mii_dev *bus, int addr, int devad, int reg,
|
|
u16 value);
|
|
|
|
static struct ether_fcc_info_s
|
|
{
|
|
int ether_index;
|
|
int fecp_offset;
|
|
int phy_addr;
|
|
int actual_phy_addr;
|
|
int initialized;
|
|
}
|
|
ether_fcc_info[] = {
|
|
#if defined(CONFIG_ETHER_ON_FEC1)
|
|
{
|
|
0,
|
|
offsetof(immap_t, im_cpm.cp_fec1),
|
|
CONFIG_FEC1_PHY,
|
|
-1,
|
|
0,
|
|
|
|
},
|
|
#endif
|
|
#if defined(CONFIG_ETHER_ON_FEC2)
|
|
{
|
|
1,
|
|
offsetof(immap_t, im_cpm.cp_fec2),
|
|
CONFIG_FEC2_PHY,
|
|
-1,
|
|
0,
|
|
},
|
|
#endif
|
|
};
|
|
|
|
/* Ethernet Transmit and Receive Buffers */
|
|
#define DBUF_LENGTH 1520
|
|
|
|
#define TX_BUF_CNT 2
|
|
|
|
#define TOUT_LOOP 100
|
|
|
|
#define PKT_MAXBUF_SIZE 1518
|
|
#define PKT_MINBUF_SIZE 64
|
|
#define PKT_MAXBLR_SIZE 1520
|
|
|
|
#ifdef __GNUC__
|
|
static char txbuf[DBUF_LENGTH] __aligned(8);
|
|
#else
|
|
#error txbuf must be aligned.
|
|
#endif
|
|
|
|
static uint rxIdx; /* index of the current RX buffer */
|
|
static uint txIdx; /* index of the current TX buffer */
|
|
|
|
/*
|
|
* FEC Ethernet Tx and Rx buffer descriptors allocated at the
|
|
* immr->udata_bd address on Dual-Port RAM
|
|
* Provide for Double Buffering
|
|
*/
|
|
|
|
struct common_buf_desc {
|
|
cbd_t rxbd[PKTBUFSRX]; /* Rx BD */
|
|
cbd_t txbd[TX_BUF_CNT]; /* Tx BD */
|
|
};
|
|
|
|
static struct common_buf_desc __iomem *rtx;
|
|
|
|
#if defined(CONFIG_MII) || defined(CONFIG_CMD_MII)
|
|
static void __mii_init(void);
|
|
#endif
|
|
|
|
static int fec_probe(struct udevice *dev)
|
|
{
|
|
struct ether_fcc_info_s *efis = dev_get_priv(dev);
|
|
int index = dev_get_driver_data(dev);
|
|
int i;
|
|
|
|
for (i = 0; i < ARRAY_SIZE(ether_fcc_info); i++) {
|
|
if (ether_fcc_info[i].ether_index != index)
|
|
continue;
|
|
|
|
memcpy(efis, ðer_fcc_info[i], sizeof(*efis));
|
|
|
|
efis->actual_phy_addr = -1;
|
|
|
|
#if defined(CONFIG_MII) || defined(CONFIG_CMD_MII)
|
|
int retval;
|
|
struct mii_dev *mdiodev = mdio_alloc();
|
|
if (!mdiodev)
|
|
return -ENOMEM;
|
|
strlcpy(mdiodev->name, dev->name, MDIO_NAME_LEN);
|
|
mdiodev->read = fec8xx_miiphy_read;
|
|
mdiodev->write = fec8xx_miiphy_write;
|
|
|
|
retval = mdio_register(mdiodev);
|
|
if (retval < 0)
|
|
return retval;
|
|
#endif
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static int fec_send(struct udevice *dev, void *packet, int length)
|
|
{
|
|
int j, rc;
|
|
struct ether_fcc_info_s *efis = dev_get_priv(dev);
|
|
fec_t __iomem *fecp =
|
|
(fec_t __iomem *)(CONFIG_SYS_IMMR + efis->fecp_offset);
|
|
|
|
/* section 16.9.23.3
|
|
* Wait for ready
|
|
*/
|
|
j = 0;
|
|
while ((in_be16(&rtx->txbd[txIdx].cbd_sc) & BD_ENET_TX_READY) &&
|
|
(j < TOUT_LOOP)) {
|
|
udelay(1);
|
|
j++;
|
|
}
|
|
if (j >= TOUT_LOOP)
|
|
printf("TX not ready\n");
|
|
|
|
out_be32(&rtx->txbd[txIdx].cbd_bufaddr, (uint)packet);
|
|
out_be16(&rtx->txbd[txIdx].cbd_datlen, length);
|
|
setbits_be16(&rtx->txbd[txIdx].cbd_sc,
|
|
BD_ENET_TX_READY | BD_ENET_TX_LAST);
|
|
|
|
/* Activate transmit Buffer Descriptor polling */
|
|
/* Descriptor polling active */
|
|
out_be32(&fecp->fec_x_des_active, 0x01000000);
|
|
|
|
j = 0;
|
|
while ((in_be16(&rtx->txbd[txIdx].cbd_sc) & BD_ENET_TX_READY) &&
|
|
(j < TOUT_LOOP)) {
|
|
udelay(1);
|
|
j++;
|
|
}
|
|
if (j >= TOUT_LOOP)
|
|
printf("TX timeout\n");
|
|
|
|
/* return only status bits */;
|
|
rc = in_be16(&rtx->txbd[txIdx].cbd_sc) & BD_ENET_TX_STATS;
|
|
|
|
txIdx = (txIdx + 1) % TX_BUF_CNT;
|
|
|
|
return rc;
|
|
}
|
|
|
|
static int fec_recv(struct udevice *dev, int flags, uchar **packetp)
|
|
{
|
|
int length;
|
|
|
|
/* section 16.9.23.2 */
|
|
if (in_be16(&rtx->rxbd[rxIdx].cbd_sc) & BD_ENET_RX_EMPTY)
|
|
return -EAGAIN;
|
|
|
|
length = in_be16(&rtx->rxbd[rxIdx].cbd_datlen);
|
|
|
|
if (!(in_be16(&rtx->rxbd[rxIdx].cbd_sc) & 0x003f)) {
|
|
uchar *rx = net_rx_packets[rxIdx];
|
|
|
|
#if defined(CONFIG_CMD_CDP)
|
|
if ((rx[0] & 1) != 0 &&
|
|
memcmp((uchar *)rx, net_bcast_ethaddr, 6) != 0 &&
|
|
!is_cdp_packet((uchar *)rx))
|
|
return 0;
|
|
#endif
|
|
*packetp = rx;
|
|
|
|
return length - 4;
|
|
} else {
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
static int fec_free_pkt(struct udevice *dev, uchar *packet, int length)
|
|
{
|
|
struct ether_fcc_info_s *efis = dev_get_priv(dev);
|
|
fec_t __iomem *fecp =
|
|
(fec_t __iomem *)(CONFIG_SYS_IMMR + efis->fecp_offset);
|
|
|
|
/* Give the buffer back to the FEC. */
|
|
out_be16(&rtx->rxbd[rxIdx].cbd_datlen, 0);
|
|
|
|
/* wrap around buffer index when necessary */
|
|
if ((rxIdx + 1) >= PKTBUFSRX) {
|
|
out_be16(&rtx->rxbd[PKTBUFSRX - 1].cbd_sc,
|
|
BD_ENET_RX_WRAP | BD_ENET_RX_EMPTY);
|
|
rxIdx = 0;
|
|
} else {
|
|
out_be16(&rtx->rxbd[rxIdx].cbd_sc, BD_ENET_RX_EMPTY);
|
|
rxIdx++;
|
|
}
|
|
|
|
/* Try to fill Buffer Descriptors */
|
|
/* Descriptor polling active */
|
|
out_be32(&fecp->fec_r_des_active, 0x01000000);
|
|
|
|
return 0;
|
|
}
|
|
|
|
/**************************************************************
|
|
*
|
|
* FEC Ethernet Initialization Routine
|
|
*
|
|
*************************************************************/
|
|
|
|
#define FEC_ECNTRL_PINMUX 0x00000004
|
|
#define FEC_ECNTRL_ETHER_EN 0x00000002
|
|
#define FEC_ECNTRL_RESET 0x00000001
|
|
|
|
#define FEC_RCNTRL_BC_REJ 0x00000010
|
|
#define FEC_RCNTRL_PROM 0x00000008
|
|
#define FEC_RCNTRL_MII_MODE 0x00000004
|
|
#define FEC_RCNTRL_DRT 0x00000002
|
|
#define FEC_RCNTRL_LOOP 0x00000001
|
|
|
|
#define FEC_TCNTRL_FDEN 0x00000004
|
|
#define FEC_TCNTRL_HBC 0x00000002
|
|
#define FEC_TCNTRL_GTS 0x00000001
|
|
|
|
#define FEC_RESET_DELAY 50
|
|
|
|
#if defined(CONFIG_RMII)
|
|
|
|
static inline void fec_10Mbps(struct udevice *dev)
|
|
{
|
|
struct ether_fcc_info_s *efis = dev_get_priv(dev);
|
|
int fecidx = efis->ether_index;
|
|
uint mask = (fecidx == 0) ? 0x0000010 : 0x0000008;
|
|
immap_t __iomem *immr = (immap_t __iomem *)CONFIG_SYS_IMMR;
|
|
|
|
if ((unsigned int)fecidx >= 2)
|
|
hang();
|
|
|
|
setbits_be32(&immr->im_cpm.cp_cptr, mask);
|
|
}
|
|
|
|
static inline void fec_100Mbps(struct udevice *dev)
|
|
{
|
|
struct ether_fcc_info_s *efis = dev_get_priv(dev);
|
|
int fecidx = efis->ether_index;
|
|
uint mask = (fecidx == 0) ? 0x0000010 : 0x0000008;
|
|
immap_t __iomem *immr = (immap_t __iomem *)CONFIG_SYS_IMMR;
|
|
|
|
if ((unsigned int)fecidx >= 2)
|
|
hang();
|
|
|
|
clrbits_be32(&immr->im_cpm.cp_cptr, mask);
|
|
}
|
|
|
|
#endif
|
|
|
|
static inline void fec_full_duplex(struct udevice *dev)
|
|
{
|
|
struct ether_fcc_info_s *efis = dev_get_priv(dev);
|
|
fec_t __iomem *fecp =
|
|
(fec_t __iomem *)(CONFIG_SYS_IMMR + efis->fecp_offset);
|
|
|
|
clrbits_be32(&fecp->fec_r_cntrl, FEC_RCNTRL_DRT);
|
|
setbits_be32(&fecp->fec_x_cntrl, FEC_TCNTRL_FDEN); /* FD enable */
|
|
}
|
|
|
|
static inline void fec_half_duplex(struct udevice *dev)
|
|
{
|
|
struct ether_fcc_info_s *efis = dev_get_priv(dev);
|
|
fec_t __iomem *fecp =
|
|
(fec_t __iomem *)(CONFIG_SYS_IMMR + efis->fecp_offset);
|
|
|
|
setbits_be32(&fecp->fec_r_cntrl, FEC_RCNTRL_DRT);
|
|
clrbits_be32(&fecp->fec_x_cntrl, FEC_TCNTRL_FDEN); /* FD disable */
|
|
}
|
|
|
|
static void fec_pin_init(int fecidx)
|
|
{
|
|
struct bd_info *bd = gd->bd;
|
|
immap_t __iomem *immr = (immap_t __iomem *)CONFIG_SYS_IMMR;
|
|
|
|
/*
|
|
* Set MII speed to 2.5 MHz or slightly below.
|
|
*
|
|
* According to the MPC860T (Rev. D) Fast ethernet controller user
|
|
* manual (6.2.14),
|
|
* the MII management interface clock must be less than or equal
|
|
* to 2.5 MHz.
|
|
* This MDC frequency is equal to system clock / (2 * MII_SPEED).
|
|
* Then MII_SPEED = system_clock / 2 * 2,5 MHz.
|
|
*
|
|
* All MII configuration is done via FEC1 registers:
|
|
*/
|
|
out_be32(&immr->im_cpm.cp_fec1.fec_mii_speed,
|
|
((bd->bi_intfreq + 4999999) / 5000000) << 1);
|
|
|
|
#if defined(CONFIG_MPC885) && defined(WANT_MII)
|
|
/* use MDC for MII */
|
|
setbits_be16(&immr->im_ioport.iop_pdpar, 0x0080);
|
|
clrbits_be16(&immr->im_ioport.iop_pddir, 0x0080);
|
|
#endif
|
|
|
|
if (fecidx == 0) {
|
|
#if defined(CONFIG_ETHER_ON_FEC1)
|
|
|
|
#if defined(CONFIG_MPC885) /* MPC87x/88x have got 2 FECs and different pinout */
|
|
|
|
#if !defined(CONFIG_RMII)
|
|
|
|
setbits_be16(&immr->im_ioport.iop_papar, 0xf830);
|
|
setbits_be16(&immr->im_ioport.iop_padir, 0x0830);
|
|
clrbits_be16(&immr->im_ioport.iop_padir, 0xf000);
|
|
|
|
setbits_be32(&immr->im_cpm.cp_pbpar, 0x00001001);
|
|
clrbits_be32(&immr->im_cpm.cp_pbdir, 0x00001001);
|
|
|
|
setbits_be16(&immr->im_ioport.iop_pcpar, 0x000c);
|
|
clrbits_be16(&immr->im_ioport.iop_pcdir, 0x000c);
|
|
|
|
setbits_be32(&immr->im_cpm.cp_pepar, 0x00000003);
|
|
setbits_be32(&immr->im_cpm.cp_pedir, 0x00000003);
|
|
clrbits_be32(&immr->im_cpm.cp_peso, 0x00000003);
|
|
|
|
clrbits_be32(&immr->im_cpm.cp_cptr, 0x00000100);
|
|
|
|
#else
|
|
|
|
#if !defined(CONFIG_FEC1_PHY_NORXERR)
|
|
setbits_be16(&immr->im_ioport.iop_papar, 0x1000);
|
|
clrbits_be16(&immr->im_ioport.iop_padir, 0x1000);
|
|
#endif
|
|
setbits_be16(&immr->im_ioport.iop_papar, 0xe810);
|
|
setbits_be16(&immr->im_ioport.iop_padir, 0x0810);
|
|
clrbits_be16(&immr->im_ioport.iop_padir, 0xe000);
|
|
|
|
setbits_be32(&immr->im_cpm.cp_pbpar, 0x00000001);
|
|
clrbits_be32(&immr->im_cpm.cp_pbdir, 0x00000001);
|
|
|
|
setbits_be32(&immr->im_cpm.cp_cptr, 0x00000100);
|
|
clrbits_be32(&immr->im_cpm.cp_cptr, 0x00000050);
|
|
|
|
#endif /* !CONFIG_RMII */
|
|
|
|
#else
|
|
/*
|
|
* Configure all of port D for MII.
|
|
*/
|
|
out_be16(&immr->im_ioport.iop_pdpar, 0x1fff);
|
|
out_be16(&immr->im_ioport.iop_pddir, 0x1fff);
|
|
|
|
#if defined(CONFIG_TARGET_MCR3000)
|
|
out_be16(&immr->im_ioport.iop_papar, 0xBBFF);
|
|
out_be16(&immr->im_ioport.iop_padir, 0x04F0);
|
|
out_be16(&immr->im_ioport.iop_paodr, 0x0000);
|
|
|
|
out_be32(&immr->im_cpm.cp_pbpar, 0x000133FF);
|
|
out_be32(&immr->im_cpm.cp_pbdir, 0x0003BF0F);
|
|
out_be16(&immr->im_cpm.cp_pbodr, 0x0000);
|
|
|
|
out_be16(&immr->im_ioport.iop_pcpar, 0x0400);
|
|
out_be16(&immr->im_ioport.iop_pcdir, 0x0080);
|
|
out_be16(&immr->im_ioport.iop_pcso , 0x0D53);
|
|
out_be16(&immr->im_ioport.iop_pcint, 0x0000);
|
|
|
|
out_be16(&immr->im_ioport.iop_pdpar, 0x03FE);
|
|
out_be16(&immr->im_ioport.iop_pddir, 0x1C09);
|
|
|
|
setbits_be32(&immr->im_ioport.utmode, 0x80);
|
|
#endif
|
|
#endif
|
|
|
|
#endif /* CONFIG_ETHER_ON_FEC1 */
|
|
} else if (fecidx == 1) {
|
|
#if defined(CONFIG_ETHER_ON_FEC2)
|
|
|
|
#if defined(CONFIG_MPC885) /* MPC87x/88x have got 2 FECs and different pinout */
|
|
|
|
#if !defined(CONFIG_RMII)
|
|
setbits_be32(&immr->im_cpm.cp_pepar, 0x0003fffc);
|
|
setbits_be32(&immr->im_cpm.cp_pedir, 0x0003fffc);
|
|
clrbits_be32(&immr->im_cpm.cp_peso, 0x000087fc);
|
|
setbits_be32(&immr->im_cpm.cp_peso, 0x00037800);
|
|
|
|
clrbits_be32(&immr->im_cpm.cp_cptr, 0x00000080);
|
|
#else
|
|
|
|
#if !defined(CONFIG_FEC2_PHY_NORXERR)
|
|
setbits_be32(&immr->im_cpm.cp_pepar, 0x00000010);
|
|
setbits_be32(&immr->im_cpm.cp_pedir, 0x00000010);
|
|
clrbits_be32(&immr->im_cpm.cp_peso, 0x00000010);
|
|
#endif
|
|
setbits_be32(&immr->im_cpm.cp_pepar, 0x00039620);
|
|
setbits_be32(&immr->im_cpm.cp_pedir, 0x00039620);
|
|
setbits_be32(&immr->im_cpm.cp_peso, 0x00031000);
|
|
clrbits_be32(&immr->im_cpm.cp_peso, 0x00008620);
|
|
|
|
setbits_be32(&immr->im_cpm.cp_cptr, 0x00000080);
|
|
clrbits_be32(&immr->im_cpm.cp_cptr, 0x00000028);
|
|
#endif /* CONFIG_RMII */
|
|
|
|
#endif /* CONFIG_MPC885 */
|
|
|
|
#endif /* CONFIG_ETHER_ON_FEC2 */
|
|
}
|
|
}
|
|
|
|
static int fec_reset(fec_t __iomem *fecp)
|
|
{
|
|
int i;
|
|
|
|
/* Whack a reset.
|
|
* A delay is required between a reset of the FEC block and
|
|
* initialization of other FEC registers because the reset takes
|
|
* some time to complete. If you don't delay, subsequent writes
|
|
* to FEC registers might get killed by the reset routine which is
|
|
* still in progress.
|
|
*/
|
|
|
|
out_be32(&fecp->fec_ecntrl, FEC_ECNTRL_PINMUX | FEC_ECNTRL_RESET);
|
|
for (i = 0; (in_be32(&fecp->fec_ecntrl) & FEC_ECNTRL_RESET) &&
|
|
(i < FEC_RESET_DELAY); ++i)
|
|
udelay(1);
|
|
|
|
if (i == FEC_RESET_DELAY)
|
|
return -1;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int fec_start(struct udevice *dev)
|
|
{
|
|
struct eth_pdata *plat = dev_get_plat(dev);
|
|
struct ether_fcc_info_s *efis = dev_get_priv(dev);
|
|
immap_t __iomem *immr = (immap_t __iomem *)CONFIG_SYS_IMMR;
|
|
fec_t __iomem *fecp =
|
|
(fec_t __iomem *)(CONFIG_SYS_IMMR + efis->fecp_offset);
|
|
int i;
|
|
|
|
#if defined(CONFIG_MII) || defined(CONFIG_CMD_MII)
|
|
/* the MII interface is connected to FEC1
|
|
* so for the miiphy_xxx function to work we must
|
|
* call mii_init since fec_halt messes the thing up
|
|
*/
|
|
if (efis->ether_index != 0)
|
|
__mii_init();
|
|
#endif
|
|
|
|
if (fec_reset(fecp) < 0)
|
|
printf("FEC_RESET_DELAY timeout\n");
|
|
|
|
/* We use strictly polling mode only
|
|
*/
|
|
out_be32(&fecp->fec_imask, 0);
|
|
|
|
/* Clear any pending interrupt
|
|
*/
|
|
out_be32(&fecp->fec_ievent, 0xffc0);
|
|
|
|
/* No need to set the IVEC register */
|
|
|
|
/* Set station address
|
|
*/
|
|
#define ea plat->enetaddr
|
|
out_be32(&fecp->fec_addr_low, (ea[0] << 24) | (ea[1] << 16) |
|
|
(ea[2] << 8) | ea[3]);
|
|
out_be16(&fecp->fec_addr_high, (ea[4] << 8) | ea[5]);
|
|
#undef ea
|
|
|
|
#if defined(CONFIG_CMD_CDP)
|
|
/*
|
|
* Turn on multicast address hash table
|
|
*/
|
|
out_be32(&fecp->fec_hash_table_high, 0xffffffff);
|
|
out_be32(&fecp->fec_hash_table_low, 0xffffffff);
|
|
#else
|
|
/* Clear multicast address hash table
|
|
*/
|
|
out_be32(&fecp->fec_hash_table_high, 0);
|
|
out_be32(&fecp->fec_hash_table_low, 0);
|
|
#endif
|
|
|
|
/* Set maximum receive buffer size.
|
|
*/
|
|
out_be32(&fecp->fec_r_buff_size, PKT_MAXBLR_SIZE);
|
|
|
|
/* Set maximum frame length
|
|
*/
|
|
out_be32(&fecp->fec_r_hash, PKT_MAXBUF_SIZE);
|
|
|
|
/*
|
|
* Setup Buffers and Buffer Descriptors
|
|
*/
|
|
rxIdx = 0;
|
|
txIdx = 0;
|
|
|
|
if (!rtx)
|
|
rtx = (struct common_buf_desc __iomem *)
|
|
(immr->im_cpm.cp_dpmem + CPM_FEC_BASE);
|
|
/*
|
|
* Setup Receiver Buffer Descriptors (13.14.24.18)
|
|
* Settings:
|
|
* Empty, Wrap
|
|
*/
|
|
for (i = 0; i < PKTBUFSRX; i++) {
|
|
out_be16(&rtx->rxbd[i].cbd_sc, BD_ENET_RX_EMPTY);
|
|
out_be16(&rtx->rxbd[i].cbd_datlen, 0); /* Reset */
|
|
out_be32(&rtx->rxbd[i].cbd_bufaddr, (uint)net_rx_packets[i]);
|
|
}
|
|
setbits_be16(&rtx->rxbd[PKTBUFSRX - 1].cbd_sc, BD_ENET_RX_WRAP);
|
|
|
|
/*
|
|
* Setup Ethernet Transmitter Buffer Descriptors (13.14.24.19)
|
|
* Settings:
|
|
* Last, Tx CRC
|
|
*/
|
|
for (i = 0; i < TX_BUF_CNT; i++) {
|
|
out_be16(&rtx->txbd[i].cbd_sc, BD_ENET_TX_LAST | BD_ENET_TX_TC);
|
|
out_be16(&rtx->txbd[i].cbd_datlen, 0); /* Reset */
|
|
out_be32(&rtx->txbd[i].cbd_bufaddr, (uint)txbuf);
|
|
}
|
|
setbits_be16(&rtx->txbd[TX_BUF_CNT - 1].cbd_sc, BD_ENET_TX_WRAP);
|
|
|
|
/* Set receive and transmit descriptor base
|
|
*/
|
|
out_be32(&fecp->fec_r_des_start, (__force unsigned int)rtx->rxbd);
|
|
out_be32(&fecp->fec_x_des_start, (__force unsigned int)rtx->txbd);
|
|
|
|
/* Enable MII mode
|
|
*/
|
|
/* Half duplex mode */
|
|
out_be32(&fecp->fec_r_cntrl, FEC_RCNTRL_MII_MODE | FEC_RCNTRL_DRT);
|
|
out_be32(&fecp->fec_x_cntrl, 0);
|
|
|
|
/* Enable big endian and don't care about SDMA FC.
|
|
*/
|
|
out_be32(&fecp->fec_fun_code, 0x78000000);
|
|
|
|
/*
|
|
* Setup the pin configuration of the FEC
|
|
*/
|
|
fec_pin_init(efis->ether_index);
|
|
|
|
rxIdx = 0;
|
|
txIdx = 0;
|
|
|
|
/*
|
|
* Now enable the transmit and receive processing
|
|
*/
|
|
out_be32(&fecp->fec_ecntrl, FEC_ECNTRL_PINMUX | FEC_ECNTRL_ETHER_EN);
|
|
|
|
if (efis->phy_addr == -1) {
|
|
#ifdef CONFIG_SYS_DISCOVER_PHY
|
|
/*
|
|
* wait for the PHY to wake up after reset
|
|
*/
|
|
efis->actual_phy_addr = mii_discover_phy(dev);
|
|
|
|
if (efis->actual_phy_addr == -1) {
|
|
printf("Unable to discover phy!\n");
|
|
return -1;
|
|
}
|
|
#else
|
|
efis->actual_phy_addr = -1;
|
|
#endif
|
|
} else {
|
|
efis->actual_phy_addr = efis->phy_addr;
|
|
}
|
|
|
|
#if defined(CONFIG_MII) && defined(CONFIG_RMII)
|
|
/*
|
|
* adapt the RMII speed to the speed of the phy
|
|
*/
|
|
if (miiphy_speed(dev->name, efis->actual_phy_addr) == _100BASET)
|
|
fec_100Mbps(dev);
|
|
else
|
|
fec_10Mbps(dev);
|
|
#endif
|
|
|
|
#if defined(CONFIG_MII)
|
|
/*
|
|
* adapt to the half/full speed settings
|
|
*/
|
|
if (miiphy_duplex(dev->name, efis->actual_phy_addr) == FULL)
|
|
fec_full_duplex(dev);
|
|
else
|
|
fec_half_duplex(dev);
|
|
#endif
|
|
|
|
/* And last, try to fill Rx Buffer Descriptors */
|
|
/* Descriptor polling active */
|
|
out_be32(&fecp->fec_r_des_active, 0x01000000);
|
|
|
|
efis->initialized = 1;
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
static void fec_stop(struct udevice *dev)
|
|
{
|
|
struct ether_fcc_info_s *efis = dev_get_priv(dev);
|
|
fec_t __iomem *fecp =
|
|
(fec_t __iomem *)(CONFIG_SYS_IMMR + efis->fecp_offset);
|
|
int i;
|
|
|
|
/* avoid halt if initialized; mii gets stuck otherwise */
|
|
if (!efis->initialized)
|
|
return;
|
|
|
|
/* Whack a reset.
|
|
* A delay is required between a reset of the FEC block and
|
|
* initialization of other FEC registers because the reset takes
|
|
* some time to complete. If you don't delay, subsequent writes
|
|
* to FEC registers might get killed by the reset routine which is
|
|
* still in progress.
|
|
*/
|
|
|
|
out_be32(&fecp->fec_ecntrl, FEC_ECNTRL_PINMUX | FEC_ECNTRL_RESET);
|
|
for (i = 0; (in_be32(&fecp->fec_ecntrl) & FEC_ECNTRL_RESET) &&
|
|
(i < FEC_RESET_DELAY); ++i)
|
|
udelay(1);
|
|
|
|
if (i == FEC_RESET_DELAY) {
|
|
printf("FEC_RESET_DELAY timeout\n");
|
|
return;
|
|
}
|
|
|
|
efis->initialized = 0;
|
|
}
|
|
|
|
#if defined(CONFIG_SYS_DISCOVER_PHY) || defined(CONFIG_MII) || defined(CONFIG_CMD_MII)
|
|
|
|
/* Make MII read/write commands for the FEC.
|
|
*/
|
|
|
|
#define mk_mii_read(ADDR, REG) (0x60020000 | ((ADDR << 23) | \
|
|
(REG & 0x1f) << 18))
|
|
|
|
#define mk_mii_write(ADDR, REG, VAL) (0x50020000 | ((ADDR << 23) | \
|
|
(REG & 0x1f) << 18) | \
|
|
(VAL & 0xffff))
|
|
|
|
/* Interrupt events/masks.
|
|
*/
|
|
#define FEC_ENET_HBERR ((uint)0x80000000) /* Heartbeat error */
|
|
#define FEC_ENET_BABR ((uint)0x40000000) /* Babbling receiver */
|
|
#define FEC_ENET_BABT ((uint)0x20000000) /* Babbling transmitter */
|
|
#define FEC_ENET_GRA ((uint)0x10000000) /* Graceful stop complete */
|
|
#define FEC_ENET_TXF ((uint)0x08000000) /* Full frame transmitted */
|
|
#define FEC_ENET_TXB ((uint)0x04000000) /* A buffer was transmitted */
|
|
#define FEC_ENET_RXF ((uint)0x02000000) /* Full frame received */
|
|
#define FEC_ENET_RXB ((uint)0x01000000) /* A buffer was received */
|
|
#define FEC_ENET_MII ((uint)0x00800000) /* MII interrupt */
|
|
#define FEC_ENET_EBERR ((uint)0x00400000) /* SDMA bus error */
|
|
|
|
/* send command to phy using mii, wait for result */
|
|
static uint
|
|
mii_send(uint mii_cmd)
|
|
{
|
|
uint mii_reply;
|
|
fec_t __iomem *ep;
|
|
int cnt;
|
|
immap_t __iomem *immr = (immap_t __iomem *)CONFIG_SYS_IMMR;
|
|
|
|
ep = &immr->im_cpm.cp_fec;
|
|
|
|
out_be32(&ep->fec_mii_data, mii_cmd); /* command to phy */
|
|
|
|
/* wait for mii complete */
|
|
cnt = 0;
|
|
while (!(in_be32(&ep->fec_ievent) & FEC_ENET_MII)) {
|
|
if (++cnt > 1000) {
|
|
printf("mii_send STUCK!\n");
|
|
break;
|
|
}
|
|
}
|
|
mii_reply = in_be32(&ep->fec_mii_data); /* result from phy */
|
|
out_be32(&ep->fec_ievent, FEC_ENET_MII); /* clear MII complete */
|
|
return mii_reply & 0xffff; /* data read from phy */
|
|
}
|
|
#endif
|
|
|
|
#if defined(CONFIG_SYS_DISCOVER_PHY)
|
|
static int mii_discover_phy(struct udevice *dev)
|
|
{
|
|
#define MAX_PHY_PASSES 11
|
|
uint phyno;
|
|
int pass;
|
|
uint phytype;
|
|
int phyaddr;
|
|
|
|
phyaddr = -1; /* didn't find a PHY yet */
|
|
for (pass = 1; pass <= MAX_PHY_PASSES && phyaddr < 0; ++pass) {
|
|
if (pass > 1) {
|
|
/* PHY may need more time to recover from reset.
|
|
* The LXT970 needs 50ms typical, no maximum is
|
|
* specified, so wait 10ms before try again.
|
|
* With 11 passes this gives it 100ms to wake up.
|
|
*/
|
|
udelay(10000); /* wait 10ms */
|
|
}
|
|
for (phyno = 0; phyno < 32 && phyaddr < 0; ++phyno) {
|
|
phytype = mii_send(mk_mii_read(phyno, MII_PHYSID2));
|
|
if (phytype != 0xffff) {
|
|
phyaddr = phyno;
|
|
phytype |= mii_send(mk_mii_read(phyno,
|
|
MII_PHYSID1)) << 16;
|
|
}
|
|
}
|
|
}
|
|
if (phyaddr < 0)
|
|
printf("No PHY device found.\n");
|
|
|
|
return phyaddr;
|
|
}
|
|
#endif /* CONFIG_SYS_DISCOVER_PHY */
|
|
|
|
#if (defined(CONFIG_MII) || defined(CONFIG_CMD_MII)) && !defined(CONFIG_BITBANGMII)
|
|
|
|
/****************************************************************************
|
|
* mii_init -- Initialize the MII via FEC 1 for MII command without ethernet
|
|
* This function is a subset of eth_init
|
|
****************************************************************************
|
|
*/
|
|
static void __mii_init(void)
|
|
{
|
|
immap_t __iomem *immr = (immap_t __iomem *)CONFIG_SYS_IMMR;
|
|
fec_t __iomem *fecp = &immr->im_cpm.cp_fec;
|
|
|
|
if (fec_reset(fecp) < 0)
|
|
printf("FEC_RESET_DELAY timeout\n");
|
|
|
|
/* We use strictly polling mode only
|
|
*/
|
|
out_be32(&fecp->fec_imask, 0);
|
|
|
|
/* Clear any pending interrupt
|
|
*/
|
|
out_be32(&fecp->fec_ievent, 0xffc0);
|
|
|
|
/* Now enable the transmit and receive processing
|
|
*/
|
|
out_be32(&fecp->fec_ecntrl, FEC_ECNTRL_PINMUX | FEC_ECNTRL_ETHER_EN);
|
|
}
|
|
|
|
void mii_init(void)
|
|
{
|
|
int i;
|
|
|
|
__mii_init();
|
|
|
|
/* Setup the pin configuration of the FEC(s)
|
|
*/
|
|
for (i = 0; i < ARRAY_SIZE(ether_fcc_info); i++)
|
|
fec_pin_init(ether_fcc_info[i].ether_index);
|
|
}
|
|
|
|
/*****************************************************************************
|
|
* Read and write a MII PHY register, routines used by MII Utilities
|
|
*
|
|
* FIXME: These routines are expected to return 0 on success, but mii_send
|
|
* does _not_ return an error code. Maybe 0xFFFF means error, i.e.
|
|
* no PHY connected...
|
|
* For now always return 0.
|
|
* FIXME: These routines only work after calling eth_init() at least once!
|
|
* Otherwise they hang in mii_send() !!! Sorry!
|
|
*****************************************************************************/
|
|
|
|
int fec8xx_miiphy_read(struct mii_dev *bus, int addr, int devad, int reg)
|
|
{
|
|
unsigned short value = 0;
|
|
short rdreg; /* register working value */
|
|
|
|
rdreg = mii_send(mk_mii_read(addr, reg));
|
|
|
|
value = rdreg;
|
|
return value;
|
|
}
|
|
|
|
int fec8xx_miiphy_write(struct mii_dev *bus, int addr, int devad, int reg,
|
|
u16 value)
|
|
{
|
|
(void)mii_send(mk_mii_write(addr, reg, value));
|
|
|
|
return 0;
|
|
}
|
|
#endif
|
|
|
|
static const struct eth_ops fec_ops = {
|
|
.start = fec_start,
|
|
.send = fec_send,
|
|
.recv = fec_recv,
|
|
.stop = fec_stop,
|
|
.free_pkt = fec_free_pkt,
|
|
};
|
|
|
|
static const struct udevice_id fec_ids[] = {
|
|
#ifdef CONFIG_ETHER_ON_FEC1
|
|
{
|
|
.compatible = "fsl,pq1-fec1",
|
|
.data = 0,
|
|
},
|
|
#endif
|
|
#ifdef CONFIG_ETHER_ON_FEC2
|
|
{
|
|
.compatible = "fsl,pq1-fec2",
|
|
.data = 1,
|
|
},
|
|
#endif
|
|
{ }
|
|
};
|
|
|
|
U_BOOT_DRIVER(fec) = {
|
|
.name = "fec",
|
|
.id = UCLASS_ETH,
|
|
.of_match = fec_ids,
|
|
.probe = fec_probe,
|
|
.ops = &fec_ops,
|
|
.priv_auto = sizeof(struct ether_fcc_info_s),
|
|
.plat_auto = sizeof(struct eth_pdata),
|
|
};
|