mvfst/quic/common/BufUtil.cpp

// Copyright 2004-present Facebook. All Rights Reserved.

#include "quic/common/BufUtil.h"

namespace quic {

Buf BufQueue::splitAtMost(size_t len) {
  Buf result;
  folly::IOBuf* current = chain_.get();
  if (current == nullptr) {
    DCHECK_EQ(chainLength_, 0);
    return folly::IOBuf::create(0);
  }
  size_t remaining = len;
  while (remaining != 0) {
    if (current->length() < remaining) {
      remaining -= current->length();
    } else {
      Buf clone;
      if (remaining < current->length()) {
        clone = current->cloneOne();
        clone->trimStart(remaining);
      }
      current->trimEnd(current->length() - remaining);
      remaining = 0;
      auto next = current->next();
      if (next == chain_.get()) {
        result = std::move(chain_);
      } else {
        auto chain = chain_.release();
        result = next->separateChain(chain, current);
        if (clone) {
          clone->prependChain(std::unique_ptr<folly::IOBuf>(next));
        } else {
          clone = std::unique_ptr<folly::IOBuf>(next);
        }
      }
      chain_ = std::move(clone);
      break;
    }
    current = current->next();
    if (current == chain_.get()) {
      break;
    }
  }
  if (remaining > 0) {
    // We did not find all the data we needed, so we are going to consume the
    // entire chain instead.
    result = std::move(chain_);
  }
  chainLength_ -= (len - remaining);
  DCHECK_EQ(chainLength_, chain_ ? chain_->computeChainDataLength() : 0);
  if (result == nullptr) {
    return folly::IOBuf::create(0);
  }
  return result;
}

size_t BufQueue::trimStartAtMost(size_t amount) {
  auto original = amount;
  folly::IOBuf* current = chain_.get();
  if (current == nullptr || amount == 0) {
    return 0;
  }
  while (amount > 0) {
    if (current->length() >= amount) {
      current->trimStart(amount);
      amount = 0;
      break;
    }
    amount -= current->length();
    current = current->next();
    if (current == chain_.get()) {
      break;
    }
  }
  auto prev = current->prev();
  /** We are potentially in 2 states here,
   * 1. we found the entire amount
   * 2. or we did not.
   * If we did not find the entire amount, then current ==
   * chain and we can remove the entire chain.
   * If we did, then we can split from the chain head to the previous buffer and
   * then keep the current buffer.
   */
  if (prev != current && current != chain_.get()) {
    auto chain = chain_.release();
    current->separateChain(chain, prev);
    chain_ = std::unique_ptr<folly::IOBuf>(current);
  } else if (amount > 0) {
    DCHECK_EQ(current, chain_.get());
    chain_ = nullptr;
  }
  size_t trimmed = original - amount;
  DCHECK_GE(chainLength_, trimmed);
  chainLength_ -= trimmed;
  DCHECK(chainLength_ == 0 || !chain_->empty());
  return trimmed;
}

// TODO replace users with trimStartAtMost
void BufQueue::trimStart(size_t amount) {
  auto trimmed = trimStartAtMost(amount);
  if (trimmed != amount) {
    throw std::underflow_error(
        "Attempt to trim more bytes than are present in BufQueue");
  }
}

void BufQueue::append(Buf&& buf) {
  if (!buf || buf->empty()) {
    return;
  }
  chainLength_ += buf->computeChainDataLength();
  appendToChain(chain_, std::move(buf));
}

void BufQueue::appendToChain(Buf& dst, Buf&& src) {
  if (dst == nullptr) {
    dst = std::move(src);
  } else {
    dst->prependChain(std::move(src));
  }
}

BufAppender::BufAppender(folly::IOBuf* data, size_t appendLen)
    : crtBuf_(CHECK_NOTNULL(data)), head_(data), appendLen_(appendLen) {}

void BufAppender::push(const uint8_t* data, size_t len) {
  if (crtBuf_->tailroom() < len || lastBufShared_) {
    auto newBuf = folly::IOBuf::create(std::max(appendLen_, len));
    folly::IOBuf* newBufPtr = newBuf.get();
    head_->prependChain(std::move(newBuf));
    crtBuf_ = newBufPtr;
  }
  memcpy(crtBuf_->writableTail(), data, len);
  crtBuf_->append(len);
  lastBufShared_ = false;
}

void BufAppender::insert(std::unique_ptr<folly::IOBuf> data) {
  // just skip the current buffer and append it to the end of the current
  // buffer.
  folly::IOBuf* dataPtr = data.get();
  // If the buffer is shared we do not want to overrwrite the tail of the
  // buffer.
  lastBufShared_ = data->isShared();
  head_->prependChain(std::move(data));
  crtBuf_ = dataPtr;
}

BufWriter::BufWriter(folly::IOBuf& iobuf, size_t most)
    : iobuf_(iobuf), most_(most) {
  CHECK(iobuf_.tailroom() >= most_)
      << "Buffer room=" << iobuf_.tailroom() << " limit=" << most_;
}

void BufWriter::push(const uint8_t* data, size_t len) {
  sizeCheck(len);
  memcpy(iobuf_.writableTail(), data, len);
  iobuf_.append(len);
  written_ += len;
}

void BufWriter::insert(std::unique_ptr<folly::IOBuf> data) {
  copy(std::move(data));
}

void BufWriter::append(size_t len) {
  iobuf_.append(len);
  written_ += len;
  appendCount_ += len;
}

void BufWriter::copy(std::unique_ptr<folly::IOBuf> data) {
  sizeCheck(data->computeChainDataLength());
  size_t totalInserted = 0;
  folly::IOBuf* curBuf = data.get();
  while (curBuf != data->prev()) {
    push(curBuf->data(), curBuf->length());
    totalInserted += curBuf->length();
    curBuf = curBuf->next();
  }
  push(curBuf->data(), curBuf->length());
  totalInserted += curBuf->length();
  CHECK_EQ(data->computeChainDataLength(), totalInserted);
}

void BufWriter::backFill(const uint8_t* data, size_t len, size_t destOffset) {
  CHECK_GE(appendCount_, len);
  appendCount_ -= len;
  CHECK_LE(destOffset + len, iobuf_.length());
  memcpy(iobuf_.writableData() + destOffset, data, len);
}
} // namespace quic