1 files changed, 607 insertions, 0 deletions
diff --git a/libtransport/src/core/packet.cc b/libtransport/src/core/packet.cc
new file mode 100644
index 000000000..817f8de66
--- /dev/null
+++ b/libtransport/src/core/packet.cc
@@ -0,0 +1,607 @@
+/*
+ * 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 <hicn/transport/core/packet.h>
+#include <hicn/transport/errors/malformed_packet_exception.h>
+#include <hicn/transport/utils/hash.h>
+#include <hicn/transport/utils/log.h>
+
+extern "C" {
+#ifndef _WIN32
+TRANSPORT_CLANG_DISABLE_WARNING("-Wextern-c-compat")
+#endif
+#include <hicn/error.h>
+}
+
+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<hicn_header_t *>(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<hicn_header_t *>(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<hicn_header_t *>(packet_->writableData());
+  header_head_ = packet_.get();
+  payload_head_ = nullptr;
+  format_ = getFormatFromBuffer(reinterpret_cast<uint8_t *>(packet_start_));
+}
+
+std::size_t Packet::payloadSize() const {
+  return getPayloadSizeFromBuffer(format_,
+                                  reinterpret_cast<uint8_t *>(packet_start_));
+}
+
+std::size_t Packet::headerSize() const {
+  return getHeaderSizeFromBuffer(format_,
+                                 reinterpret_cast<uint8_t *>(packet_start_));
+}
+
+Packet &Packet::appendPayload(std::unique_ptr<utils::MemBuf> &&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<utils::MemBuf> &&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<utils::MemBuf> Packet::getPayload() const {
+  const_cast<Packet *>(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<utils::MemBuf> Packet::acquireMemBufReference() const {
+  return packet_;
+}
+
+void Packet::dump() const {
+  const_cast<Packet *>(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 &timestamp) {
+  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<utils::CryptoHashType>(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<Packet *>(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