Changes in uspace/srv/net/ethip/pdu.c [02a09ed:96c0b7b] in mainline

File:

• uspace/srv/net/ethip/pdu.c (modified) (13 diffs)

uspace/srv/net/ethip/pdu.c

@@ -62 +62 @@
 
         hdr = (eth_header_t *)data;
-        addr48(frame->src, hdr->src);
-        addr48(frame->dest, hdr->dest);
+        mac48_encode(&frame->src, hdr->src);
+        mac48_encode(&frame->dest, hdr->dest);
         hdr->etype_len = host2uint16_t_be(frame->etype_len);
 
@@ -69 +69 @@
             frame->size);
 
-        log_msg(LOG_DEFAULT, LVL_DEBUG, "Encoded Ethernet frame (%zu bytes)", size);
+        log_msg(LVL_DEBUG, "Encoding Ethernet frame src=%llx dest=%llx etype=%x",
+            frame->src, frame->dest, frame->etype_len);
+        log_msg(LVL_DEBUG, "Encoded Ethernet frame (%zu bytes)", size);
 
         *rdata = data;
@@ -81 +83 @@
         eth_header_t *hdr;
 
-        log_msg(LOG_DEFAULT, LVL_DEBUG, "eth_pdu_decode()");
+        log_msg(LVL_DEBUG, "eth_pdu_decode()");
 
         if (size < sizeof(eth_header_t)) {
-                log_msg(LOG_DEFAULT, LVL_DEBUG, "PDU too short (%zu)", size);
+                log_msg(LVL_DEBUG, "PDU too short (%zu)", size);
                 return EINVAL;
         }
@@ -95 +97 @@
                 return ENOMEM;
 
-        addr48(hdr->src, frame->src);
-        addr48(hdr->dest, frame->dest);
+        mac48_decode(hdr->src, &frame->src);
+        mac48_decode(hdr->dest, &frame->dest);
         frame->etype_len = uint16_t_be2host(hdr->etype_len);
 
@@ -102 +104 @@
             frame->size);
 
-        log_msg(LOG_DEFAULT, LVL_DEBUG, "Decoded Ethernet frame payload (%zu bytes)", frame->size);
-
-        return EOK;
+        log_msg(LVL_DEBUG, "Decoding Ethernet frame src=%llx dest=%llx etype=%x",
+            frame->src, frame->dest, frame->etype_len);
+        log_msg(LVL_DEBUG, "Decoded Ethernet frame payload (%zu bytes)", frame->size);
+
+        return EOK;
+}
+
+void mac48_encode(mac48_addr_t *addr, void *buf)
+{
+        uint64_t val;
+        uint8_t *bbuf = (uint8_t *)buf;
+        int i;
+
+        val = addr->addr;
+        for (i = 0; i < MAC48_BYTES; i++)
+                bbuf[i] = (val >> (8 * (MAC48_BYTES - i - 1))) & 0xff;
+}
+
+void mac48_decode(void *data, mac48_addr_t *addr)
+{
+        uint64_t val;
+        uint8_t *bdata = (uint8_t *)data;
+        int i;
+
+        val = 0;
+        for (i = 0; i < MAC48_BYTES; i++)
+                val |= (uint64_t)bdata[i] << (8 * (MAC48_BYTES - i - 1));
+
+        addr->addr = val;
 }
 
@@ -115 +143 @@
         uint16_t fopcode;
 
-        log_msg(LOG_DEFAULT, LVL_DEBUG, "arp_pdu_encode()");
+        log_msg(LVL_DEBUG, "arp_pdu_encode()");
 
         size = sizeof(arp_eth_packet_fmt_t);
@@ -138 +166 @@
         pfmt->proto_addr_size = IPV4_ADDR_SIZE;
         pfmt->opcode = host2uint16_t_be(fopcode);
-        addr48(packet->sender_hw_addr, pfmt->sender_hw_addr);
+        mac48_encode(&packet->sender_hw_addr, pfmt->sender_hw_addr);
         pfmt->sender_proto_addr =
