ethernet: add sanity checks to p2p_ethernet_add/del

[vpp.git] / src / vnet / ethernet / mac_address.c

diff --git a/src/vnet/ethernet/mac_address.c b/src/vnet/ethernet/mac_address.c
index 72725c8..b798129 100644 (file)
--- a/src/vnet/ethernet/mac_address.c
+++ b/src/vnet/ethernet/mac_address.c
@@ -15,20 +15,61 @@
 
 #include <vnet/ethernet/mac_address.h>
 
+/* *INDENT-OFF* */
 const mac_address_t ZERO_MAC_ADDRESS = {
   .bytes = {
-           0, 0, 0, 0, 0, 0,
-           },
+    0, 0, 0, 0, 0, 0,
+  },
 };
+/* *INDENT-ON* */
 
 u8 *
 format_mac_address_t (u8 * s, va_list * args)
 {
   const mac_address_t *mac = va_arg (*args, mac_address_t *);
 
-  return (format (s, "%U", format_mac_address, mac->bytes));
+  return format (s, "%02x:%02x:%02x:%02x:%02x:%02x",
+                mac->bytes[0], mac->bytes[1], mac->bytes[2],
+                mac->bytes[3], mac->bytes[4], mac->bytes[5]);
 }
 
+uword
+unformat_mac_address_t (unformat_input_t * input, va_list * args)
+{
+  mac_address_t *mac = va_arg (*args, mac_address_t *);
+  u32 i, a[3];
+
+  if (unformat (input, "%_%X:%X:%X:%X:%X:%X%_",
+               1, &mac->bytes[0], 1, &mac->bytes[1], 1, &mac->bytes[2],
+               1, &mac->bytes[3], 1, &mac->bytes[4], 1, &mac->bytes[5]))
+    return (1);
+  else if (unformat (input, "%_%x.%x.%x%_", &a[0], &a[1], &a[2]))
+    {
+      for (i = 0; i < ARRAY_LEN (a); i++)
+       if (a[i] >= (1 << 16))
+         return 0;
+
+      mac->bytes[0] = (a[0] >> 8) & 0xff;
+      mac->bytes[1] = (a[0] >> 0) & 0xff;
+      mac->bytes[2] = (a[1] >> 8) & 0xff;
+      mac->bytes[3] = (a[1] >> 0) & 0xff;
+      mac->bytes[4] = (a[2] >> 8) & 0xff;
+      mac->bytes[5] = (a[2] >> 0) & 0xff;
+
+      return (1);
+    }
+  return (0);
+}
+
+void
+mac_address_increment (mac_address_t * mac)
+{
+  u64 a;
+
+  a = mac_address_as_u64 (mac);
+  a++;
+  mac_address_from_u64 (mac, a);
+}
 
 /*
  * fd.io coding-style-patch-verification: ON