Mark
46 lines
1.2 KiB
C
46 lines
1.2 KiB
C
#include "net/packet.h"
|
|
#include "sys/assert.h"
|
|
#include "sys/string.h"
|
|
#include "sys/debug.h"
|
|
#include "net/util.h"
|
|
#include "net/eth.h"
|
|
#include "net/if.h"
|
|
|
|
#include "net/inet.h"
|
|
#include "net/arp.h"
|
|
|
|
int eth_send_wrapped(struct netdev *src, const uint8_t *hwaddr, uint16_t et, void *data, size_t len) {
|
|
struct eth_frame *eth = data;
|
|
|
|
memcpy(eth->dst_hwaddr, hwaddr, 6);
|
|
memcpy(eth->src_hwaddr, src->hwaddr, 6);
|
|
eth->ethertype = htons(et);
|
|
|
|
_assert(src->send);
|
|
return src->send(src, data, len);
|
|
}
|
|
|
|
void eth_handle_frame(struct packet *p) {
|
|
if (p->size < sizeof(struct eth_frame)) {
|
|
kwarn("%s: dropping undersized packet: %u\n", p->dev->name, p->size);
|
|
return;
|
|
}
|
|
|
|
struct eth_frame *eth = (struct eth_frame *) p->data;
|
|
|
|
switch (ntohs(eth->ethertype)) {
|
|
case ETH_T_ARP:
|
|
arp_handle_frame(p, p->data + sizeof(struct eth_frame), p->size - sizeof(struct eth_frame));
|
|
break;
|
|
case ETH_T_IP:
|
|
inet_handle_frame(p, eth, p->data + sizeof(struct eth_frame), p->size - sizeof(struct eth_frame));
|
|
break;
|
|
case ETH_T_IPv6:
|
|
// Silently drop
|
|
break;
|
|
default:
|
|
kwarn("%s: dropping unknown type: %04x\n", p->dev->name, ntohs(eth->ethertype));
|
|
break;
|
|
}
|
|
}
|