Neale Ranns | de5b08f | 2018-08-29 06:37:18 -0700 | [diff] [blame] | 1 | /* |
| 2 | * Copyright (c) 2018 Cisco and/or its affiliates. |
| 3 | * Licensed under the Apache License, Version 2.0 (the "License"); |
| 4 | * you may not use this file except in compliance with the License. |
| 5 | * You may obtain a copy of the License at: |
| 6 | * |
| 7 | * http://www.apache.org/licenses/LICENSE-2.0 |
| 8 | * |
| 9 | * Unless required by applicable law or agreed to in writing, software |
| 10 | * distributed under the License is distributed on an "AS IS" BASIS, |
| 11 | * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. |
| 12 | * See the License for the specific language governing permissions and |
| 13 | * limitations under the License. |
| 14 | */ |
| 15 | |
| 16 | #ifndef __MAC_ADDRESS_H__ |
| 17 | #define __MAC_ADDRESS_H__ |
| 18 | |
Neale Ranns | 3702930 | 2018-08-10 05:30:06 -0700 | [diff] [blame] | 19 | #include <vlib/vlib.h> |
Neale Ranns | de5b08f | 2018-08-29 06:37:18 -0700 | [diff] [blame] | 20 | |
| 21 | typedef struct mac_address_t_ |
| 22 | { |
Neale Ranns | 4d5b917 | 2018-10-24 02:57:49 -0700 | [diff] [blame] | 23 | union |
| 24 | { |
| 25 | u8 bytes[6]; |
Neale Ranns | faf22cb | 2018-11-16 05:20:36 -0800 | [diff] [blame] | 26 | struct |
| 27 | { |
| 28 | u32 first_4; |
| 29 | u16 last_2; |
| 30 | } __clib_packed u; |
Neale Ranns | 4d5b917 | 2018-10-24 02:57:49 -0700 | [diff] [blame] | 31 | }; |
Neale Ranns | de5b08f | 2018-08-29 06:37:18 -0700 | [diff] [blame] | 32 | } mac_address_t; |
| 33 | |
Neale Ranns | faf22cb | 2018-11-16 05:20:36 -0800 | [diff] [blame] | 34 | STATIC_ASSERT ((sizeof (mac_address_t) == 6), |
| 35 | "MAC address must represent the on wire format"); |
| 36 | |
Neale Ranns | de5b08f | 2018-08-29 06:37:18 -0700 | [diff] [blame] | 37 | extern const mac_address_t ZERO_MAC_ADDRESS; |
| 38 | |
Neale Ranns | 3702930 | 2018-08-10 05:30:06 -0700 | [diff] [blame] | 39 | always_inline u64 |
| 40 | ethernet_mac_address_u64 (const u8 * a) |
| 41 | { |
| 42 | return (((u64) a[0] << (u64) (5 * 8)) |
| 43 | | ((u64) a[1] << (u64) (4 * 8)) |
| 44 | | ((u64) a[2] << (u64) (3 * 8)) |
| 45 | | ((u64) a[3] << (u64) (2 * 8)) |
| 46 | | ((u64) a[4] << (u64) (1 * 8)) | ((u64) a[5] << (u64) (0 * 8))); |
| 47 | } |
| 48 | |
| 49 | always_inline void |
| 50 | ethernet_mac_address_from_u64 (u64 u, u8 * a) |
| 51 | { |
| 52 | i8 ii; |
| 53 | |
| 54 | for (ii = 5; ii >= 0; ii--) |
| 55 | { |
| 56 | a[ii] = u & 0xFF; |
| 57 | u = u >> 8; |
| 58 | } |
| 59 | } |
| 60 | |
| 61 | static inline int |
| 62 | ethernet_mac_address_is_multicast_u64 (u64 a) |
| 63 | { |
| 64 | return (a & (1ULL << (5 * 8))) != 0; |
| 65 | } |
| 66 | |
| 67 | static inline int |
| 68 | ethernet_mac_address_is_zero (const u8 * mac) |
| 69 | { |
| 70 | return ((*((u32 *) mac) == 0) && (*((u16 *) (mac + 4)) == 0)); |
| 71 | } |
| 72 | |
BenoƮt Ganne | fe750c2 | 2019-03-25 11:41:34 +0100 | [diff] [blame] | 73 | static inline void |
| 74 | ethernet_mac_address_generate (u8 * mac) |
| 75 | { |
| 76 | u32 rnd = clib_cpu_time_now (); |
| 77 | rnd = random_u32 (&rnd); |
| 78 | |
| 79 | memcpy (mac + 2, &rnd, sizeof (rnd)); |
| 80 | mac[0] = 2; |
| 81 | mac[1] = 0xfe; |
| 82 | } |
| 83 | |
Neale Ranns | 3702930 | 2018-08-10 05:30:06 -0700 | [diff] [blame] | 84 | static inline int |
| 85 | ethernet_mac_address_equal (const u8 * a, const u8 * b) |
| 86 | { |
| 87 | return ((*((u32 *) a) == (*((u32 *) b))) && |
| 88 | (*((u16 *) (a + 4)) == (*((u16 *) (b + 4))))); |
| 89 | } |
| 90 | |
Neale Ranns | de5b08f | 2018-08-29 06:37:18 -0700 | [diff] [blame] | 91 | static_always_inline void |
| 92 | mac_address_from_bytes (mac_address_t * mac, const u8 * bytes) |
| 93 | { |
Neale Ranns | 4d5b917 | 2018-10-24 02:57:49 -0700 | [diff] [blame] | 94 | /* zero out the last 2 bytes, then copy over only 6 */ |
Neale Ranns | 3702930 | 2018-08-10 05:30:06 -0700 | [diff] [blame] | 95 | clib_memcpy_fast (mac->bytes, bytes, 6); |
Neale Ranns | de5b08f | 2018-08-29 06:37:18 -0700 | [diff] [blame] | 96 | } |
| 97 | |
Neale Ranns | 93cc3ee | 2018-10-10 07:22:51 -0700 | [diff] [blame] | 98 | static_always_inline void |
| 99 | mac_address_to_bytes (const mac_address_t * mac, u8 * bytes) |
| 100 | { |
| 101 | /* zero out the last 2 bytes, then copy over only 6 */ |
Neale Ranns | 3702930 | 2018-08-10 05:30:06 -0700 | [diff] [blame] | 102 | clib_memcpy_fast (bytes, mac->bytes, 6); |
Neale Ranns | 93cc3ee | 2018-10-10 07:22:51 -0700 | [diff] [blame] | 103 | } |
| 104 | |
Neale Ranns | de5b08f | 2018-08-29 06:37:18 -0700 | [diff] [blame] | 105 | static_always_inline int |
| 106 | mac_address_is_zero (const mac_address_t * mac) |
| 107 | { |
Neale Ranns | faf22cb | 2018-11-16 05:20:36 -0800 | [diff] [blame] | 108 | return (0 == mac->u.first_4 && 0 == mac->u.last_2); |
Neale Ranns | de5b08f | 2018-08-29 06:37:18 -0700 | [diff] [blame] | 109 | } |
| 110 | |
| 111 | static_always_inline u64 |
| 112 | mac_address_as_u64 (const mac_address_t * mac) |
| 113 | { |
Jon Loeliger | 6a32ce3 | 2020-03-09 13:13:35 -0500 | [diff] [blame] | 114 | volatile u64 as_u64 = 0; |
Neale Ranns | faf22cb | 2018-11-16 05:20:36 -0800 | [diff] [blame] | 115 | |
Jon Loeliger | 6a32ce3 | 2020-03-09 13:13:35 -0500 | [diff] [blame] | 116 | clib_memcpy ((void *) &as_u64, mac->bytes, 6); |
Neale Ranns | faf22cb | 2018-11-16 05:20:36 -0800 | [diff] [blame] | 117 | |
Jon Loeliger | 6a32ce3 | 2020-03-09 13:13:35 -0500 | [diff] [blame] | 118 | return as_u64; |
Neale Ranns | de5b08f | 2018-08-29 06:37:18 -0700 | [diff] [blame] | 119 | } |
| 120 | |
| 121 | static_always_inline void |
Neale Ranns | 3702930 | 2018-08-10 05:30:06 -0700 | [diff] [blame] | 122 | mac_address_from_u64 (mac_address_t * mac, u64 u) |
Neale Ranns | de5b08f | 2018-08-29 06:37:18 -0700 | [diff] [blame] | 123 | { |
Neale Ranns | faf22cb | 2018-11-16 05:20:36 -0800 | [diff] [blame] | 124 | clib_memcpy (mac->bytes, &u, 6); |
Neale Ranns | de5b08f | 2018-08-29 06:37:18 -0700 | [diff] [blame] | 125 | } |
| 126 | |
Neale Ranns | 93cc3ee | 2018-10-10 07:22:51 -0700 | [diff] [blame] | 127 | static_always_inline void |
| 128 | mac_address_copy (mac_address_t * dst, const mac_address_t * src) |
| 129 | { |
| 130 | mac_address_from_bytes (dst, src->bytes); |
| 131 | } |
| 132 | |
Neale Ranns | 3702930 | 2018-08-10 05:30:06 -0700 | [diff] [blame] | 133 | static_always_inline int |
| 134 | mac_address_cmp (const mac_address_t * a, const mac_address_t * b) |
| 135 | { |
| 136 | return (memcmp (a->bytes, b->bytes, 6)); |
| 137 | } |
| 138 | |
| 139 | static_always_inline int |
| 140 | mac_address_equal (const mac_address_t * a, const mac_address_t * b) |
| 141 | { |
| 142 | return (a->u.last_2 == b->u.last_2 && a->u.first_4 == b->u.first_4); |
| 143 | } |
| 144 | |
| 145 | static_always_inline void |
| 146 | mac_address_set_zero (mac_address_t * mac) |
| 147 | { |
| 148 | mac->u.first_4 = 0; |
| 149 | mac->u.last_2 = 0; |
| 150 | } |
| 151 | |
Neale Ranns | e98d71b | 2020-02-24 12:45:53 +0000 | [diff] [blame] | 152 | static_always_inline int |
| 153 | mac_address_n_bits_set (const mac_address_t * a) |
| 154 | { |
| 155 | return (count_set_bits (mac_address_as_u64 (a))); |
| 156 | } |
| 157 | |
Neale Ranns | cbe25aa | 2019-09-30 10:53:31 +0000 | [diff] [blame] | 158 | extern void mac_address_increment (mac_address_t * mac); |
Neale Ranns | 86327be | 2018-11-02 09:14:01 -0700 | [diff] [blame] | 159 | extern uword unformat_mac_address_t (unformat_input_t * input, |
| 160 | va_list * args); |
Neale Ranns | de5b08f | 2018-08-29 06:37:18 -0700 | [diff] [blame] | 161 | extern u8 *format_mac_address_t (u8 * s, va_list * args); |
| 162 | |
| 163 | #endif |
| 164 | |
| 165 | /* |
| 166 | * fd.io coding-style-patch-verification: ON |
| 167 | * |
| 168 | * Local Variables: |
| 169 | * eval: (c-set-style "gnu") |
| 170 | * End: |
| 171 | */ |