forked from Imagelibrary/rtems
94365d9159
* ide/ata.c, ide/ata.h, ide/ata_internal.h, ide/ide_controller.c, ide/ide_ctrl.h, ide/ide_ctrl_cfg.h, ide/ide_ctrl_io.h, network/cs8900.c, network/cs8900.c.bsp, network/cs8900.h, network/dec21140.c, network/elnk.c, network/open_eth.c, network/sonic.c, network/sonic.h, rtc/icm7170.c, rtc/icm7170.h, rtc/icm7170_reg.c, rtc/icm7170_reg2.c, rtc/icm7170_reg4.c, rtc/icm7170_reg8.c, rtc/m48t08.c, rtc/m48t08.h, rtc/m48t08_reg.c, rtc/m48t08_reg2.c, rtc/m48t08_reg4.c, rtc/m48t08_reg8.c, rtc/rtc.h, rtc/rtcprobe.c, serial/mc68681.c, serial/mc68681.h, serial/mc68681_p.h, serial/mc68681_reg.c, serial/mc68681_reg2.c, serial/mc68681_reg4.c, serial/mc68681_reg8.c, serial/serial.h, serial/z85c30.c, serial/z85c30.h, serial/z85c30_p.h, serial/z85c30_reg.c: URL for license changed.
298 lines
6.6 KiB
Plaintext
298 lines
6.6 KiB
Plaintext
/*
|
|
------------------------------------------------------------------------
|
|
$Id$
|
|
------------------------------------------------------------------------
|
|
|
|
My Right Boot, a boot ROM for embedded hardware.
|
|
|
|
Copyright Cybertec Pty Ltd, 2000
|
|
All rights reserved Cybertec Pty Ltd, 2000
|
|
|
|
COPYRIGHT (c) 1989-1998.
|
|
On-Line Applications Research Corporation (OAR).
|
|
|
|
The license and distribution terms for this file may be
|
|
found in the file LICENSE in this distribution or at
|
|
http://www.rtems.com/license/LICENSE.
|
|
|
|
------------------------------------------------------------------------
|
|
|
|
CS8900 net boot driver.
|
|
|
|
*/
|
|
|
|
#include <rtems/bspIo.h>
|
|
#include <rtems.h>
|
|
|
|
#include <libchip/cs8900.h>
|
|
|
|
/*
|
|
* Our local data.
|
|
*/
|
|
|
|
#ifdef CS8900_VERBOSE
|
|
static BOOLEAN cs8900_io_verbose;
|
|
#endif
|
|
|
|
static rtems_isr_void_entry old_handler[CS8900_DEVICES];
|
|
static void *old_parameter[CS8900_DEVICES];
|
|
|
|
/*
|
|
* Tables of IO addresses and interrupt levels for each device attached.
|
|
*/
|
|
|
|
static const unsigned long ethernet_io_base[CS8900_DEVICES] =
|
|
{
|
|
ETHERNET_BASE
|
|
};
|
|
|
|
static const unsigned long ethernet_mem_base[CS8900_DEVICES] =
|
|
{
|
|
ETHERNET_BASE + CS8900_MEMORY_BASE
|
|
};
|
|
|
|
static const unsigned int ethernet_irq_level[CS8900_DEVICES] =
|
|
{
|
|
ETHERNET_IRQ_LEVEL
|
|
};
|
|
|
|
static const unsigned int ethernet_irq_priority[CS8900_DEVICES] =
|
|
{
|
|
ETHERNET_IRQ_PRIORITY
|
|
};
|
|
|
|
static const unsigned int ethernet_irq_vector[CS8900_DEVICES] =
|
|
{
|
|
ETHERNET_IRQ_VECTOR,
|
|
};
|
|
|
|
void cs8900_io_set_reg (int dev, unsigned short reg, unsigned short data)
|
|
{
|
|
#ifdef CS8900_DATA_BUS_SWAPPED
|
|
data = (data >> 8) | (data << 8);
|
|
#endif
|
|
|
|
#ifdef CS8900_VERBOSE
|
|
if (cs8900_io_verbose)
|
|
printf ("CS8900: io set reg=0x%04x, data=0x%04x\n", reg, data);
|
|
#endif
|
|
|
|
WRITE_REGISTER_16 (ethernet_io_base[dev] + reg, data);
|
|
}
|
|
|
|
unsigned short cs8900_io_get_reg (int dev, unsigned short reg)
|
|
{
|
|
unsigned long data;
|
|
|
|
READ_REGISTER_16 (ethernet_io_base[dev] + reg, data);
|
|
|
|
#ifdef CS8900_DATA_BUS_SWAPPED
|
|
data = (data >> 8) | (data << 8);
|
|
#endif
|
|
|
|
#ifdef CS8900_VERBOSE
|
|
if (cs8900_io_verbose)
|
|
printk ("CS8900: io get reg=0x%04x, data=0x%04x\n", reg, data);
|
|
#endif
|
|
|
|
return data;
|
|
}
|
|
|
|
void cs8900_mem_set_reg (int dev, unsigned long reg, unsigned short data)
|
|
{
|
|
#ifdef CS8900_DATA_BUS_SWAPPED
|
|
data = (data >> 8) | (data << 8);
|
|
#endif
|
|
|
|
#ifdef CS8900_VERBOSE
|
|
if (cs8900_io_verbose)
|
|
printk ("CS8900: mem set reg=0x%04x, data=0x%04x\n", reg, data);
|
|
#endif
|
|
|
|
WRITE_REGISTER_16 (ethernet_io_base[dev] + reg, data);
|
|
}
|
|
|
|
unsigned short cs8900_mem_get_reg (int dev, unsigned long reg)
|
|
{
|
|
unsigned short data;
|
|
READ_REGISTER_16 (ethernet_io_base[dev] + reg, data);
|
|
|
|
#ifdef CS8900_DATA_BUS_SWAPPED
|
|
data = (data >> 8) | (data << 8);
|
|
#endif
|
|
|
|
#ifdef CS8900_VERBOSE
|
|
if (cs8900_io_verbose)
|
|
printk ("CS8900: mem get reg=0x%04x, data=0x%04x\n", reg, data);
|
|
#endif
|
|
|
|
return data;
|
|
}
|
|
|
|
void cs8900_put_data_block (int dev, int len, unsigned char *data)
|
|
{
|
|
#ifndef CS8900_DATA_BUS_SWAPPED
|
|
unsigned short swap_word;
|
|
#endif
|
|
unsigned short *src = (unsigned short *) ((unsigned long) data);
|
|
unsigned short *dst = (unsigned short *) (ethernet_mem_base[dev] + CS8900_PP_TxFrameLoc);
|
|
|
|
while (len > 1)
|
|
{
|
|
#ifndef CS8900_DATA_BUS_SWAPPED
|
|
swap_word = *src++;
|
|
*dst++ = (swap_word >> 8) | (swap_word << 8);
|
|
#else
|
|
*dst++ = *src++;
|
|
#endif
|
|
len -= 2;
|
|
}
|
|
|
|
if (len)
|
|
{
|
|
#ifndef CS8900_DATA_BUS_SWAPPED
|
|
swap_word = *src++;
|
|
*dst++ = (swap_word >> 8) | (swap_word << 8);
|
|
#else
|
|
*dst++ = *src++;
|
|
#endif
|
|
}
|
|
}
|
|
|
|
unsigned short cs8900_get_data_block (int dev, unsigned char *data)
|
|
{
|
|
unsigned short swap_word;
|
|
volatile unsigned short *src = (unsigned short *) (ethernet_mem_base[dev] + CS8900_PP_RxLength);
|
|
unsigned short *dst;
|
|
unsigned short len;
|
|
unsigned short rx_len;
|
|
unsigned short len_odd;
|
|
|
|
#ifdef CS8900_DATA_BUS_SWAPPED
|
|
swap_word = *src++;
|
|
len = (swap_word >> 8) | (swap_word << 8);
|
|
#else
|
|
len = *src++;
|
|
#endif
|
|
|
|
dst = (unsigned short *) ((unsigned long) data);
|
|
|
|
len_odd = len & 1;
|
|
rx_len = len & ~1;
|
|
|
|
for (; rx_len; rx_len -= 2)
|
|
{
|
|
#ifndef CS8900_DATA_BUS_SWAPPED
|
|
swap_word = *src++;
|
|
*dst++ = (swap_word >> 8) | (swap_word << 8);
|
|
#else
|
|
*dst++ = *src++;
|
|
#endif
|
|
}
|
|
|
|
if (len_odd)
|
|
{
|
|
#ifndef CS8900_DATA_BUS_SWAPPED
|
|
swap_word = *src++;
|
|
*dst++ = (swap_word >> 8) | (swap_word << 8);
|
|
#else
|
|
*dst++ = *src++;
|
|
#endif
|
|
}
|
|
|
|
return len;
|
|
}
|
|
|
|
void
|
|
cs8900_tx_load (int dev, struct mbuf *m)
|
|
{
|
|
volatile unsigned short *dst = (unsigned short *) (ethernet_mem_base[dev] + CS8900_PP_TxFrameLoc);
|
|
unsigned int len;
|
|
unsigned char *src;
|
|
int remainder = 0;
|
|
unsigned char remainder_data = '\0';
|
|
|
|
while (m)
|
|
{
|
|
/*
|
|
* We can get empty mbufs from the stack.
|
|
*/
|
|
|
|
len = m->m_len;
|
|
src = mtod (m, unsigned char*);
|
|
|
|
if (len)
|
|
{
|
|
if (remainder)
|
|
{
|
|
#ifndef CS8900_DATA_BUS_SWAPPED
|
|
*dst++ = remainder_data | (*src++ << 8);
|
|
#else
|
|
*dst++ = *src++ | (remainder_data << 8);
|
|
#endif
|
|
len--;
|
|
remainder = 0;
|
|
}
|
|
|
|
if (len & 1)
|
|
{
|
|
remainder = 1;
|
|
len--;
|
|
}
|
|
|
|
for (; len; len -= 2)
|
|
#ifndef CS8900_DATA_BUS_SWAPPED
|
|
*dst++ = (*src++) | (*(++src) << 8);
|
|
#else
|
|
*dst++ = (*src++ << 8) | *(++src);
|
|
#endif
|
|
|
|
if (remainder)
|
|
remainder_data = *src++;
|
|
}
|
|
|
|
m = m->m_next;
|
|
}
|
|
|
|
if (remainder)
|
|
{
|
|
#ifndef CS8900_DATA_BUS_SWAPPED
|
|
*dst = (unsigned short) remainder_data;
|
|
#else
|
|
*dst = (unsigned short) (remainder_data << 8);
|
|
#endif
|
|
}
|
|
}
|
|
|
|
void cs8900_attach_interrupt (int dev, cs8900_device *cs)
|
|
{
|
|
rtems_interrupt_catch_with_void (cs8900_interrupt,
|
|
ethernet_irq_vector[dev],
|
|
&old_handler[dev],
|
|
cs,
|
|
&old_parameter[dev]);
|
|
|
|
CF_SIM_WRITE_ICR (CF_BASE,
|
|
ethernet_irq_level[dev],
|
|
CF_SIM_ICR_AVEC_AUTO,
|
|
ethernet_irq_level[dev],
|
|
ethernet_irq_priority[dev]);
|
|
CF_SIM_IMR_ENABLE (CF_BASE, 1 << ethernet_irq_level[dev]);
|
|
}
|
|
|
|
void cs8900_detach_interrupt (int dev)
|
|
{
|
|
CF_SIM_IMR_DISABLE (CF_BASE, 1 << ethernet_irq_level[dev]);
|
|
|
|
rtems_interrupt_catch_with_void (old_handler,
|
|
ethernet_irq_vector[dev],
|
|
NULL,
|
|
old_parameter[dev],
|
|
NULL);
|
|
}
|
|
|
|
void cs8900_get_mac_addr (int dev, unsigned char *mac_address)
|
|
{
|
|
memcpy (mac_address, rct_get_mac_address (dev), 6);
|
|
}
|