Ventoy2Disk/Ventoy2Disk/Utility.c

   1 /******************************************************************************
   2  * Utility.c
   3  *
   4  * Copyright (c) 2020, longpanda <admin@ventoy.net>
   5  *
   6  * This program is free software; you can redistribute it and/or
   7  * modify it under the terms of the GNU General Public License as
   8  * published by the Free Software Foundation; either version 3 of the
   9  * License, or (at your option) any later version.
  10  *
  11  * This program is distributed in the hope that it will be useful, but
  12  * WITHOUT ANY WARRANTY; without even the implied warranty of
  13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  14  * General Public License for more details.
  15  *
  16  * You should have received a copy of the GNU General Public License
  17  * along with this program; if not, see <http://www.gnu.org/licenses/>.
  18  *
  19  */
  20 #include <Windows.h>
  21 #include "Ventoy2Disk.h"
  22
  23 void Log(const char *Fmt, ...)
  24 {
  25     va_list Arg;
  26     int Len = 0;
  27     FILE *File = NULL;
  28     SYSTEMTIME Sys;
  29     char szBuf[1024];
  30
  31     GetLocalTime(&Sys);
  32     Len += safe_sprintf(szBuf,
  33         "[%4d/%02d/%02d %02d:%02d:%02d.%03d] ",
  34         Sys.wYear, Sys.wMonth, Sys.wDay,
  35         Sys.wHour, Sys.wMinute, Sys.wSecond,
  36         Sys.wMilliseconds);
  37
  38     va_start(Arg, Fmt);
  39     Len += vsnprintf_s(szBuf + Len, sizeof(szBuf)-Len, sizeof(szBuf)-Len, Fmt, Arg);
  40     va_end(Arg);
  41
  42     //printf("%s\n", szBuf);
  43
  44 #if 1
  45     fopen_s(&File, VENTOY_FILE_LOG, "a+");
  46     if (File)
  47     {
  48         fwrite(szBuf, 1, Len, File);
  49         fwrite("\n", 1, 1, File);
  50         fclose(File);
  51     }
  52 #endif
  53
  54 }
  55
  56 BOOL IsPathExist(BOOL Dir, const char *Fmt, ...)
  57 {
  58     va_list Arg;
  59     HANDLE hFile;
  60     DWORD Attr;
  61     CHAR FilePath[MAX_PATH];
  62
  63     va_start(Arg, Fmt);
  64     vsnprintf_s(FilePath, sizeof(FilePath), sizeof(FilePath), Fmt, Arg);
  65     va_end(Arg);
  66
  67     hFile = CreateFileA(FilePath, FILE_READ_EA, FILE_SHARE_READ, 0, OPEN_EXISTING, 0, 0);
  68     if (INVALID_HANDLE_VALUE == hFile)
  69     {
  70         return FALSE;
  71     }
  72
  73     CloseHandle(hFile);
  74
  75     Attr = GetFileAttributesA(FilePath);
  76
  77     if (Dir)
  78     {
  79         if ((Attr & FILE_ATTRIBUTE_DIRECTORY) == 0)
  80         {
  81             return FALSE;
  82         }
  83     }
  84     else
  85     {
  86         if (Attr & FILE_ATTRIBUTE_DIRECTORY)
  87         {
  88             return FALSE;
  89         }
  90     }
  91
  92     return TRUE;
  93 }
  94
  95
  96 int ReadWholeFileToBuf(const CHAR *FileName, int ExtLen, void **Bufer, int *BufLen)
  97 {
  98     int FileSize;
  99     FILE *File = NULL;
 100     void *Data = NULL;
 101
 102     fopen_s(&File, FileName, "rb");
 103     if (File == NULL)
 104     {
 105         Log("Failed to open file %s", FileName);
 106         return 1;
 107     }
 108
 109     fseek(File, 0, SEEK_END);
 110     FileSize = (int)ftell(File);
 111
 112     Data = malloc(FileSize + ExtLen);
 113     if (!Data)
 114     {
 115         fclose(File);
 116         return 1;
 117     }
 118
 119     fseek(File, 0, SEEK_SET);
 120     fread(Data, 1, FileSize, File);
 121
 122     fclose(File);
 123
 124     *Bufer = Data;
 125     *BufLen = FileSize;
 126
 127     return 0;
 128 }
 129
 130 const CHAR* GetLocalVentoyVersion(void)
 131 {
 132     int rc;
 133     int FileSize;
 134     CHAR *Pos = NULL;
 135     CHAR *Buf = NULL;
 136     static CHAR LocalVersion[64] = { 0 };
 137
 138     if (LocalVersion[0] == 0)
 139     {
 140         rc = ReadWholeFileToBuf(VENTOY_FILE_VERSION, 1, (void **)&Buf, &FileSize);
 141         if (rc)
 142         {
 143             return "";
 144         }
 145         Buf[FileSize] = 0;
 146
 147         for (Pos = Buf; *Pos; Pos++)
 148         {
 149             if (*Pos == '\r' || *Pos == '\n')
 150             {
 151                 *Pos = 0;
 152                 break;
 153             }
 154         }
 155
 156         safe_sprintf(LocalVersion, "%s", Buf);
 157         free(Buf);
 158     }
 159
 160     return LocalVersion;
 161 }
 162
 163 const CHAR* ParseVentoyVersionFromString(CHAR *Buf)
 164 {
 165     CHAR *Pos = NULL;
 166     CHAR *End = NULL;
 167     static CHAR LocalVersion[64] = { 0 };
 168
 169     Pos = strstr(Buf, "VENTOY_VERSION=");
 170     if (Pos)
 171     {
 172         Pos += strlen("VENTOY_VERSION=");
 173         if (*Pos == '"')
 174         {
 175             Pos++;
 176         }
 177
 178         End = Pos;
 179         while (*End != 0 && *End != '"' && *End != '\r' && *End != '\n')
 180         {
 181             End++;
 182         }
 183
 184         *End = 0;
 185
 186         safe_sprintf(LocalVersion, "%s", Pos);
 187         return LocalVersion;
 188     }
 189
 190     return "";
 191 }
 192
 193 BOOL IsWow64(void)
 194 {
 195     typedef BOOL(WINAPI *LPFN_ISWOW64PROCESS)(HANDLE, PBOOL);
 196     LPFN_ISWOW64PROCESS fnIsWow64Process;
 197     BOOL bIsWow64 = FALSE;
 198
 199     fnIsWow64Process = (LPFN_ISWOW64PROCESS)GetProcAddress(GetModuleHandleA("kernel32"), "IsWow64Process");
 200     if (NULL != fnIsWow64Process)
 201     {
 202         fnIsWow64Process(GetCurrentProcess(), &bIsWow64);
 203     }
 204
 205     return bIsWow64;
 206 }
 207
 208 void DumpWindowsVersion(void)
 209 {
 210     int Bit;
 211     BOOL WsVer;
 212     DWORD Major, Minor;
 213     ULONGLONG MajorEqual, MinorEqual;
 214     OSVERSIONINFOEXA Ver1, Ver2;
 215     const CHAR *Ver = NULL;
 216     CHAR WinVer[256] = { 0 };
 217
 218     memset(&Ver1, 0, sizeof(Ver1));
 219     memset(&Ver2, 0, sizeof(Ver2));
 220
 221     Ver1.dwOSVersionInfoSize = sizeof(Ver1);
 222
 223     // suppress the C4996 warning for GetVersionExA
 224     #pragma warning(push)
 225     #pragma warning(disable:4996)
 226     if (!GetVersionExA((OSVERSIONINFOA *)&Ver1))
 227     {
 228         memset(&Ver1, 0, sizeof(Ver1));
 229         Ver1.dwOSVersionInfoSize = sizeof(OSVERSIONINFOA);
 230         if (!GetVersionExA((OSVERSIONINFOA *)&Ver1))
 231         {
 232             return;
 233         }
 234     }
 235     #pragma warning(pop)
 236
 237     if (Ver1.dwPlatformId == VER_PLATFORM_WIN32_NT)
 238     {
 239         if (Ver1.dwMajorVersion > 6 || (Ver1.dwMajorVersion == 6 && Ver1.dwMinorVersion >= 2))
 240         {
 241             // GetVersionEx() has problem on some Windows version
 242
 243             MajorEqual = VerSetConditionMask(0, VER_MAJORVERSION, VER_EQUAL);
 244             for (Major = Ver1.dwMajorVersion; Major <= 9; Major++)
 245             {
 246                 memset(&Ver2, 0, sizeof(Ver2));
 247                 Ver2.dwOSVersionInfoSize = sizeof(Ver2);
 248                 Ver2.dwMajorVersion = Major;
 249
 250                 if (!VerifyVersionInfoA(&Ver2, VER_MAJORVERSION, MajorEqual))
 251                 {
 252                     continue;
 253                 }
 254
 255                 if (Ver1.dwMajorVersion < Major)
 256                 {
 257                     Ver1.dwMajorVersion = Major;
 258                     Ver1.dwMinorVersion = 0;
 259                 }
 260
 261                 MinorEqual = VerSetConditionMask(0, VER_MINORVERSION, VER_EQUAL);
 262                 for (Minor = Ver1.dwMinorVersion; Minor <= 9; Minor++)
 263                 {
 264                     memset(&Ver2, 0, sizeof(Ver2));
 265
 266                     Ver2.dwOSVersionInfoSize = sizeof(Ver2);
 267                     Ver2.dwMinorVersion = Minor;
 268
 269                     if (!VerifyVersionInfoA(&Ver2, VER_MINORVERSION, MinorEqual))
 270                     {
 271                         continue;
 272                     }
 273
 274                     Ver1.dwMinorVersion = Minor;
 275                     break;
 276                 }
 277
 278                 break;
 279             }
 280         }
 281
 282         if (Ver1.dwMajorVersion <= 0xF && Ver1.dwMinorVersion <= 0xF)
 283         {
 284             WsVer = (Ver1.wProductType <= VER_NT_WORKSTATION);
 285             switch ((Ver1.dwMajorVersion << 4) | Ver2.dwMinorVersion)
 286             {
 287                 case 0x51:
 288                 {
 289                     Ver = "XP";
 290                     break;
 291                 }
 292                 case 0x52:
 293                 {
 294                     Ver = GetSystemMetrics(89) ? "Server 2003 R2" : "Server 2003";
 295                     break;
 296                 }
 297                 case 0x60:
 298                 {
 299                     Ver = WsVer ? "Vista" : "Server 2008";
 300                     break;
 301                 }
 302                 case 0x61:
 303                 {
 304                     Ver = WsVer ? "7" : "Server 2008 R2";
 305                     break;
 306                 }
 307                 case 0x62:
 308                 {
 309                     Ver = WsVer ? "8" : "Server 2012";
 310                     break;
 311                 }
 312                 case 0x63:
 313                 {
 314                     Ver = WsVer ? "8.1" : "Server 2012 R2";
 315                     break;
 316                 }
 317                 case 0x64:
 318                 {
 319                     Ver = WsVer ? "10 (Preview 1)" : "Server 10 (Preview 1)";
 320                     break;
 321                 }
 322                 case 0xA0:
 323                 {
 324                     Ver = WsVer ? "10" : ((Ver1.dwBuildNumber > 15000) ? "Server 2019" : "Server 2016");
 325                     break;
 326                 }
 327                 default:
 328                 {
 329                     Ver = "10 or later";
 330                     break;
 331                 }
 332             }
 333         }
 334     }
 335
 336     Bit = IsWow64() ? 64 : 32;
 337
 338     if (Ver1.wServicePackMinor)
 339     {
 340         safe_sprintf(WinVer, "Windows %s SP%u.%u %d-bit", Ver, Ver1.wServicePackMajor, Ver1.wServicePackMinor, Bit);
 341     }
 342     else if (Ver1.wServicePackMajor)
 343     {
 344         safe_sprintf(WinVer, "Windows %s SP%u %d-bit", Ver, Ver1.wServicePackMajor, Bit);
 345     }
 346     else
 347     {
 348         safe_sprintf(WinVer, "Windows %s %d-bit", Ver, Bit);
 349     }
 350
 351     if (((Ver1.dwMajorVersion << 4) | Ver2.dwMinorVersion) >= 0x62)
 352     {
 353         Log("Windows Version : %s (Build %u)", WinVer, Ver1.dwBuildNumber);
 354     }
 355     else
 356     {
 357         Log("Windows Version : %s", WinVer);
 358     }
 359
 360     return;
 361 }
 362
 363 BOOL IsVentoyLogicalDrive(CHAR DriveLetter)
 364 {
 365     int i;
 366     CONST CHAR *Files[] =
 367     {
 368         "EFI\\BOOT\\BOOTX64.EFI",
 369         "grub\\themes\\ventoy\\theme.txt",
 370         "ventoy\\ventoy.cpio",
 371     };
 372
 373     for (i = 0; i < sizeof(Files) / sizeof(Files[0]); i++)
 374     {
 375         if (!IsFileExist("%C:\\%s", DriveLetter, Files[i]))
 376         {
 377             return FALSE;
 378         }
 379     }
 380
 381     return TRUE;
 382 }
 383
 384
 385 int VentoyFillLocation(UINT64 DiskSizeInBytes, UINT32 StartSectorId, UINT32 SectorCount, PART_TABLE *Table)
 386 {
 387     BYTE Head;
 388     BYTE Sector;
 389     BYTE nSector = 63;
 390     BYTE nHead = 8;
 391     UINT32 Cylinder;
 392     UINT32 EndSectorId;
 393
 394     while (nHead != 0 && (DiskSizeInBytes / 512 / nSector / nHead) > 1024)
 395     {
 396         nHead = (BYTE)nHead * 2;
 397     }
 398
 399     if (nHead == 0)
 400     {
 401         nHead = 255;
 402     }
 403
 404     Cylinder = StartSectorId / nSector / nHead;
 405     Head = StartSectorId / nSector % nHead;
 406     Sector = StartSectorId % nSector + 1;
 407
 408     Table->StartHead = Head;
 409     Table->StartSector = Sector;
 410     Table->StartCylinder = Cylinder;
 411
 412     EndSectorId = StartSectorId + SectorCount - 1;
 413     Cylinder = EndSectorId / nSector / nHead;
 414     Head = EndSectorId / nSector % nHead;
 415     Sector = EndSectorId % nSector + 1;
 416
 417     Table->EndHead = Head;
 418     Table->EndSector = Sector;
 419     Table->EndCylinder = Cylinder;
 420
 421     Table->StartSectorId = StartSectorId;
 422     Table->SectorCount = SectorCount;
 423
 424     return 0;
 425 }
 426
 427 int VentoyFillMBR(UINT64 DiskSizeBytes, MBR_HEAD *pMBR)
 428 {
 429     GUID Guid;
 430         int ReservedValue;
 431     UINT32 DiskSignature;
 432     UINT32 DiskSectorCount;
 433     UINT32 PartSectorCount;
 434     UINT32 PartStartSector;
 435         UINT32 ReservedSector;
 436
 437     VentoyGetLocalBootImg(pMBR);
 438
 439     CoCreateGuid(&Guid);
 440
 441     memcpy(&DiskSignature, &Guid, sizeof(UINT32));
 442
 443     Log("Disk signature: 0x%08x", DiskSignature);
 444
 445     *((UINT32 *)(pMBR->BootCode + 0x1B8)) = DiskSignature;
 446
 447     DiskSectorCount = (UINT32)(DiskSizeBytes / 512);
 448
 449         ReservedValue = GetReservedSpaceInMB();
 450         if (ReservedValue <= 0)
 451         {
 452                 ReservedSector = 0;
 453         }
 454         else
 455         {
 456                 ReservedSector = (UINT32)(ReservedValue * 2048);
 457         }
 458
 459         Log("ReservedSector: %u", ReservedSector);
 460
 461     //Part1
 462     PartStartSector = VENTOY_PART1_START_SECTOR;
 463         PartSectorCount = DiskSectorCount - ReservedSector - VENTOY_EFI_PART_SIZE / 512 - PartStartSector;
 464     VentoyFillLocation(DiskSizeBytes, PartStartSector, PartSectorCount, pMBR->PartTbl);
 465
 466     pMBR->PartTbl[0].Active = 0x80; // bootable
 467     pMBR->PartTbl[0].FsFlag = 0x07; // exFAT/NTFS/HPFS
 468
 469     //Part2
 470     PartStartSector += PartSectorCount;
 471     PartSectorCount = VENTOY_EFI_PART_SIZE / 512;
 472     VentoyFillLocation(DiskSizeBytes, PartStartSector, PartSectorCount, pMBR->PartTbl + 1);
 473
 474     pMBR->PartTbl[1].Active = 0x00;
 475     pMBR->PartTbl[1].FsFlag = 0xEF; // EFI System Partition
 476
 477     pMBR->Byte55 = 0x55;
 478     pMBR->ByteAA = 0xAA;
 479
 480     return 0;
 481 }
 482
 483 CHAR GetFirstUnusedDriveLetter(void)
 484 {
 485     CHAR Letter = 'D';
 486     DWORD Drives = GetLogicalDrives();
 487
 488     Drives >>= 3;
 489     while (Drives & 0x1)
 490     {
 491         Letter++;
 492         Drives >>= 1;
 493     }
 494
 495     return Letter;
 496 }
 497
 498 const CHAR * GetBusTypeString(STORAGE_BUS_TYPE Type)
 499 {
 500     switch (Type)
 501     {
 502         case BusTypeUnknown: return "unknown";
 503         case BusTypeScsi: return "SCSI";
 504         case BusTypeAtapi: return "Atapi";
 505         case BusTypeAta: return "ATA";
 506         case BusType1394: return "1394";
 507         case BusTypeSsa: return "SSA";
 508         case BusTypeFibre: return "Fibre";
 509         case BusTypeUsb: return "USB";
 510         case BusTypeRAID: return "RAID";
 511         case BusTypeiScsi: return "iSCSI";
 512         case BusTypeSas: return "SAS";
 513         case BusTypeSata: return "SATA";
 514         case BusTypeSd: return "SD";
 515         case BusTypeMmc: return "MMC";
 516         case BusTypeVirtual: return "Virtual";
 517         case BusTypeFileBackedVirtual: return "FileBackedVirtual";
 518         case BusTypeSpaces: return "Spaces";
 519         case BusTypeNvme: return "Nvme";
 520     }
 521     return "unknown";
 522 }
 523
 524 int VentoyGetLocalBootImg(MBR_HEAD *pMBR)
 525 {
 526     int Len = 0;
 527     BYTE *ImgBuf = NULL;
 528     static int Loaded = 0;
 529     static MBR_HEAD MBR;
 530
 531     if (Loaded)
 532     {
 533         memcpy(pMBR, &MBR, 512);
 534         return 0;
 535     }
 536
 537     if (0 == ReadWholeFileToBuf(VENTOY_FILE_BOOT_IMG, 0, (void **)&ImgBuf, &Len))
 538     {
 539         Log("Copy boot img success");
 540         memcpy(pMBR, ImgBuf, 512);
 541         free(ImgBuf);
 542
 543         CoCreateGuid((GUID *)(pMBR->BootCode + 0x180));
 544
 545         memcpy(&MBR, pMBR, 512);
 546         Loaded = 1;
 547
 548         return 0;
 549     }
 550     else
 551     {
 552         Log("Copy boot img failed");
 553         return 1;
 554     }
 555 }
 556
 557 int GetHumanReadableGBSize(UINT64 SizeBytes)
 558 {
 559     int i;
 560     int Pow2 = 1;
 561     double Delta;
 562     double GB = SizeBytes * 1.0 / 1000 / 1000 / 1000;
 563
 564     for (i = 0; i < 12; i++)
 565     {
 566         if (Pow2 > GB)
 567         {
 568             Delta = (Pow2 - GB) / Pow2;
 569         }
 570         else
 571         {
 572             Delta = (GB - Pow2) / Pow2;
 573         }
 574
 575         if (Delta < 0.05)
 576         {
 577             return Pow2;
 578         }
 579
 580         Pow2 <<= 1;
 581     }
 582
 583     return (int)GB;
 584 }
 585
 586 void TrimString(CHAR *String)
 587 {
 588     CHAR *Pos1 = String;
 589     CHAR *Pos2 = String;
 590     size_t Len = strlen(String);
 591
 592     while (Len > 0)
 593     {
 594         if (String[Len - 1] != ' ' && String[Len - 1] != '\t')
 595         {
 596             break;
 597         }
 598         String[Len - 1] = 0;
 599         Len--;
 600     }
 601
 602     while (*Pos1 == ' ' || *Pos1 == '\t')
 603     {
 604         Pos1++;
 605     }
 606
 607     while (*Pos1)
 608     {
 609         *Pos2++ = *Pos1++;
 610     }
 611     *Pos2++ = 0;
 612
 613     return;
 614 }
 615
 616 int GetRegDwordValue(HKEY Key, LPCSTR SubKey, LPCSTR ValueName, DWORD *pValue)
 617 {
 618     HKEY hKey;
 619     DWORD Type;
 620     DWORD Size;
 621     LSTATUS lRet;
 622     DWORD Value;
 623
 624     lRet = RegOpenKeyExA(Key, SubKey, 0, KEY_QUERY_VALUE, &hKey);
 625     Log("RegOpenKeyExA <%s> Ret:%ld", SubKey, lRet);
 626
 627     if (ERROR_SUCCESS == lRet)
 628     {
 629         Size = sizeof(Value);
 630         lRet = RegQueryValueExA(hKey, ValueName, NULL, &Type, (LPBYTE)&Value, &Size);
 631         Log("RegQueryValueExA <%s> ret:%u  Size:%u Value:%u", ValueName, lRet, Size, Value);
 632
 633         *pValue = Value;
 634         RegCloseKey(hKey);
 635
 636         return 0;
 637     }
 638     else
 639     {
 640         return 1;
 641     }
 642 }
 643
 644 int GetPhysicalDriveCount(void)
 645 {
 646     DWORD Value;
 647     int Count = 0;
 648
 649     if (GetRegDwordValue(HKEY_LOCAL_MACHINE, "SYSTEM\\CurrentControlSet\\Services\\disk\\Enum", "Count", &Value) == 0)
 650     {
 651         Count = (int)Value;
 652     }
 653
 654     Log("GetPhysicalDriveCount: %d", Count);
 655     return Count;
 656 }
 657
 658
 659