-            host2uint32_t_be(packet->sender_proto_addr);
-        addr48(packet->target_hw_addr, pfmt->target_hw_addr);
+            host2uint32_t_be(packet->sender_proto_addr.ipv4);
+        mac48_encode(&packet->target_hw_addr, pfmt->target_hw_addr);
         pfmt->target_proto_addr =
-            host2uint32_t_be(packet->target_proto_addr);
+            host2uint32_t_be(packet->target_proto_addr.ipv4);
 
         *rdata = data;
@@ -155 +183 @@
         arp_eth_packet_fmt_t *pfmt;
 
-        log_msg(LOG_DEFAULT, LVL_DEBUG, "arp_pdu_decode()");
+        log_msg(LVL_DEBUG, "arp_pdu_decode()");
 
         if (size < sizeof(arp_eth_packet_fmt_t)) {
-                log_msg(LOG_DEFAULT, LVL_DEBUG, "ARP PDU too short (%zu)", size);
+                log_msg(LVL_DEBUG, "ARP PDU too short (%zu)", size);
                 return EINVAL;
         }
@@ -165 +193 @@
 
         if (uint16_t_be2host(pfmt->hw_addr_space) != AHRD_ETHERNET) {
-                log_msg(LOG_DEFAULT, LVL_DEBUG, "HW address space != %u (%" PRIu16 ")",
+                log_msg(LVL_DEBUG, "HW address space != %u (%" PRIu16 ")",
                     AHRD_ETHERNET, uint16_t_be2host(pfmt->hw_addr_space));
                 return EINVAL;
@@ -171 +199 @@
 
         if (uint16_t_be2host(pfmt->proto_addr_space) != 0x0800) {
-                log_msg(LOG_DEFAULT, LVL_DEBUG, "Proto address space != %u (%" PRIu16 ")",
+                log_msg(LVL_DEBUG, "Proto address space != %u (%" PRIu16 ")",
                     ETYPE_IP, uint16_t_be2host(pfmt->proto_addr_space));
                 return EINVAL;
@@ -177 +205 @@
 
         if (pfmt->hw_addr_size != ETH_ADDR_SIZE) {
-                log_msg(LOG_DEFAULT, LVL_DEBUG, "HW address size != %zu (%zu)",
+                log_msg(LVL_DEBUG, "HW address size != %zu (%zu)",
                     (size_t)ETH_ADDR_SIZE, (size_t)pfmt->hw_addr_size);
                 return EINVAL;
@@ -183 +211 @@
 
         if (pfmt->proto_addr_size != IPV4_ADDR_SIZE) {
-                log_msg(LOG_DEFAULT, LVL_DEBUG, "Proto address size != %zu (%zu)",
+                log_msg(LVL_DEBUG, "Proto address size != %zu (%zu)",
                     (size_t)IPV4_ADDR_SIZE, (size_t)pfmt->proto_addr_size);
                 return EINVAL;
@@ -192 +220 @@
         case AOP_REPLY: packet->opcode = aop_reply; break;
         default:
-                log_msg(LOG_DEFAULT, LVL_DEBUG, "Invalid ARP opcode (%" PRIu16 ")",
+                log_msg(LVL_DEBUG, "Invalid ARP opcode (%" PRIu16 ")",
                     uint16_t_be2host(pfmt->opcode));
                 return EINVAL;
         }
 
-        addr48(pfmt->sender_hw_addr, packet->sender_hw_addr);
-        packet->sender_proto_addr =
+        mac48_decode(pfmt->sender_hw_addr, &packet->sender_hw_addr);
+        packet->sender_proto_addr.ipv4 =
             uint32_t_be2host(pfmt->sender_proto_addr);
-        addr48(pfmt->target_hw_addr, packet->target_hw_addr);
-        packet->target_proto_addr =
+        mac48_decode(pfmt->target_hw_addr, &packet->target_hw_addr);
+        packet->target_proto_addr.ipv4 =
             uint32_t_be2host(pfmt->target_proto_addr);
-        log_msg(LOG_DEFAULT, LVL_DEBUG, "packet->tpa = %x\n", pfmt->target_proto_addr);
-
-        return EOK;
-}
+        log_msg(LVL_DEBUG, "packet->tpa = %x\n", pfmt->target_proto_addr);
+
+        return EOK;
+}
+
 
 /** @}