-
- packet_t * p = (packet_t *) packet;
-
- outputf("NIC: Packet: %d 0x%x", _nic->packetlen, htons(p->ethertype));
- if (htons(p->ethertype) == 0x1338) {
- if (htons(p->datalen) + sizeof(packet_t) > _nic->packetlen) {
- outputf("NIC: Malformed packet");
- } else {
- handle_command(p);
+
+ len = _nic->packetlen;
+
+ outputf("NIC: Packet: %d bytes", len);
+
+ p = pbuf_alloc(PBUF_RAW, len, PBUF_POOL);
+ if (p == NULL)
+ {
+ outputf("NIC: out of memory for packet?");
+ LINK_STATS_INC(link.memerr);
+ LINK_STATS_INC(link.drop);
+ return;
+ }
+
+ for(q = p; q != NULL; q = q->next)
+ {
+ memcpy(q->payload, pkt+pos, q->len);
+ pos += q->len;
+ }
+
+ LINK_STATS_INC(link.recv);
+
+ ethhdr = p->payload;
+
+ switch (htons(ethhdr->type)) {
+ case ETHTYPE_IP:
+ case ETHTYPE_ARP:
+ if (_netif.input(p, &_netif) != ERR_OK)
+ {
+ LWIP_DEBUGF(NETIF_DEBUG, ("netdev_input: IP input error\n"));
+ pbuf_free(p);