/* * Copyright (c) 2019, 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 "mac_frame.h" #include #include #include "common/code_utils.hpp" #include "mac/mac_frame.hpp" using namespace ot; bool otMacFrameDoesAddrMatch(const otRadioFrame *aFrame, otPanId aPanId, otShortAddress aShortAddress, const otExtAddress *aExtAddress) { return otMacFrameDoesAddrMatchAny(aFrame, aPanId, aShortAddress, Mac::kShortAddrInvalid, aExtAddress); } bool otMacFrameDoesAddrMatchAny(const otRadioFrame *aFrame, otPanId aPanId, otShortAddress aShortAddress, otShortAddress aAltShortAddress, const otExtAddress *aExtAddress) { const Mac::Frame &frame = *static_cast(aFrame); bool rval = true; Mac::Address dst; Mac::PanId panid; VerifyOrExit(frame.GetDstAddr(dst) == kErrorNone, rval = false); switch (dst.GetType()) { case Mac::Address::kTypeShort: VerifyOrExit(dst.GetShort() == Mac::kShortAddrBroadcast || dst.GetShort() == aShortAddress || (aAltShortAddress != Mac::kShortAddrInvalid && dst.GetShort() == aAltShortAddress), rval = false); break; case Mac::Address::kTypeExtended: VerifyOrExit(dst.GetExtended() == *static_cast(aExtAddress), rval = false); break; case Mac::Address::kTypeNone: break; } SuccessOrExit(frame.GetDstPanId(panid)); VerifyOrExit(panid == Mac::kPanIdBroadcast || panid == aPanId, rval = false); exit: return rval; } bool otMacFrameIsAck(const otRadioFrame *aFrame) { return static_cast(aFrame)->GetType() == Mac::Frame::kTypeAck; } bool otMacFrameIsData(const otRadioFrame *aFrame) { return static_cast(aFrame)->GetType() == Mac::Frame::kTypeData; } bool otMacFrameIsCommand(const otRadioFrame *aFrame) { return static_cast(aFrame)->GetType() == Mac::Frame::kTypeMacCmd; } bool otMacFrameIsDataRequest(const otRadioFrame *aFrame) { return static_cast(aFrame)->IsDataRequestCommand(); } bool otMacFrameIsAckRequested(const otRadioFrame *aFrame) { return static_cast(aFrame)->GetAckRequest(); } static void GetOtMacAddress(const Mac::Address &aInAddress, otMacAddress *aOutAddress) { switch (aInAddress.GetType()) { case Mac::Address::kTypeNone: aOutAddress->mType = OT_MAC_ADDRESS_TYPE_NONE; break; case Mac::Address::kTypeShort: aOutAddress->mType = OT_MAC_ADDRESS_TYPE_SHORT; aOutAddress->mAddress.mShortAddress = aInAddress.GetShort(); break; case Mac::Address::kTypeExtended: aOutAddress->mType = OT_MAC_ADDRESS_TYPE_EXTENDED; aOutAddress->mAddress.mExtAddress = aInAddress.GetExtended(); break; } } otError otMacFrameGetSrcAddr(const otRadioFrame *aFrame, otMacAddress *aMacAddress) { otError error; Mac::Address address; error = static_cast(aFrame)->GetSrcAddr(address); SuccessOrExit(error); GetOtMacAddress(address, aMacAddress); exit: return error; } otError otMacFrameGetDstAddr(const otRadioFrame *aFrame, otMacAddress *aMacAddress) { otError error; Mac::Address address; error = static_cast(aFrame)->GetDstAddr(address); SuccessOrExit(error); GetOtMacAddress(address, aMacAddress); exit: return error; } otError otMacFrameGetSequence(const otRadioFrame *aFrame, uint8_t *aSequence) { otError error; if (static_cast(aFrame)->IsSequencePresent()) { *aSequence = static_cast(aFrame)->GetSequence(); error = kErrorNone; } else { error = kErrorParse; } return error; } void otMacFrameProcessTransmitAesCcm(otRadioFrame *aFrame, const otExtAddress *aExtAddress) { static_cast(aFrame)->ProcessTransmitAesCcm(*static_cast(aExtAddress)); } bool otMacFrameIsVersion2015(const otRadioFrame *aFrame) { return static_cast(aFrame)->IsVersion2015(); } void otMacFrameGenerateImmAck(const otRadioFrame *aFrame, bool aIsFramePending, otRadioFrame *aAckFrame) { assert(aFrame != nullptr && aAckFrame != nullptr); static_cast(aAckFrame)->GenerateImmAck(*static_cast(aFrame), aIsFramePending); } #if OPENTHREAD_CONFIG_THREAD_VERSION >= OT_THREAD_VERSION_1_2 otError otMacFrameGenerateEnhAck(const otRadioFrame *aFrame, bool aIsFramePending, const uint8_t *aIeData, uint8_t aIeLength, otRadioFrame *aAckFrame) { assert(aFrame != nullptr && aAckFrame != nullptr); return static_cast(aAckFrame)->GenerateEnhAck(*static_cast(aFrame), aIsFramePending, aIeData, aIeLength); } #endif #if OPENTHREAD_CONFIG_MAC_CSL_RECEIVER_ENABLE void otMacFrameSetCslIe(otRadioFrame *aFrame, uint16_t aCslPeriod, uint16_t aCslPhase) { static_cast(aFrame)->SetCslIe(aCslPeriod, aCslPhase); } #endif // OPENTHREAD_CONFIG_MAC_CSL_RECEIVER_ENABLE bool otMacFrameIsSecurityEnabled(otRadioFrame *aFrame) { return static_cast(aFrame)->GetSecurityEnabled(); } bool otMacFrameIsKeyIdMode1(otRadioFrame *aFrame) { uint8_t keyIdMode; otError error; error = static_cast(aFrame)->GetKeyIdMode(keyIdMode); return (error == OT_ERROR_NONE) ? (keyIdMode == Mac::Frame::kKeyIdMode1) : false; } bool otMacFrameIsKeyIdMode2(otRadioFrame *aFrame) { uint8_t keyIdMode; otError error; error = static_cast(aFrame)->GetKeyIdMode(keyIdMode); return (error == OT_ERROR_NONE) ? (keyIdMode == Mac::Frame::kKeyIdMode2) : false; } uint8_t otMacFrameGetKeyId(otRadioFrame *aFrame) { uint8_t keyId = 0; IgnoreError(static_cast(aFrame)->GetKeyId(keyId)); return keyId; } void otMacFrameSetKeyId(otRadioFrame *aFrame, uint8_t aKeyId) { static_cast(aFrame)->SetKeyId(aKeyId); } uint32_t otMacFrameGetFrameCounter(otRadioFrame *aFrame) { uint32_t frameCounter = UINT32_MAX; IgnoreError(static_cast(aFrame)->GetFrameCounter(frameCounter)); return frameCounter; } void otMacFrameSetFrameCounter(otRadioFrame *aFrame, uint32_t aFrameCounter) { static_cast(aFrame)->SetFrameCounter(aFrameCounter); } #if OPENTHREAD_CONFIG_MAC_CSL_RECEIVER_ENABLE uint8_t otMacFrameGenerateCslIeTemplate(uint8_t *aDest) { assert(aDest != nullptr); reinterpret_cast(aDest)->SetId(Mac::CslIe::kHeaderIeId); reinterpret_cast(aDest)->SetLength(sizeof(Mac::CslIe)); return sizeof(Mac::HeaderIe) + sizeof(Mac::CslIe); } #endif #if OPENTHREAD_CONFIG_MLE_LINK_METRICS_SUBJECT_ENABLE uint8_t otMacFrameGenerateEnhAckProbingIe(uint8_t *aDest, const uint8_t *aIeData, uint8_t aIeDataLength) { uint8_t len = sizeof(Mac::VendorIeHeader) + aIeDataLength; assert(aDest != nullptr); reinterpret_cast(aDest)->SetId(Mac::ThreadIe::kHeaderIeId); reinterpret_cast(aDest)->SetLength(len); aDest += sizeof(Mac::HeaderIe); reinterpret_cast(aDest)->SetVendorOui(Mac::ThreadIe::kVendorOuiThreadCompanyId); reinterpret_cast(aDest)->SetSubType(Mac::ThreadIe::kEnhAckProbingIe); if (aIeData != nullptr) { aDest += sizeof(Mac::VendorIeHeader); memcpy(aDest, aIeData, aIeDataLength); } return sizeof(Mac::HeaderIe) + len; } void otMacFrameSetEnhAckProbingIe(otRadioFrame *aFrame, const uint8_t *aData, uint8_t aDataLen) { assert(aFrame != nullptr && aData != nullptr); reinterpret_cast(aFrame)->SetEnhAckProbingIe(aData, aDataLen); } #endif // OPENTHREAD_CONFIG_MLE_LINK_METRICS_SUBJECT_ENABLE #if OPENTHREAD_CONFIG_MAC_CSL_RECEIVER_ENABLE static uint16_t ComputeCslPhase(uint32_t aRadioTime, otRadioContext *aRadioContext) { return (aRadioContext->mCslSampleTime - aRadioTime) % (aRadioContext->mCslPeriod * OT_US_PER_TEN_SYMBOLS) / OT_US_PER_TEN_SYMBOLS; } #endif otError otMacFrameProcessTransmitSecurity(otRadioFrame *aFrame, otRadioContext *aRadioContext) { otError error = OT_ERROR_NONE; #if OPENTHREAD_CONFIG_THREAD_VERSION >= OT_THREAD_VERSION_1_2 otMacKeyMaterial *key = nullptr; uint8_t keyId; uint32_t frameCounter; bool processKeyId; processKeyId = #if OPENTHREAD_CONFIG_WAKEUP_COORDINATOR_ENABLE otMacFrameIsKeyIdMode2(aFrame) || #endif otMacFrameIsKeyIdMode1(aFrame); VerifyOrExit(otMacFrameIsSecurityEnabled(aFrame) && processKeyId && !aFrame->mInfo.mTxInfo.mIsSecurityProcessed); if (otMacFrameIsAck(aFrame)) { keyId = otMacFrameGetKeyId(aFrame); VerifyOrExit(keyId != 0, error = OT_ERROR_FAILED); if (keyId == aRadioContext->mKeyId) { key = &aRadioContext->mCurrKey; frameCounter = aRadioContext->mMacFrameCounter++; } else if (keyId == aRadioContext->mKeyId - 1) { key = &aRadioContext->mPrevKey; frameCounter = aRadioContext->mPrevMacFrameCounter++; } else if (keyId == aRadioContext->mKeyId + 1) { key = &aRadioContext->mNextKey; frameCounter = 0; } else { ExitNow(error = OT_ERROR_SECURITY); } } else if (!aFrame->mInfo.mTxInfo.mIsHeaderUpdated) { key = &aRadioContext->mCurrKey; keyId = aRadioContext->mKeyId; frameCounter = aRadioContext->mMacFrameCounter++; } if (key != nullptr) { aFrame->mInfo.mTxInfo.mAesKey = key; otMacFrameSetKeyId(aFrame, keyId); otMacFrameSetFrameCounter(aFrame, frameCounter); aFrame->mInfo.mTxInfo.mIsHeaderUpdated = true; } #else VerifyOrExit(!aFrame->mInfo.mTxInfo.mIsSecurityProcessed); #endif // OPENTHREAD_CONFIG_THREAD_VERSION >= OT_THREAD_VERSION_1_2 otMacFrameProcessTransmitAesCcm(aFrame, &aRadioContext->mExtAddress); exit: return error; } #if OPENTHREAD_CONFIG_TIME_SYNC_ENABLE void otMacFrameUpdateTimeIe(otRadioFrame *aFrame, uint64_t aRadioTime, otRadioContext *aRadioContext) { uint8_t *timeIe; uint64_t time; VerifyOrExit((aFrame->mInfo.mTxInfo.mIeInfo != nullptr) && (aFrame->mInfo.mTxInfo.mIeInfo->mTimeIeOffset != 0)); timeIe = aFrame->mPsdu + aFrame->mInfo.mTxInfo.mIeInfo->mTimeIeOffset; time = aRadioTime + aFrame->mInfo.mTxInfo.mIeInfo->mNetworkTimeOffset; *timeIe = aFrame->mInfo.mTxInfo.mIeInfo->mTimeSyncSeq; *(++timeIe) = static_cast(time & 0xff); for (uint8_t i = 1; i < sizeof(uint64_t); i++) { time = time >> 8; *(++timeIe) = static_cast(time & 0xff); } exit: return; } #endif // OPENTHREAD_CONFIG_TIME_SYNC_ENABLE otError otMacFrameProcessTxSfd(otRadioFrame *aFrame, uint64_t aRadioTime, otRadioContext *aRadioContext) { #if OPENTHREAD_CONFIG_MAC_CSL_RECEIVER_ENABLE if (aRadioContext->mCslPeriod > 0) // CSL IE should be filled for every transmit attempt { otMacFrameSetCslIe(aFrame, aRadioContext->mCslPeriod, ComputeCslPhase(aRadioTime, aRadioContext)); } #endif #if OPENTHREAD_CONFIG_TIME_SYNC_ENABLE otMacFrameUpdateTimeIe(aFrame, aRadioTime, aRadioContext); #endif aFrame->mInfo.mTxInfo.mTimestamp = aRadioTime; return otMacFrameProcessTransmitSecurity(aFrame, aRadioContext); }