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 static 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     UINT32 DiskSignature;
 431     UINT32 DiskSectorCount;
 432     UINT32 PartSectorCount;
 433     UINT32 PartStartSector;
 434
 435     VentoyGetLocalBootImg(pMBR);
 436
 437     CoCreateGuid(&Guid);
 438
 439     memcpy(&DiskSignature, &Guid, sizeof(UINT32));
 440
 441     Log("Disk signature: 0x%08x", DiskSignature);
 442
 443     *((UINT32 *)(pMBR->BootCode + 0x1B8)) = DiskSignature;
 444
 445     DiskSectorCount = (UINT32)(DiskSizeBytes / 512);
 446
 447     //Part1
 448     PartStartSector = VENTOY_PART1_START_SECTOR;
 449     PartSectorCount = DiskSectorCount - VENTOY_EFI_PART_SIZE / 512 - PartStartSector;
 450     VentoyFillLocation(DiskSizeBytes, PartStartSector, PartSectorCount, pMBR->PartTbl);
 451
 452     pMBR->PartTbl[0].Active = 0x00;
 453     pMBR->PartTbl[0].FsFlag = 0x07; // exFAT/NTFS/HPFS
 454
 455     //Part2
 456     PartStartSector += PartSectorCount;
 457     PartSectorCount = VENTOY_EFI_PART_SIZE / 512;
 458     VentoyFillLocation(DiskSizeBytes, PartStartSector, PartSectorCount, pMBR->PartTbl + 1);
 459
 460     pMBR->PartTbl[1].Active = 0x80; // bootable
 461     pMBR->PartTbl[1].FsFlag = 0xEF; // EFI System Partition
 462
 463     pMBR->Byte55 = 0x55;
 464     pMBR->ByteAA = 0xAA;
 465
 466     return 0;
 467 }
 468
 469 CHAR GetFirstUnusedDriveLetter(void)
 470 {
 471     CHAR Letter = 'D';
 472     DWORD Drives = GetLogicalDrives();
 473
 474     Drives >>= 3;
 475     while (Drives & 0x1)
 476     {
 477         Letter++;
 478         Drives >>= 1;
 479     }
 480
 481     return Letter;
 482 }
 483
 484 const CHAR * GetBusTypeString(STORAGE_BUS_TYPE Type)
 485 {
 486     switch (Type)
 487     {
 488         case BusTypeUnknown: return "unknown";
 489         case BusTypeScsi: return "SCSI";
 490         case BusTypeAtapi: return "Atapi";
 491         case BusTypeAta: return "ATA";
 492         case BusType1394: return "1394";
 493         case BusTypeSsa: return "SSA";
 494         case BusTypeFibre: return "Fibre";
 495         case BusTypeUsb: return "USB";
 496         case BusTypeRAID: return "RAID";
 497         case BusTypeiScsi: return "iSCSI";
 498         case BusTypeSas: return "SAS";
 499         case BusTypeSata: return "SATA";
 500         case BusTypeSd: return "SD";
 501         case BusTypeMmc: return "MMC";
 502         case BusTypeVirtual: return "Virtual";
 503         case BusTypeFileBackedVirtual: return "FileBackedVirtual";
 504         case BusTypeSpaces: return "Spaces";
 505         case BusTypeNvme: return "Nvme";
 506     }
 507     return "unknown";
 508 }
 509
 510 int VentoyGetLocalBootImg(MBR_HEAD *pMBR)
 511 {
 512     int Len = 0;
 513     BYTE *ImgBuf = NULL;
 514     static int Loaded = 0;
 515     static MBR_HEAD MBR;
 516
 517     if (Loaded)
 518     {
 519         memcpy(pMBR, &MBR, 512);
 520         return 0;
 521     }
 522
 523     if (0 == ReadWholeFileToBuf(VENTOY_FILE_BOOT_IMG, 0, (void **)&ImgBuf, &Len))
 524     {
 525         Log("Copy boot img success");
 526         memcpy(pMBR, ImgBuf, 512);
 527         free(ImgBuf);
 528
 529         CoCreateGuid((GUID *)(pMBR->BootCode + 0x180));
 530
 531         memcpy(&MBR, pMBR, 512);
 532         Loaded = 1;
 533
 534         return 0;
 535     }
 536     else
 537     {
 538         Log("Copy boot img failed");
 539         return 1;
 540     }
 541 }
 542
 543 int GetHumanReadableGBSize(UINT64 SizeBytes)
 544 {
 545     int i;
 546     int Pow2 = 1;
 547     double Delta;
 548     double GB = SizeBytes * 1.0 / 1000 / 1000 / 1000;
 549
 550     for (i = 0; i < 12; i++)
 551     {
 552         if (Pow2 > GB)
 553         {
 554             Delta = (Pow2 - GB) / Pow2;
 555         }
 556         else
 557         {
 558             Delta = (GB - Pow2) / Pow2;
 559         }
 560
 561         if (Delta < 0.05)
 562         {
 563             return Pow2;
 564         }
 565
 566         Pow2 <<= 1;
 567     }
 568
 569     return (int)GB;
 570 }
 571
 572 void TrimString(CHAR *String)
 573 {
 574     CHAR *Pos1 = String;
 575     CHAR *Pos2 = String;
 576     size_t Len = strlen(String);
 577
 578     while (Len > 0)
 579     {
 580         if (String[Len - 1] != ' ' && String[Len - 1] != '\t')
 581         {
 582             break;
 583         }
 584         String[Len - 1] = 0;
 585         Len--;
 586     }
 587
 588     while (*Pos1 == ' ' || *Pos1 == '\t')
 589     {
 590         Pos1++;
 591     }
 592
 593     while (*Pos1)
 594     {
 595         *Pos2++ = *Pos1++;
 596     }
 597     *Pos2++ = 0;
 598
 599     return;
 600 }
 601
 602 int GetRegDwordValue(HKEY Key, LPCSTR SubKey, LPCSTR ValueName, DWORD *pValue)
 603 {
 604     HKEY hKey;
 605     DWORD Type;
 606     DWORD Size;
 607     LSTATUS lRet;
 608     DWORD Value;
 609
 610     lRet = RegOpenKeyExA(Key, SubKey, 0, KEY_QUERY_VALUE, &hKey);
 611     Log("RegOpenKeyExA <%s> Ret:%ld", SubKey, lRet);
 612
 613     if (ERROR_SUCCESS == lRet)
 614     {
 615         Size = sizeof(Value);
 616         lRet = RegQueryValueExA(hKey, ValueName, NULL, &Type, (LPBYTE)&Value, &Size);
 617         Log("RegQueryValueExA <%s> ret:%u  Size:%u Value:%u", ValueName, lRet, Size, Value);
 618
 619         *pValue = Value;
 620         RegCloseKey(hKey);
 621
 622         return 0;
 623     }
 624     else
 625     {
 626         return 1;
 627     }
 628 }
 629
 630 int GetPhysicalDriveCount(void)
 631 {
 632     DWORD Value;
 633     int Count = 0;
 634
 635     if (GetRegDwordValue(HKEY_LOCAL_MACHINE, "SYSTEM\\CurrentControlSet\\Services\\disk\\Enum", "Count", &Value) == 0)
 636     {
 637         Count = (int)Value;
 638     }
 639
 640     Log("GetPhysicalDriveCount: %d", Count);
 641     return Count;
 642 }
 643
 644
 645