Ratan Gupta | 82549cc | 2017-04-21 08:45:23 +0530 | [diff] [blame] | 1 | #pragma once |
William A. Kennington III | bb0eacc | 2022-10-21 15:22:06 -0700 | [diff] [blame] | 2 | #include <fmt/core.h> |
| 3 | #include <net/ethernet.h> |
William A. Kennington III | 0d7ce48 | 2019-01-30 17:14:23 -0800 | [diff] [blame] | 4 | #include <netinet/in.h> |
Ratan Gupta | 3681a50 | 2017-06-17 19:20:04 +0530 | [diff] [blame] | 5 | |
William A. Kennington III | bb0eacc | 2022-10-21 15:22:06 -0700 | [diff] [blame] | 6 | #include <algorithm> |
| 7 | #include <array> |
Patrick Venture | 189d44e | 2018-07-09 12:30:59 -0700 | [diff] [blame] | 8 | #include <chrono> |
William A. Kennington III | 71de63a | 2022-11-08 10:50:54 -0800 | [diff] [blame] | 9 | #include <numeric> |
William A. Kennington III | 3a70fa2 | 2018-09-20 18:48:20 -0700 | [diff] [blame] | 10 | #include <sdeventplus/clock.hpp> |
| 11 | #include <sdeventplus/utility/timer.hpp> |
Patrick Venture | 189d44e | 2018-07-09 12:30:59 -0700 | [diff] [blame] | 12 | #include <string> |
William A. Kennington III | bb0eacc | 2022-10-21 15:22:06 -0700 | [diff] [blame] | 13 | #include <string_view> |
| 14 | #include <type_traits> |
William A. Kennington III | dd9ef81 | 2022-10-05 02:08:02 -0700 | [diff] [blame] | 15 | #include <unordered_map> |
Willy Tu | f7dce2e | 2022-10-07 05:48:08 +0000 | [diff] [blame] | 16 | #include <unordered_set> |
William A. Kennington III | 0d7ce48 | 2019-01-30 17:14:23 -0800 | [diff] [blame] | 17 | #include <variant> |
Ratan Gupta | 0f9dc1b | 2017-09-03 17:57:50 +0530 | [diff] [blame] | 18 | |
Ratan Gupta | 82549cc | 2017-04-21 08:45:23 +0530 | [diff] [blame] | 19 | namespace phosphor |
| 20 | { |
| 21 | namespace network |
| 22 | { |
Ratan Gupta | e05083a | 2017-09-16 07:12:11 +0530 | [diff] [blame] | 23 | |
| 24 | using namespace std::chrono_literals; |
Ratan Gupta | 16f1288 | 2017-09-22 18:26:11 +0530 | [diff] [blame] | 25 | |
William A. Kennington III | c7cf25f | 2021-11-09 16:16:59 -0800 | [diff] [blame] | 26 | // wait for three seconds before reloading systemd-networkd |
| 27 | constexpr auto reloadTimeout = 3s; |
Ratan Gupta | 16f1288 | 2017-09-22 18:26:11 +0530 | [diff] [blame] | 28 | |
William A. Kennington III | d41db38 | 2021-11-09 20:42:29 -0800 | [diff] [blame] | 29 | // refresh the objets after four seconds as network |
| 30 | // configuration takes 3-4 sec to reconfigure at most. |
| 31 | constexpr auto refreshTimeout = 4s; |
Ratan Gupta | e05083a | 2017-09-16 07:12:11 +0530 | [diff] [blame] | 32 | |
William A. Kennington III | 0d7ce48 | 2019-01-30 17:14:23 -0800 | [diff] [blame] | 33 | // Byte representations for common address types in network byte order |
William A. Kennington III | bb0eacc | 2022-10-21 15:22:06 -0700 | [diff] [blame] | 34 | using InAddrAny = std::variant<in_addr, in6_addr>; |
William A. Kennington III | b9d7cba | 2022-11-08 10:54:11 -0800 | [diff] [blame^] | 35 | class IfAddr |
| 36 | { |
| 37 | private: |
| 38 | InAddrAny addr; |
| 39 | uint8_t pfx; |
| 40 | |
| 41 | static void invalidPfx(uint8_t pfx); |
| 42 | |
| 43 | public: |
| 44 | constexpr IfAddr() : addr({}), pfx(0) |
| 45 | { |
| 46 | } |
| 47 | |
| 48 | constexpr IfAddr(InAddrAny addr, uint8_t pfx) : addr(addr), pfx(pfx) |
| 49 | { |
| 50 | std::visit( |
| 51 | [pfx](auto v) { |
| 52 | if (sizeof(v) * 8 < pfx) |
| 53 | { |
| 54 | invalidPfx(pfx); |
| 55 | } |
| 56 | }, |
| 57 | addr); |
| 58 | } |
| 59 | |
| 60 | constexpr auto getAddr() const |
| 61 | { |
| 62 | return addr; |
| 63 | } |
| 64 | |
| 65 | constexpr auto getPfx() const |
| 66 | { |
| 67 | return pfx; |
| 68 | } |
| 69 | |
| 70 | constexpr bool operator==(phosphor::network::IfAddr rhs) const noexcept |
| 71 | { |
| 72 | return addr == rhs.addr && pfx == rhs.pfx; |
| 73 | } |
| 74 | }; |
William A. Kennington III | 0d7ce48 | 2019-01-30 17:14:23 -0800 | [diff] [blame] | 75 | |
William A. Kennington III | 3a70fa2 | 2018-09-20 18:48:20 -0700 | [diff] [blame] | 76 | using Timer = sdeventplus::utility::Timer<sdeventplus::ClockId::Monotonic>; |
| 77 | |
William A. Kennington III | dd9ef81 | 2022-10-05 02:08:02 -0700 | [diff] [blame] | 78 | struct string_hash : public std::hash<std::string_view> |
| 79 | { |
| 80 | using is_transparent = void; |
| 81 | }; |
| 82 | template <typename V> |
| 83 | using string_umap = |
| 84 | std::unordered_map<std::string, V, string_hash, std::equal_to<>>; |
William A. Kennington III | 9644479 | 2022-10-05 15:16:22 -0700 | [diff] [blame] | 85 | using string_uset = |
| 86 | std::unordered_set<std::string, string_hash, std::equal_to<>>; |
William A. Kennington III | dd9ef81 | 2022-10-05 02:08:02 -0700 | [diff] [blame] | 87 | |
William A. Kennington III | 3e471c5 | 2022-10-27 19:46:07 -0700 | [diff] [blame] | 88 | constexpr std::size_t hash_multi() noexcept |
William A. Kennington III | 991a8e8 | 2022-10-11 15:02:47 -0700 | [diff] [blame] | 89 | { |
| 90 | return 0; |
| 91 | } |
| 92 | |
| 93 | template <typename T, typename... Args> |
William A. Kennington III | becda1a | 2022-11-03 12:44:59 -0700 | [diff] [blame] | 94 | constexpr std::size_t hash_multi(const T& v, const Args&... args) noexcept |
William A. Kennington III | 991a8e8 | 2022-10-11 15:02:47 -0700 | [diff] [blame] | 95 | { |
| 96 | const std::size_t seed = hash_multi(args...); |
| 97 | return seed ^ (std::hash<T>{}(v) + 0x9e3779b9 + (seed << 6) + (seed >> 2)); |
| 98 | } |
| 99 | |
William A. Kennington III | bb0eacc | 2022-10-21 15:22:06 -0700 | [diff] [blame] | 100 | namespace detail |
| 101 | { |
| 102 | |
William A. Kennington III | 71de63a | 2022-11-08 10:50:54 -0800 | [diff] [blame] | 103 | template <typename T, uint8_t size = sizeof(T)> |
| 104 | struct BswapAlign |
| 105 | { |
| 106 | using type = T; |
| 107 | }; |
| 108 | |
| 109 | template <typename T> |
| 110 | struct BswapAlign<T, 2> |
| 111 | { |
| 112 | using type alignas(uint16_t) = T; |
| 113 | }; |
| 114 | |
| 115 | template <typename T> |
| 116 | struct BswapAlign<T, 4> |
| 117 | { |
| 118 | using type alignas(uint32_t) = T; |
| 119 | }; |
| 120 | |
| 121 | template <typename T> |
| 122 | struct BswapAlign<T, 8> |
| 123 | { |
| 124 | using type alignas(uint64_t) = T; |
| 125 | }; |
| 126 | |
| 127 | template <typename T> |
| 128 | constexpr T bswapInt(typename BswapAlign<T>::type n) noexcept |
| 129 | { |
| 130 | static_assert(std::is_trivially_copyable_v<T>); |
| 131 | if constexpr (sizeof(T) == 2) |
| 132 | { |
| 133 | reinterpret_cast<uint16_t&>(n) = |
| 134 | __builtin_bswap16(reinterpret_cast<uint16_t&>(n)); |
| 135 | } |
| 136 | else if constexpr (sizeof(T) == 4) |
| 137 | { |
| 138 | reinterpret_cast<uint32_t&>(n) = |
| 139 | __builtin_bswap32(reinterpret_cast<uint32_t&>(n)); |
| 140 | } |
| 141 | else if constexpr (sizeof(T) == 8) |
| 142 | { |
| 143 | reinterpret_cast<uint64_t&>(n) = |
| 144 | __builtin_bswap64(reinterpret_cast<uint64_t&>(n)); |
| 145 | } |
| 146 | else |
| 147 | { |
| 148 | auto b = reinterpret_cast<std::byte*>(&n); |
| 149 | std::reverse(b, b + sizeof(n)); |
| 150 | } |
| 151 | return n; |
| 152 | } |
| 153 | |
| 154 | } // namespace detail |
| 155 | |
| 156 | template <typename T> |
| 157 | constexpr T bswap(T n) noexcept |
| 158 | { |
| 159 | return detail::bswapInt<T>(n); |
| 160 | } |
| 161 | |
| 162 | template <typename T> |
| 163 | constexpr T hton(T n) noexcept |
| 164 | { |
| 165 | if constexpr (std::endian::native == std::endian::big) |
| 166 | { |
| 167 | return n; |
| 168 | } |
| 169 | else if constexpr (std::endian::native == std::endian::little) |
| 170 | { |
| 171 | return bswap(n); |
| 172 | } |
| 173 | else |
| 174 | { |
| 175 | static_assert(std::is_same_v<T, void>); |
| 176 | } |
| 177 | } |
| 178 | |
| 179 | template <typename T> |
| 180 | constexpr T ntoh(T n) noexcept |
| 181 | { |
| 182 | return hton(n); |
| 183 | } |
| 184 | |
| 185 | namespace detail |
| 186 | { |
| 187 | |
William A. Kennington III | bb0eacc | 2022-10-21 15:22:06 -0700 | [diff] [blame] | 188 | template <typename T> |
| 189 | constexpr bool vcontains() noexcept |
| 190 | { |
| 191 | return false; |
| 192 | } |
| 193 | |
| 194 | template <typename T, typename V, typename... Vs> |
| 195 | constexpr bool vcontains() noexcept |
| 196 | { |
| 197 | return vcontains<T, Vs...>() || std::is_same_v<T, V>; |
| 198 | } |
| 199 | |
| 200 | template <typename T, typename... Types> |
| 201 | constexpr std::enable_if_t<vcontains<T, Types...>(), bool> |
| 202 | veq(T t, std::variant<Types...> v) noexcept |
| 203 | { |
| 204 | return std::visit( |
| 205 | [t](auto v) { |
| 206 | if constexpr (std::is_same_v<T, decltype(v)>) |
| 207 | { |
| 208 | return v == t; |
| 209 | } |
| 210 | else |
| 211 | { |
| 212 | return false; |
| 213 | } |
| 214 | }, |
| 215 | v); |
| 216 | } |
| 217 | |
| 218 | template <typename T> |
| 219 | struct AddrBufMaker |
| 220 | { |
| 221 | }; |
| 222 | |
| 223 | template <> |
| 224 | struct AddrBufMaker<ether_addr> |
| 225 | { |
| 226 | public: |
| 227 | std::string_view operator()(ether_addr val) noexcept; |
| 228 | |
| 229 | private: |
| 230 | std::array<char, /*octet*/ 2 * /*octets*/ 6 + /*seps*/ 5> buf; |
| 231 | }; |
| 232 | |
| 233 | template <> |
| 234 | struct AddrBufMaker<in_addr> |
| 235 | { |
| 236 | public: |
| 237 | std::string_view operator()(in_addr val) noexcept; |
| 238 | |
| 239 | private: |
| 240 | std::array<char, /*octet*/ 3 * /*octets*/ 4 + /*seps*/ 3> buf; |
| 241 | }; |
| 242 | |
| 243 | template <> |
| 244 | struct AddrBufMaker<in6_addr> |
| 245 | { |
| 246 | public: |
| 247 | std::string_view operator()(in6_addr val) noexcept; |
| 248 | |
| 249 | private: |
| 250 | std::array<char, /*hextet*/ 4 * /*hextets*/ 8 + /*seps*/ 7> buf; |
| 251 | }; |
| 252 | |
| 253 | template <typename BufMaker> |
| 254 | struct FormatFromBuf |
| 255 | { |
| 256 | private: |
| 257 | fmt::formatter<std::string_view> formatter; |
| 258 | |
| 259 | public: |
| 260 | template <typename ParseContext> |
| 261 | constexpr auto parse(ParseContext& ctx) |
| 262 | { |
| 263 | return ctx.begin(); |
| 264 | } |
| 265 | |
| 266 | template <typename FormatContext> |
| 267 | auto format(auto v, FormatContext& ctx) const |
| 268 | { |
| 269 | return formatter.format(BufMaker{}(v), ctx); |
| 270 | } |
| 271 | }; |
| 272 | } // namespace detail |
Gunnar Mills | 57d9c50 | 2018-09-14 14:42:34 -0500 | [diff] [blame] | 273 | } // namespace network |
| 274 | } // namespace phosphor |
William A. Kennington III | 3e471c5 | 2022-10-27 19:46:07 -0700 | [diff] [blame] | 275 | |
| 276 | template <typename... Ts> |
| 277 | struct std::hash<std::tuple<Ts...>> |
| 278 | { |
| 279 | constexpr auto operator()(const std::tuple<Ts...>& t) const noexcept |
| 280 | { |
| 281 | return std::apply(phosphor::network::hash_multi<Ts...>, t); |
| 282 | } |
| 283 | }; |
William A. Kennington III | bb0eacc | 2022-10-21 15:22:06 -0700 | [diff] [blame] | 284 | |
William A. Kennington III | 653114f | 2022-11-01 22:34:04 -0700 | [diff] [blame] | 285 | template <> |
| 286 | struct std::hash<in_addr> |
| 287 | { |
| 288 | std::size_t operator()(in_addr addr) const noexcept; |
| 289 | }; |
| 290 | |
| 291 | template <> |
| 292 | struct std::hash<in6_addr> |
| 293 | { |
| 294 | std::size_t operator()(in6_addr addr) const noexcept; |
| 295 | }; |
| 296 | |
William A. Kennington III | b9d7cba | 2022-11-08 10:54:11 -0800 | [diff] [blame^] | 297 | template <> |
| 298 | struct std::hash<phosphor::network::IfAddr> |
| 299 | { |
| 300 | std::size_t operator()(phosphor::network::IfAddr addr) const noexcept; |
| 301 | }; |
| 302 | |
William A. Kennington III | bb0eacc | 2022-10-21 15:22:06 -0700 | [diff] [blame] | 303 | namespace fmt |
| 304 | { |
| 305 | template <> |
| 306 | struct formatter<ether_addr> |
| 307 | : phosphor::network::detail::FormatFromBuf< |
| 308 | phosphor::network::detail::AddrBufMaker<ether_addr>> |
| 309 | { |
| 310 | }; |
| 311 | template <> |
| 312 | struct formatter<in_addr> |
| 313 | : phosphor::network::detail::FormatFromBuf< |
| 314 | phosphor::network::detail::AddrBufMaker<in_addr>> |
| 315 | { |
| 316 | }; |
| 317 | template <> |
| 318 | struct formatter<in6_addr> |
| 319 | : phosphor::network::detail::FormatFromBuf< |
| 320 | phosphor::network::detail::AddrBufMaker<in6_addr>> |
| 321 | { |
| 322 | }; |
| 323 | template <> |
| 324 | struct formatter<phosphor::network::InAddrAny> |
| 325 | { |
| 326 | private: |
| 327 | fmt::formatter<std::string_view> formatter; |
| 328 | |
| 329 | public: |
| 330 | template <typename ParseContext> |
| 331 | constexpr auto parse(ParseContext& ctx) |
| 332 | { |
| 333 | return ctx.begin(); |
| 334 | } |
| 335 | |
| 336 | template <typename FormatContext> |
| 337 | auto format(auto v, FormatContext& ctx) const |
| 338 | { |
| 339 | return std::visit( |
| 340 | [&](auto v) { |
| 341 | auto abm = |
| 342 | phosphor::network::detail::AddrBufMaker<decltype(v)>{}; |
| 343 | return formatter.format(abm(v), ctx); |
| 344 | }, |
| 345 | v); |
| 346 | } |
| 347 | }; |
William A. Kennington III | b9d7cba | 2022-11-08 10:54:11 -0800 | [diff] [blame^] | 348 | template <> |
| 349 | struct formatter<phosphor::network::IfAddr> |
| 350 | { |
| 351 | private: |
| 352 | fmt::formatter<phosphor::network::InAddrAny> addrF; |
| 353 | fmt::formatter<char> strF; |
| 354 | fmt::formatter<uint8_t> numF; |
| 355 | |
| 356 | public: |
| 357 | template <typename ParseContext> |
| 358 | constexpr auto parse(ParseContext& ctx) |
| 359 | { |
| 360 | return ctx.begin(); |
| 361 | } |
| 362 | |
| 363 | template <typename FormatContext> |
| 364 | auto format(auto v, FormatContext& ctx) const |
| 365 | { |
| 366 | addrF.format(v.getAddr(), ctx); |
| 367 | strF.format('/', ctx); |
| 368 | return numF.format(v.getPfx(), ctx); |
| 369 | } |
| 370 | }; |
William A. Kennington III | bb0eacc | 2022-10-21 15:22:06 -0700 | [diff] [blame] | 371 | } // namespace fmt |
| 372 | |
| 373 | namespace std |
| 374 | { |
| 375 | string to_string(ether_addr value); |
| 376 | string to_string(in_addr value); |
| 377 | string to_string(in6_addr value); |
| 378 | string to_string(phosphor::network::InAddrAny value); |
William A. Kennington III | b9d7cba | 2022-11-08 10:54:11 -0800 | [diff] [blame^] | 379 | string to_string(phosphor::network::IfAddr value); |
William A. Kennington III | bb0eacc | 2022-10-21 15:22:06 -0700 | [diff] [blame] | 380 | } // namespace std |
| 381 | |
| 382 | constexpr bool operator==(ether_addr lhs, ether_addr rhs) noexcept |
| 383 | { |
| 384 | return std::equal(lhs.ether_addr_octet, lhs.ether_addr_octet + 6, |
| 385 | rhs.ether_addr_octet); |
| 386 | } |
| 387 | |
| 388 | constexpr bool operator==(in_addr lhs, in_addr rhs) noexcept |
| 389 | { |
| 390 | return lhs.s_addr == rhs.s_addr; |
| 391 | } |
| 392 | |
| 393 | constexpr bool operator==(in6_addr lhs, in6_addr rhs) noexcept |
| 394 | { |
| 395 | return std::equal(lhs.s6_addr32, lhs.s6_addr32 + 4, rhs.s6_addr32); |
| 396 | } |
| 397 | |
| 398 | template <typename T> |
| 399 | constexpr std::enable_if_t<!std::is_same_v<phosphor::network::InAddrAny, T>, |
| 400 | bool> |
| 401 | operator==(phosphor::network::InAddrAny lhs, T rhs) noexcept |
| 402 | { |
| 403 | return phosphor::network::detail::veq(rhs, lhs); |
| 404 | } |
| 405 | |
William A. Kennington III | 86eb8b7 | 2022-11-01 22:35:04 -0700 | [diff] [blame] | 406 | auto& operator<<(auto& os, ether_addr v) |
William A. Kennington III | bb0eacc | 2022-10-21 15:22:06 -0700 | [diff] [blame] | 407 | { |
| 408 | return os << phosphor::network::detail::AddrBufMaker<ether_addr>{}(v); |
| 409 | } |
| 410 | |
William A. Kennington III | 86eb8b7 | 2022-11-01 22:35:04 -0700 | [diff] [blame] | 411 | auto& operator<<(auto& os, in_addr v) |
William A. Kennington III | bb0eacc | 2022-10-21 15:22:06 -0700 | [diff] [blame] | 412 | { |
| 413 | return os << phosphor::network::detail::AddrBufMaker<in_addr>{}(v); |
| 414 | } |
| 415 | |
William A. Kennington III | 86eb8b7 | 2022-11-01 22:35:04 -0700 | [diff] [blame] | 416 | auto& operator<<(auto& os, in6_addr v) |
William A. Kennington III | bb0eacc | 2022-10-21 15:22:06 -0700 | [diff] [blame] | 417 | { |
| 418 | return os << phosphor::network::detail::AddrBufMaker<in6_addr>{}(v); |
| 419 | } |
| 420 | |
William A. Kennington III | 86eb8b7 | 2022-11-01 22:35:04 -0700 | [diff] [blame] | 421 | auto& operator<<(auto& os, phosphor::network::InAddrAny v) |
William A. Kennington III | bb0eacc | 2022-10-21 15:22:06 -0700 | [diff] [blame] | 422 | { |
| 423 | return os << std::visit( |
| 424 | [](auto v) { |
| 425 | return phosphor::network::detail::AddrBufMaker< |
| 426 | decltype(v)>{}(v); |
| 427 | }, |
| 428 | v); |
| 429 | } |
William A. Kennington III | b9d7cba | 2022-11-08 10:54:11 -0800 | [diff] [blame^] | 430 | |
| 431 | auto& operator<<(auto& os, phosphor::network::IfAddr v) |
| 432 | { |
| 433 | return os << v.getAddr() << "/" << std::dec << int{v.getPfx()}; |
| 434 | } |