ThreadError Local::AddHasRoutePrefix(const uint8_t *aPrefix, uint8_t aPrefixLength, int8_t aPrf, bool aStable) { PrefixTlv *prefixTlv; HasRouteTlv *hasRouteTlv; RemoveHasRoutePrefix(aPrefix, aPrefixLength); prefixTlv = reinterpret_cast<PrefixTlv *>(mTlvs + mLength); Insert(reinterpret_cast<uint8_t *>(prefixTlv), sizeof(PrefixTlv) + BitVectorBytes(aPrefixLength) + sizeof(HasRouteTlv) + sizeof(HasRouteEntry)); prefixTlv->Init(0, aPrefixLength, aPrefix); prefixTlv->SetSubTlvsLength(sizeof(HasRouteTlv) + sizeof(HasRouteEntry)); hasRouteTlv = reinterpret_cast<HasRouteTlv *>(prefixTlv->GetSubTlvs()); hasRouteTlv->Init(); hasRouteTlv->SetLength(hasRouteTlv->GetLength() + sizeof(HasRouteEntry)); hasRouteTlv->GetEntry(0)->Init(); hasRouteTlv->GetEntry(0)->SetPreference(aPrf); if (aStable) { prefixTlv->SetStable(); hasRouteTlv->SetStable(); } otDumpDebgNetData("add route done", mTlvs, mLength); return kThreadError_None; }
otError Local::AddHasRoutePrefix(const uint8_t *aPrefix, uint8_t aPrefixLength, int8_t aPrf, bool aStable) { otError error = OT_ERROR_NONE; uint8_t prefixLengthBytes = BitVectorBytes(aPrefixLength); PrefixTlv * prefixTlv; HasRouteTlv *hasRouteTlv; uint8_t appendLength; VerifyOrExit(prefixLengthBytes <= sizeof(Ip6::Address), error = OT_ERROR_INVALID_ARGS); VerifyOrExit((aPrf == OT_ROUTE_PREFERENCE_LOW) || (aPrf == OT_ROUTE_PREFERENCE_MED) || (aPrf == OT_ROUTE_PREFERENCE_HIGH), error = OT_ERROR_INVALID_ARGS); RemoveHasRoutePrefix(aPrefix, aPrefixLength); appendLength = sizeof(PrefixTlv) + prefixLengthBytes + sizeof(HasRouteTlv) + sizeof(HasRouteEntry); VerifyOrExit(mLength + appendLength <= sizeof(mTlvs), error = OT_ERROR_NO_BUFS); prefixTlv = reinterpret_cast<PrefixTlv *>(mTlvs + mLength); Insert(reinterpret_cast<uint8_t *>(prefixTlv), appendLength); prefixTlv->Init(0, aPrefixLength, aPrefix); prefixTlv->SetSubTlvsLength(sizeof(HasRouteTlv) + sizeof(HasRouteEntry)); hasRouteTlv = static_cast<HasRouteTlv *>(prefixTlv->GetSubTlvs()); hasRouteTlv->Init(); hasRouteTlv->SetLength(hasRouteTlv->GetLength() + sizeof(HasRouteEntry)); hasRouteTlv->GetEntry(0)->Init(); hasRouteTlv->GetEntry(0)->SetPreference(aPrf); if (aStable) { prefixTlv->SetStable(); hasRouteTlv->SetStable(); } ClearResubmitDelayTimer(); otDumpDebgNetData("add route done", mTlvs, mLength); exit: return error; }