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