#include <sys/param.h>
#include <sys/socket.h>
#include <net/if.h>
#include <net/if_ether.h>
#include <netinet/in.h>
#include <netinet/in_systm.h>
#include <lib/libsa/stand.h>
#include <lib/libsa/net.h>
#include "ofdev.h"
#include "openfirm.h"
#include "netif_of.h"
static struct iodesc sdesc;
struct iodesc *
socktodesc(int sock)
{
if (sock != 0)
return NULL;
return &sdesc;
}
int
netif_of_open(struct of_dev *op)
{
struct iodesc *io;
#ifdef NETIF_DEBUG
printf("netif_open...");
#endif
io = &sdesc;
if (io->io_netif) {
#ifdef NETIF_DEBUG
printf("device busy\n");
#endif
errno = ENFILE;
return -1;
}
(void)memset(io, 0, sizeof *io);
io->io_netif = (void *)op;
OF_getprop(OF_instance_to_package(op->handle),
"mac-address", io->myea, sizeof io->myea);
#ifdef NETIF_DEBUG
printf("OK\n");
#endif
return 0;
}
void
netif_of_close(int fd)
{
struct iodesc *io;
#ifdef NETIF_DEBUG
printf("netif_close(%x)...", fd);
#endif
#ifdef NETIF_DEBUG
if (fd != 0) {
printf("EBADF\n");
return;
}
#endif
io = &sdesc;
io->io_netif = NULL;
#ifdef NETIF_DEBUG
printf("OK\n");
#endif
}
ssize_t
netif_put(struct iodesc *desc, void *pkt, size_t len)
{
struct of_dev *op;
ssize_t rv;
size_t sendlen;
op = (struct of_dev *)desc->io_netif;
#ifdef NETIF_DEBUG
{
struct ether_header *eh;
printf("netif_put: desc=0x%x pkt=0x%x len=%d\n",
desc, pkt, len);
eh = pkt;
printf("dst: %s ", ether_sprintf(eh->ether_dhost));
printf("src: %s ", ether_sprintf(eh->ether_shost));
printf("type: 0x%x\n", eh->ether_type & 0xFFFF);
}
#endif
sendlen = len;
if (sendlen < 60) {
sendlen = 60;
#ifdef NETIF_DEBUG
printf("netif_put: length padded to %d\n", sendlen);
#endif
}
rv = OF_write(op->handle, pkt, sendlen);
#ifdef NETIF_DEBUG
printf("netif_put: xmit returned %d\n", rv);
#endif
return rv;
}
ssize_t
netif_get(struct iodesc *desc, void *pkt, size_t maxlen, saseconds_t timo)
{
struct of_dev *op;
int tick0, tmo_ms;
int len;
op = (struct of_dev *)desc->io_netif;
#ifdef NETIF_DEBUG
printf("netif_get: pkt=0x%x, maxlen=%d, tmo=%d\n",
pkt, maxlen, timo);
#endif
tmo_ms = timo * 1000;
tick0 = OF_milliseconds();
do {
len = OF_read(op->handle, pkt, maxlen);
} while ((len == -2 || len == 0) &&
(OF_milliseconds() - tick0 < tmo_ms));
#ifdef NETIF_DEBUG
printf("netif_get: received len=%d\n", len);
#endif
if (len < 12)
return -1;
#ifdef NETIF_DEBUG
{
struct ether_header *eh = pkt;
printf("dst: %s ", ether_sprintf(eh->ether_dhost));
printf("src: %s ", ether_sprintf(eh->ether_shost));
printf("type: 0x%x\n", eh->ether_type & 0xFFFF);
}
#endif
return len;
}
satime_t
getsecs(void)
{
return OF_milliseconds() / 1000;
}