2009-12-02 16:59:42 +01:00
|
|
|
/*
|
|
|
|
* rtl8169.c
|
|
|
|
*
|
|
|
|
* This file contains a ethernet device driver for Realtek rtl8169 based
|
|
|
|
* ethernet cards.
|
|
|
|
*
|
|
|
|
*/
|
|
|
|
|
|
|
|
#include "../drivers.h"
|
|
|
|
|
|
|
|
#include <stdlib.h>
|
|
|
|
#include <stdio.h>
|
|
|
|
#include <string.h>
|
|
|
|
#include <stddef.h>
|
|
|
|
#include <minix/com.h>
|
|
|
|
#include <minix/ds.h>
|
|
|
|
#include <minix/keymap.h>
|
|
|
|
#include <minix/syslib.h>
|
|
|
|
#include <minix/type.h>
|
|
|
|
#include <minix/sysutil.h>
|
|
|
|
#include <minix/endpoint.h>
|
|
|
|
#include <timers.h>
|
|
|
|
#include <net/hton.h>
|
|
|
|
#include <net/gen/ether.h>
|
|
|
|
#include <net/gen/eth_io.h>
|
|
|
|
#include <ibm/pci.h>
|
|
|
|
|
|
|
|
#include <sys/types.h>
|
|
|
|
#include <fcntl.h>
|
|
|
|
#include <assert.h>
|
|
|
|
#include <unistd.h>
|
|
|
|
#include <sys/ioc_memory.h>
|
|
|
|
#include "../../kernel/const.h"
|
|
|
|
#include "../../kernel/config.h"
|
|
|
|
#include "../../kernel/type.h"
|
|
|
|
|
|
|
|
#define tmra_ut timer_t
|
|
|
|
#define tmra_inittimer(tp) tmr_inittimer(tp)
|
|
|
|
#define Proc_number(p) proc_number(p)
|
|
|
|
#define debug 1
|
|
|
|
#define printW() ((void)0)
|
|
|
|
|
|
|
|
#define VERBOSE 0 /* display message during init */
|
|
|
|
|
|
|
|
#include "rtl8169.h"
|
|
|
|
|
|
|
|
#define RE_PORT_NR 1 /* Minix */
|
|
|
|
|
|
|
|
#define IOVEC_NR 16 /* I/O vectors are handled IOVEC_NR entries at a time. */
|
|
|
|
|
|
|
|
#define RE_DTCC_VALUE 600 /* DTCC Update after every 10 minutes */
|
|
|
|
|
|
|
|
#define RX_CONFIG_MASK 0xff7e1880 /* Clears the bits supported by chip */
|
|
|
|
|
|
|
|
#define RE_INTR_MASK (RL_IMR_TDU | RL_IMR_FOVW | RL_IMR_PUN | RL_IMR_RDU | RL_IMR_TER | RL_IMR_TOK | RL_IMR_RER | RL_IMR_ROK)
|
|
|
|
|
|
|
|
#define RL_ENVVAR "RTLETH" /* Configuration */
|
|
|
|
|
|
|
|
PRIVATE struct pcitab
|
|
|
|
{
|
|
|
|
u16_t vid;
|
|
|
|
u16_t did;
|
|
|
|
int checkclass;
|
|
|
|
} pcitab[] =
|
|
|
|
{
|
|
|
|
{ 0x10ec, 0x8129, 0 }, /* Realtek RTL8129 */
|
|
|
|
{ 0x10ec, 0x8167, 0 }, /* Realtek RTL8169/8110 Family Gigabit NIC */
|
|
|
|
{ 0x10ec, 0x8169, 0 }, /* Realtek RTL8169 */
|
|
|
|
|
|
|
|
{ 0x1186, 0x4300, 0 }, /* D-Link DGE-528T Gigabit adaptor */
|
|
|
|
|
|
|
|
{ 0x1259, 0xc107, 0 }, /* Allied Telesyn International Gigabit Ethernet Adapter */
|
|
|
|
|
|
|
|
{ 0x1385, 0x8169, 0 }, /* Netgear Gigabit Ethernet Adapter */
|
|
|
|
|
|
|
|
{ 0x16ec, 0x0116, 0 }, /* US Robotics Realtek 8169S chip */
|
|
|
|
|
|
|
|
{ 0x1737, 0x1032, 0 }, /* Linksys Instant Gigabit Desktop Network Interface */
|
|
|
|
|
|
|
|
{ 0x0000, 0x0000, 0 }
|
|
|
|
};
|
|
|
|
|
|
|
|
typedef struct re_desc
|
|
|
|
{
|
|
|
|
u32_t status; /* command/status */
|
|
|
|
u32_t vlan; /* VLAN */
|
|
|
|
u32_t addr_low; /* low 32-bits of physical buffer address */
|
|
|
|
u32_t addr_high; /* high 32-bits of physical buffer address */
|
|
|
|
} re_desc;
|
|
|
|
|
|
|
|
typedef struct re_dtcc
|
|
|
|
{
|
|
|
|
u32_t TxOk_low; /* low 32-bits of Tx Ok packets */
|
|
|
|
u32_t TxOk_high; /* high 32-bits of Tx Ok packets */
|
|
|
|
u32_t RxOk_low; /* low 32-bits of Rx Ok packets */
|
|
|
|
u32_t RxOk_high; /* high 32-bits of Rx Ok packets */
|
|
|
|
u32_t TxEr_low; /* low 32-bits of Tx errors */
|
|
|
|
u32_t TxEr_high; /* high 32-bits of Tx errors */
|
|
|
|
u32_t RxEr; /* Rx errors */
|
|
|
|
u16_t MissPkt; /* Missed packets */
|
|
|
|
u16_t FAE; /* Frame Aignment Error packets (MII mode only) */
|
|
|
|
u32_t Tx1Col; /* Tx Ok packets with only 1 collision happened before Tx Ok */
|
|
|
|
u32_t TxMCol; /* Tx Ok packets with > 1 and < 16 collisions happened before Tx Ok */
|
|
|
|
u32_t RxOkPhy_low; /* low 32-bits of Rx Ok packets with physical addr destination ID */
|
|
|
|
u32_t RxOkPhy_high; /* high 32-bits of Rx Ok packets with physical addr destination ID */
|
|
|
|
u32_t RxOkBrd_low; /* low 32-bits of Rx Ok packets with broadcast destination ID */
|
|
|
|
u32_t RxOkBrd_high; /* high 32-bits of Rx Ok packets with broadcast destination ID */
|
|
|
|
u32_t RxOkMul; /* Rx Ok Packets with multicast destination ID */
|
|
|
|
u16_t TxAbt; /* Tx abort packets */
|
|
|
|
u16_t TxUndrn; /* Tx underrun packets */
|
|
|
|
} re_dtcc;
|
|
|
|
|
|
|
|
typedef struct re {
|
|
|
|
port_t re_base_port;
|
|
|
|
int re_irq;
|
|
|
|
int re_mode;
|
|
|
|
int re_flags;
|
|
|
|
endpoint_t re_client;
|
|
|
|
int re_link_up;
|
|
|
|
int re_got_int;
|
|
|
|
int re_send_int;
|
|
|
|
int re_report_link;
|
|
|
|
int re_need_reset;
|
|
|
|
int re_tx_alive;
|
|
|
|
int setup;
|
|
|
|
u32_t re_mac;
|
|
|
|
char *re_model;
|
|
|
|
|
|
|
|
/* Rx */
|
|
|
|
int re_rx_head;
|
|
|
|
struct {
|
|
|
|
int ret_busy;
|
|
|
|
phys_bytes ret_buf;
|
|
|
|
char *v_ret_buf;
|
|
|
|
} re_rx[N_RX_DESC];
|
|
|
|
|
|
|
|
vir_bytes re_read_s;
|
|
|
|
re_desc *re_rx_desc; /* Rx descriptor buffer */
|
|
|
|
phys_bytes p_rx_desc; /* Rx descriptor buffer physical */
|
|
|
|
|
|
|
|
/* Tx */
|
|
|
|
int re_tx_head;
|
|
|
|
struct {
|
|
|
|
int ret_busy;
|
|
|
|
phys_bytes ret_buf;
|
|
|
|
char *v_ret_buf;
|
|
|
|
} re_tx[N_TX_DESC];
|
|
|
|
re_desc *re_tx_desc; /* Tx descriptor buffer */
|
|
|
|
phys_bytes p_tx_desc; /* Tx descriptor buffer physical */
|
|
|
|
|
|
|
|
/* PCI related */
|
|
|
|
int re_seen; /* TRUE iff device available */
|
|
|
|
u8_t re_pcibus;
|
|
|
|
u8_t re_pcidev;
|
|
|
|
u8_t re_pcifunc;
|
|
|
|
|
|
|
|
/* 'large' items */
|
|
|
|
int re_hook_id; /* IRQ hook id at kernel */
|
|
|
|
eth_stat_t re_stat;
|
|
|
|
phys_bytes dtcc_buf; /* Dump Tally Counter buffer physical */
|
|
|
|
re_dtcc *v_dtcc_buf; /* Dump Tally Counter buffer */
|
|
|
|
u32_t dtcc_counter; /* DTCC update counter */
|
|
|
|
ether_addr_t re_address;
|
|
|
|
message re_rx_mess;
|
|
|
|
message re_tx_mess;
|
|
|
|
char re_name[sizeof("rtl8169#n")];
|
|
|
|
iovec_t re_iovec[IOVEC_NR];
|
|
|
|
iovec_s_t re_iovec_s[IOVEC_NR];
|
|
|
|
u32_t interrupts;
|
|
|
|
}
|
|
|
|
re_t;
|
|
|
|
|
|
|
|
#define REM_DISABLED 0x0
|
|
|
|
#define REM_ENABLED 0x1
|
|
|
|
|
|
|
|
#define REF_PACK_SENT 0x001
|
|
|
|
#define REF_PACK_RECV 0x002
|
|
|
|
#define REF_SEND_AVAIL 0x004
|
|
|
|
#define REF_READING 0x010
|
|
|
|
#define REF_EMPTY 0x000
|
|
|
|
#define REF_PROMISC 0x040
|
|
|
|
#define REF_MULTI 0x080
|
|
|
|
#define REF_BROAD 0x100
|
|
|
|
#define REF_ENABLED 0x200
|
|
|
|
|
|
|
|
static re_t re_table[RE_PORT_NR];
|
|
|
|
|
|
|
|
static u16_t eth_ign_proto;
|
|
|
|
static tmra_ut rl_watchdog;
|
|
|
|
|
|
|
|
FORWARD _PROTOTYPE(unsigned my_inb, (U16_t port));
|
|
|
|
FORWARD _PROTOTYPE(unsigned my_inw, (U16_t port));
|
|
|
|
FORWARD _PROTOTYPE(unsigned my_inl, (U16_t port));
|
|
|
|
static unsigned my_inb(U16_t port)
|
|
|
|
{
|
|
|
|
u32_t value;
|
|
|
|
int s;
|
|
|
|
if ((s = sys_inb(port, &value)) != OK)
|
|
|
|
printf("RTL8169: warning, sys_inb failed: %d\n", s);
|
|
|
|
return value;
|
|
|
|
}
|
|
|
|
static unsigned my_inw(U16_t port)
|
|
|
|
{
|
|
|
|
u32_t value;
|
|
|
|
int s;
|
|
|
|
if ((s = sys_inw(port, &value)) != OK)
|
|
|
|
printf("RTL8169: warning, sys_inw failed: %d\n", s);
|
|
|
|
return value;
|
|
|
|
}
|
|
|
|
static unsigned my_inl(U16_t port)
|
|
|
|
{
|
|
|
|
U32_t value;
|
|
|
|
int s;
|
|
|
|
if ((s = sys_inl(port, &value)) != OK)
|
|
|
|
printf("RTL8169: warning, sys_inl failed: %d\n", s);
|
|
|
|
return value;
|
|
|
|
}
|
|
|
|
#define rl_inb(port, offset) (my_inb((port) + (offset)))
|
|
|
|
#define rl_inw(port, offset) (my_inw((port) + (offset)))
|
|
|
|
#define rl_inl(port, offset) (my_inl((port) + (offset)))
|
|
|
|
|
|
|
|
FORWARD _PROTOTYPE(void my_outb, (U16_t port, U8_t value));
|
|
|
|
FORWARD _PROTOTYPE(void my_outw, (U16_t port, U16_t value));
|
|
|
|
FORWARD _PROTOTYPE(void my_outl, (U16_t port, U32_t value));
|
|
|
|
static void my_outb(U16_t port, U8_t value)
|
|
|
|
{
|
|
|
|
int s;
|
|
|
|
|
|
|
|
if ((s = sys_outb(port, value)) != OK)
|
|
|
|
printf("RTL8169: warning, sys_outb failed: %d\n", s);
|
|
|
|
}
|
|
|
|
static void my_outw(U16_t port, U16_t value)
|
|
|
|
{
|
|
|
|
int s;
|
|
|
|
|
|
|
|
if ((s = sys_outw(port, value)) != OK)
|
|
|
|
printf("RTL8169: warning, sys_outw failed: %d\n", s);
|
|
|
|
}
|
|
|
|
static void my_outl(U16_t port, U32_t value)
|
|
|
|
{
|
|
|
|
int s;
|
|
|
|
|
|
|
|
if ((s = sys_outl(port, value)) != OK)
|
|
|
|
printf("RTL8169: warning, sys_outl failed: %d\n", s);
|
|
|
|
}
|
|
|
|
#define rl_outb(port, offset, value) (my_outb((port) + (offset), (value)))
|
|
|
|
#define rl_outw(port, offset, value) (my_outw((port) + (offset), (value)))
|
|
|
|
#define rl_outl(port, offset, value) (my_outl((port) + (offset), (value)))
|
|
|
|
|
|
|
|
_PROTOTYPE( static void rl_init, (message *mp) );
|
|
|
|
_PROTOTYPE( static void rl_pci_conf, (void) );
|
|
|
|
_PROTOTYPE( static int rl_probe, (re_t *rep) );
|
|
|
|
_PROTOTYPE( static void rl_conf_hw, (re_t *rep) );
|
|
|
|
_PROTOTYPE( static void rl_init_buf, (re_t *rep) );
|
|
|
|
_PROTOTYPE( static void rl_init_hw, (re_t *rep) );
|
|
|
|
_PROTOTYPE( static void rl_reset_hw, (re_t *rep) );
|
|
|
|
_PROTOTYPE( static void rl_confaddr, (re_t *rep) );
|
|
|
|
_PROTOTYPE( static void rl_rec_mode, (re_t *rep) );
|
|
|
|
_PROTOTYPE( static void rl_readv_s, (message *mp, int from_int) );
|
|
|
|
_PROTOTYPE( static void rl_writev_s, (message *mp, int from_int) );
|
|
|
|
_PROTOTYPE( static void rl_check_ints, (re_t *rep) );
|
|
|
|
_PROTOTYPE( static void rl_report_link, (re_t *rep) );
|
|
|
|
_PROTOTYPE( static void rl_do_reset, (re_t *rep) );
|
|
|
|
_PROTOTYPE( static void rl_getstat, (message *mp) );
|
|
|
|
_PROTOTYPE( static void rl_getstat_s, (message *mp) );
|
|
|
|
_PROTOTYPE( static void rl_getname, (message *mp) );
|
|
|
|
_PROTOTYPE( static void reply, (re_t *rep, int err, int may_block) );
|
|
|
|
_PROTOTYPE( static void mess_reply, (message *req, message *reply) );
|
|
|
|
_PROTOTYPE( static void rtl8169_stop, (void) );
|
|
|
|
_PROTOTYPE( static void check_int_events, (void) );
|
|
|
|
_PROTOTYPE( static void do_hard_int, (void) );
|
|
|
|
_PROTOTYPE( static void rtl8169_dump, (void) );
|
|
|
|
_PROTOTYPE( static void dump_phy, (re_t *rep) );
|
|
|
|
_PROTOTYPE( static int rl_handler, (re_t *rep) );
|
|
|
|
_PROTOTYPE( static void rl_watchdog_f, (timer_t *tp) );
|
|
|
|
|
|
|
|
/*
|
|
|
|
* The message used in the main loop is made global, so that rl_watchdog_f()
|
|
|
|
* can change its message type to fake an interrupt message.
|
|
|
|
*/
|
|
|
|
PRIVATE message m;
|
|
|
|
PRIVATE int int_event_check; /* set to TRUE if events arrived */
|
|
|
|
|
|
|
|
static char *progname;
|
|
|
|
u32_t system_hz;
|
|
|
|
|
Basic System Event Framework (SEF) with ping and live update.
SYSLIB CHANGES:
- SEF must be used by every system process and is thereby part of the system
library.
- The framework provides a receive() interface (sef_receive) for system
processes to automatically catch known system even messages and process them.
- SEF provides a default behavior for each type of system event, but allows
system processes to register callbacks to override the default behavior.
- Custom (local to the process) or predefined (provided by SEF) callback
implementations can be registered to SEF.
- SEF currently includes support for 2 types of system events:
1. SEF Ping. The event occurs every time RS sends a ping to figure out
whether a system process is still alive. The default callback implementation
provided by SEF is to notify RS back to let it know the process is alive
and kicking.
2. SEF Live update. The event occurs every time RS sends a prepare to update
message to let a system process know an update is available and to prepare
for it. The live update support is very basic for now. SEF only deals with
verifying if the prepare state can be supported by the process, dumping the
state for debugging purposes, and providing an event-driven programming
model to the process to react to state changes check-in when ready to update.
- SEF should be extended in the future to integrate support for more types of
system events. Ideally, all the cross-cutting concerns should be integrated into
SEF to avoid duplicating code and ease extensibility. Examples include:
* PM notify messages primarily used at shutdown.
* SYSTEM notify messages primarily used for signals.
* CLOCK notify messages used for system alarms.
* Debug messages. IS could still be in charge of fkey handling but would
forward the debug message to the target process (e.g. PM, if the user
requested debug information about PM). SEF would then catch the message and
do nothing unless the process has registered an appropriate callback to
deal with the event. This simplifies the programming model to print debug
information, avoids duplicating code, and reduces the effort to print
debug information.
SYSTEM PROCESSES CHANGES:
- Every system process registers SEF callbacks it needs to override the default
system behavior and calls sef_startup() right after being started.
- sef_startup() does almost nothing now, but will be extended in the future to
support callbacks of its own to let RS control and synchronize with every
system process at initialization time.
- Every system process calls sef_receive() now rather than receive() directly,
to let SEF handle predefined system events.
RS CHANGES:
- RS supports a basic single-component live update protocol now, as follows:
* When an update command is issued (via "service update *"), RS notifies the
target system process to prepare for a specific update state.
* If the process doesn't respond back in time, the update is aborted.
* When the process responds back, RS kills it and marks it for refreshing.
* The process is then automatically restarted as for a buggy process and can
start running again.
* Live update is currently prototyped as a controlled failure.
2009-12-21 15:12:21 +01:00
|
|
|
/* SEF functions and variables. */
|
|
|
|
FORWARD _PROTOTYPE( void sef_local_startup, (void) );
|
Initialization protocol for system services.
SYSLIB CHANGES:
- SEF framework now supports a new SEF Init request type from RS. 3 different
callbacks are available (init_fresh, init_lu, init_restart) to specify
initialization code when a service starts fresh, starts after a live update,
or restarts.
SYSTEM SERVICE CHANGES:
- Initialization code for system services is now enclosed in a callback SEF will
automatically call at init time. The return code of the callback will
tell RS whether the initialization completed successfully.
- Each init callback can access information passed by RS to initialize. As of
now, each system service has access to the public entries of RS's system process
table to gather all the information required to initialize. This design
eliminates many existing or potential races at boot time and provides a uniform
initialization interface to system services. The same interface will be reused
for the upcoming publish/subscribe model to handle dynamic
registration / deregistration of system services.
VM CHANGES:
- Uniform privilege management for all system services. Every service uses the
same call mask format. For boot services, VM copies the call mask from init
data. For dynamic services, VM still receives the call mask via rs_set_priv
call that will be soon replaced by the upcoming publish/subscribe model.
RS CHANGES:
- The system process table has been reorganized and split into private entries
and public entries. Only the latter ones are exposed to system services.
- VM call masks are now entirely configured in rs/table.c
- RS has now its own slot in the system process table. Only kernel tasks and
user processes not included in the boot image are now left out from the system
process table.
- RS implements the initialization protocol for system services.
- For services in the boot image, RS blocks till initialization is complete and
panics when failure is reported back. Services are initialized in their order of
appearance in the boot image priv table and RS blocks to implements synchronous
initialization for every system service having the flag SF_SYNCH_BOOT set.
- For services started dynamically, the initialization protocol is implemented
as though it were the first ping for the service. In this case, if the
system service fails to report back (or reports failure), RS brings the service
down rather than trying to restart it.
2010-01-08 02:20:42 +01:00
|
|
|
FORWARD _PROTOTYPE( int sef_cb_init_fresh, (int type, sef_init_info_t *info) );
|
|
|
|
EXTERN int env_argc;
|
|
|
|
EXTERN char **env_argv;
|
Basic System Event Framework (SEF) with ping and live update.
SYSLIB CHANGES:
- SEF must be used by every system process and is thereby part of the system
library.
- The framework provides a receive() interface (sef_receive) for system
processes to automatically catch known system even messages and process them.
- SEF provides a default behavior for each type of system event, but allows
system processes to register callbacks to override the default behavior.
- Custom (local to the process) or predefined (provided by SEF) callback
implementations can be registered to SEF.
- SEF currently includes support for 2 types of system events:
1. SEF Ping. The event occurs every time RS sends a ping to figure out
whether a system process is still alive. The default callback implementation
provided by SEF is to notify RS back to let it know the process is alive
and kicking.
2. SEF Live update. The event occurs every time RS sends a prepare to update
message to let a system process know an update is available and to prepare
for it. The live update support is very basic for now. SEF only deals with
verifying if the prepare state can be supported by the process, dumping the
state for debugging purposes, and providing an event-driven programming
model to the process to react to state changes check-in when ready to update.
- SEF should be extended in the future to integrate support for more types of
system events. Ideally, all the cross-cutting concerns should be integrated into
SEF to avoid duplicating code and ease extensibility. Examples include:
* PM notify messages primarily used at shutdown.
* SYSTEM notify messages primarily used for signals.
* CLOCK notify messages used for system alarms.
* Debug messages. IS could still be in charge of fkey handling but would
forward the debug message to the target process (e.g. PM, if the user
requested debug information about PM). SEF would then catch the message and
do nothing unless the process has registered an appropriate callback to
deal with the event. This simplifies the programming model to print debug
information, avoids duplicating code, and reduces the effort to print
debug information.
SYSTEM PROCESSES CHANGES:
- Every system process registers SEF callbacks it needs to override the default
system behavior and calls sef_startup() right after being started.
- sef_startup() does almost nothing now, but will be extended in the future to
support callbacks of its own to let RS control and synchronize with every
system process at initialization time.
- Every system process calls sef_receive() now rather than receive() directly,
to let SEF handle predefined system events.
RS CHANGES:
- RS supports a basic single-component live update protocol now, as follows:
* When an update command is issued (via "service update *"), RS notifies the
target system process to prepare for a specific update state.
* If the process doesn't respond back in time, the update is aborted.
* When the process responds back, RS kills it and marks it for refreshing.
* The process is then automatically restarted as for a buggy process and can
start running again.
* Live update is currently prototyped as a controlled failure.
2009-12-21 15:12:21 +01:00
|
|
|
|
2009-12-02 16:59:42 +01:00
|
|
|
/*===========================================================================*
|
|
|
|
* main *
|
|
|
|
*===========================================================================*/
|
|
|
|
int main(int argc, char *argv[])
|
|
|
|
{
|
|
|
|
int r;
|
|
|
|
|
Basic System Event Framework (SEF) with ping and live update.
SYSLIB CHANGES:
- SEF must be used by every system process and is thereby part of the system
library.
- The framework provides a receive() interface (sef_receive) for system
processes to automatically catch known system even messages and process them.
- SEF provides a default behavior for each type of system event, but allows
system processes to register callbacks to override the default behavior.
- Custom (local to the process) or predefined (provided by SEF) callback
implementations can be registered to SEF.
- SEF currently includes support for 2 types of system events:
1. SEF Ping. The event occurs every time RS sends a ping to figure out
whether a system process is still alive. The default callback implementation
provided by SEF is to notify RS back to let it know the process is alive
and kicking.
2. SEF Live update. The event occurs every time RS sends a prepare to update
message to let a system process know an update is available and to prepare
for it. The live update support is very basic for now. SEF only deals with
verifying if the prepare state can be supported by the process, dumping the
state for debugging purposes, and providing an event-driven programming
model to the process to react to state changes check-in when ready to update.
- SEF should be extended in the future to integrate support for more types of
system events. Ideally, all the cross-cutting concerns should be integrated into
SEF to avoid duplicating code and ease extensibility. Examples include:
* PM notify messages primarily used at shutdown.
* SYSTEM notify messages primarily used for signals.
* CLOCK notify messages used for system alarms.
* Debug messages. IS could still be in charge of fkey handling but would
forward the debug message to the target process (e.g. PM, if the user
requested debug information about PM). SEF would then catch the message and
do nothing unless the process has registered an appropriate callback to
deal with the event. This simplifies the programming model to print debug
information, avoids duplicating code, and reduces the effort to print
debug information.
SYSTEM PROCESSES CHANGES:
- Every system process registers SEF callbacks it needs to override the default
system behavior and calls sef_startup() right after being started.
- sef_startup() does almost nothing now, but will be extended in the future to
support callbacks of its own to let RS control and synchronize with every
system process at initialization time.
- Every system process calls sef_receive() now rather than receive() directly,
to let SEF handle predefined system events.
RS CHANGES:
- RS supports a basic single-component live update protocol now, as follows:
* When an update command is issued (via "service update *"), RS notifies the
target system process to prepare for a specific update state.
* If the process doesn't respond back in time, the update is aborted.
* When the process responds back, RS kills it and marks it for refreshing.
* The process is then automatically restarted as for a buggy process and can
start running again.
* Live update is currently prototyped as a controlled failure.
2009-12-21 15:12:21 +01:00
|
|
|
/* SEF local startup. */
|
2009-12-02 16:59:42 +01:00
|
|
|
env_setargs(argc, argv);
|
Initialization protocol for system services.
SYSLIB CHANGES:
- SEF framework now supports a new SEF Init request type from RS. 3 different
callbacks are available (init_fresh, init_lu, init_restart) to specify
initialization code when a service starts fresh, starts after a live update,
or restarts.
SYSTEM SERVICE CHANGES:
- Initialization code for system services is now enclosed in a callback SEF will
automatically call at init time. The return code of the callback will
tell RS whether the initialization completed successfully.
- Each init callback can access information passed by RS to initialize. As of
now, each system service has access to the public entries of RS's system process
table to gather all the information required to initialize. This design
eliminates many existing or potential races at boot time and provides a uniform
initialization interface to system services. The same interface will be reused
for the upcoming publish/subscribe model to handle dynamic
registration / deregistration of system services.
VM CHANGES:
- Uniform privilege management for all system services. Every service uses the
same call mask format. For boot services, VM copies the call mask from init
data. For dynamic services, VM still receives the call mask via rs_set_priv
call that will be soon replaced by the upcoming publish/subscribe model.
RS CHANGES:
- The system process table has been reorganized and split into private entries
and public entries. Only the latter ones are exposed to system services.
- VM call masks are now entirely configured in rs/table.c
- RS has now its own slot in the system process table. Only kernel tasks and
user processes not included in the boot image are now left out from the system
process table.
- RS implements the initialization protocol for system services.
- For services in the boot image, RS blocks till initialization is complete and
panics when failure is reported back. Services are initialized in their order of
appearance in the boot image priv table and RS blocks to implements synchronous
initialization for every system service having the flag SF_SYNCH_BOOT set.
- For services started dynamically, the initialization protocol is implemented
as though it were the first ping for the service. In this case, if the
system service fails to report back (or reports failure), RS brings the service
down rather than trying to restart it.
2010-01-08 02:20:42 +01:00
|
|
|
sef_local_startup();
|
2009-12-02 16:59:42 +01:00
|
|
|
|
|
|
|
while (TRUE) {
|
Basic System Event Framework (SEF) with ping and live update.
SYSLIB CHANGES:
- SEF must be used by every system process and is thereby part of the system
library.
- The framework provides a receive() interface (sef_receive) for system
processes to automatically catch known system even messages and process them.
- SEF provides a default behavior for each type of system event, but allows
system processes to register callbacks to override the default behavior.
- Custom (local to the process) or predefined (provided by SEF) callback
implementations can be registered to SEF.
- SEF currently includes support for 2 types of system events:
1. SEF Ping. The event occurs every time RS sends a ping to figure out
whether a system process is still alive. The default callback implementation
provided by SEF is to notify RS back to let it know the process is alive
and kicking.
2. SEF Live update. The event occurs every time RS sends a prepare to update
message to let a system process know an update is available and to prepare
for it. The live update support is very basic for now. SEF only deals with
verifying if the prepare state can be supported by the process, dumping the
state for debugging purposes, and providing an event-driven programming
model to the process to react to state changes check-in when ready to update.
- SEF should be extended in the future to integrate support for more types of
system events. Ideally, all the cross-cutting concerns should be integrated into
SEF to avoid duplicating code and ease extensibility. Examples include:
* PM notify messages primarily used at shutdown.
* SYSTEM notify messages primarily used for signals.
* CLOCK notify messages used for system alarms.
* Debug messages. IS could still be in charge of fkey handling but would
forward the debug message to the target process (e.g. PM, if the user
requested debug information about PM). SEF would then catch the message and
do nothing unless the process has registered an appropriate callback to
deal with the event. This simplifies the programming model to print debug
information, avoids duplicating code, and reduces the effort to print
debug information.
SYSTEM PROCESSES CHANGES:
- Every system process registers SEF callbacks it needs to override the default
system behavior and calls sef_startup() right after being started.
- sef_startup() does almost nothing now, but will be extended in the future to
support callbacks of its own to let RS control and synchronize with every
system process at initialization time.
- Every system process calls sef_receive() now rather than receive() directly,
to let SEF handle predefined system events.
RS CHANGES:
- RS supports a basic single-component live update protocol now, as follows:
* When an update command is issued (via "service update *"), RS notifies the
target system process to prepare for a specific update state.
* If the process doesn't respond back in time, the update is aborted.
* When the process responds back, RS kills it and marks it for refreshing.
* The process is then automatically restarted as for a buggy process and can
start running again.
* Live update is currently prototyped as a controlled failure.
2009-12-21 15:12:21 +01:00
|
|
|
if ((r = sef_receive(ANY, &m)) != OK)
|
|
|
|
panic("rtl8169", "sef_receive failed", r);
|
2009-12-02 16:59:42 +01:00
|
|
|
|
|
|
|
if (is_notify(m.m_type)) {
|
|
|
|
switch (_ENDPOINT_P(m.m_source)) {
|
|
|
|
case CLOCK:
|
|
|
|
/*
|
|
|
|
* Under MINIX, synchronous alarms are used
|
|
|
|
* instead of watchdog functions.
|
|
|
|
* The approach is very different: MINIX VMD
|
|
|
|
* timeouts are handled within the kernel
|
|
|
|
* (the watchdog is executed by CLOCK), and
|
|
|
|
* notify() the driver in some cases. MINIX
|
|
|
|
* timeouts result in a SYN_ALARM message to
|
|
|
|
* the driver and thus are handled where they
|
|
|
|
* should be handled. Locally, watchdog
|
|
|
|
* functions are used again.
|
|
|
|
*/
|
|
|
|
rl_watchdog_f(NULL);
|
|
|
|
break;
|
|
|
|
case HARDWARE:
|
|
|
|
do_hard_int();
|
|
|
|
if (int_event_check) {
|
|
|
|
check_int_events();
|
|
|
|
}
|
|
|
|
break ;
|
|
|
|
case PM_PROC_NR:
|
|
|
|
{
|
|
|
|
sigset_t set;
|
|
|
|
|
|
|
|
if (getsigset(&set) != 0) break;
|
|
|
|
|
|
|
|
if (sigismember(&set, SIGTERM))
|
|
|
|
rtl8169_stop();
|
|
|
|
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
default:
|
|
|
|
panic("rtl8169", "illegal notify from",
|
|
|
|
m.m_type);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* done, get nwe message */
|
|
|
|
continue;
|
|
|
|
}
|
|
|
|
|
|
|
|
switch (m.m_type) {
|
|
|
|
case DL_WRITEV_S: rl_writev_s(&m, FALSE); break;
|
|
|
|
case DL_READV_S: rl_readv_s(&m, FALSE); break;
|
|
|
|
case DL_CONF: rl_init(&m); break;
|
|
|
|
case DL_GETSTAT: rl_getstat(&m); break;
|
|
|
|
case DL_GETSTAT_S: rl_getstat_s(&m); break;
|
|
|
|
case DL_GETNAME: rl_getname(&m); break;
|
|
|
|
default:
|
|
|
|
panic("rtl8169", "illegal message", m.m_type);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
Basic System Event Framework (SEF) with ping and live update.
SYSLIB CHANGES:
- SEF must be used by every system process and is thereby part of the system
library.
- The framework provides a receive() interface (sef_receive) for system
processes to automatically catch known system even messages and process them.
- SEF provides a default behavior for each type of system event, but allows
system processes to register callbacks to override the default behavior.
- Custom (local to the process) or predefined (provided by SEF) callback
implementations can be registered to SEF.
- SEF currently includes support for 2 types of system events:
1. SEF Ping. The event occurs every time RS sends a ping to figure out
whether a system process is still alive. The default callback implementation
provided by SEF is to notify RS back to let it know the process is alive
and kicking.
2. SEF Live update. The event occurs every time RS sends a prepare to update
message to let a system process know an update is available and to prepare
for it. The live update support is very basic for now. SEF only deals with
verifying if the prepare state can be supported by the process, dumping the
state for debugging purposes, and providing an event-driven programming
model to the process to react to state changes check-in when ready to update.
- SEF should be extended in the future to integrate support for more types of
system events. Ideally, all the cross-cutting concerns should be integrated into
SEF to avoid duplicating code and ease extensibility. Examples include:
* PM notify messages primarily used at shutdown.
* SYSTEM notify messages primarily used for signals.
* CLOCK notify messages used for system alarms.
* Debug messages. IS could still be in charge of fkey handling but would
forward the debug message to the target process (e.g. PM, if the user
requested debug information about PM). SEF would then catch the message and
do nothing unless the process has registered an appropriate callback to
deal with the event. This simplifies the programming model to print debug
information, avoids duplicating code, and reduces the effort to print
debug information.
SYSTEM PROCESSES CHANGES:
- Every system process registers SEF callbacks it needs to override the default
system behavior and calls sef_startup() right after being started.
- sef_startup() does almost nothing now, but will be extended in the future to
support callbacks of its own to let RS control and synchronize with every
system process at initialization time.
- Every system process calls sef_receive() now rather than receive() directly,
to let SEF handle predefined system events.
RS CHANGES:
- RS supports a basic single-component live update protocol now, as follows:
* When an update command is issued (via "service update *"), RS notifies the
target system process to prepare for a specific update state.
* If the process doesn't respond back in time, the update is aborted.
* When the process responds back, RS kills it and marks it for refreshing.
* The process is then automatically restarted as for a buggy process and can
start running again.
* Live update is currently prototyped as a controlled failure.
2009-12-21 15:12:21 +01:00
|
|
|
/*===========================================================================*
|
|
|
|
* sef_local_startup *
|
|
|
|
*===========================================================================*/
|
|
|
|
PRIVATE void sef_local_startup()
|
|
|
|
{
|
Initialization protocol for system services.
SYSLIB CHANGES:
- SEF framework now supports a new SEF Init request type from RS. 3 different
callbacks are available (init_fresh, init_lu, init_restart) to specify
initialization code when a service starts fresh, starts after a live update,
or restarts.
SYSTEM SERVICE CHANGES:
- Initialization code for system services is now enclosed in a callback SEF will
automatically call at init time. The return code of the callback will
tell RS whether the initialization completed successfully.
- Each init callback can access information passed by RS to initialize. As of
now, each system service has access to the public entries of RS's system process
table to gather all the information required to initialize. This design
eliminates many existing or potential races at boot time and provides a uniform
initialization interface to system services. The same interface will be reused
for the upcoming publish/subscribe model to handle dynamic
registration / deregistration of system services.
VM CHANGES:
- Uniform privilege management for all system services. Every service uses the
same call mask format. For boot services, VM copies the call mask from init
data. For dynamic services, VM still receives the call mask via rs_set_priv
call that will be soon replaced by the upcoming publish/subscribe model.
RS CHANGES:
- The system process table has been reorganized and split into private entries
and public entries. Only the latter ones are exposed to system services.
- VM call masks are now entirely configured in rs/table.c
- RS has now its own slot in the system process table. Only kernel tasks and
user processes not included in the boot image are now left out from the system
process table.
- RS implements the initialization protocol for system services.
- For services in the boot image, RS blocks till initialization is complete and
panics when failure is reported back. Services are initialized in their order of
appearance in the boot image priv table and RS blocks to implements synchronous
initialization for every system service having the flag SF_SYNCH_BOOT set.
- For services started dynamically, the initialization protocol is implemented
as though it were the first ping for the service. In this case, if the
system service fails to report back (or reports failure), RS brings the service
down rather than trying to restart it.
2010-01-08 02:20:42 +01:00
|
|
|
/* Register init callbacks. */
|
|
|
|
sef_setcb_init_fresh(sef_cb_init_fresh);
|
|
|
|
sef_setcb_init_restart(sef_cb_init_fresh);
|
|
|
|
|
Basic System Event Framework (SEF) with ping and live update.
SYSLIB CHANGES:
- SEF must be used by every system process and is thereby part of the system
library.
- The framework provides a receive() interface (sef_receive) for system
processes to automatically catch known system even messages and process them.
- SEF provides a default behavior for each type of system event, but allows
system processes to register callbacks to override the default behavior.
- Custom (local to the process) or predefined (provided by SEF) callback
implementations can be registered to SEF.
- SEF currently includes support for 2 types of system events:
1. SEF Ping. The event occurs every time RS sends a ping to figure out
whether a system process is still alive. The default callback implementation
provided by SEF is to notify RS back to let it know the process is alive
and kicking.
2. SEF Live update. The event occurs every time RS sends a prepare to update
message to let a system process know an update is available and to prepare
for it. The live update support is very basic for now. SEF only deals with
verifying if the prepare state can be supported by the process, dumping the
state for debugging purposes, and providing an event-driven programming
model to the process to react to state changes check-in when ready to update.
- SEF should be extended in the future to integrate support for more types of
system events. Ideally, all the cross-cutting concerns should be integrated into
SEF to avoid duplicating code and ease extensibility. Examples include:
* PM notify messages primarily used at shutdown.
* SYSTEM notify messages primarily used for signals.
* CLOCK notify messages used for system alarms.
* Debug messages. IS could still be in charge of fkey handling but would
forward the debug message to the target process (e.g. PM, if the user
requested debug information about PM). SEF would then catch the message and
do nothing unless the process has registered an appropriate callback to
deal with the event. This simplifies the programming model to print debug
information, avoids duplicating code, and reduces the effort to print
debug information.
SYSTEM PROCESSES CHANGES:
- Every system process registers SEF callbacks it needs to override the default
system behavior and calls sef_startup() right after being started.
- sef_startup() does almost nothing now, but will be extended in the future to
support callbacks of its own to let RS control and synchronize with every
system process at initialization time.
- Every system process calls sef_receive() now rather than receive() directly,
to let SEF handle predefined system events.
RS CHANGES:
- RS supports a basic single-component live update protocol now, as follows:
* When an update command is issued (via "service update *"), RS notifies the
target system process to prepare for a specific update state.
* If the process doesn't respond back in time, the update is aborted.
* When the process responds back, RS kills it and marks it for refreshing.
* The process is then automatically restarted as for a buggy process and can
start running again.
* Live update is currently prototyped as a controlled failure.
2009-12-21 15:12:21 +01:00
|
|
|
/* No live update support for now. */
|
|
|
|
|
|
|
|
/* Let SEF perform startup. */
|
|
|
|
sef_startup();
|
|
|
|
}
|
|
|
|
|
Initialization protocol for system services.
SYSLIB CHANGES:
- SEF framework now supports a new SEF Init request type from RS. 3 different
callbacks are available (init_fresh, init_lu, init_restart) to specify
initialization code when a service starts fresh, starts after a live update,
or restarts.
SYSTEM SERVICE CHANGES:
- Initialization code for system services is now enclosed in a callback SEF will
automatically call at init time. The return code of the callback will
tell RS whether the initialization completed successfully.
- Each init callback can access information passed by RS to initialize. As of
now, each system service has access to the public entries of RS's system process
table to gather all the information required to initialize. This design
eliminates many existing or potential races at boot time and provides a uniform
initialization interface to system services. The same interface will be reused
for the upcoming publish/subscribe model to handle dynamic
registration / deregistration of system services.
VM CHANGES:
- Uniform privilege management for all system services. Every service uses the
same call mask format. For boot services, VM copies the call mask from init
data. For dynamic services, VM still receives the call mask via rs_set_priv
call that will be soon replaced by the upcoming publish/subscribe model.
RS CHANGES:
- The system process table has been reorganized and split into private entries
and public entries. Only the latter ones are exposed to system services.
- VM call masks are now entirely configured in rs/table.c
- RS has now its own slot in the system process table. Only kernel tasks and
user processes not included in the boot image are now left out from the system
process table.
- RS implements the initialization protocol for system services.
- For services in the boot image, RS blocks till initialization is complete and
panics when failure is reported back. Services are initialized in their order of
appearance in the boot image priv table and RS blocks to implements synchronous
initialization for every system service having the flag SF_SYNCH_BOOT set.
- For services started dynamically, the initialization protocol is implemented
as though it were the first ping for the service. In this case, if the
system service fails to report back (or reports failure), RS brings the service
down rather than trying to restart it.
2010-01-08 02:20:42 +01:00
|
|
|
/*===========================================================================*
|
|
|
|
* sef_cb_init_fresh *
|
|
|
|
*===========================================================================*/
|
|
|
|
PRIVATE int sef_cb_init_fresh(int type, sef_init_info_t *info)
|
|
|
|
{
|
|
|
|
/* Initialize the rtl8169 driver. */
|
|
|
|
u32_t inet_proc_nr;
|
|
|
|
int r;
|
|
|
|
re_t *rep;
|
|
|
|
long v;
|
|
|
|
|
|
|
|
system_hz = sys_hz();
|
|
|
|
|
|
|
|
(progname = strrchr(env_argv[0], '/')) ? progname++
|
|
|
|
: (progname = env_argv[0]);
|
|
|
|
|
|
|
|
v = 0;
|
|
|
|
(void) env_parse("ETH_IGN_PROTO", "x", 0, &v, 0x0000L, 0xFFFFL);
|
|
|
|
eth_ign_proto = htons((u16_t) v);
|
|
|
|
|
|
|
|
/* Claim buffer memory now under Minix, before MM takes it all. */
|
|
|
|
for (rep = &re_table[0]; rep < re_table + RE_PORT_NR; rep++)
|
|
|
|
rl_init_buf(rep);
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Try to notify INET that we are present (again). If INET cannot
|
|
|
|
* be found, assume this is the first time we started and INET is
|
|
|
|
* not yet alive.
|
|
|
|
*/
|
|
|
|
#if 0
|
|
|
|
r = ds_retrieve_u32("inet", &inet_proc_nr);
|
|
|
|
if (r == OK)
|
|
|
|
notify(inet_proc_nr);
|
|
|
|
else if (r != ESRCH)
|
|
|
|
printf("rtl8169: ds_retrieve_u32 failed for 'inet': %d\n", r);
|
|
|
|
#endif
|
|
|
|
|
|
|
|
return(OK);
|
|
|
|
}
|
|
|
|
|
2009-12-02 16:59:42 +01:00
|
|
|
static void mdio_write(U16_t port, int regaddr, int value)
|
|
|
|
{
|
|
|
|
int i;
|
|
|
|
|
|
|
|
rl_outl(port, RL_PHYAR, 0x80000000 | (regaddr & 0x1F) << 16 | (value & 0xFFFF));
|
|
|
|
|
|
|
|
for (i = 20; i > 0; i--) {
|
|
|
|
/*
|
|
|
|
* Check if the RTL8169 has completed writing to the specified
|
|
|
|
* MII register
|
|
|
|
*/
|
|
|
|
if (!(rl_inl(port, RL_PHYAR) & 0x80000000))
|
|
|
|
break;
|
|
|
|
else
|
|
|
|
micro_delay(50);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
static int mdio_read(U16_t port, int regaddr)
|
|
|
|
{
|
|
|
|
int i, value = -1;
|
|
|
|
|
|
|
|
rl_outl(port, RL_PHYAR, (regaddr & 0x1F) << 16);
|
|
|
|
|
|
|
|
for (i = 20; i > 0; i--) {
|
|
|
|
/*
|
|
|
|
* Check if the RTL8169 has completed retrieving data from
|
|
|
|
* the specified MII register
|
|
|
|
*/
|
|
|
|
if (rl_inl(port, RL_PHYAR) & 0x80000000) {
|
|
|
|
value = (int)(rl_inl(port, RL_PHYAR) & 0xFFFF);
|
|
|
|
break;
|
|
|
|
} else
|
|
|
|
micro_delay(50);
|
|
|
|
}
|
|
|
|
return value;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*===========================================================================*
|
|
|
|
* check_int_events *
|
|
|
|
*===========================================================================*/
|
|
|
|
static void check_int_events(void)
|
|
|
|
{
|
|
|
|
int i;
|
|
|
|
re_t *rep;
|
|
|
|
|
|
|
|
for (i = 0, rep = &re_table[0]; i < RE_PORT_NR; i++, rep++) {
|
|
|
|
if (rep->re_mode != REM_ENABLED)
|
|
|
|
continue;
|
|
|
|
if (!rep->re_got_int)
|
|
|
|
continue;
|
|
|
|
rep->re_got_int = 0;
|
|
|
|
assert(rep->re_flags & REF_ENABLED);
|
|
|
|
rl_check_ints(rep);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
/*===========================================================================*
|
|
|
|
* rtl8169_stop *
|
|
|
|
*===========================================================================*/
|
|
|
|
static void rtl8169_stop()
|
|
|
|
{
|
|
|
|
int i;
|
|
|
|
re_t *rep;
|
|
|
|
|
|
|
|
for (i = 0, rep = &re_table[0]; i < RE_PORT_NR; i++, rep++) {
|
|
|
|
if (rep->re_mode != REM_ENABLED)
|
|
|
|
continue;
|
|
|
|
rl_outb(rep->re_base_port, RL_CR, 0);
|
|
|
|
}
|
|
|
|
|
|
|
|
exit(0);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void rtl8169_update_stat(re_t *rep)
|
|
|
|
{
|
|
|
|
port_t port;
|
|
|
|
int i;
|
|
|
|
|
|
|
|
port = rep->re_base_port;
|
|
|
|
|
|
|
|
/* Fetch Missed Packets */
|
|
|
|
rep->re_stat.ets_missedP += rl_inw(port, RL_MPC);
|
|
|
|
rl_outw(port, RL_MPC, 0x00);
|
|
|
|
|
|
|
|
/* Dump Tally Counter Command */
|
|
|
|
rl_outl(port, RL_DTCCR_HI, 0); /* 64 bits */
|
|
|
|
rl_outl(port, RL_DTCCR_LO, rep->dtcc_buf | RL_DTCCR_CMD);
|
|
|
|
for (i = 0; i < 1000; i++) {
|
|
|
|
if (!(rl_inl(port, RL_DTCCR_LO) & RL_DTCCR_CMD))
|
|
|
|
break;
|
|
|
|
micro_delay(10);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Update counters */
|
|
|
|
rep->re_stat.ets_frameAll = rep->v_dtcc_buf->FAE;
|
|
|
|
rep->re_stat.ets_transDef = rep->v_dtcc_buf->TxUndrn;
|
|
|
|
rep->re_stat.ets_transAb = rep->v_dtcc_buf->TxAbt;
|
|
|
|
rep->re_stat.ets_collision =
|
|
|
|
rep->v_dtcc_buf->Tx1Col + rep->v_dtcc_buf->TxMCol;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*===========================================================================*
|
|
|
|
* rtl8169_dump *
|
|
|
|
*===========================================================================*/
|
|
|
|
static void rtl8169_dump(void)
|
|
|
|
{
|
|
|
|
re_dtcc *dtcc;
|
|
|
|
re_t *rep;
|
|
|
|
int i;
|
|
|
|
|
|
|
|
printf("\n");
|
|
|
|
for (i = 0, rep = &re_table[0]; i < RE_PORT_NR; i++, rep++) {
|
|
|
|
if (rep->re_mode == REM_DISABLED)
|
|
|
|
printf("Realtek RTL 8169 port %d is disabled\n", i);
|
|
|
|
|
|
|
|
if (rep->re_mode != REM_ENABLED)
|
|
|
|
continue;
|
|
|
|
|
|
|
|
rtl8169_update_stat(rep);
|
|
|
|
|
|
|
|
printf("Realtek RTL 8169 statistics of port %d:\n", i);
|
|
|
|
|
|
|
|
printf("recvErr :%8ld\t", rep->re_stat.ets_recvErr);
|
|
|
|
printf("sendErr :%8ld\t", rep->re_stat.ets_sendErr);
|
|
|
|
printf("OVW :%8ld\n", rep->re_stat.ets_OVW);
|
|
|
|
|
|
|
|
printf("CRCerr :%8ld\t", rep->re_stat.ets_CRCerr);
|
|
|
|
printf("frameAll :%8ld\t", rep->re_stat.ets_frameAll);
|
|
|
|
printf("missedP :%8ld\n", rep->re_stat.ets_missedP);
|
|
|
|
|
|
|
|
printf("packetR :%8ld\t", rep->re_stat.ets_packetR);
|
|
|
|
printf("packetT :%8ld\t", rep->re_stat.ets_packetT);
|
|
|
|
printf("transDef :%8ld\n", rep->re_stat.ets_transDef);
|
|
|
|
|
|
|
|
printf("collision :%8ld\t", rep->re_stat.ets_collision);
|
|
|
|
printf("transAb :%8ld\t", rep->re_stat.ets_transAb);
|
|
|
|
printf("carrSense :%8ld\n", rep->re_stat.ets_carrSense);
|
|
|
|
|
|
|
|
printf("fifoUnder :%8ld\t", rep->re_stat.ets_fifoUnder);
|
|
|
|
printf("fifoOver :%8ld\t", rep->re_stat.ets_fifoOver);
|
|
|
|
printf("OWC :%8ld\n", rep->re_stat.ets_OWC);
|
|
|
|
printf("interrupts :%8lu\n", rep->interrupts);
|
|
|
|
|
|
|
|
printf("\nRealtek RTL 8169 Tally Counters:\n");
|
|
|
|
|
|
|
|
dtcc = rep->v_dtcc_buf;
|
|
|
|
|
|
|
|
if (dtcc->TxOk_high)
|
|
|
|
printf("TxOk :%8ld%08ld\t", dtcc->TxOk_high, dtcc->TxOk_low);
|
|
|
|
else
|
|
|
|
printf("TxOk :%16lu\t", dtcc->TxOk_low);
|
|
|
|
|
|
|
|
if (dtcc->RxOk_high)
|
|
|
|
printf("RxOk :%8ld%08ld\n", dtcc->RxOk_high, dtcc->RxOk_low);
|
|
|
|
else
|
|
|
|
printf("RxOk :%16lu\n", dtcc->RxOk_low);
|
|
|
|
|
|
|
|
if (dtcc->TxEr_high)
|
|
|
|
printf("TxEr :%8ld%08ld\t", dtcc->TxEr_high, dtcc->TxEr_low);
|
|
|
|
else
|
|
|
|
printf("TxEr :%16ld\t", dtcc->TxEr_low);
|
|
|
|
|
|
|
|
printf("RxEr :%16ld\n", dtcc->RxEr);
|
|
|
|
|
|
|
|
printf("Tx1Col :%16ld\t", dtcc->Tx1Col);
|
|
|
|
printf("TxMCol :%16ld\n", dtcc->TxMCol);
|
|
|
|
|
|
|
|
if (dtcc->RxOkPhy_high)
|
|
|
|
printf("RxOkPhy :%8ld%08ld\t", dtcc->RxOkPhy_high, dtcc->RxOkPhy_low);
|
|
|
|
else
|
|
|
|
printf("RxOkPhy :%16ld\t", dtcc->RxOkPhy_low);
|
|
|
|
|
|
|
|
if (dtcc->RxOkBrd_high)
|
|
|
|
printf("RxOkBrd :%8ld%08ld\n", dtcc->RxOkBrd_high, dtcc->RxOkBrd_low);
|
|
|
|
else
|
|
|
|
printf("RxOkBrd :%16ld\n", dtcc->RxOkBrd_low);
|
|
|
|
|
|
|
|
printf("RxOkMul :%16ld\t", dtcc->RxOkMul);
|
|
|
|
printf("MissPkt :%16d\n", dtcc->MissPkt);
|
|
|
|
|
|
|
|
printf("\nRealtek RTL 8169 Miscellaneous Info:\n");
|
|
|
|
|
|
|
|
printf("re_flags : 0x%08x\n", rep->re_flags);
|
|
|
|
printf("tx_head :%8d busy %d\t",
|
|
|
|
rep->re_tx_head, rep->re_tx[rep->re_tx_head].ret_busy);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
/*===========================================================================*
|
|
|
|
* do_init *
|
|
|
|
*===========================================================================*/
|
|
|
|
static void rl_init(mp)
|
|
|
|
message *mp;
|
|
|
|
{
|
|
|
|
static int first_time = 1;
|
|
|
|
|
|
|
|
int port;
|
|
|
|
re_t *rep;
|
|
|
|
message reply_mess;
|
|
|
|
|
|
|
|
if (first_time) {
|
|
|
|
first_time = 0;
|
|
|
|
rl_pci_conf(); /* Configure PCI devices. */
|
|
|
|
|
|
|
|
tmra_inittimer(&rl_watchdog);
|
|
|
|
/* Use a synchronous alarm instead of a watchdog timer. */
|
|
|
|
sys_setalarm(system_hz, 0);
|
|
|
|
}
|
|
|
|
|
|
|
|
port = mp->DL_PORT;
|
|
|
|
if (port < 0 || port >= RE_PORT_NR) {
|
|
|
|
reply_mess.m_type = DL_CONF_REPLY;
|
|
|
|
reply_mess.m3_i1 = ENXIO;
|
|
|
|
mess_reply(mp, &reply_mess);
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
rep = &re_table[port];
|
|
|
|
if (rep->re_mode == REM_DISABLED) {
|
|
|
|
/* This is the default, try to (re)locate the device. */
|
|
|
|
rl_conf_hw(rep);
|
|
|
|
if (rep->re_mode == REM_DISABLED) {
|
|
|
|
/* Probe failed, or the device is configured off. */
|
|
|
|
reply_mess.m_type = DL_CONF_REPLY;
|
|
|
|
reply_mess.m3_i1 = ENXIO;
|
|
|
|
mess_reply(mp, &reply_mess);
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
if (rep->re_mode == REM_ENABLED)
|
|
|
|
rl_init_hw(rep);
|
|
|
|
}
|
|
|
|
|
|
|
|
assert(rep->re_mode == REM_ENABLED);
|
|
|
|
assert(rep->re_flags & REF_ENABLED);
|
|
|
|
|
|
|
|
rep->re_flags &= ~(REF_PROMISC | REF_MULTI | REF_BROAD);
|
|
|
|
|
|
|
|
if (mp->DL_MODE & DL_PROMISC_REQ)
|
|
|
|
rep->re_flags |= REF_PROMISC;
|
|
|
|
if (mp->DL_MODE & DL_MULTI_REQ)
|
|
|
|
rep->re_flags |= REF_MULTI;
|
|
|
|
if (mp->DL_MODE & DL_BROAD_REQ)
|
|
|
|
rep->re_flags |= REF_BROAD;
|
|
|
|
|
|
|
|
rep->re_client = mp->m_source;
|
|
|
|
rl_rec_mode(rep);
|
|
|
|
|
|
|
|
reply_mess.m_type = DL_CONF_REPLY;
|
|
|
|
reply_mess.m3_i1 = mp->DL_PORT;
|
|
|
|
reply_mess.m3_i2 = RE_PORT_NR;
|
|
|
|
*(ether_addr_t *) reply_mess.m3_ca1 = rep->re_address;
|
|
|
|
|
|
|
|
mess_reply(mp, &reply_mess);
|
|
|
|
}
|
|
|
|
|
|
|
|
/*===========================================================================*
|
|
|
|
* rl_pci_conf *
|
|
|
|
*===========================================================================*/
|
|
|
|
static void rl_pci_conf()
|
|
|
|
{
|
|
|
|
int i, h;
|
|
|
|
re_t *rep;
|
|
|
|
static char envvar[] = RL_ENVVAR "#";
|
|
|
|
static char envfmt[] = "*:d.d.d";
|
|
|
|
static char val[128];
|
|
|
|
long v;
|
|
|
|
|
|
|
|
for (i = 0, rep = re_table; i < RE_PORT_NR; i++, rep++) {
|
|
|
|
strcpy(rep->re_name, "rtl8169#0");
|
|
|
|
rep->re_name[8] += i;
|
|
|
|
rep->re_seen = FALSE;
|
|
|
|
envvar[sizeof(RL_ENVVAR)-1] = '0' + i;
|
|
|
|
if (0 == env_get_param(envvar, val, sizeof(val)) &&
|
|
|
|
!env_prefix(envvar, "pci"))
|
|
|
|
{
|
|
|
|
env_panic(envvar);
|
|
|
|
}
|
|
|
|
v = 0;
|
|
|
|
(void) env_parse(envvar, envfmt, 1, &v, 0, 255);
|
|
|
|
rep->re_pcibus = v;
|
|
|
|
v = 0;
|
|
|
|
(void) env_parse(envvar, envfmt, 2, &v, 0, 255);
|
|
|
|
rep->re_pcidev = v;
|
|
|
|
v = 0;
|
|
|
|
(void) env_parse(envvar, envfmt, 3, &v, 0, 255);
|
|
|
|
rep->re_pcifunc = v;
|
|
|
|
}
|
|
|
|
|
|
|
|
pci_init();
|
|
|
|
|
|
|
|
for (h = 1; h >= 0; h--) {
|
|
|
|
for (i = 0, rep = re_table; i < RE_PORT_NR; i++, rep++) {
|
|
|
|
if (((rep->re_pcibus | rep->re_pcidev |
|
|
|
|
rep->re_pcifunc) != 0) != h) {
|
|
|
|
continue;
|
|
|
|
}
|
|
|
|
if (rl_probe(rep))
|
|
|
|
rep->re_seen = TRUE;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
/*===========================================================================*
|
|
|
|
* rl_probe *
|
|
|
|
*===========================================================================*/
|
|
|
|
static int rl_probe(rep)
|
|
|
|
re_t *rep;
|
|
|
|
{
|
|
|
|
int i, r, devind, just_one;
|
|
|
|
u16_t vid, did;
|
|
|
|
u32_t bar;
|
|
|
|
u8_t ilr;
|
|
|
|
char *dname;
|
|
|
|
|
|
|
|
if ((rep->re_pcibus | rep->re_pcidev | rep->re_pcifunc) != 0) {
|
|
|
|
/* Look for specific PCI device */
|
|
|
|
r = pci_find_dev(rep->re_pcibus, rep->re_pcidev,
|
|
|
|
rep->re_pcifunc, &devind);
|
|
|
|
if (r == 0) {
|
|
|
|
printf("%s: no PCI found at %d.%d.%d\n",
|
|
|
|
rep->re_name, rep->re_pcibus,
|
|
|
|
rep->re_pcidev, rep->re_pcifunc);
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
pci_ids(devind, &vid, &did);
|
|
|
|
just_one = TRUE;
|
|
|
|
} else {
|
|
|
|
r = pci_first_dev(&devind, &vid, &did);
|
|
|
|
if (r == 0)
|
|
|
|
return 0;
|
|
|
|
just_one = FALSE;
|
|
|
|
}
|
|
|
|
|
|
|
|
for (;;) {
|
|
|
|
for (i = 0; pcitab[i].vid != 0; i++) {
|
|
|
|
if (pcitab[i].vid != vid)
|
|
|
|
continue;
|
|
|
|
if (pcitab[i].did != did)
|
|
|
|
continue;
|
|
|
|
if (pcitab[i].checkclass) {
|
|
|
|
panic("rtl_probe",
|
|
|
|
"class check not implemented", NO_NUM);
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
if (pcitab[i].vid != 0)
|
|
|
|
break;
|
|
|
|
|
|
|
|
if (just_one) {
|
|
|
|
printf("%s: wrong PCI device (%04x/%04x) found at %d.%d.%d\n",
|
|
|
|
rep->re_name, vid, did,
|
|
|
|
rep->re_pcibus,
|
|
|
|
rep->re_pcidev, rep->re_pcifunc);
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
r = pci_next_dev(&devind, &vid, &did);
|
|
|
|
if (!r)
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
dname = pci_dev_name(vid, did);
|
|
|
|
if (!dname)
|
|
|
|
dname = "unknown device";
|
|
|
|
printf("%s: ", rep->re_name);
|
|
|
|
printf("%s (%x/%x) at %s\n", dname, vid, did, pci_slot_name(devind));
|
|
|
|
|
|
|
|
pci_reserve(devind);
|
|
|
|
bar = pci_attr_r32(devind, PCI_BAR) & 0xffffffe0;
|
|
|
|
if (bar < 0x400) {
|
|
|
|
panic("rtl_probe",
|
|
|
|
"base address is not properly configured", NO_NUM);
|
|
|
|
}
|
|
|
|
rep->re_base_port = bar;
|
|
|
|
|
|
|
|
ilr = pci_attr_r8(devind, PCI_ILR);
|
|
|
|
rep->re_irq = ilr;
|
|
|
|
if (debug) {
|
|
|
|
printf("%s: using I/O address 0x%lx, IRQ %d\n",
|
|
|
|
rep->re_name, (unsigned long)bar, ilr);
|
|
|
|
}
|
|
|
|
|
|
|
|
return TRUE;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*===========================================================================*
|
|
|
|
* rl_conf_hw *
|
|
|
|
*===========================================================================*/
|
|
|
|
static void rl_conf_hw(rep)
|
|
|
|
re_t *rep;
|
|
|
|
{
|
|
|
|
static eth_stat_t empty_stat = {0, 0, 0, 0, 0, 0 /* ,... */ };
|
|
|
|
|
|
|
|
rep->re_mode = REM_DISABLED; /* Superfluous */
|
|
|
|
|
|
|
|
if (rep->re_seen)
|
|
|
|
rep->re_mode = REM_ENABLED; /* PCI device is present */
|
|
|
|
if (rep->re_mode != REM_ENABLED)
|
|
|
|
return;
|
|
|
|
|
|
|
|
rep->re_flags = REF_EMPTY;
|
|
|
|
rep->re_link_up = 0;
|
|
|
|
rep->re_got_int = 0;
|
|
|
|
rep->re_send_int = 0;
|
|
|
|
rep->re_report_link = 0;
|
|
|
|
rep->re_need_reset = 0;
|
|
|
|
rep->re_tx_alive = 0;
|
|
|
|
rep->re_rx_head = 0;
|
|
|
|
rep->re_read_s = 0;
|
|
|
|
rep->re_tx_head = 0;
|
|
|
|
rep->re_stat = empty_stat;
|
|
|
|
rep->dtcc_counter = 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*===========================================================================*
|
|
|
|
* rl_init_buf *
|
|
|
|
*===========================================================================*/
|
|
|
|
static void rl_init_buf(rep)
|
|
|
|
re_t *rep;
|
|
|
|
{
|
|
|
|
size_t rx_bufsize, tx_bufsize, rx_descsize, tx_descsize, tot_bufsize;
|
|
|
|
struct re_desc *desc;
|
|
|
|
phys_bytes buf;
|
|
|
|
char *mallocbuf;
|
|
|
|
int d;
|
|
|
|
|
|
|
|
assert(!rep->setup);
|
|
|
|
|
|
|
|
/* Allocate receive and transmit descriptors */
|
|
|
|
rx_descsize = (N_RX_DESC * sizeof(struct re_desc));
|
|
|
|
tx_descsize = (N_TX_DESC * sizeof(struct re_desc));
|
|
|
|
|
|
|
|
/* Allocate receive and transmit buffers */
|
|
|
|
tx_bufsize = ETH_MAX_PACK_SIZE_TAGGED;
|
|
|
|
if (tx_bufsize % 4)
|
|
|
|
tx_bufsize += 4-(tx_bufsize % 4); /* Align */
|
|
|
|
rx_bufsize = RX_BUFSIZE;
|
|
|
|
tot_bufsize = rx_descsize + tx_descsize;
|
|
|
|
tot_bufsize += (N_TX_DESC * tx_bufsize) + (N_RX_DESC * rx_bufsize);
|
|
|
|
tot_bufsize += sizeof(struct re_dtcc);
|
|
|
|
|
|
|
|
if (tot_bufsize % 4096)
|
|
|
|
tot_bufsize += 4096 - (tot_bufsize % 4096);
|
|
|
|
|
|
|
|
if (!(mallocbuf = alloc_contig(tot_bufsize, AC_ALIGN64K, &buf)))
|
|
|
|
panic("RTL8169", "Couldn't allocate kernel buffer", NO_NUM);
|
|
|
|
|
|
|
|
/* Rx Descriptor */
|
|
|
|
rep->re_rx_desc = (re_desc *)mallocbuf;
|
|
|
|
rep->p_rx_desc = buf;
|
|
|
|
memset(mallocbuf, 0x00, rx_descsize);
|
|
|
|
buf += rx_descsize;
|
|
|
|
mallocbuf += rx_descsize;
|
|
|
|
|
|
|
|
/* Tx Descriptor */
|
|
|
|
rep->re_tx_desc = (re_desc *)mallocbuf;
|
|
|
|
rep->p_tx_desc = buf;
|
|
|
|
memset(mallocbuf, 0x00, tx_descsize);
|
|
|
|
buf += tx_descsize;
|
|
|
|
mallocbuf += tx_descsize;
|
|
|
|
|
|
|
|
desc = rep->re_rx_desc;
|
|
|
|
for (d = 0; d < N_RX_DESC; d++) {
|
|
|
|
/* Setting Rx buffer */
|
|
|
|
rep->re_rx[d].ret_buf = buf;
|
|
|
|
rep->re_rx[d].v_ret_buf = mallocbuf;
|
|
|
|
buf += rx_bufsize;
|
|
|
|
mallocbuf += rx_bufsize;
|
|
|
|
|
|
|
|
/* Setting Rx descriptor */
|
|
|
|
if (d == (N_RX_DESC - 1)) /* Last descriptor? if so, set the EOR bit */
|
|
|
|
desc->status = DESC_EOR | DESC_OWN | (RX_BUFSIZE & DESC_RX_LENMASK);
|
|
|
|
else
|
|
|
|
desc->status = DESC_OWN | (RX_BUFSIZE & DESC_RX_LENMASK);
|
|
|
|
|
|
|
|
desc->addr_low = rep->re_rx[d].ret_buf;
|
|
|
|
desc++;
|
|
|
|
}
|
|
|
|
desc = rep->re_tx_desc;
|
|
|
|
for (d = 0; d < N_TX_DESC; d++) {
|
|
|
|
rep->re_tx[d].ret_busy = FALSE;
|
|
|
|
rep->re_tx[d].ret_buf = buf;
|
|
|
|
rep->re_tx[d].v_ret_buf = mallocbuf;
|
|
|
|
buf += tx_bufsize;
|
|
|
|
mallocbuf += tx_bufsize;
|
|
|
|
|
|
|
|
/* Setting Tx descriptor */
|
|
|
|
desc->addr_low = rep->re_tx[d].ret_buf;
|
|
|
|
desc++;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Dump Tally Counter buffer */
|
|
|
|
rep->dtcc_buf = buf;
|
|
|
|
rep->v_dtcc_buf = (re_dtcc *)mallocbuf;
|
|
|
|
|
|
|
|
rep->setup = 1;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*===========================================================================*
|
|
|
|
* rl_init_hw *
|
|
|
|
*===========================================================================*/
|
|
|
|
static void rl_init_hw(rep)
|
|
|
|
re_t *rep;
|
|
|
|
{
|
|
|
|
int s, i;
|
|
|
|
|
|
|
|
rep->re_flags = REF_EMPTY;
|
|
|
|
rep->re_flags |= REF_ENABLED;
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Set the interrupt handler. The policy is to only send HARD_INT
|
|
|
|
* notifications. Don't reenable interrupts automatically. The id
|
|
|
|
* that is passed back is the interrupt line number.
|
|
|
|
*/
|
|
|
|
rep->re_hook_id = rep->re_irq;
|
|
|
|
if ((s = sys_irqsetpolicy(rep->re_irq, 0, &rep->re_hook_id)) != OK)
|
|
|
|
printf("RTL8169: error, couldn't set IRQ policy: %d\n", s);
|
|
|
|
|
|
|
|
rl_reset_hw(rep);
|
|
|
|
|
|
|
|
if ((s = sys_irqenable(&rep->re_hook_id)) != OK)
|
|
|
|
printf("RTL8169: error, couldn't enable interrupts: %d\n", s);
|
|
|
|
|
|
|
|
printf("%s: model: %s mac: 0x%08lx\n",
|
|
|
|
rep->re_name, rep->re_model, rep->re_mac);
|
|
|
|
|
|
|
|
rl_confaddr(rep);
|
|
|
|
if (debug) {
|
|
|
|
printf("%s: Ethernet address ", rep->re_name);
|
|
|
|
for (i = 0; i < 6; i++) {
|
|
|
|
printf("%x%c", rep->re_address.ea_addr[i],
|
|
|
|
i < 5 ? ':' : '\n');
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
static void rtl8169s_phy_config(port_t port)
|
|
|
|
{
|
|
|
|
mdio_write(port, 0x1f, 0x0001);
|
|
|
|
mdio_write(port, 0x06, 0x006e);
|
|
|
|
mdio_write(port, 0x08, 0x0708);
|
|
|
|
mdio_write(port, 0x15, 0x4000);
|
|
|
|
mdio_write(port, 0x18, 0x65c7);
|
|
|
|
|
|
|
|
mdio_write(port, 0x1f, 0x0001);
|
|
|
|
mdio_write(port, 0x03, 0x00a1);
|
|
|
|
mdio_write(port, 0x02, 0x0008);
|
|
|
|
mdio_write(port, 0x01, 0x0120);
|
|
|
|
mdio_write(port, 0x00, 0x1000);
|
|
|
|
mdio_write(port, 0x04, 0x0800);
|
|
|
|
mdio_write(port, 0x04, 0x0000);
|
|
|
|
|
|
|
|
mdio_write(port, 0x03, 0xff41);
|
|
|
|
mdio_write(port, 0x02, 0xdf60);
|
|
|
|
mdio_write(port, 0x01, 0x0140);
|
|
|
|
mdio_write(port, 0x00, 0x0077);
|
|
|
|
mdio_write(port, 0x04, 0x7800);
|
|
|
|
mdio_write(port, 0x04, 0x7000);
|
|
|
|
|
|
|
|
mdio_write(port, 0x03, 0x802f);
|
|
|
|
mdio_write(port, 0x02, 0x4f02);
|
|
|
|
mdio_write(port, 0x01, 0x0409);
|
|
|
|
mdio_write(port, 0x00, 0xf0f9);
|
|
|
|
mdio_write(port, 0x04, 0x9800);
|
|
|
|
mdio_write(port, 0x04, 0x9000);
|
|
|
|
|
|
|
|
mdio_write(port, 0x03, 0xdf01);
|
|
|
|
mdio_write(port, 0x02, 0xdf20);
|
|
|
|
mdio_write(port, 0x01, 0xff95);
|
|
|
|
mdio_write(port, 0x00, 0xba00);
|
|
|
|
mdio_write(port, 0x04, 0xa800);
|
|
|
|
mdio_write(port, 0x04, 0xa000);
|
|
|
|
|
|
|
|
mdio_write(port, 0x03, 0xff41);
|
|
|
|
mdio_write(port, 0x02, 0xdf20);
|
|
|
|
mdio_write(port, 0x01, 0x0140);
|
|
|
|
mdio_write(port, 0x00, 0x00bb);
|
|
|
|
mdio_write(port, 0x04, 0xb800);
|
|
|
|
mdio_write(port, 0x04, 0xb000);
|
|
|
|
|
|
|
|
mdio_write(port, 0x03, 0xdf41);
|
|
|
|
mdio_write(port, 0x02, 0xdc60);
|
|
|
|
mdio_write(port, 0x01, 0x6340);
|
|
|
|
mdio_write(port, 0x00, 0x007d);
|
|
|
|
mdio_write(port, 0x04, 0xd800);
|
|
|
|
mdio_write(port, 0x04, 0xd000);
|
|
|
|
|
|
|
|
mdio_write(port, 0x03, 0xdf01);
|
|
|
|
mdio_write(port, 0x02, 0xdf20);
|
|
|
|
mdio_write(port, 0x01, 0x100a);
|
|
|
|
mdio_write(port, 0x00, 0xa0ff);
|
|
|
|
mdio_write(port, 0x04, 0xf800);
|
|
|
|
mdio_write(port, 0x04, 0xf000);
|
|
|
|
|
|
|
|
mdio_write(port, 0x1f, 0x0000);
|
|
|
|
mdio_write(port, 0x0b, 0x0000);
|
|
|
|
mdio_write(port, 0x00, 0x9200);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void rtl8169scd_phy_config(port_t port)
|
|
|
|
{
|
|
|
|
mdio_write(port, 0x1f, 0x0001);
|
|
|
|
mdio_write(port, 0x04, 0x0000);
|
|
|
|
mdio_write(port, 0x03, 0x00a1);
|
|
|
|
mdio_write(port, 0x02, 0x0008);
|
|
|
|
mdio_write(port, 0x01, 0x0120);
|
|
|
|
mdio_write(port, 0x00, 0x1000);
|
|
|
|
mdio_write(port, 0x04, 0x0800);
|
|
|
|
mdio_write(port, 0x04, 0x9000);
|
|
|
|
mdio_write(port, 0x03, 0x802f);
|
|
|
|
mdio_write(port, 0x02, 0x4f02);
|
|
|
|
mdio_write(port, 0x01, 0x0409);
|
|
|
|
mdio_write(port, 0x00, 0xf099);
|
|
|
|
mdio_write(port, 0x04, 0x9800);
|
|
|
|
mdio_write(port, 0x04, 0xa000);
|
|
|
|
mdio_write(port, 0x03, 0xdf01);
|
|
|
|
mdio_write(port, 0x02, 0xdf20);
|
|
|
|
mdio_write(port, 0x01, 0xff95);
|
|
|
|
mdio_write(port, 0x00, 0xba00);
|
|
|
|
mdio_write(port, 0x04, 0xa800);
|
|
|
|
mdio_write(port, 0x04, 0xf000);
|
|
|
|
mdio_write(port, 0x03, 0xdf01);
|
|
|
|
mdio_write(port, 0x02, 0xdf20);
|
|
|
|
mdio_write(port, 0x01, 0x101a);
|
|
|
|
mdio_write(port, 0x00, 0xa0ff);
|
|
|
|
mdio_write(port, 0x04, 0xf800);
|
|
|
|
mdio_write(port, 0x04, 0x0000);
|
|
|
|
mdio_write(port, 0x1f, 0x0000);
|
|
|
|
|
|
|
|
mdio_write(port, 0x1f, 0x0001);
|
|
|
|
mdio_write(port, 0x10, 0xf41b);
|
|
|
|
mdio_write(port, 0x14, 0xfb54);
|
|
|
|
mdio_write(port, 0x18, 0xf5c7);
|
|
|
|
mdio_write(port, 0x1f, 0x0000);
|
|
|
|
|
|
|
|
mdio_write(port, 0x1f, 0x0001);
|
|
|
|
mdio_write(port, 0x17, 0x0cc0);
|
|
|
|
mdio_write(port, 0x1f, 0x0000);
|
|
|
|
}
|
|
|
|
|
|
|
|
/*===========================================================================*
|
|
|
|
* rl_reset_hw *
|
|
|
|
*===========================================================================*/
|
|
|
|
static void rl_reset_hw(rep)
|
|
|
|
re_t *rep;
|
|
|
|
{
|
|
|
|
port_t port;
|
|
|
|
u32_t t;
|
|
|
|
int i;
|
|
|
|
clock_t t0, t1;
|
|
|
|
|
|
|
|
port = rep->re_base_port;
|
|
|
|
|
|
|
|
rl_outw(port, RL_IMR, 0x0000);
|
|
|
|
|
|
|
|
/* Reset the device */
|
|
|
|
printf("rl_reset_hw: (before reset) port = 0x%x, RL_CR = 0x%x\n",
|
|
|
|
port, rl_inb(port, RL_CR));
|
|
|
|
rl_outb(port, RL_CR, RL_CR_RST);
|
|
|
|
getuptime(&t0);
|
|
|
|
do {
|
|
|
|
if (!(rl_inb(port, RL_CR) & RL_CR_RST))
|
|
|
|
break;
|
|
|
|
} while (getuptime(&t1) == OK && (t1 - t0) < system_hz);
|
|
|
|
printf("rl_reset_hw: (after reset) port = 0x%x, RL_CR = 0x%x\n",
|
|
|
|
port, rl_inb(port, RL_CR));
|
|
|
|
if (rl_inb(port, RL_CR) & RL_CR_RST)
|
|
|
|
printf("rtl8169: reset failed to complete");
|
|
|
|
rl_outw(port, RL_ISR, 0xFFFF);
|
|
|
|
|
|
|
|
/* Get Model and MAC info */
|
|
|
|
t = rl_inl(port, RL_TCR);
|
|
|
|
rep->re_mac = (t & (RL_TCR_HWVER_AM | RL_TCR_HWVER_BM));
|
|
|
|
switch (rep->re_mac) {
|
|
|
|
case RL_TCR_HWVER_RTL8169:
|
|
|
|
rep->re_model = "RTL8169";
|
|
|
|
|
|
|
|
printf("Set MAC Reg C+CR Offset 0x82h = 0x01h\n");
|
|
|
|
rl_outw(port, 0x82, 0x01);
|
|
|
|
break;
|
|
|
|
case RL_TCR_HWVER_RTL8169S:
|
|
|
|
rep->re_model = "RTL8169S";
|
|
|
|
|
|
|
|
rtl8169s_phy_config(port);
|
|
|
|
|
|
|
|
printf("Set MAC Reg C+CR Offset 0x82h = 0x01h\n");
|
|
|
|
rl_outw(port, 0x82, 0x01);
|
|
|
|
printf("Set PHY Reg 0x0bh = 0x00h\n");
|
|
|
|
mdio_write(port, 0x0b, 0x0000); /* w 0x0b 15 0 0 */
|
|
|
|
break;
|
|
|
|
case RL_TCR_HWVER_RTL8110S:
|
|
|
|
rep->re_model = "RTL8110S";
|
|
|
|
|
|
|
|
rtl8169s_phy_config(port);
|
|
|
|
|
|
|
|
printf("Set MAC Reg C+CR Offset 0x82h = 0x01h\n");
|
|
|
|
rl_outw(port, 0x82, 0x01);
|
|
|
|
break;
|
|
|
|
case RL_TCR_HWVER_RTL8169SB:
|
|
|
|
rep->re_model = "RTL8169SB";
|
|
|
|
|
|
|
|
mdio_write(port, 0x1f, 0x02);
|
|
|
|
mdio_write(port, 0x01, 0x90d0);
|
|
|
|
mdio_write(port, 0x1f, 0x00);
|
|
|
|
|
|
|
|
printf("Set MAC Reg C+CR Offset 0x82h = 0x01h\n");
|
|
|
|
rl_outw(port, 0x82, 0x01);
|
|
|
|
break;
|
|
|
|
case RL_TCR_HWVER_RTL8110SCd:
|
|
|
|
rep->re_model = "RTL8110SCd";
|
|
|
|
|
|
|
|
rtl8169scd_phy_config(port);
|
|
|
|
|
|
|
|
printf("Set MAC Reg C+CR Offset 0x82h = 0x01h\n");
|
|
|
|
rl_outw(port, 0x82, 0x01);
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
rep->re_model = "Unknown";
|
|
|
|
rep->re_mac = t;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
mdio_write(port, MII_CTRL, MII_CTRL_RST);
|
|
|
|
for (i = 0; i < 1000; i++) {
|
|
|
|
t = mdio_read(port, MII_CTRL);
|
|
|
|
if (!(t & MII_CTRL_RST))
|
|
|
|
break;
|
|
|
|
else
|
|
|
|
micro_delay(100);
|
|
|
|
}
|
|
|
|
|
|
|
|
t = mdio_read(port, MII_CTRL) | MII_CTRL_ANE | MII_CTRL_DM | MII_CTRL_SP_1000;
|
|
|
|
mdio_write(port, MII_CTRL, t);
|
|
|
|
|
|
|
|
t = mdio_read(port, MII_ANA);
|
|
|
|
t |= MII_ANA_10THD | MII_ANA_10TFD | MII_ANA_100TXHD | MII_ANA_100TXFD;
|
|
|
|
t |= MII_ANA_PAUSE_SYM | MII_ANA_PAUSE_ASYM;
|
|
|
|
mdio_write(port, MII_ANA, t);
|
|
|
|
|
|
|
|
t = mdio_read(port, MII_1000_CTRL) | 0x300;
|
|
|
|
mdio_write(port, MII_1000_CTRL, t);
|
|
|
|
|
|
|
|
/* Restart Auto-Negotiation Process */
|
|
|
|
t = mdio_read(port, MII_CTRL) | MII_CTRL_ANE | MII_CTRL_RAN;
|
|
|
|
mdio_write(port, MII_CTRL, t);
|
|
|
|
|
|
|
|
rl_outw(port, RL_9346CR, RL_9346CR_EEM_CONFIG); /* Unlock */
|
|
|
|
|
|
|
|
t = rl_inw(port, RL_CPLUSCMD);
|
|
|
|
if ((rep->re_mac == RL_TCR_HWVER_RTL8169S) ||
|
|
|
|
(rep->re_mac == RL_TCR_HWVER_RTL8110S)) {
|
|
|
|
printf("Set MAC Reg C+CR Offset 0xE0. "
|
|
|
|
"Bit-3 and bit-14 MUST be 1\n");
|
|
|
|
rl_outw(port, RL_CPLUSCMD, t | RL_CPLUS_MULRW | (1 << 14));
|
|
|
|
} else
|
|
|
|
rl_outw(port, RL_CPLUSCMD, t | RL_CPLUS_MULRW);
|
|
|
|
|
|
|
|
rl_outw(port, RL_INTRMITIGATE, 0x00);
|
|
|
|
|
|
|
|
t = rl_inb(port, RL_CR);
|
|
|
|
rl_outb(port, RL_CR, t | RL_CR_RE | RL_CR_TE);
|
|
|
|
|
|
|
|
/* Initialize Rx */
|
|
|
|
rl_outw(port, RL_RMS, RX_BUFSIZE); /* Maximum rx packet size */
|
|
|
|
t = rl_inl(port, RL_RCR) & RX_CONFIG_MASK;
|
|
|
|
rl_outl(port, RL_RCR, RL_RCR_RXFTH_UNLIM | RL_RCR_MXDMA_1024 | t);
|
|
|
|
rl_outl(port, RL_RDSAR_LO, rep->p_rx_desc);
|
|
|
|
rl_outl(port, RL_RDSAR_HI, 0x00); /* For 64 bit */
|
|
|
|
|
|
|
|
/* Initialize Tx */
|
|
|
|
rl_outw(port, RL_ETTHR, 0x3f); /* No early transmit */
|
|
|
|
rl_outl(port, RL_TCR, RL_TCR_MXDMA_2048 | RL_TCR_IFG_STD);
|
|
|
|
rl_outl(port, RL_TNPDS_LO, rep->p_tx_desc);
|
|
|
|
rl_outl(port, RL_TNPDS_HI, 0x00); /* For 64 bit */
|
|
|
|
|
|
|
|
rl_outw(port, RL_9346CR, RL_9346CR_EEM_NORMAL); /* Lock */
|
|
|
|
|
|
|
|
rl_outw(port, RL_MPC, 0x00);
|
|
|
|
rl_outw(port, RL_MULINT, rl_inw(port, RL_MULINT) & 0xF000);
|
|
|
|
rl_outw(port, RL_IMR, RE_INTR_MASK);
|
|
|
|
}
|
|
|
|
|
|
|
|
/*===========================================================================*
|
|
|
|
* rl_confaddr *
|
|
|
|
*===========================================================================*/
|
|
|
|
static void rl_confaddr(rep)
|
|
|
|
re_t *rep;
|
|
|
|
{
|
|
|
|
static char eakey[] = RL_ENVVAR "#_EA";
|
|
|
|
static char eafmt[] = "x:x:x:x:x:x";
|
|
|
|
|
|
|
|
int i;
|
|
|
|
port_t port;
|
|
|
|
u32_t w;
|
|
|
|
long v;
|
|
|
|
|
|
|
|
/* User defined ethernet address? */
|
|
|
|
eakey[sizeof(RL_ENVVAR)-1] = '0' + (rep-re_table);
|
|
|
|
|
|
|
|
port = rep->re_base_port;
|
|
|
|
|
|
|
|
for (i = 0; i < 6; i++) {
|
|
|
|
if (env_parse(eakey, eafmt, i, &v, 0x00L, 0xFFL) != EP_SET)
|
|
|
|
break;
|
|
|
|
rep->re_address.ea_addr[i] = v;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (i != 0 && i != 6)
|
|
|
|
env_panic(eakey); /* It's all or nothing */
|
|
|
|
|
|
|
|
/* Should update ethernet address in hardware */
|
|
|
|
if (i == 6) {
|
|
|
|
port = rep->re_base_port;
|
|
|
|
rl_outb(port, RL_9346CR, RL_9346CR_EEM_CONFIG);
|
|
|
|
w = 0;
|
|
|
|
for (i = 0; i < 4; i++)
|
|
|
|
w |= (rep->re_address.ea_addr[i] << (i * 8));
|
|
|
|
rl_outl(port, RL_IDR, w);
|
|
|
|
w = 0;
|
|
|
|
for (i = 4; i < 6; i++)
|
|
|
|
w |= (rep->re_address.ea_addr[i] << ((i-4) * 8));
|
|
|
|
rl_outl(port, RL_IDR + 4, w);
|
|
|
|
rl_outb(port, RL_9346CR, RL_9346CR_EEM_NORMAL);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Get ethernet address */
|
|
|
|
for (i = 0; i < 6; i++)
|
|
|
|
rep->re_address.ea_addr[i] = rl_inb(port, RL_IDR+i);
|
|
|
|
}
|
|
|
|
|
|
|
|
/*===========================================================================*
|
|
|
|
* rl_rec_mode *
|
|
|
|
*===========================================================================*/
|
|
|
|
static void rl_rec_mode(rep)
|
|
|
|
re_t *rep;
|
|
|
|
{
|
|
|
|
port_t port;
|
|
|
|
u32_t rcr;
|
|
|
|
u32_t mc_filter[2]; /* Multicast hash filter */
|
|
|
|
|
|
|
|
port = rep->re_base_port;
|
|
|
|
|
|
|
|
mc_filter[1] = mc_filter[0] = 0xffffffff;
|
|
|
|
rl_outl(port, RL_MAR + 0, mc_filter[0]);
|
|
|
|
rl_outl(port, RL_MAR + 4, mc_filter[1]);
|
|
|
|
|
|
|
|
rcr = rl_inl(port, RL_RCR);
|
|
|
|
rcr &= ~(RL_RCR_AB | RL_RCR_AM | RL_RCR_APM | RL_RCR_AAP);
|
|
|
|
if (rep->re_flags & REF_PROMISC)
|
|
|
|
rcr |= RL_RCR_AB | RL_RCR_AM | RL_RCR_AAP;
|
|
|
|
if (rep->re_flags & REF_BROAD)
|
|
|
|
rcr |= RL_RCR_AB;
|
|
|
|
if (rep->re_flags & REF_MULTI)
|
|
|
|
rcr |= RL_RCR_AM;
|
|
|
|
rcr |= RL_RCR_APM;
|
|
|
|
rl_outl(port, RL_RCR, RL_RCR_RXFTH_UNLIM | RL_RCR_MXDMA_1024 | rcr);
|
|
|
|
}
|
|
|
|
|
|
|
|
void transmittest(re_t *rep)
|
|
|
|
{
|
|
|
|
int tx_head;
|
|
|
|
re_desc *desc;
|
|
|
|
|
|
|
|
tx_head = rep->re_tx_head;
|
|
|
|
desc = rep->re_tx_desc;
|
|
|
|
desc += tx_head;
|
|
|
|
|
|
|
|
if(rep->re_tx[tx_head].ret_busy) {
|
|
|
|
do {
|
|
|
|
message m;
|
|
|
|
int r;
|
Basic System Event Framework (SEF) with ping and live update.
SYSLIB CHANGES:
- SEF must be used by every system process and is thereby part of the system
library.
- The framework provides a receive() interface (sef_receive) for system
processes to automatically catch known system even messages and process them.
- SEF provides a default behavior for each type of system event, but allows
system processes to register callbacks to override the default behavior.
- Custom (local to the process) or predefined (provided by SEF) callback
implementations can be registered to SEF.
- SEF currently includes support for 2 types of system events:
1. SEF Ping. The event occurs every time RS sends a ping to figure out
whether a system process is still alive. The default callback implementation
provided by SEF is to notify RS back to let it know the process is alive
and kicking.
2. SEF Live update. The event occurs every time RS sends a prepare to update
message to let a system process know an update is available and to prepare
for it. The live update support is very basic for now. SEF only deals with
verifying if the prepare state can be supported by the process, dumping the
state for debugging purposes, and providing an event-driven programming
model to the process to react to state changes check-in when ready to update.
- SEF should be extended in the future to integrate support for more types of
system events. Ideally, all the cross-cutting concerns should be integrated into
SEF to avoid duplicating code and ease extensibility. Examples include:
* PM notify messages primarily used at shutdown.
* SYSTEM notify messages primarily used for signals.
* CLOCK notify messages used for system alarms.
* Debug messages. IS could still be in charge of fkey handling but would
forward the debug message to the target process (e.g. PM, if the user
requested debug information about PM). SEF would then catch the message and
do nothing unless the process has registered an appropriate callback to
deal with the event. This simplifies the programming model to print debug
information, avoids duplicating code, and reduces the effort to print
debug information.
SYSTEM PROCESSES CHANGES:
- Every system process registers SEF callbacks it needs to override the default
system behavior and calls sef_startup() right after being started.
- sef_startup() does almost nothing now, but will be extended in the future to
support callbacks of its own to let RS control and synchronize with every
system process at initialization time.
- Every system process calls sef_receive() now rather than receive() directly,
to let SEF handle predefined system events.
RS CHANGES:
- RS supports a basic single-component live update protocol now, as follows:
* When an update command is issued (via "service update *"), RS notifies the
target system process to prepare for a specific update state.
* If the process doesn't respond back in time, the update is aborted.
* When the process responds back, RS kills it and marks it for refreshing.
* The process is then automatically restarted as for a buggy process and can
start running again.
* Live update is currently prototyped as a controlled failure.
2009-12-21 15:12:21 +01:00
|
|
|
if ((r = sef_receive(ANY, &m)) != OK)
|
|
|
|
panic("rtl8169", "sef_receive failed", r);
|
2009-12-02 16:59:42 +01:00
|
|
|
} while(m.m_source != HARDWARE);
|
|
|
|
assert(!(rep->re_flags & REF_SEND_AVAIL));
|
|
|
|
rep->re_flags |= REF_SEND_AVAIL;
|
|
|
|
}
|
|
|
|
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*===========================================================================*
|
|
|
|
* rl_readv_s *
|
|
|
|
*===========================================================================*/
|
2010-01-20 18:59:48 +01:00
|
|
|
static void rl_readv_s(message *mp, int from_int)
|
2009-12-02 16:59:42 +01:00
|
|
|
{
|
|
|
|
int i, j, n, s, dl_port, re_client, count, size, index;
|
|
|
|
port_t port;
|
|
|
|
unsigned totlen, packlen;
|
2010-01-20 18:59:48 +01:00
|
|
|
phys_bytes src_phys;
|
2009-12-02 16:59:42 +01:00
|
|
|
re_desc *desc;
|
|
|
|
u32_t rxstat = 0x12345678;
|
|
|
|
re_t *rep;
|
|
|
|
iovec_s_t *iovp;
|
|
|
|
int cps;
|
|
|
|
int iov_offset = 0;
|
|
|
|
|
|
|
|
dl_port = mp->DL_PORT;
|
|
|
|
count = mp->DL_COUNT;
|
|
|
|
if (dl_port < 0 || dl_port >= RE_PORT_NR)
|
|
|
|
panic("rtl8169", " illegal port", dl_port);
|
|
|
|
rep = &re_table[dl_port];
|
|
|
|
re_client = mp->DL_PROC;
|
|
|
|
rep->re_client = re_client;
|
|
|
|
|
|
|
|
assert(rep->re_mode == REM_ENABLED);
|
|
|
|
assert(rep->re_flags & REF_ENABLED);
|
|
|
|
|
|
|
|
port = rep->re_base_port;
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Assume that the RL_CR_BUFE check was been done by rl_checks_ints
|
|
|
|
*/
|
|
|
|
if (!from_int && (rl_inb(port, RL_CR) & RL_CR_BUFE))
|
|
|
|
goto suspend; /* Receive buffer is empty, suspend */
|
|
|
|
|
|
|
|
index = rep->re_rx_head;
|
|
|
|
readvs_test_loop:
|
|
|
|
desc = rep->re_rx_desc;
|
|
|
|
desc += index;
|
|
|
|
readvs_loop:
|
|
|
|
rxstat = desc->status;
|
|
|
|
|
|
|
|
if (rxstat & DESC_OWN)
|
|
|
|
goto suspend;
|
|
|
|
|
|
|
|
if (rxstat & DESC_RX_CRC)
|
|
|
|
rep->re_stat.ets_CRCerr++;
|
|
|
|
|
|
|
|
if ((rxstat & (DESC_FS | DESC_LS)) != (DESC_FS | DESC_LS)) {
|
|
|
|
printf("rl_readv_s: packet is fragmented\n");
|
|
|
|
/* Fix the fragmented packet */
|
|
|
|
if (index == N_RX_DESC - 1) {
|
|
|
|
desc->status = DESC_EOR | DESC_OWN | (RX_BUFSIZE & DESC_RX_LENMASK);
|
|
|
|
index = 0;
|
|
|
|
desc = rep->re_rx_desc;
|
|
|
|
} else {
|
|
|
|
desc->status = DESC_OWN | (RX_BUFSIZE & DESC_RX_LENMASK);
|
|
|
|
index++;
|
|
|
|
desc++;
|
|
|
|
}
|
|
|
|
goto readvs_loop; /* Loop until we get correct packet */
|
|
|
|
}
|
|
|
|
|
|
|
|
totlen = rxstat & DESC_RX_LENMASK;
|
|
|
|
if (totlen < 8 || totlen > 2 * ETH_MAX_PACK_SIZE) {
|
|
|
|
/* Someting went wrong */
|
|
|
|
printf("rl_readv_s: bad length (%u) in status 0x%08lx\n",
|
|
|
|
totlen, rxstat);
|
|
|
|
panic(NULL, NULL, NO_NUM);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Should subtract the CRC */
|
|
|
|
packlen = totlen - ETH_CRC_SIZE;
|
|
|
|
|
|
|
|
size = 0;
|
|
|
|
src_phys = rep->re_rx[index].ret_buf;
|
|
|
|
for (i = 0; i < count; i += IOVEC_NR,
|
|
|
|
iov_offset += IOVEC_NR * sizeof(rep->re_iovec_s[0]))
|
|
|
|
{
|
|
|
|
n = IOVEC_NR;
|
|
|
|
if (i + n > count)
|
|
|
|
n = count-i;
|
|
|
|
cps = sys_safecopyfrom(re_client, mp->DL_GRANT, iov_offset,
|
|
|
|
(vir_bytes) rep->re_iovec_s,
|
|
|
|
n * sizeof(rep->re_iovec_s[0]), D);
|
|
|
|
if (cps != OK) {
|
|
|
|
panic(__FILE__, "rl_readv_s: sys_safecopyfrom failed",
|
|
|
|
cps);
|
|
|
|
}
|
|
|
|
|
|
|
|
for (j = 0, iovp = rep->re_iovec_s; j < n; j++, iovp++) {
|
|
|
|
s = iovp->iov_size;
|
|
|
|
if (size + s > packlen) {
|
|
|
|
assert(packlen > size);
|
|
|
|
s = packlen-size;
|
|
|
|
}
|
|
|
|
|
|
|
|
cps = sys_safecopyto(re_client, iovp->iov_grant, 0,
|
|
|
|
(vir_bytes) rep->re_rx[index].v_ret_buf + size, s, D);
|
|
|
|
if (cps != OK)
|
|
|
|
panic(__FILE__,
|
|
|
|
"rl_readv_s: sys_safecopyto failed", cps);
|
|
|
|
|
|
|
|
size += s;
|
|
|
|
if (size == packlen)
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
if (size == packlen)
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
if (size < packlen)
|
|
|
|
assert(0);
|
|
|
|
|
|
|
|
rep->re_stat.ets_packetR++;
|
|
|
|
rep->re_read_s = packlen;
|
|
|
|
if (index == N_RX_DESC - 1) {
|
|
|
|
desc->status = DESC_EOR | DESC_OWN | (RX_BUFSIZE & DESC_RX_LENMASK);
|
|
|
|
index = 0;
|
|
|
|
} else {
|
|
|
|
desc->status = DESC_OWN | (RX_BUFSIZE & DESC_RX_LENMASK);
|
|
|
|
index++;
|
|
|
|
}
|
|
|
|
rep->re_rx_head = index;
|
|
|
|
assert(rep->re_rx_head < N_RX_DESC);
|
|
|
|
rep->re_flags = (rep->re_flags & ~REF_READING) | REF_PACK_RECV;
|
|
|
|
|
|
|
|
if (!from_int)
|
|
|
|
reply(rep, OK, FALSE);
|
|
|
|
|
|
|
|
return;
|
|
|
|
|
|
|
|
suspend:
|
|
|
|
if (from_int) {
|
|
|
|
assert(rep->re_flags & REF_READING);
|
|
|
|
|
|
|
|
/* No need to store any state */
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
rep->re_rx_mess = *mp;
|
|
|
|
assert(!(rep->re_flags & REF_READING));
|
|
|
|
rep->re_flags |= REF_READING;
|
|
|
|
|
|
|
|
reply(rep, OK, FALSE);
|
|
|
|
}
|
|
|
|
|
|
|
|
/*===========================================================================*
|
|
|
|
* rl_writev_s *
|
|
|
|
*===========================================================================*/
|
2010-01-20 18:59:48 +01:00
|
|
|
static void rl_writev_s(message *mp, int from_int)
|
2009-12-02 16:59:42 +01:00
|
|
|
{
|
|
|
|
int i, j, n, s, port, count, size;
|
|
|
|
int tx_head, re_client;
|
|
|
|
re_t *rep;
|
|
|
|
iovec_s_t *iovp;
|
|
|
|
re_desc *desc;
|
|
|
|
char *ret;
|
|
|
|
int cps;
|
|
|
|
int iov_offset = 0;
|
|
|
|
|
|
|
|
port = mp->DL_PORT;
|
|
|
|
count = mp->DL_COUNT;
|
|
|
|
if (port < 0 || port >= RE_PORT_NR)
|
|
|
|
panic("rtl8169", "illegal port", port);
|
|
|
|
rep = &re_table[port];
|
|
|
|
assert(mp);
|
|
|
|
assert(port >= 0 && port < RE_PORT_NR);
|
|
|
|
assert(rep->setup);
|
|
|
|
re_client = mp->DL_PROC;
|
|
|
|
rep->re_client = re_client;
|
|
|
|
|
|
|
|
assert(rep->re_mode == REM_ENABLED);
|
|
|
|
assert(rep->re_flags & REF_ENABLED);
|
|
|
|
|
|
|
|
if (from_int) {
|
|
|
|
assert(rep->re_flags & REF_SEND_AVAIL);
|
|
|
|
rep->re_flags &= ~REF_SEND_AVAIL;
|
|
|
|
rep->re_send_int = FALSE;
|
|
|
|
rep->re_tx_alive = TRUE;
|
|
|
|
}
|
|
|
|
|
|
|
|
tx_head = rep->re_tx_head;
|
|
|
|
|
|
|
|
desc = rep->re_tx_desc;
|
|
|
|
desc += tx_head;
|
|
|
|
|
|
|
|
if(!desc || !rep->re_tx_desc) {
|
|
|
|
printf("desc 0x%lx, re_tx_desc 0x%lx, tx_head %d, setup %d\n",
|
|
|
|
desc, rep->re_tx_desc, tx_head, rep->setup);
|
|
|
|
}
|
|
|
|
|
|
|
|
assert(rep->re_tx_desc);
|
|
|
|
assert(rep->re_tx_head >= 0 && rep->re_tx_head < N_TX_DESC);
|
|
|
|
|
|
|
|
assert(desc);
|
|
|
|
|
|
|
|
|
|
|
|
if (rep->re_tx[tx_head].ret_busy) {
|
|
|
|
assert(!(rep->re_flags & REF_SEND_AVAIL));
|
|
|
|
rep->re_flags |= REF_SEND_AVAIL;
|
|
|
|
if (rep->re_tx[tx_head].ret_busy)
|
|
|
|
goto suspend;
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Race condition, the interrupt handler may clear re_busy
|
|
|
|
* before we got a chance to set REF_SEND_AVAIL. Checking
|
|
|
|
* ret_busy twice should be sufficient.
|
|
|
|
*/
|
|
|
|
#if VERBOSE
|
|
|
|
printf("rl_writev_s: race detected\n");
|
|
|
|
#endif
|
|
|
|
rep->re_flags &= ~REF_SEND_AVAIL;
|
|
|
|
rep->re_send_int = FALSE;
|
|
|
|
}
|
|
|
|
|
|
|
|
assert(!(rep->re_flags & REF_SEND_AVAIL));
|
|
|
|
assert(!(rep->re_flags & REF_PACK_SENT));
|
|
|
|
|
|
|
|
size = 0;
|
|
|
|
ret = rep->re_tx[tx_head].v_ret_buf;
|
|
|
|
for (i = 0; i < count; i += IOVEC_NR,
|
|
|
|
iov_offset += IOVEC_NR * sizeof(rep->re_iovec_s[0]))
|
|
|
|
{
|
|
|
|
n = IOVEC_NR;
|
|
|
|
if (i + n > count)
|
|
|
|
n = count - i;
|
|
|
|
cps = sys_safecopyfrom(re_client, mp->DL_GRANT, iov_offset,
|
|
|
|
(vir_bytes) rep->re_iovec_s,
|
|
|
|
n * sizeof(rep->re_iovec_s[0]), D);
|
|
|
|
if (cps != OK) {
|
|
|
|
panic(__FILE__, "rl_writev_s: sys_safecopyfrom failed",
|
|
|
|
cps);
|
|
|
|
}
|
|
|
|
|
|
|
|
for (j = 0, iovp = rep->re_iovec_s; j < n; j++, iovp++) {
|
|
|
|
s = iovp->iov_size;
|
|
|
|
if (size + s > ETH_MAX_PACK_SIZE_TAGGED)
|
|
|
|
panic("rtl8169", "invalid packet size", NO_NUM);
|
|
|
|
|
|
|
|
cps = sys_safecopyfrom(re_client, iovp->iov_grant, 0,
|
|
|
|
(vir_bytes) ret, s, D);
|
|
|
|
if (cps != OK) {
|
|
|
|
panic(__FILE__,
|
|
|
|
"rl_writev_s: sys_safecopyfrom failed",
|
|
|
|
cps);
|
|
|
|
}
|
|
|
|
size += s;
|
|
|
|
ret += s;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
assert(desc);
|
|
|
|
if (size < ETH_MIN_PACK_SIZE)
|
|
|
|
panic("rtl8169", "invalid packet size", size);
|
|
|
|
|
|
|
|
rep->re_tx[tx_head].ret_busy = TRUE;
|
|
|
|
|
|
|
|
if (tx_head == N_TX_DESC - 1) {
|
|
|
|
desc->status = DESC_EOR | DESC_OWN | DESC_FS | DESC_LS | size;
|
|
|
|
tx_head = 0;
|
|
|
|
} else {
|
|
|
|
desc->status = DESC_OWN | DESC_FS | DESC_LS | size;
|
|
|
|
tx_head++;
|
|
|
|
}
|
|
|
|
|
|
|
|
assert(tx_head < N_TX_DESC);
|
|
|
|
rep->re_tx_head = tx_head;
|
|
|
|
|
|
|
|
rl_outl(rep->re_base_port, RL_TPPOLL, RL_TPPOLL_NPQ);
|
|
|
|
rep->re_flags |= REF_PACK_SENT;
|
|
|
|
|
|
|
|
/*
|
|
|
|
* If the interrupt handler called, don't send a reply. The reply
|
|
|
|
* will be sent after all interrupts are handled.
|
|
|
|
*/
|
|
|
|
if (from_int)
|
|
|
|
return;
|
|
|
|
reply(rep, OK, FALSE);
|
|
|
|
return;
|
|
|
|
|
|
|
|
suspend:
|
|
|
|
if (from_int)
|
|
|
|
panic("rtl8169", "should not be sending\n", NO_NUM);
|
|
|
|
|
|
|
|
rep->re_tx_mess = *mp;
|
|
|
|
reply(rep, OK, FALSE);
|
|
|
|
}
|
|
|
|
|
|
|
|
/*===========================================================================*
|
|
|
|
* rl_check_ints *
|
|
|
|
*===========================================================================*/
|
|
|
|
static void rl_check_ints(rep)
|
|
|
|
re_t *rep;
|
|
|
|
{
|
|
|
|
int re_flags;
|
|
|
|
|
|
|
|
re_flags = rep->re_flags;
|
|
|
|
|
|
|
|
if ((re_flags & REF_READING) &&
|
|
|
|
!(rl_inb(rep->re_base_port, RL_CR) & RL_CR_BUFE))
|
|
|
|
{
|
|
|
|
assert(rep->re_rx_mess.m_type == DL_READV_S);
|
|
|
|
rl_readv_s(&rep->re_rx_mess, TRUE /* from int */);
|
|
|
|
}
|
|
|
|
|
|
|
|
if (rep->re_need_reset)
|
|
|
|
rl_do_reset(rep);
|
|
|
|
|
|
|
|
if (rep->re_send_int) {
|
|
|
|
assert(rep->re_tx_mess.m_type == DL_WRITEV_S);
|
|
|
|
rl_writev_s(&rep->re_tx_mess, TRUE /* from int */);
|
|
|
|
}
|
|
|
|
|
|
|
|
if (rep->re_report_link)
|
|
|
|
rl_report_link(rep);
|
|
|
|
|
|
|
|
if (rep->re_flags & (REF_PACK_SENT | REF_PACK_RECV))
|
|
|
|
reply(rep, OK, TRUE);
|
|
|
|
}
|
|
|
|
|
|
|
|
/*===========================================================================*
|
|
|
|
* rl_report_link *
|
|
|
|
*===========================================================================*/
|
|
|
|
static void rl_report_link(rep)
|
|
|
|
re_t *rep;
|
|
|
|
{
|
|
|
|
port_t port;
|
|
|
|
u8_t mii_status;
|
|
|
|
|
|
|
|
rep->re_report_link = FALSE;
|
|
|
|
port = rep->re_base_port;
|
|
|
|
|
|
|
|
mii_status = rl_inb(port, RL_PHYSTAT);
|
|
|
|
|
|
|
|
if (mii_status & RL_STAT_LINK) {
|
|
|
|
rep->re_link_up = 1;
|
|
|
|
printf("%s: link up at ", rep->re_name);
|
|
|
|
} else {
|
|
|
|
rep->re_link_up = 0;
|
|
|
|
printf("%s: link down\n", rep->re_name);
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (mii_status & RL_STAT_1000)
|
|
|
|
printf("1000 Mbps");
|
|
|
|
else if (mii_status & RL_STAT_100)
|
|
|
|
printf("100 Mbps");
|
|
|
|
else if (mii_status & RL_STAT_10)
|
|
|
|
printf("10 Mbps");
|
|
|
|
|
|
|
|
if (mii_status & RL_STAT_FULLDUP)
|
|
|
|
printf(", full duplex");
|
|
|
|
else
|
|
|
|
printf(", half duplex");
|
|
|
|
printf("\n");
|
|
|
|
|
|
|
|
dump_phy(rep);
|
|
|
|
}
|
|
|
|
|
|
|
|
/*===========================================================================*
|
|
|
|
* rl_do_reset *
|
|
|
|
*===========================================================================*/
|
|
|
|
static void rl_do_reset(rep)
|
|
|
|
re_t *rep;
|
|
|
|
{
|
|
|
|
rep->re_need_reset = FALSE;
|
|
|
|
rl_reset_hw(rep);
|
|
|
|
rl_rec_mode(rep);
|
|
|
|
|
|
|
|
rep->re_tx_head = 0;
|
|
|
|
if (rep->re_flags & REF_SEND_AVAIL) {
|
|
|
|
rep->re_tx[rep->re_tx_head].ret_busy = FALSE;
|
|
|
|
rep->re_send_int = TRUE;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
/*===========================================================================*
|
|
|
|
* rl_getstat *
|
|
|
|
*===========================================================================*/
|
|
|
|
static void rl_getstat(mp)
|
|
|
|
message *mp;
|
|
|
|
{
|
|
|
|
int r, port;
|
|
|
|
eth_stat_t stats;
|
|
|
|
re_t *rep;
|
|
|
|
|
|
|
|
port = mp->DL_PORT;
|
|
|
|
if (port < 0 || port >= RE_PORT_NR)
|
|
|
|
panic("rtl8169", "illegal port", port);
|
|
|
|
rep = &re_table[port];
|
|
|
|
rep->re_client = mp->DL_PROC;
|
|
|
|
|
|
|
|
assert(rep->re_mode == REM_ENABLED);
|
|
|
|
assert(rep->re_flags & REF_ENABLED);
|
|
|
|
|
|
|
|
stats = rep->re_stat;
|
|
|
|
|
|
|
|
r = sys_datacopy(SELF, (vir_bytes) &stats, mp->DL_PROC,
|
|
|
|
(vir_bytes) mp->DL_ADDR, sizeof(stats));
|
|
|
|
if (r != OK)
|
|
|
|
panic(__FILE__, "rl_getstat: sys_datacopy failed", r);
|
|
|
|
|
|
|
|
mp->m_type = DL_STAT_REPLY;
|
|
|
|
mp->DL_PORT = port;
|
|
|
|
mp->DL_STAT = OK;
|
|
|
|
r = send(mp->m_source, mp);
|
|
|
|
if (r != OK)
|
|
|
|
panic("RTL8169", "rl_getstat: send failed: %d\n", r);
|
|
|
|
}
|
|
|
|
|
|
|
|
/*===========================================================================*
|
|
|
|
* rl_getstat_s *
|
|
|
|
*===========================================================================*/
|
|
|
|
static void rl_getstat_s(mp)
|
|
|
|
message *mp;
|
|
|
|
{
|
|
|
|
int r, port;
|
|
|
|
eth_stat_t stats;
|
|
|
|
re_t *rep;
|
|
|
|
|
|
|
|
port = mp->DL_PORT;
|
|
|
|
if (port < 0 || port >= RE_PORT_NR)
|
|
|
|
panic("rtl8169", "illegal port", port);
|
|
|
|
rep = &re_table[port];
|
|
|
|
rep->re_client = mp->DL_PROC;
|
|
|
|
|
|
|
|
assert(rep->re_mode == REM_ENABLED);
|
|
|
|
assert(rep->re_flags & REF_ENABLED);
|
|
|
|
|
|
|
|
stats = rep->re_stat;
|
|
|
|
|
|
|
|
r = sys_safecopyto(mp->DL_PROC, mp->DL_GRANT, 0,
|
|
|
|
(vir_bytes) &stats, sizeof(stats), D);
|
|
|
|
if (r != OK)
|
|
|
|
panic(__FILE__, "rl_getstat_s: sys_safecopyto failed", r);
|
|
|
|
|
|
|
|
mp->m_type = DL_STAT_REPLY;
|
|
|
|
mp->DL_PORT = port;
|
|
|
|
mp->DL_STAT = OK;
|
|
|
|
r = send(mp->m_source, mp);
|
|
|
|
if (r != OK)
|
|
|
|
panic("RTL8169", "rl_getstat_s: send failed: %d\n", r);
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/*===========================================================================*
|
|
|
|
* rl_getname *
|
|
|
|
*===========================================================================*/
|
|
|
|
static void rl_getname(mp)
|
|
|
|
message *mp;
|
|
|
|
{
|
|
|
|
int r;
|
|
|
|
|
|
|
|
strncpy(mp->DL_NAME, progname, sizeof(mp->DL_NAME));
|
|
|
|
mp->DL_NAME[sizeof(mp->DL_NAME)-1] = '\0';
|
|
|
|
mp->m_type = DL_NAME_REPLY;
|
|
|
|
r = send(mp->m_source, mp);
|
|
|
|
if (r != OK)
|
|
|
|
panic("RTL8169", "rl_getname: send failed: %d\n", r);
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/*===========================================================================*
|
|
|
|
* reply *
|
|
|
|
*===========================================================================*/
|
|
|
|
static void reply(rep, err, may_block)
|
|
|
|
re_t *rep;
|
|
|
|
int err;
|
|
|
|
int may_block;
|
|
|
|
{
|
|
|
|
message reply;
|
|
|
|
int status;
|
|
|
|
int r;
|
|
|
|
clock_t now;
|
|
|
|
|
|
|
|
status = 0;
|
|
|
|
if (rep->re_flags & REF_PACK_SENT)
|
|
|
|
status |= DL_PACK_SEND;
|
|
|
|
if (rep->re_flags & REF_PACK_RECV)
|
|
|
|
status |= DL_PACK_RECV;
|
|
|
|
|
|
|
|
reply.m_type = DL_TASK_REPLY;
|
|
|
|
reply.DL_PORT = rep - re_table;
|
|
|
|
reply.DL_PROC = rep->re_client;
|
|
|
|
reply.DL_STAT = status | ((u32_t) err << 16);
|
|
|
|
reply.DL_COUNT = rep->re_read_s;
|
|
|
|
if (OK != (r = getuptime(&now)))
|
|
|
|
panic("rtl8169", "getuptime() failed:", r);
|
|
|
|
reply.DL_CLCK = now;
|
|
|
|
|
|
|
|
r = send(rep->re_client, &reply);
|
|
|
|
|
|
|
|
if (r == ELOCKED && may_block) {
|
|
|
|
printW(); printf("send locked\n");
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (r < 0) {
|
|
|
|
printf("RTL8169 tried sending to %d, type %d\n",
|
|
|
|
rep->re_client, reply.m_type);
|
|
|
|
panic("rtl8169", "send failed:", r);
|
|
|
|
}
|
|
|
|
|
|
|
|
rep->re_read_s = 0;
|
|
|
|
rep->re_flags &= ~(REF_PACK_SENT | REF_PACK_RECV);
|
|
|
|
}
|
|
|
|
|
|
|
|
/*===========================================================================*
|
|
|
|
* mess_reply *
|
|
|
|
*===========================================================================*/
|
|
|
|
static void mess_reply(req, reply_mess)
|
|
|
|
message *req;
|
|
|
|
message *reply_mess;
|
|
|
|
{
|
|
|
|
if (send(req->m_source, reply_mess) != OK)
|
|
|
|
panic("rtl8169", "unable to mess_reply", NO_NUM);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void dump_phy(re_t *rep)
|
|
|
|
{
|
|
|
|
#if VERBOSE
|
|
|
|
port_t port;
|
|
|
|
u32_t t;
|
|
|
|
|
|
|
|
port = rep->re_base_port;
|
|
|
|
|
|
|
|
t = rl_inb(port, RL_CONFIG0);
|
|
|
|
printf("CONFIG0\t\t:");
|
|
|
|
t = t & RL_CFG0_ROM;
|
|
|
|
if (t == RL_CFG0_ROM128K)
|
|
|
|
printf(" 128K Boot ROM");
|
|
|
|
else if (t == RL_CFG0_ROM64K)
|
|
|
|
printf(" 64K Boot ROM");
|
|
|
|
else if (t == RL_CFG0_ROM32K)
|
|
|
|
printf(" 32K Boot ROM");
|
|
|
|
else if (t == RL_CFG0_ROM16K)
|
|
|
|
printf(" 16K Boot ROM");
|
|
|
|
else if (t == RL_CFG0_ROM8K)
|
|
|
|
printf(" 8K Boot ROM");
|
|
|
|
else if (t == RL_CFG0_ROMNO)
|
|
|
|
printf(" No Boot ROM");
|
|
|
|
printf("\n");
|
|
|
|
|
|
|
|
t = rl_inb(port, RL_CONFIG1);
|
|
|
|
printf("CONFIG1\t\t:");
|
|
|
|
if (t & RL_CFG1_LEDS1)
|
|
|
|
printf(" LED1");
|
|
|
|
if (t & RL_CFG1_LEDS0)
|
|
|
|
printf(" LED0");
|
|
|
|
if (t & RL_CFG1_DVRLOAD)
|
|
|
|
printf(" Driver");
|
|
|
|
if (t & RL_CFG1_LWACT)
|
|
|
|
printf(" LWAKE");
|
|
|
|
if (t & RL_CFG1_IOMAP)
|
|
|
|
printf(" IOMAP");
|
|
|
|
if (t & RL_CFG1_MEMMAP)
|
|
|
|
printf(" MEMMAP");
|
|
|
|
if (t & RL_CFG1_VPD)
|
|
|
|
printf(" VPD");
|
|
|
|
if (t & RL_CFG1_PME)
|
|
|
|
printf(" PME");
|
|
|
|
printf("\n");
|
|
|
|
|
|
|
|
t = rl_inb(port, RL_CONFIG2);
|
|
|
|
printf("CONFIG2\t\t:");
|
|
|
|
if (t & RL_CFG2_AUX)
|
|
|
|
printf(" AUX");
|
|
|
|
if (t & RL_CFG2_PCIBW)
|
|
|
|
printf(" PCI-64-Bit");
|
|
|
|
else
|
|
|
|
printf(" PCI-32-Bit");
|
|
|
|
t = t & RL_CFG2_PCICLK;
|
|
|
|
if (t == RL_CFG2_66MHZ)
|
|
|
|
printf(" 66 MHz");
|
|
|
|
else if (t == RL_CFG2_33MHZ)
|
|
|
|
printf(" 33 MHz");
|
|
|
|
printf("\n");
|
|
|
|
|
|
|
|
t = mdio_read(port, MII_CTRL);
|
|
|
|
printf("MII_CTRL\t:");
|
|
|
|
if (t & MII_CTRL_RST)
|
|
|
|
printf(" Reset");
|
|
|
|
if (t & MII_CTRL_LB)
|
|
|
|
printf(" Loopback");
|
|
|
|
if (t & MII_CTRL_ANE)
|
|
|
|
printf(" ANE");
|
|
|
|
if (t & MII_CTRL_PD)
|
|
|
|
printf(" Power-down");
|
|
|
|
if (t & MII_CTRL_ISO)
|
|
|
|
printf(" Isolate");
|
|
|
|
if (t & MII_CTRL_RAN)
|
|
|
|
printf(" RAN");
|
|
|
|
if (t & MII_CTRL_DM)
|
|
|
|
printf(" Full-duplex");
|
|
|
|
if (t & MII_CTRL_CT)
|
|
|
|
printf(" COL-signal");
|
|
|
|
t = t & (MII_CTRL_SP_LSB | MII_CTRL_SP_MSB);
|
|
|
|
if (t == MII_CTRL_SP_10)
|
|
|
|
printf(" 10 Mb/s");
|
|
|
|
else if (t == MII_CTRL_SP_100)
|
|
|
|
printf(" 100 Mb/s");
|
|
|
|
else if (t == MII_CTRL_SP_1000)
|
|
|
|
printf(" 1000 Mb/s");
|
|
|
|
printf("\n");
|
|
|
|
|
|
|
|
t = mdio_read(port, MII_STATUS);
|
|
|
|
printf("MII_STATUS\t:");
|
|
|
|
if (t & MII_STATUS_100T4)
|
|
|
|
printf(" 100Base-T4");
|
|
|
|
if (t & MII_STATUS_100XFD)
|
|
|
|
printf(" 100BaseX-FD");
|
|
|
|
if (t & MII_STATUS_100XHD)
|
|
|
|
printf(" 100BaseX-HD");
|
|
|
|
if (t & MII_STATUS_10FD)
|
|
|
|
printf(" 10Mbps-FD");
|
|
|
|
if (t & MII_STATUS_10HD)
|
|
|
|
printf(" 10Mbps-HD");
|
|
|
|
if (t & MII_STATUS_100T2FD)
|
|
|
|
printf(" 100Base-T2-FD");
|
|
|
|
if (t & MII_STATUS_100T2HD)
|
|
|
|
printf(" 100Base-T2-HD");
|
|
|
|
if (t & MII_STATUS_EXT_STAT)
|
|
|
|
printf(" Ext-stat");
|
|
|
|
if (t & MII_STATUS_RES)
|
|
|
|
printf(" res-0x%lx", t & MII_STATUS_RES);
|
|
|
|
if (t & MII_STATUS_MFPS)
|
|
|
|
printf(" MFPS");
|
|
|
|
if (t & MII_STATUS_ANC)
|
|
|
|
printf(" ANC");
|
|
|
|
if (t & MII_STATUS_RF)
|
|
|
|
printf(" remote-fault");
|
|
|
|
if (t & MII_STATUS_ANA)
|
|
|
|
printf(" ANA");
|
|
|
|
if (t & MII_STATUS_LS)
|
|
|
|
printf(" Link");
|
|
|
|
if (t & MII_STATUS_JD)
|
|
|
|
printf(" Jabber");
|
|
|
|
if (t & MII_STATUS_EC)
|
|
|
|
printf(" Extended-capability");
|
|
|
|
printf("\n");
|
|
|
|
|
|
|
|
t = mdio_read(port, MII_ANA);
|
|
|
|
printf("MII_ANA\t\t: 0x%04lx\n", t);
|
|
|
|
|
|
|
|
t = mdio_read(port, MII_ANLPA);
|
|
|
|
printf("MII_ANLPA\t: 0x%04lx\n", t);
|
|
|
|
|
|
|
|
t = mdio_read(port, MII_ANE);
|
|
|
|
printf("MII_ANE\t\t:");
|
|
|
|
if (t & MII_ANE_RES)
|
|
|
|
printf(" res-0x%lx", t & MII_ANE_RES);
|
|
|
|
if (t & MII_ANE_PDF)
|
|
|
|
printf(" Par-Detect-Fault");
|
|
|
|
if (t & MII_ANE_LPNPA)
|
|
|
|
printf(" LP-Next-Page-Able");
|
|
|
|
if (t & MII_ANE_NPA)
|
|
|
|
printf(" Loc-Next-Page-Able");
|
|
|
|
if (t & MII_ANE_PR)
|
|
|
|
printf(" Page-Received");
|
|
|
|
if (t & MII_ANE_LPANA)
|
|
|
|
printf(" LP-Auto-Neg-Able");
|
|
|
|
printf("\n");
|
|
|
|
|
|
|
|
t = mdio_read(port, MII_1000_CTRL);
|
|
|
|
printf("MII_1000_CTRL\t:");
|
|
|
|
if (t & MII_1000C_FULL)
|
|
|
|
printf(" 1000BaseT-FD");
|
|
|
|
if (t & MII_1000C_HALF)
|
|
|
|
printf(" 1000BaseT-HD");
|
|
|
|
printf("\n");
|
|
|
|
|
|
|
|
t = mdio_read(port, MII_1000_STATUS);
|
|
|
|
if (t) {
|
|
|
|
printf("MII_1000_STATUS\t:");
|
|
|
|
if (t & MII_1000S_LRXOK)
|
|
|
|
printf(" Local-Receiver");
|
|
|
|
if (t & MII_1000S_RRXOK)
|
|
|
|
printf(" Remote-Receiver");
|
|
|
|
if (t & MII_1000S_HALF)
|
|
|
|
printf(" 1000BaseT-HD");
|
|
|
|
if (t & MII_1000S_FULL)
|
|
|
|
printf(" 1000BaseT-FD");
|
|
|
|
printf("\n");
|
|
|
|
|
|
|
|
t = mdio_read(port, MII_EXT_STATUS);
|
|
|
|
printf("MII_EXT_STATUS\t:");
|
|
|
|
if (t & MII_ESTAT_1000XFD)
|
|
|
|
printf(" 1000BaseX-FD");
|
|
|
|
if (t & MII_ESTAT_1000XHD)
|
|
|
|
printf(" 1000BaseX-HD");
|
|
|
|
if (t & MII_ESTAT_1000TFD)
|
|
|
|
printf(" 1000BaseT-FD");
|
|
|
|
if (t & MII_ESTAT_1000THD)
|
|
|
|
printf(" 1000BaseT-HD");
|
|
|
|
printf("\n");
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
|
|
|
|
static void do_hard_int(void)
|
|
|
|
{
|
|
|
|
int i, s;
|
|
|
|
|
|
|
|
for (i = 0; i < RE_PORT_NR; i++) {
|
|
|
|
|
|
|
|
/* Run interrupt handler at driver level. */
|
|
|
|
rl_handler(&re_table[i]);
|
|
|
|
|
|
|
|
/* Reenable interrupts for this hook. */
|
|
|
|
if ((s = sys_irqenable(&re_table[i].re_hook_id)) != OK)
|
|
|
|
printf("RTL8169: error, couldn't enable interrupts: %d\n", s);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
/*===========================================================================*
|
|
|
|
* rl_handler *
|
|
|
|
*===========================================================================*/
|
|
|
|
static int rl_handler(rep)
|
|
|
|
re_t *rep;
|
|
|
|
{
|
|
|
|
int i, port, tx_head, tx_tail, link_up;
|
|
|
|
u16_t isr;
|
|
|
|
re_desc *desc;
|
|
|
|
int_event_check = FALSE; /* disable check by default */
|
|
|
|
|
|
|
|
port = rep->re_base_port;
|
|
|
|
|
|
|
|
/* Ack interrupt */
|
|
|
|
isr = rl_inw(port, RL_ISR);
|
|
|
|
if(!isr)
|
|
|
|
return;
|
|
|
|
rl_outw(port, RL_ISR, isr);
|
|
|
|
rep->interrupts++;
|
|
|
|
|
|
|
|
if (isr & RL_IMR_FOVW) {
|
|
|
|
isr &= ~RL_IMR_FOVW;
|
|
|
|
/* Should do anything? */
|
|
|
|
|
|
|
|
rep->re_stat.ets_fifoOver++;
|
|
|
|
}
|
|
|
|
if (isr & RL_IMR_PUN) {
|
|
|
|
isr &= ~RL_IMR_PUN;
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Either the link status changed or there was a TX fifo
|
|
|
|
* underrun.
|
|
|
|
*/
|
|
|
|
link_up = !(!(rl_inb(port, RL_PHYSTAT) & RL_STAT_LINK));
|
|
|
|
if (link_up != rep->re_link_up) {
|
|
|
|
rep->re_report_link = TRUE;
|
|
|
|
rep->re_got_int = TRUE;
|
|
|
|
int_event_check = TRUE;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
if (isr & (RL_ISR_RDU | RL_ISR_RER | RL_ISR_ROK)) {
|
|
|
|
if (isr & RL_ISR_RER)
|
|
|
|
rep->re_stat.ets_recvErr++;
|
|
|
|
isr &= ~(RL_ISR_RDU | RL_ISR_RER | RL_ISR_ROK);
|
|
|
|
|
|
|
|
if (!rep->re_got_int && (rep->re_flags & REF_READING)) {
|
|
|
|
rep->re_got_int = TRUE;
|
|
|
|
int_event_check = TRUE;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
if ((isr & (RL_ISR_TDU | RL_ISR_TER | RL_ISR_TOK)) || 1) {
|
|
|
|
if (isr & RL_ISR_TER)
|
|
|
|
rep->re_stat.ets_sendErr++;
|
|
|
|
isr &= ~(RL_ISR_TDU | RL_ISR_TER | RL_ISR_TOK);
|
|
|
|
|
|
|
|
/* Transmit completed */
|
|
|
|
tx_head = rep->re_tx_head;
|
|
|
|
tx_tail = tx_head+1;
|
|
|
|
if (tx_tail >= N_TX_DESC)
|
|
|
|
tx_tail = 0;
|
|
|
|
for (i = 0; i < 2 * N_TX_DESC; i++) {
|
|
|
|
if (!rep->re_tx[tx_tail].ret_busy) {
|
|
|
|
/* Strange, this buffer is not in-use.
|
|
|
|
* Increment tx_tail until tx_head is
|
|
|
|
* reached (or until we find a buffer that
|
|
|
|
* is in-use.
|
|
|
|
*/
|
|
|
|
if (tx_tail == tx_head)
|
|
|
|
break;
|
|
|
|
if (++tx_tail >= N_TX_DESC)
|
|
|
|
tx_tail = 0;
|
|
|
|
assert(tx_tail < N_TX_DESC);
|
|
|
|
continue;
|
|
|
|
}
|
|
|
|
desc = rep->re_tx_desc;
|
|
|
|
desc += tx_tail;
|
|
|
|
if (desc->status & DESC_OWN) {
|
|
|
|
/* Buffer is not yet ready */
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
rep->re_stat.ets_packetT++;
|
|
|
|
rep->re_tx[tx_tail].ret_busy = FALSE;
|
|
|
|
|
|
|
|
if (++tx_tail >= N_TX_DESC)
|
|
|
|
tx_tail = 0;
|
|
|
|
assert(tx_tail < N_TX_DESC);
|
|
|
|
|
|
|
|
if (rep->re_flags & REF_SEND_AVAIL) {
|
|
|
|
rep->re_send_int = TRUE;
|
|
|
|
if (!rep->re_got_int) {
|
|
|
|
rep->re_got_int = TRUE;
|
|
|
|
int_event_check = TRUE;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
assert(i < 2 * N_TX_DESC);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Ignore Reserved Interrupt */
|
|
|
|
if (isr & RL_ISR_RES)
|
|
|
|
isr &= ~RL_ISR_RES;
|
|
|
|
|
|
|
|
if (isr)
|
|
|
|
printf("rl_handler: unhandled interrupt isr = 0x%04x\n", isr);
|
|
|
|
|
|
|
|
return 1;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*===========================================================================*
|
|
|
|
* rl_watchdog_f *
|
|
|
|
*===========================================================================*/
|
|
|
|
static void rl_watchdog_f(tp)
|
|
|
|
timer_t *tp;
|
|
|
|
{
|
|
|
|
int i;
|
|
|
|
re_t *rep;
|
|
|
|
/* Use a synchronous alarm instead of a watchdog timer. */
|
|
|
|
sys_setalarm(system_hz, 0);
|
|
|
|
|
|
|
|
for (i = 0, rep = &re_table[0]; i < RE_PORT_NR; i++, rep++) {
|
|
|
|
if (rep->re_mode != REM_ENABLED)
|
|
|
|
continue;
|
|
|
|
|
|
|
|
/* Should collect statistics */
|
|
|
|
if (!(++rep->dtcc_counter % RE_DTCC_VALUE))
|
|
|
|
rtl8169_update_stat(rep);
|
|
|
|
|
|
|
|
if (!(rep->re_flags & REF_SEND_AVAIL)) {
|
|
|
|
/* Assume that an idle system is alive */
|
|
|
|
rep->re_tx_alive = TRUE;
|
|
|
|
continue;
|
|
|
|
}
|
|
|
|
if (rep->re_tx_alive) {
|
|
|
|
rep->re_tx_alive = FALSE;
|
|
|
|
continue;
|
|
|
|
}
|
|
|
|
printf("rl_watchdog_f: resetting port %d mode 0x%x flags 0x%x\n",
|
|
|
|
i, rep->re_mode, rep->re_flags);
|
|
|
|
printf("tx_head :%8d busy %d\t",
|
|
|
|
rep->re_tx_head, rep->re_tx[rep->re_tx_head].ret_busy);
|
|
|
|
rep->re_need_reset = TRUE;
|
|
|
|
rep->re_got_int = TRUE;
|
|
|
|
|
|
|
|
check_int_events();
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|