#include #include #include #include #include #include #include #include #include #include #include #include #include struct ethernet_packet { uint8_t destination[6]; uint8_t source[6]; uint16_t type; uint8_t payload[]; } __attribute__((packed)) __attribute__((aligned(2))); extern spin_lock_t net_raw_sockets_lock; extern list_t * net_raw_sockets_list; extern void net_sock_add(sock_t * sock, void * frame); extern void net_ipv4_handle(void * packet, fs_node_t * nic); extern void net_arp_handle(void * packet, fs_node_t * nic); void net_eth_handle(struct ethernet_packet * frame, fs_node_t * nic) { spin_lock(net_raw_sockets_lock); foreach(node, net_raw_sockets_list) { sock_t * sock = node->value; if (!sock->_fnode.device || sock->_fnode.device == nic) { net_sock_add(sock, frame); } } spin_unlock(net_raw_sockets_lock); struct EthernetDevice * nic_eth = nic->device; if (!memcmp(frame->destination, nic_eth->mac, 6) || !memcmp(frame->destination, ETHERNET_BROADCAST_MAC, 6)) { /* Now pass the frame to the appropriate handler... */ switch (ntohs(frame->type)) { case ETHERNET_TYPE_ARP: net_arp_handle(&frame->payload, nic); break; case ETHERNET_TYPE_IPV4: printf("net: eth: %s: rx ipv4 packet\n", nic->name); net_ipv4_handle(&frame->payload, nic); break; } } free(frame); } void net_eth_send(struct EthernetDevice * nic, size_t len, void* data, uint16_t type, uint8_t * dest) { size_t total_size = sizeof(struct ethernet_packet) + len; struct ethernet_packet * packet = malloc(total_size); memcpy(packet->payload, data, len); memcpy(packet->destination, dest, 6); memcpy(packet->source, nic->mac, 6); packet->type = htons(type); write_fs(nic->device_node, 0, total_size, (uint8_t*)packet); free(packet); }