/* * Copyright (c) 2017-2019 Cisco and/or its affiliates. * Licensed under the Apache License, Version 2.0 (the "License"); * you may not use this file except in compliance with the License. * You may obtain a copy of the License at: * * http://www.apache.org/licenses/LICENSE-2.0 * * Unless required by applicable law or agreed to in writing, software * distributed under the License is distributed on an "AS IS" BASIS, * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. * See the License for the specific language governing permissions and * limitations under the License. */ #include #include #include #include extern "C" { #ifndef _WIN32 TRANSPORT_CLANG_DISABLE_WARNING("-Wextern-c-compat") #endif #include } namespace transport { namespace core { const core::Name Packet::base_name("0::0|0"); Packet::Packet(Format format) : packet_(utils::MemBuf::create(getHeaderSizeFromFormat(format, 256)) .release()), packet_start_(reinterpret_cast(packet_->writableData())), header_head_(packet_.get()), payload_head_(nullptr), format_(format) { if (hicn_packet_init_header(format, packet_start_) < 0) { throw errors::RuntimeException("Unexpected error initializing the packet."); } packet_->append(getHeaderSizeFromFormat(format_)); } Packet::Packet(MemBufPtr &&buffer) : packet_(std::move(buffer)), packet_start_(reinterpret_cast(packet_->writableData())), header_head_(packet_.get()), payload_head_(nullptr), format_(getFormatFromBuffer(packet_->writableData())) {} Packet::Packet(const uint8_t *buffer, std::size_t size) : Packet(MemBufPtr(utils::MemBuf::copyBuffer(buffer, size).release())) {} Packet::Packet(Packet &&other) : packet_(std::move(other.packet_)), packet_start_(other.packet_start_), header_head_(other.header_head_), payload_head_(other.payload_head_), format_(other.format_) { other.packet_start_ = nullptr; other.header_head_ = nullptr; other.payload_head_ = nullptr; other.format_ = HF_UNSPEC; } Packet::~Packet() {} std::size_t Packet::getHeaderSizeFromFormat(Format format, size_t signature_size) { std::size_t header_length; hicn_packet_get_header_length_from_format(format, &header_length); int is_ah = _is_ah(format); return is_ah * (header_length + signature_size) + (!is_ah) * header_length; } std::size_t Packet::getHeaderSizeFromBuffer(Format format, const uint8_t *buffer) { size_t header_length; if (hicn_packet_get_header_length(format, (hicn_header_t *)buffer, &header_length) < 0) { throw errors::MalformedPacketException(); } return header_length; } bool Packet::isInterest(const uint8_t *buffer) { bool is_interest = false; if (TRANSPORT_EXPECT_FALSE(hicn_packet_test_ece((const hicn_header_t *)buffer, &is_interest) < 0)) { throw errors::RuntimeException( "Impossible to retrieve ece flag from packet"); } return !is_interest; } Packet::Format Packet::getFormatFromBuffer(const uint8_t *buffer) { Format format = HF_UNSPEC; if (TRANSPORT_EXPECT_FALSE( hicn_packet_get_format((const hicn_header_t *)buffer, &format) < 0)) { throw errors::MalformedPacketException(); } return format; } std::size_t Packet::getPayloadSizeFromBuffer(Format format, const uint8_t *buffer) { std::size_t payload_length; if (TRANSPORT_EXPECT_FALSE( hicn_packet_get_payload_length(format, (hicn_header_t *)buffer, &payload_length) < 0)) { throw errors::MalformedPacketException(); } return payload_length; } void Packet::replace(MemBufPtr &&buffer) { packet_ = std::move(buffer); packet_start_ = reinterpret_cast(packet_->writableData()); header_head_ = packet_.get(); payload_head_ = nullptr; format_ = getFormatFromBuffer(reinterpret_cast(packet_start_)); } std::size_t Packet::payloadSize() const { return getPayloadSizeFromBuffer(format_, reinterpret_cast(packet_start_)); } std::size_t Packet::headerSize() const { return getHeaderSizeFromBuffer(format_, reinterpret_cast(packet_start_)); } Packet &Packet::appendPayload(std::unique_ptr &&payload) { separateHeaderPayload(); if (!payload_head_) { payload_head_ = payload.get(); } header_head_->prependChain(std::move(payload)); updateLength(); return *this; } Packet &Packet::appendPayload(const uint8_t *buffer, std::size_t length) { return appendPayload(utils::MemBuf::copyBuffer(buffer, length)); } Packet &Packet::appendHeader(std::unique_ptr &&header) { separateHeaderPayload(); if (!payload_head_) { header_head_->prependChain(std::move(header)); } else { payload_head_->prependChain(std::move(header)); } updateLength(); return *this; } Packet &Packet::appendHeader(const uint8_t *buffer, std::size_t length) { return appendHeader(utils::MemBuf::copyBuffer(buffer, length)); } std::unique_ptr Packet::getPayload() const { const_cast(this)->separateHeaderPayload(); // Hopefully the payload is contiguous if (TRANSPORT_EXPECT_FALSE(payload_head_ && payload_head_->next() != header_head_)) { payload_head_->gather(payloadSize()); } return payload_head_->cloneOne(); } Packet &Packet::updateLength(std::size_t length) { std::size_t total_length = length; for (utils::MemBuf *current = payload_head_; current && current != header_head_; current = current->next()) { total_length += current->length(); } if (hicn_packet_set_payload_length(format_, packet_start_, total_length) < 0) { throw errors::RuntimeException("Error setting the packet payload."); } return *this; } PayloadType Packet::getPayloadType() const { hicn_payload_type_t ret = HPT_UNSPEC; if (hicn_packet_get_payload_type(packet_start_, &ret) < 0) { throw errors::RuntimeException("Impossible to retrieve payload type."); } return PayloadType(ret); } Packet &Packet::setPayloadType(PayloadType payload_type) { if (hicn_packet_set_payload_type(packet_start_, hicn_payload_type_t(payload_type)) < 0) { throw errors::RuntimeException("Error setting payload type of the packet."); } return *this; } Packet::Format Packet::getFormat() const { if (format_ == HF_UNSPEC) { if (hicn_packet_get_format(packet_start_, &format_) < 0) { throw errors::MalformedPacketException(); } } return format_; } const std::shared_ptr Packet::acquireMemBufReference() { return packet_; } void Packet::dump() const { const_cast(this)->separateHeaderPayload(); std::cout << "HEADER -- Length: " << headerSize() << std::endl; hicn_packet_dump((uint8_t *)header_head_->data(), headerSize()); std::cout << std::endl << "PAYLOAD -- Length: " << payloadSize() << std::endl; for (utils::MemBuf *current = payload_head_; current && current != header_head_; current = current->next()) { std::cout << "MemBuf Length: " << current->length() << std::endl; hicn_packet_dump((uint8_t *)current->data(), current->length()); } } void Packet::setSignatureSize(std::size_t size_bytes) { int ret = hicn_packet_set_signature_size(format_, packet_start_, size_bytes); if (ret < 0) { throw errors::RuntimeException("Packet without Authentication Header."); } packet_->append(size_bytes); updateLength(); } uint8_t *Packet::getSignature() const { uint8_t *signature; int ret = hicn_packet_get_signature(format_, packet_start_, &signature); if (ret < 0) { throw errors::RuntimeException("Packet without Authentication Header."); } return signature; } std::size_t Packet::getSignatureSize() const { size_t size_bytes; int ret = hicn_packet_get_signature_size(format_, packet_start_, &size_bytes); if (ret < 0) { throw errors::RuntimeException("Packet without Authentication Header."); } return size_bytes; } void Packet::setSignatureTimestamp(const uint64_t ×tamp) { int ret = hicn_packet_set_signature_timestamp(format_, packet_start_, timestamp); if (ret < 0) { throw errors::RuntimeException("Error setting the signature timestamp."); } } uint64_t Packet::getSignatureTimestamp() const { uint64_t return_value; int ret = hicn_packet_get_signature_timestamp(format_, packet_start_, &return_value); if (ret < 0) { throw errors::RuntimeException("Error getting the signature timestamp."); } return return_value; } void Packet::setValidationAlgorithm( const utils::CryptoSuite &validation_algorithm) { int ret = hicn_packet_set_validation_algorithm(format_, packet_start_, uint8_t(validation_algorithm)); if (ret < 0) { throw errors::RuntimeException("Error setting the validation algorithm."); } } utils::CryptoSuite Packet::getValidationAlgorithm() const { uint8_t return_value; int ret = hicn_packet_get_validation_algorithm(format_, packet_start_, &return_value); if (ret < 0) { throw errors::RuntimeException("Error getting the validation algorithm."); } return utils::CryptoSuite(return_value); } void Packet::setKeyId(const utils::KeyId &key_id) { int ret = hicn_packet_set_key_id(format_, packet_start_, key_id.first); if (ret < 0) { throw errors::RuntimeException("Error setting the key id."); } } utils::KeyId Packet::getKeyId() const { utils::KeyId return_value; int ret = hicn_packet_get_key_id(format_, packet_start_, &return_value.first, &return_value.second); if (ret < 0) { throw errors::RuntimeException("Error getting the validation algorithm."); } return return_value; } utils::CryptoHash Packet::computeDigest(HashAlgorithm algorithm) const { utils::CryptoHasher hasher(static_cast(algorithm)); hasher.init(); // Copy IP+TCP/ICMP header before zeroing them hicn_header_t header_copy; hicn_packet_copy_header(format_, packet_start_, &header_copy, false); const_cast(this)->resetForHash(); auto current = header_head_; do { hasher.updateBytes(current->data(), current->length()); current = current->next(); } while (current != header_head_); hicn_packet_copy_header(format_, &header_copy, packet_start_, false); return hasher.finalize(); } void Packet::setChecksum() { uint16_t partial_csum = 0; for (utils::MemBuf *current = header_head_->next(); current && current != header_head_; current = current->next()) { if (partial_csum != 0) { partial_csum = ~partial_csum; } partial_csum = csum(current->data(), current->length(), partial_csum); } if (hicn_packet_compute_header_checksum(format_, packet_start_, partial_csum) < 0) { throw errors::MalformedPacketException(); } } bool Packet::checkIntegrity() const { if (hicn_packet_check_integrity(format_, packet_start_) < 0) { return false; } return true; } Packet &Packet::setSyn() { if (hicn_packet_set_syn(packet_start_) < 0) { throw errors::RuntimeException("Error setting syn bit in the packet."); } return *this; } Packet &Packet::resetSyn() { if (hicn_packet_reset_syn(packet_start_) < 0) { throw errors::RuntimeException("Error resetting syn bit in the packet."); } return *this; } bool Packet::testSyn() const { bool res = false; if (hicn_packet_test_syn(packet_start_, &res) < 0) { throw errors::RuntimeException("Error testing syn bit in the packet."); } return res; } Packet &Packet::setAck() { if (hicn_packet_set_ack(packet_start_) < 0) { throw errors::RuntimeException("Error setting ack bit in the packet."); } return *this; } Packet &Packet::resetAck() { if (hicn_packet_reset_ack(packet_start_) < 0) { throw errors::RuntimeException("Error resetting ack bit in the packet."); } return *this; } bool Packet::testAck() const { bool res = false; if (hicn_packet_test_ack(packet_start_, &res) < 0) { throw errors::RuntimeException("Error testing ack bit in the packet."); } return res; } Packet &Packet::setRst() { if (hicn_packet_set_rst(packet_start_) < 0) { throw errors::RuntimeException("Error setting rst bit in the packet."); } return *this; } Packet &Packet::resetRst() { if (hicn_packet_reset_rst(packet_start_) < 0) { throw errors::RuntimeException("Error resetting rst bit in the packet."); } return *this; } bool Packet::testRst() const { bool res = false; if (hicn_packet_test_rst(packet_start_, &res) < 0) { throw errors::RuntimeException("Error testing rst bit in the packet."); } return res; } Packet &Packet::setFin() { if (hicn_packet_set_fin(packet_start_) < 0) { throw errors::RuntimeException("Error setting fin bit in the packet."); } return *this; } Packet &Packet::resetFin() { if (hicn_packet_reset_fin(packet_start_) < 0) { throw errors::RuntimeException("Error resetting fin bit in the packet."); } return *this; } bool Packet::testFin() const { bool res = false; if (hicn_packet_test_fin(packet_start_, &res) < 0) { throw errors::RuntimeException("Error testing fin bit in the packet."); } return res; } Packet &Packet::resetFlags() { resetSyn(); resetAck(); resetRst(); resetFin(); return *this; } std::string Packet::printFlags() const { std::string flags = ""; if (testSyn()) { flags += "S"; } if (testAck()) { flags += "A"; } if (testRst()) { flags += "R"; } if (testFin()) { flags += "F"; } return flags; } Packet &Packet::setSrcPort(uint16_t srcPort) { if (hicn_packet_set_src_port(packet_start_, srcPort) < 0) { throw errors::RuntimeException("Error setting source port in the packet."); } return *this; } Packet &Packet::setDstPort(uint16_t dstPort) { if (hicn_packet_set_dst_port(packet_start_, dstPort) < 0) { throw errors::RuntimeException( "Error setting destination port in the packet."); } return *this; } uint16_t Packet::getSrcPort() const { uint16_t port = 0; if (hicn_packet_get_src_port(packet_start_, &port) < 0) { throw errors::RuntimeException("Error reading source port in the packet."); } return port; } uint16_t Packet::getDstPort() const { uint16_t port = 0; if (hicn_packet_get_dst_port(packet_start_, &port) < 0) { throw errors::RuntimeException( "Error reading destination port in the packet."); } return port; } Packet &Packet::setTTL(uint8_t hops) { if (hicn_packet_set_hoplimit(packet_start_, hops) < 0) { throw errors::RuntimeException("Error setting TTL."); } return *this; } uint8_t Packet::getTTL() const { uint8_t hops = 0; if (hicn_packet_get_hoplimit(packet_start_, &hops) < 0) { throw errors::RuntimeException("Error reading TTL."); } return hops; } void Packet::separateHeaderPayload() { if (payload_head_) { return; } int signature_size = 0; if (_is_ah(format_)) { signature_size = (uint32_t)getSignatureSize(); } auto header_size = getHeaderSizeFromFormat(format_, signature_size); auto payload_length = packet_->length() - header_size; packet_->trimEnd(packet_->length()); auto payload = packet_->cloneOne(); payload_head_ = payload.get(); payload_head_->advance(header_size); payload_head_->append(payload_length); packet_->prependChain(std::move(payload)); packet_->append(header_size); } void Packet::resetPayload() { if (packet_->isChained()) { packet_->separateChain(packet_->next(), packet_->prev()); payload_head_ = nullptr; updateLength(); } } } // end namespace core } // end namespace transport