Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #include <iostream>
- #include <cstdio>
- #include <cstring>
- using namespace std;
- typedef unsigned char u8;
- typedef unsigned short u16;
- typedef unsigned int u32;
- #define END_OF_CHAIN 0x0FFFFFFF
- #pragma pack(1)
- struct primary_partition
- {
- u8 Status;
- u8 CHSAddressStart[3];
- u8 PartitionType;
- u8 CHSAddressEnd[3];
- u32 LBAAddressStart;
- u32 SecotrCount;
- };
- #pragma pack(1)
- struct fat32_header
- {
- char Jump[3];
- char OEMName[8];
- u16 BytesPerSector;
- u8 SectorsPerCluster;
- u16 ReservedSectors;
- u8 NumberOfFats;
- u16 MaxRootEntries;
- u16 TotalSectors;
- u8 MediaDescriptor;
- u16 SectorsPerFat;
- u16 SectorsPerTrack;
- u16 NumberOfHeads;
- u32 HiddenSectors;
- u32 TotalSectorsBig;
- u32 SectorsPerFatBig;
- u16 ExtendedFlags;
- u16 FSVersion;
- u32 RootDirStartCluster;
- u16 FSInfoSector;
- u16 BackupBootSector;
- u8 Reserved1[12];
- u8 BootDrive;
- u8 Reserved2;
- u8 ExtendedSignature;
- u32 SerialNumber;
- char VolumeLabel[11];
- char Filesystem[8];
- char BootCode[420];
- unsigned short BootSignature;
- };
- #pragma pack(1)
- struct fat_83entry
- {
- char Filename[8];
- char Extension[3];
- u8 Attributes;
- u8 Reserved;
- u8 CreationTimeTenths;
- u16 CreationTime;
- u16 CreationDate;
- u16 LastAccessData;
- u16 HiFirstCluster;
- u16 LastModificationTime;
- u16 LastModificationDate;
- u16 LoFirstCluster;
- u32 Filesize;
- };
- #pragma pack(1)
- struct fat_lfnentry
- {
- unsigned char Order;
- wchar_t Chars1[5];
- unsigned char Attribute;
- unsigned char EntryType;
- unsigned char Checksum;
- wchar_t Chars2[6];
- unsigned short Zero;
- wchar_t Chars3[2];
- };
- unsigned char *imgbuff;
- fat32_header *header;
- unsigned int *fattable;
- char fat32id[8] = { 'F', 'A', 'T', '3', '2', ' ', ' ', ' ' };
- unsigned char* GetCluster(int cluster)
- {
- int fds = (header->ReservedSectors + (header->NumberOfFats * header->SectorsPerFatBig)) * 512;
- return (unsigned char*) ( ((unsigned int)imgbuff) + fds + ((cluster - 2) * header->SectorsPerCluster * header->BytesPerSector));
- }
- int AddFile(char *path, wchar_t *lfnname, char *name)
- {
- FILE *file = fopen(path, "rb");
- if (!file)
- return 1;
- fat_83entry *rootdir = (fat_83entry*)GetCluster(header->RootDirStartCluster);
- int curdirentry = 0;
- while (rootdir[curdirentry].Filename[0])
- curdirentry++;
- int curcluster = 0;
- while (fattable[curcluster])
- curcluster++;
- if (lfnname)
- {
- int lfnlen = wcslen(lfnname);
- int lfnentries = lfnlen / 13;
- if (lfnlen % 13)
- lfnentries++;
- int curchar = 0;
- for (int i = 0; i < lfnentries; i++)
- {
- ((fat_lfnentry*)rootdir)[curdirentry].Attribute = 0xF;
- ((fat_lfnentry*)rootdir)[curdirentry].Order = (lfnentries - i);
- if (!i)
- ((fat_lfnentry*)rootdir)[curdirentry].Order += 0x40;
- int ltocpy = lfnlen < 5 ? lfnlen : 5;
- memcpy(((fat_lfnentry*)rootdir)[curdirentry].Chars1, &lfnname[curchar], ltocpy * 2);
- lfnlen -= ltocpy;
- curchar += ltocpy;
- ltocpy = lfnlen < 6 ? lfnlen : 6;
- memcpy(((fat_lfnentry*)rootdir)[curdirentry].Chars2, &lfnname[curchar], ltocpy * 2);
- lfnlen -= ltocpy;
- curchar += ltocpy;
- ltocpy = lfnlen < 2 ? lfnlen : 2;
- memcpy(((fat_lfnentry*)rootdir)[curdirentry].Chars3, &lfnname[curchar], ltocpy * 2);
- lfnlen -= ltocpy;
- curchar += ltocpy;
- curdirentry++;
- }
- }
- memcpy(rootdir[curdirentry].Filename, name, 11);
- rootdir[curdirentry].HiFirstCluster = (u16)(curcluster >> 16);
- rootdir[curdirentry].LoFirstCluster = (u16)(curcluster & 0xFFFF);
- fseek(file, 0, SEEK_END);
- size_t fsize = ftell(file);
- fseek(file, 0, SEEK_SET);
- unsigned char *fbuff = new unsigned char[fsize];
- fread(fbuff, 1, fsize, file);
- fclose(file);
- int clustersreq = fsize / 4096;
- if (fsize % 4096)
- clustersreq++;
- for (int i = 0; i < clustersreq; i++)
- {
- unsigned char *clusterptr = GetCluster(curcluster);
- int writelen = fsize < 4096 ? fsize : 4096;
- memcpy(clusterptr, &fbuff[i * 4096], writelen);
- fsize -= writelen;
- if (i == (clustersreq - 1))
- fattable[curcluster] = END_OF_CHAIN;
- else
- {
- int oc = curcluster;
- curcluster++;
- while (fattable[curcluster])
- curcluster++;
- fattable[oc] = curcluster;
- }
- }
- return 0;
- }
- int main(int argc, char **argv)
- {
- imgbuff = new unsigned char[1048576 * 6];
- memset(imgbuff, 0, 1048576 * 6);
- header = (fat32_header*)imgbuff;
- header->BytesPerSector = 512;
- header->SectorsPerCluster = 8;
- header->ReservedSectors = 38;
- header->NumberOfFats = 2;
- header->MediaDescriptor = 248;
- header->SectorsPerTrack = 32;
- header->NumberOfHeads = 64;
- header->TotalSectorsBig = 262144;
- header->SectorsPerFatBig = 256;
- header->RootDirStartCluster = 2;
- header->FSInfoSector = 1;
- header->BackupBootSector = 6;
- header->BootSignature = 0xAA55;
- header->Jump[0] = 0xEB;
- header->Jump[1] = 0x58;
- header->Jump[2] = 0x90;
- for (int i = 0; i < 8; i++)
- header->Filesystem[i] = fat32id[i];
- FILE *mbr = fopen("D:\\Cygwin\\wnos\\output\\bin\\fat32mbr.bin", "rb");
- if (!mbr)
- {
- printf("Could not open fat32mbr.bin\n");
- delete imgbuff;
- return 1;
- }
- fat32_header *mbrbuff = (fat32_header*)new unsigned char[512];
- fread(mbrbuff, 1, 512, mbr);
- fclose(mbr);
- for (int i = 0; i < 420; i++)
- header->BootCode[i] = mbrbuff->BootCode[i];
- delete mbrbuff;
- fattable = (unsigned int*)(((unsigned int)imgbuff) + 512 * header->ReservedSectors);
- fattable[0] = END_OF_CHAIN;
- fattable[1] = END_OF_CHAIN;
- fattable[2] = END_OF_CHAIN;
- if (AddFile("D:\\Cygwin\\wnos\\output\\bin\\ezloader.bin", NULL, "EZLOADERBIN"))
- {
- printf("Could not open ezloader.bin\n");
- delete imgbuff;
- return 1;
- }
- if (AddFile("D:\\Cygwin\\wnos\\output\\bin\\kernel.elf64", L"kernel.elf64", "KERNEL~1ELF"))
- {
- printf("Could not open kernel.elf64\n");
- delete imgbuff;
- return 1;
- }
- FILE *out = fopen("D:\\Cygwin\\wnos\\output\\bin\\hddimg.img", "wb");
- fwrite(imgbuff, 1, 1048576 * 6, out);
- fclose(out);
- delete imgbuff;
- return 0;
- }
Advertisement
Add Comment
Please, Sign In to add comment