mirror of
https://github.com/brain-hackers/u-boot-brain
synced 2024-08-17 15:38:51 +09:00
![Mike Frysinger](/assets/img/avatar_default.png)
This is long over due. All but two net drivers have been converted, but those have now been dropped. The only thing left to do is actually delete all references to NET_MULTI and code that is compiled when that is not defined. So here we scrub the core code. Signed-off-by: Mike Frysinger <vapier@gentoo.org>
531 lines
11 KiB
C
531 lines
11 KiB
C
/*
|
|
* (C) Copyright 2001-2010
|
|
* Wolfgang Denk, DENX Software Engineering, wd@denx.de.
|
|
*
|
|
* See file CREDITS for list of people who contributed to this
|
|
* project.
|
|
*
|
|
* This program is free software; you can redistribute it and/or
|
|
* modify it under the terms of the GNU General Public License as
|
|
* published by the Free Software Foundation; either version 2 of
|
|
* the License, or (at your option) any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; if not, write to the Free Software
|
|
* Foundation, Inc., 59 Temple Place, Suite 330, Boston,
|
|
* MA 02111-1307 USA
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <command.h>
|
|
#include <net.h>
|
|
#include <miiphy.h>
|
|
#include <phy.h>
|
|
|
|
void eth_parse_enetaddr(const char *addr, uchar *enetaddr)
|
|
{
|
|
char *end;
|
|
int i;
|
|
|
|
for (i = 0; i < 6; ++i) {
|
|
enetaddr[i] = addr ? simple_strtoul(addr, &end, 16) : 0;
|
|
if (addr)
|
|
addr = (*end) ? end + 1 : end;
|
|
}
|
|
}
|
|
|
|
int eth_getenv_enetaddr(char *name, uchar *enetaddr)
|
|
{
|
|
eth_parse_enetaddr(getenv(name), enetaddr);
|
|
return is_valid_ether_addr(enetaddr);
|
|
}
|
|
|
|
int eth_setenv_enetaddr(char *name, const uchar *enetaddr)
|
|
{
|
|
char buf[20];
|
|
|
|
sprintf(buf, "%pM", enetaddr);
|
|
|
|
return setenv(name, buf);
|
|
}
|
|
|
|
int eth_getenv_enetaddr_by_index(const char *base_name, int index,
|
|
uchar *enetaddr)
|
|
{
|
|
char enetvar[32];
|
|
sprintf(enetvar, index ? "%s%daddr" : "%saddr", base_name, index);
|
|
return eth_getenv_enetaddr(enetvar, enetaddr);
|
|
}
|
|
|
|
static int eth_mac_skip(int index)
|
|
{
|
|
char enetvar[15];
|
|
char *skip_state;
|
|
sprintf(enetvar, index ? "eth%dmacskip" : "ethmacskip", index);
|
|
return ((skip_state = getenv(enetvar)) != NULL);
|
|
}
|
|
|
|
/*
|
|
* CPU and board-specific Ethernet initializations. Aliased function
|
|
* signals caller to move on
|
|
*/
|
|
static int __def_eth_init(bd_t *bis)
|
|
{
|
|
return -1;
|
|
}
|
|
int cpu_eth_init(bd_t *bis) __attribute__((weak, alias("__def_eth_init")));
|
|
int board_eth_init(bd_t *bis) __attribute__((weak, alias("__def_eth_init")));
|
|
|
|
extern int mv6436x_eth_initialize(bd_t *);
|
|
extern int mv6446x_eth_initialize(bd_t *);
|
|
|
|
#ifdef CONFIG_API
|
|
extern void (*push_packet)(volatile void *, int);
|
|
|
|
static struct {
|
|
uchar data[PKTSIZE];
|
|
int length;
|
|
} eth_rcv_bufs[PKTBUFSRX];
|
|
|
|
static unsigned int eth_rcv_current = 0, eth_rcv_last = 0;
|
|
#endif
|
|
|
|
static struct eth_device *eth_devices, *eth_current;
|
|
|
|
struct eth_device *eth_get_dev(void)
|
|
{
|
|
return eth_current;
|
|
}
|
|
|
|
struct eth_device *eth_get_dev_by_name(const char *devname)
|
|
{
|
|
struct eth_device *dev, *target_dev;
|
|
|
|
BUG_ON(devname == NULL);
|
|
|
|
if (!eth_devices)
|
|
return NULL;
|
|
|
|
dev = eth_devices;
|
|
target_dev = NULL;
|
|
do {
|
|
if (strcmp(devname, dev->name) == 0) {
|
|
target_dev = dev;
|
|
break;
|
|
}
|
|
dev = dev->next;
|
|
} while (dev != eth_devices);
|
|
|
|
return target_dev;
|
|
}
|
|
|
|
struct eth_device *eth_get_dev_by_index(int index)
|
|
{
|
|
struct eth_device *dev, *target_dev;
|
|
int idx = 0;
|
|
|
|
if (!eth_devices)
|
|
return NULL;
|
|
|
|
dev = eth_devices;
|
|
target_dev = NULL;
|
|
do {
|
|
if (idx == index) {
|
|
target_dev = dev;
|
|
break;
|
|
}
|
|
dev = dev->next;
|
|
idx++;
|
|
} while (dev != eth_devices);
|
|
|
|
return target_dev;
|
|
}
|
|
|
|
int eth_get_dev_index (void)
|
|
{
|
|
struct eth_device *dev;
|
|
int num = 0;
|
|
|
|
if (!eth_devices) {
|
|
return (-1);
|
|
}
|
|
|
|
for (dev = eth_devices; dev; dev = dev->next) {
|
|
if (dev == eth_current)
|
|
break;
|
|
++num;
|
|
}
|
|
|
|
if (dev) {
|
|
return (num);
|
|
}
|
|
|
|
return (0);
|
|
}
|
|
|
|
static void eth_current_changed(void)
|
|
{
|
|
char *act = getenv("ethact");
|
|
/* update current ethernet name */
|
|
if (eth_current) {
|
|
if (act == NULL || strcmp(act, eth_current->name) != 0)
|
|
setenv("ethact", eth_current->name);
|
|
}
|
|
/*
|
|
* remove the variable completely if there is no active
|
|
* interface
|
|
*/
|
|
else if (act != NULL)
|
|
setenv("ethact", NULL);
|
|
}
|
|
|
|
int eth_write_hwaddr(struct eth_device *dev, const char *base_name,
|
|
int eth_number)
|
|
{
|
|
unsigned char env_enetaddr[6];
|
|
int ret = 0;
|
|
|
|
if (!eth_getenv_enetaddr_by_index(base_name, eth_number, env_enetaddr))
|
|
return -1;
|
|
|
|
if (memcmp(env_enetaddr, "\0\0\0\0\0\0", 6)) {
|
|
if (memcmp(dev->enetaddr, "\0\0\0\0\0\0", 6) &&
|
|
memcmp(dev->enetaddr, env_enetaddr, 6)) {
|
|
printf("\nWarning: %s MAC addresses don't match:\n",
|
|
dev->name);
|
|
printf("Address in SROM is %pM\n",
|
|
dev->enetaddr);
|
|
printf("Address in environment is %pM\n",
|
|
env_enetaddr);
|
|
}
|
|
|
|
memcpy(dev->enetaddr, env_enetaddr, 6);
|
|
}
|
|
|
|
if (dev->write_hwaddr &&
|
|
!eth_mac_skip(eth_number) &&
|
|
is_valid_ether_addr(dev->enetaddr)) {
|
|
ret = dev->write_hwaddr(dev);
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
int eth_register(struct eth_device *dev)
|
|
{
|
|
struct eth_device *d;
|
|
|
|
assert(strlen(dev->name) < NAMESIZE);
|
|
|
|
if (!eth_devices) {
|
|
eth_current = eth_devices = dev;
|
|
eth_current_changed();
|
|
} else {
|
|
for (d=eth_devices; d->next!=eth_devices; d=d->next)
|
|
;
|
|
d->next = dev;
|
|
}
|
|
|
|
dev->state = ETH_STATE_INIT;
|
|
dev->next = eth_devices;
|
|
|
|
return 0;
|
|
}
|
|
|
|
int eth_initialize(bd_t *bis)
|
|
{
|
|
int eth_number = 0;
|
|
|
|
eth_devices = NULL;
|
|
eth_current = NULL;
|
|
|
|
show_boot_progress (64);
|
|
#if defined(CONFIG_MII) || defined(CONFIG_CMD_MII)
|
|
miiphy_init();
|
|
#endif
|
|
|
|
#ifdef CONFIG_PHYLIB
|
|
phy_init();
|
|
#endif
|
|
|
|
/*
|
|
* If board-specific initialization exists, call it.
|
|
* If not, call a CPU-specific one
|
|
*/
|
|
if (board_eth_init != __def_eth_init) {
|
|
if (board_eth_init(bis) < 0)
|
|
printf("Board Net Initialization Failed\n");
|
|
} else if (cpu_eth_init != __def_eth_init) {
|
|
if (cpu_eth_init(bis) < 0)
|
|
printf("CPU Net Initialization Failed\n");
|
|
} else
|
|
printf("Net Initialization Skipped\n");
|
|
|
|
#if defined(CONFIG_DB64360) || defined(CONFIG_CPCI750)
|
|
mv6436x_eth_initialize(bis);
|
|
#endif
|
|
#if defined(CONFIG_DB64460) || defined(CONFIG_P3Mx)
|
|
mv6446x_eth_initialize(bis);
|
|
#endif
|
|
if (!eth_devices) {
|
|
puts ("No ethernet found.\n");
|
|
show_boot_progress (-64);
|
|
} else {
|
|
struct eth_device *dev = eth_devices;
|
|
char *ethprime = getenv ("ethprime");
|
|
|
|
show_boot_progress (65);
|
|
do {
|
|
if (eth_number)
|
|
puts (", ");
|
|
|
|
printf("%s", dev->name);
|
|
|
|
if (ethprime && strcmp (dev->name, ethprime) == 0) {
|
|
eth_current = dev;
|
|
puts (" [PRIME]");
|
|
}
|
|
|
|
if (strchr(dev->name, ' '))
|
|
puts("\nWarning: eth device name has a space!\n");
|
|
|
|
if (eth_write_hwaddr(dev, "eth", eth_number))
|
|
puts("\nWarning: failed to set MAC address\n");
|
|
|
|
eth_number++;
|
|
dev = dev->next;
|
|
} while(dev != eth_devices);
|
|
|
|
eth_current_changed();
|
|
putc ('\n');
|
|
}
|
|
|
|
return eth_number;
|
|
}
|
|
|
|
#ifdef CONFIG_MCAST_TFTP
|
|
/* Multicast.
|
|
* mcast_addr: multicast ipaddr from which multicast Mac is made
|
|
* join: 1=join, 0=leave.
|
|
*/
|
|
int eth_mcast_join( IPaddr_t mcast_ip, u8 join)
|
|
{
|
|
u8 mcast_mac[6];
|
|
if (!eth_current || !eth_current->mcast)
|
|
return -1;
|
|
mcast_mac[5] = htonl(mcast_ip) & 0xff;
|
|
mcast_mac[4] = (htonl(mcast_ip)>>8) & 0xff;
|
|
mcast_mac[3] = (htonl(mcast_ip)>>16) & 0x7f;
|
|
mcast_mac[2] = 0x5e;
|
|
mcast_mac[1] = 0x0;
|
|
mcast_mac[0] = 0x1;
|
|
return eth_current->mcast(eth_current, mcast_mac, join);
|
|
}
|
|
|
|
/* the 'way' for ethernet-CRC-32. Spliced in from Linux lib/crc32.c
|
|
* and this is the ethernet-crc method needed for TSEC -- and perhaps
|
|
* some other adapter -- hash tables
|
|
*/
|
|
#define CRCPOLY_LE 0xedb88320
|
|
u32 ether_crc (size_t len, unsigned char const *p)
|
|
{
|
|
int i;
|
|
u32 crc;
|
|
crc = ~0;
|
|
while (len--) {
|
|
crc ^= *p++;
|
|
for (i = 0; i < 8; i++)
|
|
crc = (crc >> 1) ^ ((crc & 1) ? CRCPOLY_LE : 0);
|
|
}
|
|
/* an reverse the bits, cuz of way they arrive -- last-first */
|
|
crc = (crc >> 16) | (crc << 16);
|
|
crc = (crc >> 8 & 0x00ff00ff) | (crc << 8 & 0xff00ff00);
|
|
crc = (crc >> 4 & 0x0f0f0f0f) | (crc << 4 & 0xf0f0f0f0);
|
|
crc = (crc >> 2 & 0x33333333) | (crc << 2 & 0xcccccccc);
|
|
crc = (crc >> 1 & 0x55555555) | (crc << 1 & 0xaaaaaaaa);
|
|
return crc;
|
|
}
|
|
|
|
#endif
|
|
|
|
|
|
int eth_init(bd_t *bis)
|
|
{
|
|
int eth_number;
|
|
struct eth_device *old_current, *dev;
|
|
|
|
if (!eth_current) {
|
|
puts ("No ethernet found.\n");
|
|
return -1;
|
|
}
|
|
|
|
/* Sync environment with network devices */
|
|
eth_number = 0;
|
|
dev = eth_devices;
|
|
do {
|
|
uchar env_enetaddr[6];
|
|
|
|
if (eth_getenv_enetaddr_by_index("eth", eth_number,
|
|
env_enetaddr))
|
|
memcpy(dev->enetaddr, env_enetaddr, 6);
|
|
|
|
++eth_number;
|
|
dev = dev->next;
|
|
} while (dev != eth_devices);
|
|
|
|
old_current = eth_current;
|
|
do {
|
|
debug("Trying %s\n", eth_current->name);
|
|
|
|
if (eth_current->init(eth_current,bis) >= 0) {
|
|
eth_current->state = ETH_STATE_ACTIVE;
|
|
|
|
return 0;
|
|
}
|
|
debug("FAIL\n");
|
|
|
|
eth_try_another(0);
|
|
} while (old_current != eth_current);
|
|
|
|
return -1;
|
|
}
|
|
|
|
void eth_halt(void)
|
|
{
|
|
if (!eth_current)
|
|
return;
|
|
|
|
eth_current->halt(eth_current);
|
|
|
|
eth_current->state = ETH_STATE_PASSIVE;
|
|
}
|
|
|
|
int eth_send(volatile void *packet, int length)
|
|
{
|
|
if (!eth_current)
|
|
return -1;
|
|
|
|
return eth_current->send(eth_current, packet, length);
|
|
}
|
|
|
|
int eth_rx(void)
|
|
{
|
|
if (!eth_current)
|
|
return -1;
|
|
|
|
return eth_current->recv(eth_current);
|
|
}
|
|
|
|
#ifdef CONFIG_API
|
|
static void eth_save_packet(volatile void *packet, int length)
|
|
{
|
|
volatile char *p = packet;
|
|
int i;
|
|
|
|
if ((eth_rcv_last+1) % PKTBUFSRX == eth_rcv_current)
|
|
return;
|
|
|
|
if (PKTSIZE < length)
|
|
return;
|
|
|
|
for (i = 0; i < length; i++)
|
|
eth_rcv_bufs[eth_rcv_last].data[i] = p[i];
|
|
|
|
eth_rcv_bufs[eth_rcv_last].length = length;
|
|
eth_rcv_last = (eth_rcv_last + 1) % PKTBUFSRX;
|
|
}
|
|
|
|
int eth_receive(volatile void *packet, int length)
|
|
{
|
|
volatile char *p = packet;
|
|
void *pp = push_packet;
|
|
int i;
|
|
|
|
if (eth_rcv_current == eth_rcv_last) {
|
|
push_packet = eth_save_packet;
|
|
eth_rx();
|
|
push_packet = pp;
|
|
|
|
if (eth_rcv_current == eth_rcv_last)
|
|
return -1;
|
|
}
|
|
|
|
if (length < eth_rcv_bufs[eth_rcv_current].length)
|
|
return -1;
|
|
|
|
length = eth_rcv_bufs[eth_rcv_current].length;
|
|
|
|
for (i = 0; i < length; i++)
|
|
p[i] = eth_rcv_bufs[eth_rcv_current].data[i];
|
|
|
|
eth_rcv_current = (eth_rcv_current + 1) % PKTBUFSRX;
|
|
return length;
|
|
}
|
|
#endif /* CONFIG_API */
|
|
|
|
void eth_try_another(int first_restart)
|
|
{
|
|
static struct eth_device *first_failed = NULL;
|
|
char *ethrotate;
|
|
|
|
/*
|
|
* Do not rotate between network interfaces when
|
|
* 'ethrotate' variable is set to 'no'.
|
|
*/
|
|
if (((ethrotate = getenv ("ethrotate")) != NULL) &&
|
|
(strcmp(ethrotate, "no") == 0))
|
|
return;
|
|
|
|
if (!eth_current)
|
|
return;
|
|
|
|
if (first_restart) {
|
|
first_failed = eth_current;
|
|
}
|
|
|
|
eth_current = eth_current->next;
|
|
|
|
eth_current_changed();
|
|
|
|
if (first_failed == eth_current) {
|
|
NetRestartWrap = 1;
|
|
}
|
|
}
|
|
|
|
void eth_set_current(void)
|
|
{
|
|
static char *act = NULL;
|
|
static int env_changed_id = 0;
|
|
struct eth_device* old_current;
|
|
int env_id;
|
|
|
|
if (!eth_current) /* XXX no current */
|
|
return;
|
|
|
|
env_id = get_env_id();
|
|
if ((act == NULL) || (env_changed_id != env_id)) {
|
|
act = getenv("ethact");
|
|
env_changed_id = env_id;
|
|
}
|
|
if (act != NULL) {
|
|
old_current = eth_current;
|
|
do {
|
|
if (strcmp(eth_current->name, act) == 0)
|
|
return;
|
|
eth_current = eth_current->next;
|
|
} while (old_current != eth_current);
|
|
}
|
|
|
|
eth_current_changed();
|
|
}
|
|
|
|
char *eth_get_name (void)
|
|
{
|
|
return (eth_current ? eth_current->name : "unknown");
|
|
}
|