commit
968779e623
|
@ -32,6 +32,9 @@
|
|||
// A simple and portable piece of code used to generate a blank FAT32 image file.
|
||||
// Modified for Dolphin.
|
||||
|
||||
#include "Common/SDCardUtil.h"
|
||||
|
||||
#include <algorithm>
|
||||
#include <cinttypes>
|
||||
#include <cstddef>
|
||||
#include <cstdio>
|
||||
|
@ -43,7 +46,6 @@
|
|||
#include "Common/CommonTypes.h"
|
||||
#include "Common/File.h"
|
||||
#include "Common/Logging/Log.h"
|
||||
#include "Common/SDCardUtil.h"
|
||||
|
||||
#ifndef _WIN32
|
||||
#include <unistd.h> // for unlink()
|
||||
|
@ -54,33 +56,35 @@
|
|||
#pragma warning(disable : 4310)
|
||||
#endif
|
||||
|
||||
/* Believe me, you *don't* want to change these constants !! */
|
||||
#define BYTES_PER_SECTOR 512
|
||||
#define RESERVED_SECTORS 32
|
||||
#define BACKUP_BOOT_SECTOR 6
|
||||
#define NUM_FATS 2
|
||||
|
||||
#define BYTE_(p, i) (((u8*)(p))[(i)])
|
||||
|
||||
#define POKEB(p, v) BYTE_(p, 0) = (u8)(v)
|
||||
#define POKES(p, v) (BYTE_(p, 0) = (u8)(v), BYTE_(p, 1) = (u8)((v) >> 8))
|
||||
#define POKEW(p, v) \
|
||||
(BYTE_(p, 0) = (u8)(v), BYTE_(p, 1) = (u8)((v) >> 8), BYTE_(p, 2) = (u8)((v) >> 16), \
|
||||
BYTE_(p, 3) = (u8)((v) >> 24))
|
||||
namespace Common
|
||||
{
|
||||
// Believe me, you *don't* want to change these constants !!
|
||||
enum : u32
|
||||
{
|
||||
BYTES_PER_SECTOR = 512,
|
||||
RESERVED_SECTORS = 32,
|
||||
BACKUP_BOOT_SECTOR = 6,
|
||||
NUM_FATS = 2
|
||||
};
|
||||
|
||||
static u8 s_boot_sector[BYTES_PER_SECTOR]; /* Boot sector */
|
||||
static u8 s_fsinfo_sector[BYTES_PER_SECTOR]; /* FS Info sector */
|
||||
static u8 s_fat_head[BYTES_PER_SECTOR]; /* First FAT sector */
|
||||
|
||||
template <typename T>
|
||||
static void WriteData(u8* out, T data)
|
||||
{
|
||||
std::memcpy(out, &data, sizeof(data));
|
||||
}
|
||||
|
||||
/* This is the date and time when creating the disk */
|
||||
static unsigned int get_serial_id()
|
||||
{
|
||||
u16 lo, hi;
|
||||
time_t now = time(nullptr);
|
||||
struct tm tm = gmtime(&now)[0];
|
||||
const time_t now = std::time(nullptr);
|
||||
const struct tm tm = std::gmtime(&now)[0];
|
||||
|
||||
lo = (u16)(tm.tm_mday + ((tm.tm_mon + 1) << 8) + (tm.tm_sec << 8));
|
||||
hi = (u16)(tm.tm_min + (tm.tm_hour << 8) + (tm.tm_year + 1900));
|
||||
const u16 lo = static_cast<u16>(tm.tm_mday + ((tm.tm_mon + 1) << 8) + (tm.tm_sec << 8));
|
||||
const u16 hi = static_cast<u16>(tm.tm_min + (tm.tm_hour << 8) + (tm.tm_year + 1900));
|
||||
|
||||
return lo + (hi << 16);
|
||||
}
|
||||
|
@ -106,106 +110,99 @@ static unsigned int get_sectors_per_cluster(u64 disk_size)
|
|||
|
||||
static unsigned int get_sectors_per_fat(u64 disk_size, u32 sectors_per_cluster)
|
||||
{
|
||||
u64 divider;
|
||||
|
||||
/* Weird computation from MS - see fatgen103.doc for details */
|
||||
disk_size -= RESERVED_SECTORS * BYTES_PER_SECTOR; /* Don't count 32 reserved sectors */
|
||||
disk_size /= BYTES_PER_SECTOR; /* Disk size in sectors */
|
||||
divider = ((256 * sectors_per_cluster) + NUM_FATS) / 2;
|
||||
const u64 divider = ((256 * sectors_per_cluster) + NUM_FATS) / 2;
|
||||
|
||||
return (u32)((disk_size + (divider - 1)) / divider);
|
||||
return static_cast<u32>((disk_size + (divider - 1)) / divider);
|
||||
}
|
||||
|
||||
static void boot_sector_init(u8* boot, u8* info, u64 disk_size, const char* label)
|
||||
{
|
||||
u32 sectors_per_cluster = get_sectors_per_cluster(disk_size);
|
||||
u32 sectors_per_fat = get_sectors_per_fat(disk_size, sectors_per_cluster);
|
||||
u32 sectors_per_disk = (u32)(disk_size / BYTES_PER_SECTOR);
|
||||
u32 serial_id = get_serial_id();
|
||||
u32 free_count;
|
||||
const u32 sectors_per_cluster = get_sectors_per_cluster(disk_size);
|
||||
const u32 sectors_per_fat = get_sectors_per_fat(disk_size, sectors_per_cluster);
|
||||
const u32 sectors_per_disk = static_cast<u32>(disk_size / BYTES_PER_SECTOR);
|
||||
const u32 serial_id = get_serial_id();
|
||||
|
||||
if (label == nullptr)
|
||||
label = "DOLPHINSD";
|
||||
|
||||
POKEB(boot, 0xeb);
|
||||
POKEB(boot + 1, 0x5a);
|
||||
POKEB(boot + 2, 0x90);
|
||||
WriteData<u8>(boot, 0xeb);
|
||||
WriteData<u8>(boot + 1, 0x5a);
|
||||
WriteData<u8>(boot + 2, 0x90);
|
||||
strcpy((char*)boot + 3, "MSWIN4.1");
|
||||
POKES(boot + 0x0b, BYTES_PER_SECTOR); /* Sector size */
|
||||
POKEB(boot + 0xd, sectors_per_cluster); /* Sectors per cluster */
|
||||
POKES(boot + 0xe, RESERVED_SECTORS); /* Reserved sectors before first FAT */
|
||||
POKEB(boot + 0x10, NUM_FATS); /* Number of FATs */
|
||||
POKES(boot + 0x11, 0); /* Max root directory entries for FAT12/FAT16, 0 for FAT32 */
|
||||
POKES(boot + 0x13, 0); /* Total sectors, 0 to use 32-bit value at offset 0x20 */
|
||||
POKEB(boot + 0x15, 0xF8); /* Media descriptor, 0xF8 == hard disk */
|
||||
POKES(boot + 0x16, 0); /* Sectors per FAT for FAT12/16, 0 for FAT32 */
|
||||
POKES(boot + 0x18, 9); /* Sectors per track (whatever) */
|
||||
POKES(boot + 0x1a, 2); /* Number of heads (whatever) */
|
||||
POKEW(boot + 0x1c, 0); /* Hidden sectors */
|
||||
POKEW(boot + 0x20, sectors_per_disk); /* Total sectors */
|
||||
WriteData<u16>(boot + 0x0b, BYTES_PER_SECTOR); // Sector size
|
||||
WriteData<u8>(boot + 0xd, sectors_per_cluster); // Sectors per cluster
|
||||
WriteData<u16>(boot + 0xe, RESERVED_SECTORS); // Reserved sectors before first FAT
|
||||
WriteData<u8>(boot + 0x10, NUM_FATS); // Number of FATs
|
||||
WriteData<u16>(boot + 0x11, 0); // Max root directory entries for FAT12/FAT16, 0 for FAT32
|
||||
WriteData<u16>(boot + 0x13, 0); // Total sectors, 0 to use 32-bit value at offset 0x20
|
||||
WriteData<u8>(boot + 0x15, 0xF8); // Media descriptor, 0xF8 == hard disk
|
||||
WriteData<u16>(boot + 0x16, 0); // Sectors per FAT for FAT12/16, 0 for FAT32
|
||||
WriteData<u16>(boot + 0x18, 9); // Sectors per track (whatever)
|
||||
WriteData<u16>(boot + 0x1a, 2); // Number of heads (whatever)
|
||||
WriteData<u32>(boot + 0x1c, 0); // Hidden sectors
|
||||
WriteData<u32>(boot + 0x20, sectors_per_disk); // Total sectors
|
||||
|
||||
/* Extension */
|
||||
POKEW(boot + 0x24, sectors_per_fat); /* Sectors per FAT */
|
||||
POKES(boot + 0x28, 0); /* FAT flags */
|
||||
POKES(boot + 0x2a, 0); /* Version */
|
||||
POKEW(boot + 0x2c, 2); /* Cluster number of root directory start */
|
||||
POKES(boot + 0x30, 1); /* Sector number of FS information sector */
|
||||
POKES(boot + 0x32, BACKUP_BOOT_SECTOR); /* Sector number of a copy of this boot sector */
|
||||
POKEB(boot + 0x40, 0x80); /* Physical drive number */
|
||||
POKEB(boot + 0x42, 0x29); /* Extended boot signature ?? */
|
||||
POKEW(boot + 0x43, serial_id); /* Serial ID */
|
||||
strncpy((char*)boot + 0x47, label, 11); /* Volume Label */
|
||||
memcpy(boot + 0x52, "FAT32 ", 8); /* FAT system type, padded with 0x20 */
|
||||
// Extension
|
||||
WriteData<u32>(boot + 0x24, sectors_per_fat); // Sectors per FAT
|
||||
WriteData<u16>(boot + 0x28, 0); // FAT flags
|
||||
WriteData<u16>(boot + 0x2a, 0); // Version
|
||||
WriteData<u32>(boot + 0x2c, 2); // Cluster number of root directory start
|
||||
WriteData<u16>(boot + 0x30, 1); // Sector number of FS information sector
|
||||
WriteData<u16>(boot + 0x32, BACKUP_BOOT_SECTOR); // Sector number of a copy of this boot sector
|
||||
WriteData<u8>(boot + 0x40, 0x80); // Physical drive number
|
||||
WriteData<u8>(boot + 0x42, 0x29); // Extended boot signature ??
|
||||
WriteData<u32>(boot + 0x43, serial_id); // Serial ID
|
||||
strncpy((char*)boot + 0x47, label, 11); // Volume Label
|
||||
memcpy(boot + 0x52, "FAT32 ", 8); // FAT system type, padded with 0x20
|
||||
|
||||
POKEB(boot + BYTES_PER_SECTOR - 2, 0x55); /* Boot sector signature */
|
||||
POKEB(boot + BYTES_PER_SECTOR - 1, 0xAA);
|
||||
WriteData<u8>(boot + BYTES_PER_SECTOR - 2, 0x55); // Boot sector signature
|
||||
WriteData<u8>(boot + BYTES_PER_SECTOR - 1, 0xAA);
|
||||
|
||||
/* FSInfo sector */
|
||||
free_count = sectors_per_disk - 32 - 2 * sectors_per_fat;
|
||||
const u32 free_count = sectors_per_disk - 32 - 2 * sectors_per_fat;
|
||||
|
||||
POKEW(info + 0, 0x41615252);
|
||||
POKEW(info + 484, 0x61417272);
|
||||
POKEW(info + 488, free_count); /* Number of free clusters */
|
||||
POKEW(info + 492, 3); /* Next free clusters, 0-1 reserved, 2 is used for the root dir */
|
||||
POKEW(info + 508, 0xAA550000);
|
||||
WriteData<u32>(info + 0, 0x41615252);
|
||||
WriteData<u32>(info + 484, 0x61417272);
|
||||
WriteData<u32>(info + 488, free_count); // Number of free clusters
|
||||
// Next free clusters, 0-1 reserved, 2 is used for the root dir
|
||||
WriteData<u32>(info + 492, 3);
|
||||
WriteData<u32>(info + 508, 0xAA550000);
|
||||
}
|
||||
|
||||
static void fat_init(u8* fat)
|
||||
{
|
||||
POKEW(fat, 0x0ffffff8); /* Reserve cluster 1, media id in low byte */
|
||||
POKEW(fat + 4, 0x0fffffff); /* Reserve cluster 2 */
|
||||
POKEW(fat + 8, 0x0fffffff); /* End of cluster chain for root dir */
|
||||
WriteData<u32>(fat, 0x0ffffff8); // Reserve cluster 1, media id in low byte
|
||||
WriteData<u32>(fat + 4, 0x0fffffff); // Reserve cluster 2
|
||||
WriteData<u32>(fat + 8, 0x0fffffff); // End of cluster chain for root dir
|
||||
}
|
||||
|
||||
static unsigned int write_sector(FILE* file, u8* sector)
|
||||
static bool write_sector(File::IOFile& file, const u8* sector)
|
||||
{
|
||||
return fwrite(sector, 1, 512, file) != 512;
|
||||
return file.WriteBytes(sector, BYTES_PER_SECTOR);
|
||||
}
|
||||
|
||||
static unsigned int write_empty(FILE* file, u64 count)
|
||||
static bool write_empty(File::IOFile& file, std::size_t count)
|
||||
{
|
||||
static u8 empty[64 * 1024];
|
||||
static constexpr u8 empty[64 * 1024] = {};
|
||||
|
||||
count *= 512;
|
||||
count *= BYTES_PER_SECTOR;
|
||||
while (count > 0)
|
||||
{
|
||||
u64 len = sizeof(empty);
|
||||
if (len > count)
|
||||
len = count;
|
||||
const std::size_t len = std::min(sizeof(empty), count);
|
||||
|
||||
if (fwrite(empty, 1, (size_t)len, file) != (size_t)len)
|
||||
return 1;
|
||||
if (!file.WriteBytes(empty, len))
|
||||
return false;
|
||||
|
||||
count -= len;
|
||||
}
|
||||
return 0;
|
||||
return true;
|
||||
}
|
||||
|
||||
bool SDCardCreate(u64 disk_size /*in MB*/, const std::string& filename)
|
||||
{
|
||||
u32 sectors_per_fat;
|
||||
u32 sectors_per_disk;
|
||||
|
||||
// Convert MB to bytes
|
||||
disk_size *= 1024 * 1024;
|
||||
|
||||
|
@ -218,15 +215,14 @@ bool SDCardCreate(u64 disk_size /*in MB*/, const std::string& filename)
|
|||
}
|
||||
|
||||
// Pretty unlikely to overflow.
|
||||
sectors_per_disk = (u32)(disk_size / 512);
|
||||
sectors_per_fat = get_sectors_per_fat(disk_size, get_sectors_per_cluster(disk_size));
|
||||
const u32 sectors_per_disk = static_cast<u32>(disk_size / BYTES_PER_SECTOR);
|
||||
const u32 sectors_per_fat = get_sectors_per_fat(disk_size, get_sectors_per_cluster(disk_size));
|
||||
|
||||
boot_sector_init(s_boot_sector, s_fsinfo_sector, disk_size, nullptr);
|
||||
fat_init(s_fat_head);
|
||||
|
||||
File::IOFile file(filename, "wb");
|
||||
FILE* const f = file.GetHandle();
|
||||
if (!f)
|
||||
if (!file)
|
||||
{
|
||||
ERROR_LOG(COMMON, "Could not create file '%s', aborting...", filename.c_str());
|
||||
return false;
|
||||
|
@ -245,45 +241,45 @@ bool SDCardCreate(u64 disk_size /*in MB*/, const std::string& filename)
|
|||
* zero sectors
|
||||
*/
|
||||
|
||||
if (write_sector(f, s_boot_sector))
|
||||
if (!write_sector(file, s_boot_sector))
|
||||
goto FailWrite;
|
||||
|
||||
if (write_sector(f, s_fsinfo_sector))
|
||||
if (!write_sector(file, s_fsinfo_sector))
|
||||
goto FailWrite;
|
||||
|
||||
if (BACKUP_BOOT_SECTOR > 0)
|
||||
{
|
||||
if (write_empty(f, BACKUP_BOOT_SECTOR - 2))
|
||||
if (!write_empty(file, BACKUP_BOOT_SECTOR - 2))
|
||||
goto FailWrite;
|
||||
|
||||
if (write_sector(f, s_boot_sector))
|
||||
if (!write_sector(file, s_boot_sector))
|
||||
goto FailWrite;
|
||||
|
||||
if (write_sector(f, s_fsinfo_sector))
|
||||
if (!write_sector(file, s_fsinfo_sector))
|
||||
goto FailWrite;
|
||||
|
||||
if (write_empty(f, RESERVED_SECTORS - 2 - BACKUP_BOOT_SECTOR))
|
||||
if (!write_empty(file, RESERVED_SECTORS - 2 - BACKUP_BOOT_SECTOR))
|
||||
goto FailWrite;
|
||||
}
|
||||
else
|
||||
{
|
||||
if (write_empty(f, RESERVED_SECTORS - 2))
|
||||
if (!write_empty(file, RESERVED_SECTORS - 2))
|
||||
goto FailWrite;
|
||||
}
|
||||
|
||||
if (write_sector(f, s_fat_head))
|
||||
if (!write_sector(file, s_fat_head))
|
||||
goto FailWrite;
|
||||
|
||||
if (write_empty(f, sectors_per_fat - 1))
|
||||
if (!write_empty(file, sectors_per_fat - 1))
|
||||
goto FailWrite;
|
||||
|
||||
if (write_sector(f, s_fat_head))
|
||||
if (!write_sector(file, s_fat_head))
|
||||
goto FailWrite;
|
||||
|
||||
if (write_empty(f, sectors_per_fat - 1))
|
||||
if (!write_empty(file, sectors_per_fat - 1))
|
||||
goto FailWrite;
|
||||
|
||||
if (write_empty(f, sectors_per_disk - RESERVED_SECTORS - 2 * sectors_per_fat))
|
||||
if (!write_empty(file, sectors_per_disk - RESERVED_SECTORS - 2 * sectors_per_fat))
|
||||
goto FailWrite;
|
||||
|
||||
return true;
|
||||
|
@ -294,6 +290,7 @@ FailWrite:
|
|||
ERROR_LOG(COMMON, "unlink(%s) failed: %s", filename.c_str(), LastStrerrorString().c_str());
|
||||
return false;
|
||||
}
|
||||
} // namespace Common
|
||||
|
||||
#ifdef _MSC_VER
|
||||
#pragma warning(pop)
|
||||
|
|
|
@ -7,4 +7,7 @@
|
|||
#include <string>
|
||||
#include "Common/CommonTypes.h"
|
||||
|
||||
namespace Common
|
||||
{
|
||||
bool SDCardCreate(u64 disk_size /*in MB*/, const std::string& filename);
|
||||
} // namespace Common
|
||||
|
|
|
@ -67,7 +67,7 @@ void SDIOSlot0::OpenInternal()
|
|||
if (!m_card)
|
||||
{
|
||||
WARN_LOG(IOS_SD, "Failed to open SD Card image, trying to create a new 128MB image...");
|
||||
if (SDCardCreate(128, filename))
|
||||
if (Common::SDCardCreate(128, filename))
|
||||
{
|
||||
INFO_LOG(IOS_SD, "Successfully created %s", filename.c_str());
|
||||
m_card.Open(filename, "r+b");
|
||||
|
|
Loading…
Reference in New Issue