/* * Copyright (c) 2020, The OpenThread Authors. * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * 3. Neither the name of the copyright holder nor the * names of its contributors may be used to endorse or promote products * derived from this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include #include #include #include "common/code_utils.hpp" #include "common/logging.hpp" #include "common/types.hpp" namespace otbr { Ip6Address::Ip6Address(const uint8_t (&aAddress)[16]) { memcpy(m8, aAddress, sizeof(m8)); } Ip6Address::Ip6Address(const otIp6Address &aAddress) { memcpy(m8, aAddress.mFields.m8, sizeof(m8)); } std::string Ip6Address::ToString() const { char strbuf[INET6_ADDRSTRLEN]; VerifyOrDie(inet_ntop(AF_INET6, this->m8, strbuf, sizeof(strbuf)) != nullptr, "Failed to convert Ip6 address to string"); return std::string(strbuf); } Ip6Address Ip6Address::ToSolicitedNodeMulticastAddress(void) const { Ip6Address ma(Ip6Address::GetSolicitedMulticastAddressPrefix()); ma.m8[13] = m8[13]; ma.m8[14] = m8[14]; ma.m8[15] = m8[15]; return ma; } void Ip6Address::CopyTo(struct sockaddr_in6 &aSockAddr) const { memset(&aSockAddr, 0, sizeof(aSockAddr)); CopyTo(aSockAddr.sin6_addr); aSockAddr.sin6_family = AF_INET6; } void Ip6Address::CopyFrom(const struct sockaddr_in6 &aSockAddr) { CopyFrom(aSockAddr.sin6_addr); } void Ip6Address::CopyTo(struct in6_addr &aIn6Addr) const { static_assert(sizeof(m8) == sizeof(aIn6Addr.s6_addr), "invalid IPv6 address size"); memcpy(aIn6Addr.s6_addr, m8, sizeof(aIn6Addr.s6_addr)); } void Ip6Address::CopyFrom(const struct in6_addr &aIn6Addr) { static_assert(sizeof(m8) == sizeof(aIn6Addr.s6_addr), "invalid IPv6 address size"); memcpy(m8, aIn6Addr.s6_addr, sizeof(aIn6Addr.s6_addr)); } otbrError Ip6Address::FromString(const char *aStr, Ip6Address &aAddr) { int ret; ret = inet_pton(AF_INET6, aStr, &aAddr.m8); return ret == 1 ? OTBR_ERROR_NONE : OTBR_ERROR_INVALID_ARGS; } Ip6Address Ip6Address::FromString(const char *aStr) { Ip6Address addr; SuccessOrDie(FromString(aStr, addr), "inet_pton failed"); return addr; } bool Ip6Prefix::operator==(const Ip6Prefix &aOther) const { bool isEqual = false; uint8_t lengthFullBytes; // the number of complete bytes in the prefix length uint8_t lengthRemainingBits; // the number of remaining bits in the prefix length that do not form a complete byte VerifyOrExit(mLength == aOther.mLength); lengthFullBytes = mLength / 8; lengthRemainingBits = mLength % 8; VerifyOrExit(memcmp(mPrefix.m8, aOther.mPrefix.m8, lengthFullBytes) == 0); if (lengthRemainingBits > 0) { uint8_t mask = 0xff << (8 - lengthRemainingBits); VerifyOrExit((mPrefix.m8[lengthFullBytes] & mask) == (aOther.mPrefix.m8[lengthFullBytes] & mask)); } isEqual = true; exit: return isEqual; } bool Ip6Prefix::operator!=(const Ip6Prefix &aOther) const { return !(*this == aOther); } void Ip6Prefix::Set(const otIp6Prefix &aPrefix) { memcpy(reinterpret_cast(this), &aPrefix, sizeof(*this)); } std::string Ip6Prefix::ToString() const { std::stringbuf strBuilder; char strbuf[INET6_ADDRSTRLEN]; VerifyOrDie(inet_ntop(AF_INET6, mPrefix.m8, strbuf, sizeof(strbuf)) != nullptr, "Failed to convert Ip6 prefix to string"); strBuilder.sputn(strbuf, strlen(strbuf)); strBuilder.sputc('/'); snprintf(strbuf, sizeof(strbuf), "%d", mLength); strBuilder.sputn(strbuf, strlen(strbuf)); return strBuilder.str(); } std::string MacAddress::ToString(void) const { char strbuf[sizeof(m8) * 3]; snprintf(strbuf, sizeof(strbuf), "%02x:%02x:%02x:%02x:%02x:%02x", m8[0], m8[1], m8[2], m8[3], m8[4], m8[5]); return std::string(strbuf); } otError OtbrErrorToOtError(otbrError aError) { otError error; switch (aError) { case OTBR_ERROR_NONE: error = OT_ERROR_NONE; break; case OTBR_ERROR_NOT_FOUND: error = OT_ERROR_NOT_FOUND; break; case OTBR_ERROR_PARSE: error = OT_ERROR_PARSE; break; case OTBR_ERROR_NOT_IMPLEMENTED: error = OT_ERROR_NOT_IMPLEMENTED; break; case OTBR_ERROR_INVALID_ARGS: error = OT_ERROR_INVALID_ARGS; break; case OTBR_ERROR_DUPLICATED: error = OT_ERROR_DUPLICATED; break; case OTBR_ERROR_INVALID_STATE: error = OT_ERROR_INVALID_STATE; break; default: error = OT_ERROR_FAILED; break; } return error; } } // namespace otbr