metaforce/Runtime/IOStreams.cpp

#include "Runtime/IOStreams.hpp"
#include <hecl/hecl.hpp>

namespace metaforce {

#define DUMP_BITS 0

#if DUMP_BITS
static void PrintBinary(u32 val, u32 count) {
  for (u32 i = 0; i < count; ++i) {
    fmt::print(FMT_STRING("{}"), (val >> (count - i - 1)) & 0x1);
  }
}
#endif

/*!
 * \brief CBitStreamReader::ReadBit
 * Reads and decodes an encoded value from a bitstream.
 * \param bitCount How many bits to read
 * \return s32 The encoded value
 */
s32 CBitStreamReader::ReadEncoded(u32 bitCount) {
#if DUMP_BITS
  const auto pos = position();
  const auto boff = x20_bitOffset;
#endif

  u32 ret = 0;
  const s32 shiftAmt = x20_bitOffset - s32(bitCount);
  if (shiftAmt < 0) {
    /* OR in remaining bits of cached value */
    u32 mask = bitCount == 32 ? UINT32_MAX : ((1U << bitCount) - 1);
    ret |= (x1c_val << u32(-shiftAmt)) & mask;

    /* Load in exact number of bytes remaining */
    auto loadDiv = std::div(-shiftAmt, 8);
    if (loadDiv.rem)
      ++loadDiv.quot;
    readUBytesToBuf(reinterpret_cast<u8*>(&x1c_val) + 4 - loadDiv.quot, loadDiv.quot);
    x1c_val = hecl::SBig(x1c_val);

    /* New bit offset */
    x20_bitOffset = loadDiv.quot * 8 + shiftAmt;

    /* OR in next bits */
    mask = (1U << u32(-shiftAmt)) - 1;
    ret |= (x1c_val >> x20_bitOffset) & mask;
  } else {
    /* OR in bits of cached value */
    const u32 mask = bitCount == 32 ? UINT32_MAX : ((1U << bitCount) - 1);
    ret |= (x1c_val >> u32(shiftAmt)) & mask;

    /* New bit offset */
    x20_bitOffset -= bitCount;
  }

#if DUMP_BITS
  std::fputs("READ ", stdout);
  PrintBinary(ret, bitCount);
  fmt::print(FMT_STRING(" {} {}\n"), pos, boff);
#endif

  return ret;
}

void CBitStreamWriter::WriteEncoded(u32 val, u32 bitCount) {
#if DUMP_BITS
  std::fputs("WRITE ", stdout);
  PrintBinary(val, bitCount);
  fmt::print(FMT_STRING(" {} {}\n"), position(), x18_bitOffset);
#endif

  const s32 shiftAmt = x18_bitOffset - s32(bitCount);
  if (shiftAmt < 0) {
    /* OR remaining bits to cached value */
    const u32 mask = (1U << x18_bitOffset) - 1;
    x14_val |= (val >> u32(-shiftAmt)) & mask;

    /* Write out 32-bits */
    x14_val = hecl::SBig(x14_val);
    writeBytes(&x14_val, sizeof(x14_val));

    /* Cache remaining bits */
    x18_bitOffset = 0x20 + shiftAmt;
    x14_val = val << x18_bitOffset;
  } else {
    /* OR bits to cached value */
    const u32 mask = bitCount == 32 ? UINT32_MAX : ((1U << bitCount) - 1);
    x14_val |= (val & mask) << u32(shiftAmt);

    /* New bit offset */
    x18_bitOffset -= bitCount;
  }
}

void CBitStreamWriter::Flush() {
  if (x18_bitOffset >= 0x20) {
    return;
  }

  auto pos = std::div(0x20 - s32(x18_bitOffset), 8);
  if (pos.rem != 0) {
    ++pos.quot;
  }

  x14_val = hecl::SBig(x14_val);
  writeBytes(&x14_val, pos.quot);
  x18_bitOffset = 0x20;
  x14_val = 0;
}

CZipInputStream::CZipInputStream(std::unique_ptr<CInputStream>&& strm)
: x24_compBuf(new u8[4096]), x28_strm(std::move(strm)) {
  x30_zstrm.next_in = x24_compBuf.get();
  x30_zstrm.avail_in = 0;
  x30_zstrm.zalloc = [](void*, u32 c, u32 n) -> void* { return new u8[size_t{c} * size_t{n}]; };
  x30_zstrm.zfree = [](void*, void* buf) { delete[] static_cast<u8*>(buf); };
  inflateInit(&x30_zstrm);
}

CZipInputStream::~CZipInputStream() { inflateEnd(&x30_zstrm); }

atUint64 CZipInputStream::readUBytesToBuf(void* buf, atUint64 len) {
  x30_zstrm.next_out = static_cast<Bytef*>(buf);
  x30_zstrm.avail_out = len;
  x30_zstrm.total_out = 0;
  while (x30_zstrm.avail_out != 0) {
    if (x30_zstrm.avail_in == 0) {
      atUint64 readSz = x28_strm->readUBytesToBuf(x24_compBuf.get(), 4096);
      x30_zstrm.avail_in = readSz;
      x30_zstrm.next_in = x24_compBuf.get();
    }
    int inflateRet = inflate(&x30_zstrm, Z_NO_FLUSH);
    if (inflateRet != Z_OK)
      break;
  }
  return x30_zstrm.total_out;
}

} // namespace metaforce