oneechanhax/phunix
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity
phunix/servers/inet/generic/eth.c
Ben Gras 7336a67dfe retire PUBLIC, PRIVATE and FORWARD
2012-03-25 21:58:14 +02:00

1362 lines
29 KiB
C
Raw Blame History

/*
eth.c
Copyright 1995 Philip Homburg
*/
#include "inet.h"
#include "buf.h"
#include "clock.h"
#include "event.h"
#include "osdep_eth.h"
#include "type.h"
#include "assert.h"
#include "buf.h"
#include "eth.h"
#include "eth_int.h"
#include "sr.h"
THIS_FILE
#define ETH_FD_NR (4*IP_PORT_MAX)
#define EXPIRE_TIME 60*HZ /* seconds */
typedef struct eth_fd
{
int ef_flags;
nwio_ethopt_t ef_ethopt;
eth_port_t *ef_port;
struct eth_fd *ef_type_next;
struct eth_fd *ef_send_next;
int ef_srfd;
acc_t *ef_rdbuf_head;
acc_t *ef_rdbuf_tail;
get_userdata_t ef_get_userdata;
put_userdata_t ef_put_userdata;
put_pkt_t ef_put_pkt;
select_res_t ef_select_res;
time_t ef_exp_time;
size_t ef_write_count;
ioreq_t ef_ioctl_req;
} eth_fd_t;
#define EFF_FLAGS 0xf
# define EFF_EMPTY 0x0
# define EFF_INUSE 0x1
# define EFF_BUSY 0xE
# define EFF_READ_IP 0x2
# define EFF_WRITE_IP 0x4
# define EFF_IOCTL_IP 0x8
# define EFF_OPTSET 0x10
# define EFF_SEL_READ 0x20
/* Note that the vh_type field is normally considered part of the ethernet
* header.
*/
typedef struct
{
u16_t vh_type;
u16_t vh_vlan;
} vlan_hdr_t;
static int eth_checkopt ARGS(( eth_fd_t *eth_fd ));
static void hash_fd ARGS(( eth_fd_t *eth_fd ));
static void unhash_fd ARGS(( eth_fd_t *eth_fd ));
static void eth_buffree ARGS(( int priority ));
#ifdef BUF_CONSISTENCY_CHECK
static void eth_bufcheck ARGS(( void ));
#endif
static int eth_sel_read ARGS(( eth_fd_t * ));
static void packet2user ARGS(( eth_fd_t *fd, acc_t *pack, time_t exp_time ));
static void reply_thr_get ARGS(( eth_fd_t *eth_fd,
size_t result, int for_ioctl ));
static void reply_thr_put ARGS(( eth_fd_t *eth_fd,
size_t result, int for_ioctl ));
static void do_rec_conf ARGS(( eth_port_t *eth_port ));
static u32_t compute_rec_conf ARGS(( eth_port_t *eth_port ));
static acc_t *insert_vlan_hdr ARGS(( eth_port_t *eth_port, acc_t *pack ));
eth_port_t *eth_port_table;
int no_ethWritePort= 0;
static eth_fd_t eth_fd_table[ETH_FD_NR];
static ether_addr_t broadcast= { { 255, 255, 255, 255, 255, 255 } };
void eth_prep()
{
eth_port_table= alloc(eth_conf_nr * sizeof(eth_port_table[0]));
}
void eth_init()
{
int i, j;
assert (BUF_S >= sizeof(nwio_ethopt_t));
assert (BUF_S >= ETH_HDR_SIZE); /* these are in fact static assertions,
thus a good compiler doesn't
generate any code for this */
for (i=0; i<ETH_FD_NR; i++)
eth_fd_table[i].ef_flags= EFF_EMPTY;
for (i=0; i<eth_conf_nr; i++)
{
eth_port_table[i].etp_flags= EPF_EMPTY;
eth_port_table[i].etp_getstat= NULL;
eth_port_table[i].etp_sendq_head= NULL;
eth_port_table[i].etp_sendq_tail= NULL;
eth_port_table[i].etp_type_any= NULL;
ev_init(&eth_port_table[i].etp_sendev);
for (j= 0; j<ETH_TYPE_HASH_NR; j++)
eth_port_table[i].etp_type[j]= NULL;
for (j= 0; j<ETH_VLAN_HASH_NR; j++)
eth_port_table[i].etp_vlan_tab[j]= NULL;
}
#ifndef BUF_CONSISTENCY_CHECK
bf_logon(eth_buffree);
#else
bf_logon(eth_buffree, eth_bufcheck);
#endif
osdep_eth_init();
}
int eth_open(port, srfd, get_userdata, put_userdata, put_pkt,
select_res)
int port, srfd;
get_userdata_t get_userdata;
put_userdata_t put_userdata;
put_pkt_t put_pkt;
select_res_t select_res;
{
int i;
eth_port_t *eth_port;
eth_fd_t *eth_fd;
DBLOCK(0x20, printf("eth_open (%d, %d, %lx, %lx)\n", port, srfd,
(unsigned long)get_userdata, (unsigned long)put_userdata));
eth_port= &eth_port_table[port];
if (!(eth_port->etp_flags & EPF_ENABLED))
return EGENERIC;
for (i=0; i<ETH_FD_NR && (eth_fd_table[i].ef_flags & EFF_INUSE);
i++);
if (i>=ETH_FD_NR)
{
DBLOCK(1, printf("out of fds\n"));
return EAGAIN;
}
eth_fd= &eth_fd_table[i];
eth_fd->ef_flags= EFF_INUSE;
eth_fd->ef_ethopt.nweo_flags=NWEO_DEFAULT;
eth_fd->ef_port= eth_port;
eth_fd->ef_srfd= srfd;
assert(eth_fd->ef_rdbuf_head == NULL);
eth_fd->ef_get_userdata= get_userdata;
eth_fd->ef_put_userdata= put_userdata;
eth_fd->ef_put_pkt= put_pkt;
eth_fd->ef_select_res= select_res;
return i;
}
int eth_ioctl(fd, req)
int fd;
ioreq_t req;
{
acc_t *data;
eth_fd_t *eth_fd;
eth_port_t *eth_port;
DBLOCK(0x20, printf("eth_ioctl (%d, 0x%lx)\n", fd, (unsigned long)req));
eth_fd= &eth_fd_table[fd];
eth_port= eth_fd->ef_port;
assert (eth_fd->ef_flags & EFF_INUSE);
switch (req)
{
case NWIOSETHOPT:
{
nwio_ethopt_t *ethopt;
nwio_ethopt_t oldopt, newopt;
int result;
u32_t new_en_flags, new_di_flags,
old_en_flags, old_di_flags;
data= (*eth_fd->ef_get_userdata)(eth_fd->
ef_srfd, 0, sizeof(nwio_ethopt_t), TRUE);
ethopt= (nwio_ethopt_t *)ptr2acc_data(data);
oldopt= eth_fd->ef_ethopt;
newopt= *ethopt;
old_en_flags= oldopt.nweo_flags & 0xffff;
old_di_flags= (oldopt.nweo_flags >> 16) & 0xffff;
new_en_flags= newopt.nweo_flags & 0xffff;
new_di_flags= (newopt.nweo_flags >> 16) & 0xffff;
if (new_en_flags & new_di_flags)
{
bf_afree(data);
reply_thr_get (eth_fd, EBADMODE, TRUE);
return NW_OK;
}
/* NWEO_ACC_MASK */
if (new_di_flags & NWEO_ACC_MASK)
{
bf_afree(data);
reply_thr_get (eth_fd, EBADMODE, TRUE);
return NW_OK;
}
/* you can't disable access modes */
if (!(new_en_flags & NWEO_ACC_MASK))
new_en_flags |= (old_en_flags & NWEO_ACC_MASK);
/* NWEO_LOC_MASK */
if (!((new_en_flags | new_di_flags) & NWEO_LOC_MASK))
{
new_en_flags |= (old_en_flags & NWEO_LOC_MASK);
new_di_flags |= (old_di_flags & NWEO_LOC_MASK);
}
/* NWEO_BROAD_MASK */
if (!((new_en_flags | new_di_flags) & NWEO_BROAD_MASK))
{
new_en_flags |= (old_en_flags & NWEO_BROAD_MASK);
new_di_flags |= (old_di_flags & NWEO_BROAD_MASK);
}
/* NWEO_MULTI_MASK */
if (!((new_en_flags | new_di_flags) & NWEO_MULTI_MASK))
{
new_en_flags |= (old_en_flags & NWEO_MULTI_MASK);
new_di_flags |= (old_di_flags & NWEO_MULTI_MASK);
newopt.nweo_multi= oldopt.nweo_multi;
}
/* NWEO_PROMISC_MASK */
if (!((new_en_flags | new_di_flags) & NWEO_PROMISC_MASK))
{
new_en_flags |= (old_en_flags & NWEO_PROMISC_MASK);
new_di_flags |= (old_di_flags & NWEO_PROMISC_MASK);
}
/* NWEO_REM_MASK */
if (!((new_en_flags | new_di_flags) & NWEO_REM_MASK))
{
new_en_flags |= (old_en_flags & NWEO_REM_MASK);
new_di_flags |= (old_di_flags & NWEO_REM_MASK);
newopt.nweo_rem= oldopt.nweo_rem;
}
/* NWEO_TYPE_MASK */
if (!((new_en_flags | new_di_flags) & NWEO_TYPE_MASK))
{
new_en_flags |= (old_en_flags & NWEO_TYPE_MASK);
new_di_flags |= (old_di_flags & NWEO_TYPE_MASK);
newopt.nweo_type= oldopt.nweo_type;
}
/* NWEO_RW_MASK */
if (!((new_en_flags | new_di_flags) & NWEO_RW_MASK))
{
new_en_flags |= (old_en_flags & NWEO_RW_MASK);
new_di_flags |= (old_di_flags & NWEO_RW_MASK);
}
if (eth_fd->ef_flags & EFF_OPTSET)
unhash_fd(eth_fd);
newopt.nweo_flags= ((unsigned long)new_di_flags << 16) |
new_en_flags;
eth_fd->ef_ethopt= newopt;
result= eth_checkopt(eth_fd);
if (result<0)
eth_fd->ef_ethopt= oldopt;
else
{
unsigned long opt_flags;
unsigned changes;
opt_flags= oldopt.nweo_flags ^
eth_fd->ef_ethopt.nweo_flags;
changes= ((opt_flags >> 16) | opt_flags) &
0xffff;
if (changes & (NWEO_BROAD_MASK |
NWEO_MULTI_MASK | NWEO_PROMISC_MASK))
{
do_rec_conf(eth_port);
}
}
if (eth_fd->ef_flags & EFF_OPTSET)
hash_fd(eth_fd);
bf_afree(data);
reply_thr_get (eth_fd, result, TRUE);
return NW_OK;
}
case NWIOGETHOPT:
{
nwio_ethopt_t *ethopt;
acc_t *acc;
int result;
acc= bf_memreq(sizeof(nwio_ethopt_t));
ethopt= (nwio_ethopt_t *)ptr2acc_data(acc);
*ethopt= eth_fd->ef_ethopt;
result= (*eth_fd->ef_put_userdata)(eth_fd->
ef_srfd, 0, acc, TRUE);
if (result >= 0)
reply_thr_put(eth_fd, NW_OK, TRUE);
return result;
}
case NWIOGETHSTAT:
{
nwio_ethstat_t *ethstat;
acc_t *acc;
int result;
assert (sizeof(nwio_ethstat_t) <= BUF_S);
eth_port= eth_fd->ef_port;
if (!(eth_port->etp_flags & EPF_ENABLED))
{
reply_thr_put(eth_fd, EGENERIC, TRUE);
return NW_OK;
}
if (!(eth_port->etp_flags & EPF_GOT_ADDR))
{
#if 0
printf(
"eth_ioctl: suspending NWIOGETHSTAT ioctl\n");
#endif
eth_fd->ef_ioctl_req= req;
assert(!(eth_fd->ef_flags & EFF_IOCTL_IP));
eth_fd->ef_flags |= EFF_IOCTL_IP;
return NW_SUSPEND;
}
if (eth_port->etp_getstat)
{
printf(
"eth_ioctl: pending eth_get_stat request, suspending caller\n");
assert(!(eth_fd->ef_flags & EFF_IOCTL_IP));
eth_fd->ef_flags |= EFF_IOCTL_IP;
return NW_SUSPEND;
}
acc= bf_memreq(sizeof(nwio_ethstat_t));
compare (bf_bufsize(acc), ==, sizeof(*ethstat));
ethstat= (nwio_ethstat_t *)ptr2acc_data(acc);
ethstat->nwes_addr= eth_port->etp_ethaddr;
if (!eth_port->etp_vlan)
{
result= eth_get_stat(eth_port,
&ethstat->nwes_stat);
if (result == SUSPEND)
{
#if 0
printf(
"eth_ioctl: eth_get_stat returned SUSPEND\n");
#endif
eth_fd->ef_ioctl_req= req;
assert(!(eth_fd->ef_flags &
EFF_IOCTL_IP));
eth_fd->ef_flags |= EFF_IOCTL_IP;
#if 0
printf("eth_ioctl: setting etp_getstat in port %d to %p\n",
eth_port-eth_port_table, acc);
#endif
eth_port->etp_getstat= acc;
acc= NULL;
return NW_SUSPEND;
}
if (result != NW_OK)
{
bf_afree(acc);
reply_thr_put(eth_fd, result, TRUE);
return NW_OK;
}
}
else
{
/* No statistics */
memset(&ethstat->nwes_stat, '\0',
sizeof(ethstat->nwes_stat));
}
result= (*eth_fd->ef_put_userdata)(eth_fd->
ef_srfd, 0, acc, TRUE);
if (result >= 0)
reply_thr_put(eth_fd, NW_OK, TRUE);
return result;
}
default:
break;
}
reply_thr_put(eth_fd, EBADIOCTL, TRUE);
return NW_OK;
}
int eth_write(fd, count)
int fd;
size_t count;
{
eth_fd_t *eth_fd;
eth_port_t *eth_port, *rep;
acc_t *user_data;
int r;
eth_fd= &eth_fd_table[fd];
eth_port= eth_fd->ef_port;
if (!(eth_fd->ef_flags & EFF_OPTSET))
{
reply_thr_get (eth_fd, EBADMODE, FALSE);
return NW_OK;
}
assert (!(eth_fd->ef_flags & EFF_WRITE_IP));
eth_fd->ef_write_count= count;
if (eth_fd->ef_ethopt.nweo_flags & NWEO_RWDATONLY)
count += ETH_HDR_SIZE;
if (count<ETH_MIN_PACK_SIZE || count>ETH_MAX_PACK_SIZE)
{
DBLOCK(1, printf("illegal packetsize (%d)\n",count));
reply_thr_get (eth_fd, EPACKSIZE, FALSE);
return NW_OK;
}
eth_fd->ef_flags |= EFF_WRITE_IP;
/* Enqueue at the real ethernet port */
rep= eth_port->etp_vlan_port;
if (!rep)
rep= eth_port;
if (rep->etp_wr_pack)
{
eth_fd->ef_send_next= NULL;
if (rep->etp_sendq_head)
rep->etp_sendq_tail->ef_send_next= eth_fd;
else
rep->etp_sendq_head= eth_fd;
rep->etp_sendq_tail= eth_fd;
return NW_SUSPEND;
}
user_data= (*eth_fd->ef_get_userdata)(eth_fd->ef_srfd, 0,
eth_fd->ef_write_count, FALSE);
if (!user_data)
{
eth_fd->ef_flags &= ~EFF_WRITE_IP;
reply_thr_get (eth_fd, EFAULT, FALSE);
return NW_OK;
}
r= eth_send(fd, user_data, eth_fd->ef_write_count);
assert(r == NW_OK);
eth_fd->ef_flags &= ~EFF_WRITE_IP;
reply_thr_get(eth_fd, eth_fd->ef_write_count, FALSE);
return NW_OK;
}
int eth_send(fd, data, data_len)
int fd;
acc_t *data;
size_t data_len;
{
eth_fd_t *eth_fd;
eth_port_t *eth_port, *rep;
eth_hdr_t *eth_hdr;
acc_t *eth_pack;
unsigned long nweo_flags;
size_t count;
ev_arg_t ev_arg;
eth_fd= &eth_fd_table[fd];
eth_port= eth_fd->ef_port;
if (!(eth_fd->ef_flags & EFF_OPTSET))
return EBADMODE;
count= data_len;
if (eth_fd->ef_ethopt.nweo_flags & NWEO_RWDATONLY)
count += ETH_HDR_SIZE;
if (count<ETH_MIN_PACK_SIZE || count>ETH_MAX_PACK_SIZE)
{
DBLOCK(1, printf("illegal packetsize (%d)\n",count));
return EPACKSIZE;
}
rep= eth_port->etp_vlan_port;
if (!rep)
rep= eth_port;
if (rep->etp_wr_pack)
return NW_WOULDBLOCK;
nweo_flags= eth_fd->ef_ethopt.nweo_flags;
if (nweo_flags & NWEO_RWDATONLY)
{
eth_pack= bf_memreq(ETH_HDR_SIZE);
eth_pack->acc_next= data;
}
else
eth_pack= bf_packIffLess(data, ETH_HDR_SIZE);
eth_hdr= (eth_hdr_t *)ptr2acc_data(eth_pack);
if (nweo_flags & NWEO_REMSPEC)
eth_hdr->eh_dst= eth_fd->ef_ethopt.nweo_rem;
if (!(eth_port->etp_flags & EPF_GOT_ADDR))
{
/* No device, discard packet */
bf_afree(eth_pack);
return NW_OK;
}
if (!(nweo_flags & NWEO_EN_PROMISC))
eth_hdr->eh_src= eth_port->etp_ethaddr;
if (nweo_flags & NWEO_TYPESPEC)
eth_hdr->eh_proto= eth_fd->ef_ethopt.nweo_type;
if (eth_addrcmp(eth_hdr->eh_dst, eth_port->etp_ethaddr) == 0)
{
/* Local loopback. */
eth_port->etp_wr_pack= eth_pack;
ev_arg.ev_ptr= eth_port;
ev_enqueue(&eth_port->etp_sendev, eth_loop_ev, ev_arg);
return NW_OK;
}
if (rep != eth_port)
{
eth_pack= insert_vlan_hdr(eth_port, eth_pack);
if (!eth_pack)
{
/* Packet is silently discarded */
return NW_OK;
}
}
eth_write_port(rep, eth_pack);
return NW_OK;
}
int eth_read (fd, count)
int fd;
size_t count;
{
eth_fd_t *eth_fd;
acc_t *pack;
eth_fd= &eth_fd_table[fd];
if (!(eth_fd->ef_flags & EFF_OPTSET))
{
reply_thr_put(eth_fd, EBADMODE, FALSE);
return NW_OK;
}
if (count < ETH_MAX_PACK_SIZE)
{
reply_thr_put(eth_fd, EPACKSIZE, FALSE);
return NW_OK;
}
assert(!(eth_fd->ef_flags & EFF_READ_IP));
eth_fd->ef_flags |= EFF_READ_IP;
while (eth_fd->ef_rdbuf_head)
{
pack= eth_fd->ef_rdbuf_head;
eth_fd->ef_rdbuf_head= pack->acc_ext_link;
if (get_time() <= eth_fd->ef_exp_time)
{
packet2user(eth_fd, pack, eth_fd->ef_exp_time);
if (!(eth_fd->ef_flags & EFF_READ_IP))
return NW_OK;
}
else
bf_afree(pack);
}
return NW_SUSPEND;
}
int eth_cancel(fd, which_operation)
int fd;
int which_operation;
{
eth_fd_t *eth_fd, *prev, *loc_fd;
eth_port_t *eth_port;
DBLOCK(2, printf("eth_cancel (%d)\n", fd));
eth_fd= &eth_fd_table[fd];
switch (which_operation)
{
case SR_CANCEL_READ:
assert (eth_fd->ef_flags & EFF_READ_IP);
eth_fd->ef_flags &= ~EFF_READ_IP;
reply_thr_put(eth_fd, EINTR, FALSE);
break;
case SR_CANCEL_WRITE:
assert (eth_fd->ef_flags & EFF_WRITE_IP);
eth_fd->ef_flags &= ~EFF_WRITE_IP;
/* Remove fd from send queue */
eth_port= eth_fd->ef_port;
if (eth_port->etp_vlan_port)
eth_port= eth_port->etp_vlan_port;
for (prev= 0, loc_fd= eth_port->etp_sendq_head; loc_fd != NULL;
prev= loc_fd, loc_fd= loc_fd->ef_send_next)
{
if (loc_fd == eth_fd)
break;
}
assert(loc_fd == eth_fd);
if (prev == NULL)
eth_port->etp_sendq_head= loc_fd->ef_send_next;
else
prev->ef_send_next= loc_fd->ef_send_next;
if (loc_fd->ef_send_next == NULL)
eth_port->etp_sendq_tail= prev;
reply_thr_get(eth_fd, EINTR, FALSE);
break;
case SR_CANCEL_IOCTL:
assert (eth_fd->ef_flags & EFF_IOCTL_IP);
eth_fd->ef_flags &= ~EFF_IOCTL_IP;
reply_thr_get(eth_fd, EINTR, TRUE);
break;
default:
ip_panic(( "got unknown cancel request" ));
}
return NW_OK;
}
int eth_select(fd, operations)
int fd;
unsigned operations;
{
unsigned resops;
eth_fd_t *eth_fd;
eth_fd= &eth_fd_table[fd];
assert (eth_fd->ef_flags & EFF_INUSE);
resops= 0;
if (operations & SR_SELECT_READ)
{
if (eth_sel_read(eth_fd))
resops |= SR_SELECT_READ;
else if (!(operations & SR_SELECT_POLL))
eth_fd->ef_flags |= EFF_SEL_READ;
}
if (operations & SR_SELECT_WRITE)
{
/* Should handle special case when the interface is down */
resops |= SR_SELECT_WRITE;
}
if (operations & SR_SELECT_EXCEPTION)
{
printf("eth_select: not implemented for exceptions\n");
}
return resops;
}
void eth_close(fd)
int fd;
{
eth_fd_t *eth_fd;
eth_port_t *eth_port;
acc_t *pack;
eth_fd= &eth_fd_table[fd];
assert ((eth_fd->ef_flags & EFF_INUSE) &&
!(eth_fd->ef_flags & EFF_BUSY));
if (eth_fd->ef_flags & EFF_OPTSET)
unhash_fd(eth_fd);
while (eth_fd->ef_rdbuf_head != NULL)
{
pack= eth_fd->ef_rdbuf_head;
eth_fd->ef_rdbuf_head= pack->acc_ext_link;
bf_afree(pack);
}
eth_fd->ef_flags= EFF_EMPTY;
eth_port= eth_fd->ef_port;
do_rec_conf(eth_port);
}
void eth_loop_ev(ev, ev_arg)
event_t *ev;
ev_arg_t ev_arg;
{
acc_t *pack;
eth_port_t *eth_port;
eth_port= ev_arg.ev_ptr;
assert(ev == &eth_port->etp_sendev);
pack= eth_port->etp_wr_pack;
assert(!no_ethWritePort);
no_ethWritePort= 1;
eth_arrive(eth_port, pack, bf_bufsize(pack));
assert(no_ethWritePort);
no_ethWritePort= 0;
eth_port->etp_wr_pack= NULL;
eth_restart_write(eth_port);
}
static int eth_checkopt (eth_fd)
eth_fd_t *eth_fd;
{
/* bug: we don't check access modes yet */
unsigned long flags;
unsigned int en_di_flags;
acc_t *pack;
flags= eth_fd->ef_ethopt.nweo_flags;
en_di_flags= (flags >>16) | (flags & 0xffff);
if ((en_di_flags & NWEO_ACC_MASK) &&
(en_di_flags & NWEO_LOC_MASK) &&
(en_di_flags & NWEO_BROAD_MASK) &&
(en_di_flags & NWEO_MULTI_MASK) &&
(en_di_flags & NWEO_PROMISC_MASK) &&
(en_di_flags & NWEO_REM_MASK) &&
(en_di_flags & NWEO_TYPE_MASK) &&
(en_di_flags & NWEO_RW_MASK))
{
eth_fd->ef_flags |= EFF_OPTSET;
}
else
eth_fd->ef_flags &= ~EFF_OPTSET;
while (eth_fd->ef_rdbuf_head != NULL)
{
pack= eth_fd->ef_rdbuf_head;
eth_fd->ef_rdbuf_head= pack->acc_ext_link;
bf_afree(pack);
}
return NW_OK;
}
static void hash_fd(eth_fd)
eth_fd_t *eth_fd;
{
eth_port_t *eth_port;
int hash;
eth_port= eth_fd->ef_port;
if (eth_fd->ef_ethopt.nweo_flags & NWEO_TYPEANY)
{
eth_fd->ef_type_next= eth_port->etp_type_any;
eth_port->etp_type_any= eth_fd;
}
else
{
hash= eth_fd->ef_ethopt.nweo_type;
hash ^= (hash >> 8);
hash &= (ETH_TYPE_HASH_NR-1);
eth_fd->ef_type_next= eth_port->etp_type[hash];
eth_port->etp_type[hash]= eth_fd;
}
}
static void unhash_fd(eth_fd)
eth_fd_t *eth_fd;
{
eth_port_t *eth_port;
eth_fd_t *prev, *curr, **eth_fd_p;
int hash;
eth_port= eth_fd->ef_port;
if (eth_fd->ef_ethopt.nweo_flags & NWEO_TYPEANY)
{
eth_fd_p= &eth_port->etp_type_any;
}
else
{
hash= eth_fd->ef_ethopt.nweo_type;
hash ^= (hash >> 8);
hash &= (ETH_TYPE_HASH_NR-1);
eth_fd_p= &eth_port->etp_type[hash];
}
for (prev= NULL, curr= *eth_fd_p; curr;
prev= curr, curr= curr->ef_type_next)
{
if (curr == eth_fd)
break;
}
assert(curr);
if (prev)
prev->ef_type_next= curr->ef_type_next;
else
*eth_fd_p= curr->ef_type_next;
}
void eth_restart_write(eth_port)
eth_port_t *eth_port;
{
eth_fd_t *eth_fd;
int r;
assert(eth_port->etp_wr_pack == NULL);
while (eth_fd= eth_port->etp_sendq_head, eth_fd != NULL)
{
if (eth_port->etp_wr_pack)
return;
eth_port->etp_sendq_head= eth_fd->ef_send_next;
assert(eth_fd->ef_flags & EFF_WRITE_IP);
eth_fd->ef_flags &= ~EFF_WRITE_IP;
r= eth_write(eth_fd-eth_fd_table, eth_fd->ef_write_count);
assert(r == NW_OK);
}
}
void eth_arrive (eth_port, pack, pack_size)
eth_port_t *eth_port;
acc_t *pack;
size_t pack_size;
{
eth_hdr_t *eth_hdr;
ether_addr_t *dst_addr;
int pack_stat;
ether_type_t type;
eth_fd_t *eth_fd, *first_fd, *share_fd;
int hash, i;
u16_t vlan, temp;
time_t exp_time;
acc_t *vlan_pack, *hdr_acc, *tmp_acc;
eth_port_t *vp;
vlan_hdr_t vh;
u32_t *p;
exp_time= get_time() + EXPIRE_TIME;
pack= bf_packIffLess(pack, ETH_HDR_SIZE);
eth_hdr= (eth_hdr_t*)ptr2acc_data(pack);
dst_addr= &eth_hdr->eh_dst;
DIFBLOCK(0x20, dst_addr->ea_addr[0] != 0xFF &&
(dst_addr->ea_addr[0] & 0x1),
printf("got multicast packet\n"));
if (dst_addr->ea_addr[0] & 0x1)
{
/* multi cast or broadcast */
if (eth_addrcmp(*dst_addr, broadcast) == 0)
pack_stat= NWEO_EN_BROAD;
else
pack_stat= NWEO_EN_MULTI;
}
else
{
assert(eth_port->etp_flags & EPF_GOT_ADDR);
if (eth_addrcmp (*dst_addr, eth_port->etp_ethaddr) == 0)
pack_stat= NWEO_EN_LOC;
else
pack_stat= NWEO_EN_PROMISC;
}
type= eth_hdr->eh_proto;
hash= type;
hash ^= (hash >> 8);
hash &= (ETH_TYPE_HASH_NR-1);
if (type == HTONS(ETH_VLAN_PROTO))
{
/* VLAN packet. Extract original ethernet packet */
vlan_pack= pack;
vlan_pack->acc_linkC++;
hdr_acc= bf_cut(vlan_pack, 0, 2*sizeof(ether_addr_t));
vlan_pack= bf_delhead(vlan_pack, 2*sizeof(ether_addr_t));
vlan_pack= bf_packIffLess(vlan_pack, sizeof(vh));
vh= *(vlan_hdr_t *)ptr2acc_data(vlan_pack);
vlan_pack= bf_delhead(vlan_pack, sizeof(vh));
hdr_acc= bf_append(hdr_acc, vlan_pack);
vlan_pack= hdr_acc; hdr_acc= NULL;
if (bf_bufsize(vlan_pack) < ETH_MIN_PACK_SIZE)
{
tmp_acc= bf_memreq(sizeof(vh));
/* Clear padding */
assert(sizeof(vh) <= sizeof(*p));
p= (u32_t *)ptr2acc_data(tmp_acc);
*p= 0xdeadbeef;
vlan_pack= bf_append(vlan_pack, tmp_acc);
tmp_acc= NULL;
}
vlan= ntohs(vh.vh_vlan);
if (vlan & ETH_TCI_CFI)
{
/* No support for extended address formats */
bf_afree(vlan_pack); vlan_pack= NULL;
}
vlan &= ETH_TCI_VLAN_MASK;
}
else
{
/* No VLAN processing */
vlan_pack= NULL;
vlan= 0; /* lint */
}
first_fd= NULL;
for (i= 0; i<2; i++)
{
share_fd= NULL;
eth_fd= (i == 0) ? eth_port->etp_type_any :
eth_port->etp_type[hash];
for (; eth_fd; eth_fd= eth_fd->ef_type_next)
{
if (i && eth_fd->ef_ethopt.nweo_type != type)
continue;
if (!(eth_fd->ef_ethopt.nweo_flags & pack_stat))
continue;
if (eth_fd->ef_ethopt.nweo_flags & NWEO_REMSPEC &&
eth_addrcmp(eth_hdr->eh_src,
eth_fd->ef_ethopt.nweo_rem) != 0)
{
continue;
}
if ((eth_fd->ef_ethopt.nweo_flags & NWEO_ACC_MASK) ==
NWEO_SHARED)
{
if (!share_fd)
{
share_fd= eth_fd;
continue;
}
if (!eth_fd->ef_rdbuf_head)
share_fd= eth_fd;
continue;
}
if (!first_fd)
{
first_fd= eth_fd;
continue;
}
pack->acc_linkC++;
packet2user(eth_fd, pack, exp_time);
}
if (share_fd)
{
pack->acc_linkC++;
packet2user(share_fd, pack, exp_time);
}
}
if (first_fd)
{
if (first_fd->ef_put_pkt &&
(first_fd->ef_flags & EFF_READ_IP) &&
!(first_fd->ef_ethopt.nweo_flags & NWEO_RWDATONLY))
{
(*first_fd->ef_put_pkt)(first_fd->ef_srfd, pack,
pack_size);
}
else
packet2user(first_fd, pack, exp_time);
}
else
{
if (pack_stat == NWEO_EN_LOC)
{
DBLOCK(0x01,
printf("eth_arrive: dropping packet for proto 0x%x\n",
ntohs(type)));
}
else
{
DBLOCK(0x20, printf("dropping packet for proto 0x%x\n",
ntohs(type)));
}
bf_afree(pack);
}
if (vlan_pack)
{
hash= ETH_HASH_VLAN(vlan, temp);
for (vp= eth_port->etp_vlan_tab[hash]; vp;
vp= vp->etp_vlan_next)
{
if (vp->etp_vlan == vlan)
break;
}
if (vp)
{
eth_arrive(vp, vlan_pack, pack_size-sizeof(vh));
vlan_pack= NULL;
}
else
{
/* No device for VLAN */
bf_afree(vlan_pack);
vlan_pack= NULL;
}
}
}
void eth_reg_vlan(eth_port, vlan_port)
eth_port_t *eth_port;
eth_port_t *vlan_port;
{
u16_t t, vlan;
int h;
vlan= vlan_port->etp_vlan;
h= ETH_HASH_VLAN(vlan, t);
vlan_port->etp_vlan_next= eth_port->etp_vlan_tab[h];
eth_port->etp_vlan_tab[h]= vlan_port;
}
void eth_restart_ioctl(eth_port)
eth_port_t *eth_port;
{
int i, r;
eth_fd_t *eth_fd;
acc_t *acc;
#if 0
printf("in eth_restart_ioctl\n");
#endif
/* eth_restart_ioctl is called on too occasions: when a device
* driver registers with inet and when a eth_get_stat call has
* completed. We assume the second option when etp_getstat is
* not equal to zero at the start of the call.
*/
acc= eth_port->etp_getstat;
for (i= 0, eth_fd= eth_fd_table; i<ETH_FD_NR; i++, eth_fd++)
{
if (!(eth_fd->ef_flags & EFF_INUSE))
continue;
if (eth_fd->ef_port != eth_port)
continue;
if (!(eth_fd->ef_flags & EFF_IOCTL_IP))
continue;
if (eth_fd->ef_ioctl_req != NWIOGETHSTAT)
continue;
#if 0
printf("eth_restart_ioctl: etp_getstat in port %d is %p\n",
eth_port-eth_port_table, acc);
#endif
if (acc != NULL)
{
#if 0
printf("eth_restart_ioctl: completed getstat\n");
#endif
acc->acc_linkC++;
r= (*eth_fd->ef_put_userdata)(eth_fd->ef_srfd, 0,
acc, TRUE);
if (r >= 0)
reply_thr_put(eth_fd, NW_OK, TRUE);
eth_fd->ef_flags &= ~EFF_IOCTL_IP;
continue;
}
{ static int count; if (++count > 5) ip_panic(("too many restarts")); }
eth_fd->ef_flags &= ~EFF_IOCTL_IP;
eth_ioctl(i, eth_fd->ef_ioctl_req);
}
if (acc != NULL)
{
#if 0
printf("eth_restart_ioctl: clearing etp_getstat in port %d\n",
eth_port-eth_port_table);
#endif
assert(acc == eth_port->etp_getstat);
bf_afree(acc);
eth_port->etp_getstat= NULL;
}
}
static int eth_sel_read (eth_fd)
eth_fd_t *eth_fd;
{
acc_t *tmp_acc, *next_acc;
if (!(eth_fd->ef_flags & EFF_OPTSET))
return 1; /* Read will not block */
if (eth_fd->ef_rdbuf_head)
{
if (get_time() <= eth_fd->ef_exp_time)
return 1;
tmp_acc= eth_fd->ef_rdbuf_head;
while (tmp_acc)
{
next_acc= tmp_acc->acc_ext_link;
bf_afree(tmp_acc);
tmp_acc= next_acc;
}
eth_fd->ef_rdbuf_head= NULL;
}
return 0;
}
static void packet2user (eth_fd, pack, exp_time)
eth_fd_t *eth_fd;
acc_t *pack;
time_t exp_time;
{
int result;
acc_t *tmp_pack;
size_t size;
assert (eth_fd->ef_flags & EFF_INUSE);
if (!(eth_fd->ef_flags & EFF_READ_IP))
{
if (pack->acc_linkC != 1)
{
tmp_pack= bf_dupacc(pack);
bf_afree(pack);
pack= tmp_pack;
tmp_pack= NULL;
}
pack->acc_ext_link= NULL;
if (eth_fd->ef_rdbuf_head == NULL)
{
eth_fd->ef_rdbuf_head= pack;
eth_fd->ef_exp_time= exp_time;
}
else
eth_fd->ef_rdbuf_tail->acc_ext_link= pack;
eth_fd->ef_rdbuf_tail= pack;
if (eth_fd->ef_flags & EFF_SEL_READ)
{
eth_fd->ef_flags &= ~EFF_SEL_READ;
if (eth_fd->ef_select_res)
eth_fd->ef_select_res(eth_fd->ef_srfd, SR_SELECT_READ);
else
printf("packet2user: no select_res\n");
}
return;
}
if (eth_fd->ef_ethopt.nweo_flags & NWEO_RWDATONLY)
pack= bf_delhead(pack, ETH_HDR_SIZE);
size= bf_bufsize(pack);
if (eth_fd->ef_put_pkt)
{
(*eth_fd->ef_put_pkt)(eth_fd->ef_srfd, pack, size);
return;
}
eth_fd->ef_flags &= ~EFF_READ_IP;
result= (*eth_fd->ef_put_userdata)(eth_fd->ef_srfd, (size_t)0, pack,
FALSE);
if (result >=0)
reply_thr_put(eth_fd, size, FALSE);
else
reply_thr_put(eth_fd, result, FALSE);
}
static void eth_buffree (priority)
int priority;
{
int i;
eth_fd_t *eth_fd;
acc_t *pack;
if (priority == ETH_PRI_FDBUFS_EXTRA)
{
for (i= 0, eth_fd= eth_fd_table; i<ETH_FD_NR; i++, eth_fd++)
{
while (eth_fd->ef_rdbuf_head &&
eth_fd->ef_rdbuf_head->acc_ext_link)
{
pack= eth_fd->ef_rdbuf_head;
eth_fd->ef_rdbuf_head= pack->acc_ext_link;
bf_afree(pack);
}
}
}
if (priority == ETH_PRI_FDBUFS)
{
for (i= 0, eth_fd= eth_fd_table; i<ETH_FD_NR; i++, eth_fd++)
{
while (eth_fd->ef_rdbuf_head)
{
pack= eth_fd->ef_rdbuf_head;
eth_fd->ef_rdbuf_head= pack->acc_ext_link;
bf_afree(pack);
}
}
}
}
#ifdef BUF_CONSISTENCY_CHECK
static void eth_bufcheck()
{
int i;
eth_fd_t *eth_fd;
acc_t *pack;
for (i= 0; i<eth_conf_nr; i++)
{
bf_check_acc(eth_port_table[i].etp_rd_pack);
bf_check_acc(eth_port_table[i].etp_wr_pack);
}
for (i= 0, eth_fd= eth_fd_table; i<ETH_FD_NR; i++, eth_fd++)
{
for (pack= eth_fd->ef_rdbuf_head; pack;
pack= pack->acc_ext_link)
{
bf_check_acc(pack);
}
}
}
#endif
static void do_rec_conf(eth_port)
eth_port_t *eth_port;
{
int i;
u32_t flags;
eth_port_t *vp;
assert(eth_port);
if (eth_port->etp_vlan)
{
/* Configure underlying device */
eth_port= eth_port->etp_vlan_port;
}
flags= compute_rec_conf(eth_port);
for (i= 0; i<ETH_VLAN_HASH_NR; i++)
{
for (vp= eth_port->etp_vlan_tab[i]; vp; vp= vp->etp_vlan_next)
flags |= compute_rec_conf(vp);
}
eth_set_rec_conf(eth_port, flags);
}
static u32_t compute_rec_conf(eth_port)
eth_port_t *eth_port;
{
eth_fd_t *eth_fd;
u32_t flags;
int i;
flags= NWEO_NOFLAGS;
for (i=0, eth_fd= eth_fd_table; i<ETH_FD_NR; i++, eth_fd++)
{
if ((eth_fd->ef_flags & (EFF_INUSE|EFF_OPTSET)) !=
(EFF_INUSE|EFF_OPTSET))
{
continue;
}
if (eth_fd->ef_port != eth_port)
continue;
flags |= eth_fd->ef_ethopt.nweo_flags;
}
return flags;
}
static void reply_thr_get (eth_fd, result, for_ioctl)
eth_fd_t *eth_fd;
size_t result;
int for_ioctl;
{
acc_t *data;
data= (*eth_fd->ef_get_userdata)(eth_fd->ef_srfd, result, 0, for_ioctl);
assert (!data);
}
static void reply_thr_put (eth_fd, result, for_ioctl)
eth_fd_t *eth_fd;
size_t result;
int for_ioctl;
{
int error;
error= (*eth_fd->ef_put_userdata)(eth_fd->ef_srfd, result, (acc_t *)0,
for_ioctl);
assert(error == NW_OK);
}
static acc_t *insert_vlan_hdr(eth_port, pack)
eth_port_t *eth_port;
acc_t *pack;
{
acc_t *head_acc, *vh_acc;
u16_t type, vlan;
vlan_hdr_t *vp;
head_acc= bf_cut(pack, 0, 2*sizeof(ether_addr_t));
pack= bf_delhead(pack, 2*sizeof(ether_addr_t));
pack= bf_packIffLess(pack, sizeof(type));
type= *(u16_t *)ptr2acc_data(pack);
if (type == HTONS(ETH_VLAN_PROTO))
{
/* Packeted is already tagged. Should update vlan number.
* For now, just discard packet.
*/
printf("insert_vlan_hdr: discarding vlan packet\n");
bf_afree(head_acc); head_acc= NULL;
bf_afree(pack); pack= NULL;
return NULL;
}
vlan= eth_port->etp_vlan; /* priority and CFI are zero */
vh_acc= bf_memreq(sizeof(vlan_hdr_t));
vp= (vlan_hdr_t *)ptr2acc_data(vh_acc);
vp->vh_type= HTONS(ETH_VLAN_PROTO);
vp->vh_vlan= htons(vlan);
head_acc= bf_append(head_acc, vh_acc); vh_acc= NULL;
head_acc= bf_append(head_acc, pack); pack= NULL;
pack= head_acc; head_acc= NULL;
return pack;
}
/*
* $PchId: eth.c,v 1.23 2005/06/28 14:15:58 philip Exp $
*/
Reference in New Issue View Git Blame Copy Permalink