STFS loading... xex's load, but files seem broken. Ugh.

src/xenia/kernel/fs/devices/stfs_container_file.cc

@@ -0,0 +1,67 @@
+/**
+ ******************************************************************************
+ * Xenia : Xbox 360 Emulator Research Project                                 *
+ ******************************************************************************
+ * Copyright 2014 Ben Vanik. All rights reserved.                             *
+ * Released under the BSD license - see LICENSE in the root for more details. *
+ ******************************************************************************
+ */
+
+#include <xenia/kernel/fs/devices/stfs_container_file.h>
+
+#include <xenia/kernel/fs/stfs.h>
+#include <xenia/kernel/fs/devices/stfs_container_entry.h>
+
+
+using namespace xe;
+using namespace xe::kernel;
+using namespace xe::kernel::fs;
+
+
+STFSContainerFile::STFSContainerFile(
+    KernelState* kernel_state, uint32_t desired_access,
+    STFSContainerEntry* entry) :
+    entry_(entry),
+    XFile(kernel_state, desired_access) {
+}
+
+STFSContainerFile::~STFSContainerFile() {
+}
+
+X_STATUS STFSContainerFile::QueryInfo(XFileInfo* out_info) {
+  return entry_->QueryInfo(out_info);
+}
+
+X_STATUS STFSContainerFile::QueryDirectory(
+    XDirectoryInfo* out_info, size_t length, bool restart) {
+  XEASSERTALWAYS();
+  return X_STATUS_SUCCESS;
+}
+
+X_STATUS STFSContainerFile::ReadSync(
+    void* buffer, size_t buffer_length, size_t byte_offset,
+    size_t* out_bytes_read) {
+  STFSEntry* stfs_entry = entry_->stfs_entry();
+  xe_mmap_ref mmap = entry_->mmap();
+  uint8_t* map_ptr = xe_mmap_get_addr(mmap);
+
+  // Each block is 4096.
+  // Blocks may not be sequential, so we need to read by blocks and handle the
+  // offsets.
+  size_t real_length = MIN(buffer_length, stfs_entry->size - byte_offset);
+  size_t start_block = byte_offset / 4096;
+  size_t end_block = MIN(
+      stfs_entry->block_list.size(),
+      (size_t)ceil((byte_offset + real_length) / 4096.0));
+  uint8_t* dest_ptr = (uint8_t*)buffer;
+  for (size_t n = start_block; n < end_block; n++) {
+    auto& record = stfs_entry->block_list[n];
+    size_t offset = record.offset;
+    size_t read_length = record.length;
+    xe_copy_memory(dest_ptr, buffer_length - (dest_ptr - (uint8_t*)buffer),
+                   map_ptr + offset, read_length);
+    dest_ptr += read_length;
+  }
+  *out_bytes_read = real_length;
+  return X_STATUS_SUCCESS;
+}