forked from dolphin-emu/dolphin
		
	
		
			
				
	
	
		
			268 lines
		
	
	
		
			8.3 KiB
		
	
	
	
		
			C++
		
	
	
	
	
	
			
		
		
	
	
			268 lines
		
	
	
		
			8.3 KiB
		
	
	
	
		
			C++
		
	
	
	
	
	
| // Copyright 2009 Dolphin Emulator Project
 | |
| // Licensed under GPLv2+
 | |
| // Refer to the license.txt file included.
 | |
| 
 | |
| #include <algorithm>
 | |
| #include <cinttypes>
 | |
| #include <cstddef>
 | |
| #include <cstdio>
 | |
| #include <memory>
 | |
| #include <string>
 | |
| #include <vector>
 | |
| 
 | |
| #include "Common/CommonTypes.h"
 | |
| #include "Common/FileUtil.h"
 | |
| #include "Common/Logging/Log.h"
 | |
| #include "DiscIO/DiscScrubber.h"
 | |
| #include "DiscIO/Filesystem.h"
 | |
| #include "DiscIO/Volume.h"
 | |
| #include "DiscIO/VolumeCreator.h"
 | |
| 
 | |
| namespace DiscIO
 | |
| {
 | |
| constexpr size_t CLUSTER_SIZE = 0x8000;
 | |
| 
 | |
| DiscScrubber::DiscScrubber() = default;
 | |
| DiscScrubber::~DiscScrubber() = default;
 | |
| 
 | |
| bool DiscScrubber::SetupScrub(const std::string& filename, int block_size)
 | |
| {
 | |
|   m_filename = filename;
 | |
|   m_block_size = block_size;
 | |
| 
 | |
|   if (CLUSTER_SIZE % m_block_size != 0)
 | |
|   {
 | |
|     ERROR_LOG(DISCIO, "Block size %u is not a factor of 0x8000, scrubbing not possible",
 | |
|               m_block_size);
 | |
|     return false;
 | |
|   }
 | |
| 
 | |
|   m_disc = CreateVolumeFromFilename(filename);
 | |
|   if (!m_disc)
 | |
|     return false;
 | |
| 
 | |
|   m_file_size = m_disc->GetSize();
 | |
| 
 | |
|   const size_t num_clusters = static_cast<size_t>(m_file_size / CLUSTER_SIZE);
 | |
| 
 | |
|   // Warn if not DVD5 or DVD9 size
 | |
|   if (num_clusters != 0x23048 && num_clusters != 0x46090)
 | |
|   {
 | |
|     WARN_LOG(DISCIO, "%s is not a standard sized Wii disc! (%zx blocks)", filename.c_str(),
 | |
|              num_clusters);
 | |
|   }
 | |
| 
 | |
|   // Table of free blocks
 | |
|   m_free_table.resize(num_clusters, 1);
 | |
| 
 | |
|   // Fill out table of free blocks
 | |
|   const bool success = ParseDisc();
 | |
| 
 | |
|   // Done with it; need it closed for the next part
 | |
|   m_disc.reset();
 | |
|   m_block_count = 0;
 | |
| 
 | |
|   m_is_scrubbing = success;
 | |
|   return success;
 | |
| }
 | |
| 
 | |
| size_t DiscScrubber::GetNextBlock(File::IOFile& in, u8* buffer)
 | |
| {
 | |
|   const u64 current_offset = m_block_count * m_block_size;
 | |
|   const u64 i = current_offset / CLUSTER_SIZE;
 | |
| 
 | |
|   size_t read_bytes = 0;
 | |
|   if (m_is_scrubbing && m_free_table[i])
 | |
|   {
 | |
|     DEBUG_LOG(DISCIO, "Freeing 0x%016" PRIx64, current_offset);
 | |
|     std::fill(buffer, buffer + m_block_size, 0x00);
 | |
|     in.Seek(m_block_size, SEEK_CUR);
 | |
|     read_bytes = m_block_size;
 | |
|   }
 | |
|   else
 | |
|   {
 | |
|     DEBUG_LOG(DISCIO, "Used    0x%016" PRIx64, current_offset);
 | |
|     in.ReadArray(buffer, m_block_size, &read_bytes);
 | |
|   }
 | |
| 
 | |
|   m_block_count++;
 | |
|   return read_bytes;
 | |
| }
 | |
| 
 | |
| void DiscScrubber::MarkAsUsed(u64 offset, u64 size)
 | |
| {
 | |
|   u64 current_offset = offset;
 | |
|   const u64 end_offset = current_offset + size;
 | |
| 
 | |
|   DEBUG_LOG(DISCIO, "Marking 0x%016" PRIx64 " - 0x%016" PRIx64 " as used", offset, end_offset);
 | |
| 
 | |
|   while (current_offset < end_offset && current_offset < m_file_size)
 | |
|   {
 | |
|     m_free_table[current_offset / CLUSTER_SIZE] = 0;
 | |
|     current_offset += CLUSTER_SIZE;
 | |
|   }
 | |
| }
 | |
| 
 | |
| // Compensate for 0x400 (SHA-1) per 0x8000 (cluster), and round to whole clusters
 | |
| void DiscScrubber::MarkAsUsedE(u64 partition_data_offset, u64 offset, u64 size)
 | |
| {
 | |
|   u64 first_cluster_start = offset / 0x7c00 * CLUSTER_SIZE + partition_data_offset;
 | |
| 
 | |
|   u64 last_cluster_end;
 | |
|   if (size == 0)
 | |
|   {
 | |
|     // Without this special case, a size of 0 can be rounded to 1 cluster instead of 0
 | |
|     last_cluster_end = first_cluster_start;
 | |
|   }
 | |
|   else
 | |
|   {
 | |
|     last_cluster_end = ((offset + size - 1) / 0x7c00 + 1) * CLUSTER_SIZE + partition_data_offset;
 | |
|   }
 | |
| 
 | |
|   MarkAsUsed(first_cluster_start, last_cluster_end - first_cluster_start);
 | |
| }
 | |
| 
 | |
| // Helper functions for reading the BE volume
 | |
| bool DiscScrubber::ReadFromVolume(u64 offset, u32& buffer, bool decrypt)
 | |
| {
 | |
|   return m_disc->ReadSwapped(offset, &buffer, decrypt);
 | |
| }
 | |
| 
 | |
| bool DiscScrubber::ReadFromVolume(u64 offset, u64& buffer, bool decrypt)
 | |
| {
 | |
|   u32 temp_buffer;
 | |
|   if (!m_disc->ReadSwapped(offset, &temp_buffer, decrypt))
 | |
|     return false;
 | |
|   buffer = static_cast<u64>(temp_buffer) << 2;
 | |
|   return true;
 | |
| }
 | |
| 
 | |
| bool DiscScrubber::ParseDisc()
 | |
| {
 | |
|   // Mark the header as used - it's mostly 0s anyways
 | |
|   MarkAsUsed(0, 0x50000);
 | |
| 
 | |
|   for (u32 x = 0; x < 4; x++)
 | |
|   {
 | |
|     if (!ReadFromVolume(0x40000 + (x * 8) + 0, m_partition_group[x].num_partitions, false) ||
 | |
|         !ReadFromVolume(0x40000 + (x * 8) + 4, m_partition_group[x].partitions_offset, false))
 | |
|     {
 | |
|       return false;
 | |
|     }
 | |
| 
 | |
|     // Read all partitions
 | |
|     for (u32 i = 0; i < m_partition_group[x].num_partitions; i++)
 | |
|     {
 | |
|       Partition partition;
 | |
| 
 | |
|       partition.group_number = x;
 | |
|       partition.number = i;
 | |
| 
 | |
|       if (!ReadFromVolume(m_partition_group[x].partitions_offset + (i * 8) + 0, partition.offset,
 | |
|                           false) ||
 | |
|           !ReadFromVolume(m_partition_group[x].partitions_offset + (i * 8) + 4, partition.type,
 | |
|                           false) ||
 | |
|           !ReadFromVolume(partition.offset + 0x2a4, partition.header.tmd_size, false) ||
 | |
|           !ReadFromVolume(partition.offset + 0x2a8, partition.header.tmd_offset, false) ||
 | |
|           !ReadFromVolume(partition.offset + 0x2ac, partition.header.cert_chain_size, false) ||
 | |
|           !ReadFromVolume(partition.offset + 0x2b0, partition.header.cert_chain_offset, false) ||
 | |
|           !ReadFromVolume(partition.offset + 0x2b4, partition.header.h3_offset, false) ||
 | |
|           !ReadFromVolume(partition.offset + 0x2b8, partition.header.data_offset, false) ||
 | |
|           !ReadFromVolume(partition.offset + 0x2bc, partition.header.data_size, false))
 | |
|       {
 | |
|         return false;
 | |
|       }
 | |
| 
 | |
|       m_partition_group[x].partitions.push_back(partition);
 | |
|     }
 | |
| 
 | |
|     for (auto& partition : m_partition_group[x].partitions)
 | |
|     {
 | |
|       const PartitionHeader& header = partition.header;
 | |
| 
 | |
|       MarkAsUsed(partition.offset, 0x2c0);
 | |
| 
 | |
|       MarkAsUsed(partition.offset + header.tmd_offset, header.tmd_size);
 | |
|       MarkAsUsed(partition.offset + header.cert_chain_offset, header.cert_chain_size);
 | |
|       MarkAsUsed(partition.offset + header.h3_offset, 0x18000);
 | |
|       // This would mark the whole (encrypted) data area
 | |
|       // we need to parse FST and other crap to find what's free within it!
 | |
|       // MarkAsUsed(partition.offset + header.data_offset, header.data_size);
 | |
| 
 | |
|       // Parse Data! This is where the big gain is
 | |
|       if (!ParsePartitionData(partition))
 | |
|         return false;
 | |
|     }
 | |
|   }
 | |
| 
 | |
|   return true;
 | |
| }
 | |
| 
 | |
| // Operations dealing with encrypted space are done here - the volume is swapped to allow this
 | |
| bool DiscScrubber::ParsePartitionData(Partition& partition)
 | |
| {
 | |
|   bool parsed_ok = true;
 | |
| 
 | |
|   // Switch out the main volume temporarily
 | |
|   std::unique_ptr<IVolume> old_volume;
 | |
|   m_disc.swap(old_volume);
 | |
| 
 | |
|   // Ready some stuff
 | |
|   m_disc = CreateVolumeFromFilename(m_filename, partition.group_number, partition.number);
 | |
|   if (m_disc == nullptr)
 | |
|   {
 | |
|     ERROR_LOG(DISCIO, "Failed to create volume from file %s", m_filename.c_str());
 | |
|     m_disc.swap(old_volume);
 | |
|     return false;
 | |
|   }
 | |
| 
 | |
|   std::unique_ptr<IFileSystem> filesystem(CreateFileSystem(m_disc.get()));
 | |
|   if (!filesystem)
 | |
|   {
 | |
|     ERROR_LOG(DISCIO, "Failed to create filesystem for group %u partition %u",
 | |
|               partition.group_number, partition.number);
 | |
|     parsed_ok = false;
 | |
|   }
 | |
|   else
 | |
|   {
 | |
|     // Mark things as used which are not in the filesystem
 | |
|     // Header, Header Information, Apploader
 | |
|     parsed_ok = parsed_ok && ReadFromVolume(0x2440 + 0x14, partition.header.apploader_size, true);
 | |
|     parsed_ok =
 | |
|         parsed_ok && ReadFromVolume(0x2440 + 0x18, partition.header.apploader_trailer_size, true);
 | |
|     MarkAsUsedE(partition.offset + partition.header.data_offset, 0,
 | |
|                 0x2440 + partition.header.apploader_size + partition.header.apploader_trailer_size);
 | |
| 
 | |
|     // DOL
 | |
|     partition.header.dol_offset = filesystem->GetBootDOLOffset();
 | |
|     partition.header.dol_size = filesystem->GetBootDOLSize(partition.header.dol_offset);
 | |
|     parsed_ok = parsed_ok && partition.header.dol_offset && partition.header.dol_size;
 | |
|     MarkAsUsedE(partition.offset + partition.header.data_offset, partition.header.dol_offset,
 | |
|                 partition.header.dol_size);
 | |
| 
 | |
|     // FST
 | |
|     parsed_ok = parsed_ok && ReadFromVolume(0x424, partition.header.fst_offset, true);
 | |
|     parsed_ok = parsed_ok && ReadFromVolume(0x428, partition.header.fst_size, true);
 | |
|     MarkAsUsedE(partition.offset + partition.header.data_offset, partition.header.fst_offset,
 | |
|                 partition.header.fst_size);
 | |
| 
 | |
|     // Go through the filesystem and mark entries as used
 | |
|     for (const SFileInfo& file : filesystem->GetFileList())
 | |
|     {
 | |
|       DEBUG_LOG(DISCIO, "%s", file.m_FullPath.empty() ? "/" : file.m_FullPath.c_str());
 | |
|       if ((file.m_NameOffset & 0x1000000) == 0)
 | |
|       {
 | |
|         MarkAsUsedE(partition.offset + partition.header.data_offset, file.m_Offset,
 | |
|                     file.m_FileSize);
 | |
|       }
 | |
|     }
 | |
|   }
 | |
| 
 | |
|   // Swap back
 | |
|   m_disc.swap(old_volume);
 | |
| 
 | |
|   return parsed_ok;
 | |
| }
 | |
| 
 | |
| }  // namespace DiscIO
 |