windows-nt/Source/XPSP1/NT/sdktools/addsect/addsect.cpp

979 lines
30 KiB
C++
Raw Normal View History

2020-09-26 03:20:57 -05:00
//////////////////////////////////////////////////////////////////////////////
//
//
// Copyright (C) Microsoft Corporation, 1996-2001.
//
// File: addsect.cpp
//
// Contents: Add a data section to a PE binary.
//
// History: 01-Nov-2000 GalenH Created from Detours setdll.cpp.
//
//////////////////////////////////////////////////////////////////////////////
#define UNICODE
#define _UNICODE
#include <stdio.h>
#include <stdlib.h>
#include <windows.h>
#define arrayof(a) (sizeof(a)/sizeof(a[0]))
///////////////////////////////////////////////////////////////////////////////
//
class CImage
{
public:
CImage();
~CImage();
public: // File Functions
BOOL Read(HANDLE hFile);
BOOL Check(PCSTR pszSection);
BOOL Write(HANDLE hFile, PBYTE pbData, UINT cbData,
PCSTR pszSection);
BOOL Close();
public: // Manipulation Functions
PBYTE DataSet(PBYTE pbData, DWORD cbData);
protected:
BOOL CopyFileData(HANDLE hFile, DWORD nOldPos, DWORD cbData);
BOOL ZeroFileData(HANDLE hFile, DWORD cbData);
BOOL AlignFileData(HANDLE hFile);
BOOL SizeOutputBuffer(DWORD cbData);
PBYTE AllocateOutput(DWORD cbData, DWORD *pnVirtAddr);
PVOID RvaToVa(DWORD nRva);
DWORD RvaToFileOffset(DWORD nRva);
DWORD FileAlign(DWORD nAddr);
DWORD SectionAlign(DWORD nAddr);
private:
HANDLE m_hMap; // Read & Write
PBYTE m_pMap; // Read & Write
DWORD m_nNextFileAddr; // Write
DWORD m_nNextVirtAddr; // Write
BOOLEAN m_f64bit;
IMAGE_FILE_HEADER m_FileHeader;
IMAGE_OPTIONAL_HEADER64 m_OptionalHeader;
IMAGE_SECTION_HEADER m_SectionHeaders[IMAGE_NUMBEROF_DIRECTORY_ENTRIES];
DWORD m_nFileHeaderOffset;
DWORD m_nOptionalHeaderOffset;
DWORD m_nSectionsOffset;
DWORD m_nSectionsEndOffset;
DWORD m_nSectionsMaxCount;
DWORD m_nExtraOffset;
DWORD m_nFileSize;
PBYTE m_pbOutputBuffer;
DWORD m_cbOutputBuffer;
DWORD m_nOutputVirtAddr;
DWORD m_nOutputVirtSize;
DWORD m_nOutputFileAddr;
};
//////////////////////////////////////////////////////////////////////////////
//
static inline DWORD Max(DWORD a, DWORD b)
{
return a > b ? a : b;
}
static inline DWORD Min(DWORD a, DWORD b)
{
return a < b ? a : b;
}
static inline DWORD Align(DWORD a, DWORD size)
{
size--;
return (a + size) & ~size;
}
static inline DWORD QuadAlign(DWORD a)
{
return Align(a, 8);
}
//////////////////////////////////////////////////////////////////////////////
//
CImage::CImage()
{
m_hMap = NULL;
m_pMap = NULL;
m_nFileHeaderOffset = 0;
m_nSectionsOffset = 0;
m_pbOutputBuffer = NULL;
m_cbOutputBuffer = 0;
}
CImage::~CImage()
{
Close();
}
BOOL CImage::Close()
{
if (m_pMap != NULL) {
UnmapViewOfFile(m_pMap);
m_pMap = NULL;
}
if (m_hMap) {
CloseHandle(m_hMap);
m_hMap = NULL;
}
if (m_pbOutputBuffer) {
delete[] m_pbOutputBuffer;
m_pbOutputBuffer = NULL;
}
return TRUE;
}
//////////////////////////////////////////////////////////////////////////////
//
BOOL CImage::SizeOutputBuffer(DWORD cbData)
{
if (m_cbOutputBuffer < cbData) {
if (cbData < 1024) //65536
cbData = 1024;
cbData = FileAlign(cbData);
PBYTE pOutput = new BYTE [cbData];
if (pOutput == NULL) {
SetLastError(ERROR_OUTOFMEMORY);
return FALSE;
}
if (m_pbOutputBuffer) {
CopyMemory(pOutput, m_pbOutputBuffer, m_cbOutputBuffer);
delete[] m_pbOutputBuffer;
m_pbOutputBuffer = NULL;
}
ZeroMemory(pOutput + m_cbOutputBuffer, cbData - m_cbOutputBuffer),
m_pbOutputBuffer = pOutput;
m_cbOutputBuffer = cbData;
}
return TRUE;
}
PBYTE CImage::AllocateOutput(DWORD cbData, DWORD *pnVirtAddr)
{
cbData = QuadAlign(cbData);
PBYTE pbData = m_pbOutputBuffer + m_nOutputVirtSize;
*pnVirtAddr = m_nOutputVirtAddr + m_nOutputVirtSize;
m_nOutputVirtSize += cbData;
if (m_nOutputVirtSize > m_cbOutputBuffer) {
SetLastError(ERROR_OUTOFMEMORY);
return NULL;
}
ZeroMemory(pbData, cbData);
return pbData;
}
//////////////////////////////////////////////////////////////////////////////
//
DWORD CImage::FileAlign(DWORD nAddr)
{
return Align(nAddr, m_OptionalHeader.FileAlignment);
}
DWORD CImage::SectionAlign(DWORD nAddr)
{
return Align(nAddr, m_OptionalHeader.SectionAlignment);
}
//////////////////////////////////////////////////////////////////////////////
//
PVOID CImage::RvaToVa(DWORD nRva)
{
if (nRva == 0) {
return NULL;
}
for (DWORD n = 0; n < m_FileHeader.NumberOfSections; n++) {
DWORD vaStart = m_SectionHeaders[n].VirtualAddress;
DWORD vaEnd = vaStart + m_SectionHeaders[n].SizeOfRawData;
if (nRva >= vaStart && nRva < vaEnd) {
return (PBYTE)m_pMap
+ m_SectionHeaders[n].PointerToRawData
+ nRva - m_SectionHeaders[n].VirtualAddress;
}
}
return NULL;
}
DWORD CImage::RvaToFileOffset(DWORD nRva)
{
DWORD n;
for (n = 0; n < m_FileHeader.NumberOfSections; n++) {
DWORD vaStart = m_SectionHeaders[n].VirtualAddress;
DWORD vaEnd = vaStart + m_SectionHeaders[n].SizeOfRawData;
if (nRva >= vaStart && nRva < vaEnd) {
return m_SectionHeaders[n].PointerToRawData
+ nRva - m_SectionHeaders[n].VirtualAddress;
}
}
return 0;
}
//////////////////////////////////////////////////////////////////////////////
//
BOOL CImage::CopyFileData(HANDLE hFile, DWORD nOldPos, DWORD cbData)
{
DWORD cbDone = 0;
return WriteFile(hFile, m_pMap + nOldPos, cbData, &cbDone, NULL);
}
BOOL CImage::ZeroFileData(HANDLE hFile, DWORD cbData)
{
if (!SizeOutputBuffer(4096)) {
return FALSE;
}
ZeroMemory(m_pbOutputBuffer, m_cbOutputBuffer);
for (DWORD cbLeft = cbData; cbLeft > 0;) {
DWORD cbStep = cbLeft > m_cbOutputBuffer ? m_cbOutputBuffer : cbLeft;
DWORD cbDone = 0;
if (!WriteFile(hFile, m_pbOutputBuffer, cbStep, &cbDone, NULL)) {
return FALSE;
}
if (cbDone == 0)
break;
cbLeft -= cbDone;
}
return TRUE;
}
BOOL CImage::AlignFileData(HANDLE hFile)
{
DWORD nLastFileAddr = m_nNextFileAddr;
m_nNextFileAddr = FileAlign(m_nNextFileAddr);
m_nNextVirtAddr = SectionAlign(m_nNextVirtAddr);
if (hFile != INVALID_HANDLE_VALUE) {
if (m_nNextFileAddr > nLastFileAddr) {
if (SetFilePointer(hFile, nLastFileAddr, NULL, FILE_BEGIN) == ~0u) {
return FALSE;
}
return ZeroFileData(hFile, m_nNextFileAddr - nLastFileAddr);
}
}
return TRUE;
}
BOOL CImage::Read(HANDLE hFile)
{
DWORD n;
IMAGE_OPTIONAL_HEADER32 oh32;
if (hFile == INVALID_HANDLE_VALUE) {
SetLastError(ERROR_INVALID_HANDLE);
return FALSE;
}
///////////////////////////////////////////////////////// Create mapping.
//
m_nFileSize = GetFileSize(hFile, NULL);
if (m_nFileSize == ~0ul) {
return FALSE;
}
m_hMap = CreateFileMapping(hFile, NULL, PAGE_READONLY, 0, 0, NULL);
if (m_hMap == NULL) {
return FALSE;
}
m_pMap = (PBYTE)MapViewOfFile(m_hMap, FILE_MAP_READ, 0, 0, 0);
if (m_pMap == NULL) {
return FALSE;
}
////////////////////////////////////////////////////// Process DOS Header.
//
PIMAGE_DOS_HEADER pDosHeader = (PIMAGE_DOS_HEADER)m_pMap;
if (pDosHeader->e_magic == IMAGE_DOS_SIGNATURE) {
m_nFileHeaderOffset = pDosHeader->e_lfanew + sizeof(DWORD);
m_nOptionalHeaderOffset = m_nFileHeaderOffset + sizeof(m_FileHeader);
}
else {
m_nFileHeaderOffset = 0;
m_nOptionalHeaderOffset = m_nFileHeaderOffset + sizeof(m_FileHeader);
}
/////////////////////////////////////////////////////// Process PE Header.
//
CopyMemory(&m_FileHeader, m_pMap + m_nFileHeaderOffset, sizeof(m_FileHeader));
if (m_FileHeader.SizeOfOptionalHeader == 0) {
SetLastError(ERROR_EXE_MARKED_INVALID);
return FALSE;
}
///////////////////////////////////////////////// Process Optional Header.
//
CopyMemory(&oh32, m_pMap + m_nOptionalHeaderOffset, sizeof(oh32));
if (oh32.Magic == IMAGE_NT_OPTIONAL_HDR32_MAGIC)
{
// Convert 32-bit optional header to internal 64-bit optional header
m_f64bit = FALSE;
ZeroMemory(&m_OptionalHeader, sizeof(m_OptionalHeader));
m_OptionalHeader.Magic = oh32.Magic;
m_OptionalHeader.MajorLinkerVersion = oh32.MajorLinkerVersion;
m_OptionalHeader.MinorLinkerVersion = oh32.MinorLinkerVersion;
m_OptionalHeader.SizeOfCode = oh32.SizeOfCode;
m_OptionalHeader.SizeOfInitializedData = oh32.SizeOfInitializedData;
m_OptionalHeader.SizeOfUninitializedData = oh32.SizeOfUninitializedData;
m_OptionalHeader.AddressOfEntryPoint = oh32.AddressOfEntryPoint;
m_OptionalHeader.BaseOfCode = oh32.BaseOfCode;
m_OptionalHeader.ImageBase = oh32.ImageBase;
m_OptionalHeader.SectionAlignment = oh32.SectionAlignment;
m_OptionalHeader.FileAlignment = oh32.FileAlignment;
m_OptionalHeader.MajorOperatingSystemVersion = oh32.MajorOperatingSystemVersion;
m_OptionalHeader.MinorOperatingSystemVersion = oh32.MinorOperatingSystemVersion;
m_OptionalHeader.MajorImageVersion = oh32.MajorImageVersion;
m_OptionalHeader.MinorImageVersion = oh32.MinorImageVersion;
m_OptionalHeader.MajorSubsystemVersion = oh32.MajorSubsystemVersion;
m_OptionalHeader.MinorSubsystemVersion = oh32.MinorSubsystemVersion;
m_OptionalHeader.Win32VersionValue = oh32.Win32VersionValue;
m_OptionalHeader.SizeOfImage = oh32.SizeOfImage;
m_OptionalHeader.SizeOfHeaders = oh32.SizeOfHeaders;
m_OptionalHeader.CheckSum = oh32.CheckSum;
m_OptionalHeader.Subsystem = oh32.Subsystem;
m_OptionalHeader.DllCharacteristics = oh32.DllCharacteristics;
m_OptionalHeader.SizeOfStackReserve = oh32.SizeOfStackReserve;
m_OptionalHeader.SizeOfStackCommit = oh32.SizeOfStackCommit;
m_OptionalHeader.SizeOfHeapReserve = oh32.SizeOfHeapReserve;
m_OptionalHeader.SizeOfHeapCommit = oh32.SizeOfHeapCommit;
m_OptionalHeader.LoaderFlags = oh32.LoaderFlags;
m_OptionalHeader.NumberOfRvaAndSizes = oh32.NumberOfRvaAndSizes;
for (n = 0; n < oh32.NumberOfRvaAndSizes; n++)
{
m_OptionalHeader.DataDirectory[n] = oh32.DataDirectory[n];
}
}
else if (oh32.Magic == IMAGE_NT_OPTIONAL_HDR64_MAGIC)
{
m_f64bit = TRUE;
CopyMemory(&m_OptionalHeader,
m_pMap + m_nOptionalHeaderOffset, sizeof(m_OptionalHeader));
}
else
{
SetLastError(ERROR_EXE_MARKED_INVALID);
return FALSE;
}
m_nSectionsOffset = m_nOptionalHeaderOffset + m_FileHeader.SizeOfOptionalHeader;
///////////////////////////////////////////////// Process Section Headers.
//
if (m_FileHeader.NumberOfSections > arrayof(m_SectionHeaders)) {
SetLastError(ERROR_EXE_MARKED_INVALID);
return FALSE;
}
CopyMemory(&m_SectionHeaders,
m_pMap + m_nSectionsOffset,
sizeof(m_SectionHeaders[0]) * m_FileHeader.NumberOfSections);
////////////////////////////////////////////////////////// Parse Sections.
//
m_nSectionsEndOffset = m_nSectionsOffset + sizeof(m_SectionHeaders);
m_nExtraOffset = 0;
for (n = 0; n < m_FileHeader.NumberOfSections; n++) {
m_nExtraOffset = Max(m_SectionHeaders[n].PointerToRawData +
m_SectionHeaders[n].SizeOfRawData,
m_nExtraOffset);
if (m_SectionHeaders[n].PointerToRawData != 0) {
m_nSectionsEndOffset = Min(m_SectionHeaders[n].PointerToRawData,
m_nSectionsEndOffset);
}
}
m_nSectionsMaxCount = (m_nSectionsEndOffset - m_nSectionsOffset)
/ sizeof(IMAGE_SECTION_HEADER);
return TRUE;
}
//////////////////////////////////////////////////////////////////////////////
//
BOOL CImage::Check(PCSTR pszSection)
{
CHAR szName[IMAGE_SIZEOF_SHORT_NAME];
ZeroMemory(szName, sizeof(szName));
strncpy(szName, pszSection, sizeof(szName));
if ((DWORD)(m_FileHeader.NumberOfSections + 1) > m_nSectionsMaxCount) {
SetLastError(ERROR_EXE_MARKED_INVALID);
return FALSE;
}
for (DWORD n = 0; n < m_FileHeader.NumberOfSections; n++) {
if (memcmp(szName, m_SectionHeaders[n].Name, sizeof(szName)) == 0)
{
SetLastError(ERROR_DUPLICATE_TAG);
return FALSE;
}
}
return TRUE;
}
//////////////////////////////////////////////////////////////////////////////
//
BOOL CImage::Write(HANDLE hFile, PBYTE pbSectData, UINT cbSectData, PCSTR pszSection)
{
if (hFile == INVALID_HANDLE_VALUE) {
SetLastError(ERROR_INVALID_HANDLE);
return FALSE;
}
//////////////////////////////////////////////////////////////////////////
//
m_nNextFileAddr = 0;
m_nNextVirtAddr = 0;
//////////////////////////////////////////////////////////// Copy Headers.
//
if (SetFilePointer(hFile, 0, NULL, FILE_BEGIN) == ~0u) {
return FALSE;
}
if (!CopyFileData(hFile, 0, m_OptionalHeader.SizeOfHeaders)) {
return FALSE;
}
m_nNextFileAddr = m_OptionalHeader.SizeOfHeaders;
m_nNextVirtAddr = 0;
if (!AlignFileData(hFile)) {
return FALSE;
}
/////////////////////////////////////////////////////////// Copy Sections.
//
for (DWORD n = 0; n < m_FileHeader.NumberOfSections; n++) {
if (m_SectionHeaders[n].SizeOfRawData) {
if (SetFilePointer(hFile,
m_SectionHeaders[n].PointerToRawData,
NULL, FILE_BEGIN) == ~0u) {
return FALSE;
}
if (!CopyFileData(hFile,
m_SectionHeaders[n].PointerToRawData,
m_SectionHeaders[n].SizeOfRawData)) {
return FALSE;
}
}
m_nNextFileAddr = Max(m_SectionHeaders[n].PointerToRawData +
m_SectionHeaders[n].SizeOfRawData,
m_nNextFileAddr);
m_nNextVirtAddr = Max(m_SectionHeaders[n].VirtualAddress +
m_SectionHeaders[n].Misc.VirtualSize,
m_nNextVirtAddr);
m_nExtraOffset = Max(m_nNextFileAddr, m_nExtraOffset);
if (!AlignFileData(hFile)) {
return FALSE;
}
}
/////////////////////////////////////////////////////////////// Old WriteSection
DWORD cbDone;
if (pbSectData) {
/////////////////////////////////////////////////// Insert .detour Section.
//
DWORD nSection = m_FileHeader.NumberOfSections++;
ZeroMemory(&m_SectionHeaders[nSection], sizeof(m_SectionHeaders[nSection]));
strcpy((PCHAR)m_SectionHeaders[nSection].Name, pszSection);
m_SectionHeaders[nSection].Characteristics
= IMAGE_SCN_CNT_INITIALIZED_DATA | IMAGE_SCN_MEM_READ;
m_nOutputVirtAddr = m_nNextVirtAddr;
m_nOutputVirtSize = 0;
m_nOutputFileAddr = m_nNextFileAddr;
//////////////////////////////////////////////////////////////////////////
//
if (!SizeOutputBuffer(QuadAlign(cbSectData))) {
return FALSE;
}
DWORD vaData = 0;
PBYTE pbData = NULL;
if ((pbData = AllocateOutput(cbSectData, &vaData)) == NULL) {
return FALSE;
}
CopyMemory(pbData, pbSectData, cbSectData);
//////////////////////////////////////////////////////////////////////////
//
m_nNextVirtAddr += m_nOutputVirtSize;
m_nNextFileAddr += FileAlign(m_nOutputVirtSize);
if (!AlignFileData(hFile)) {
return FALSE;
}
//////////////////////////////////////////////////////////////////////////
//
m_SectionHeaders[nSection].VirtualAddress = m_nOutputVirtAddr;
m_SectionHeaders[nSection].Misc.VirtualSize = m_nOutputVirtSize;
m_SectionHeaders[nSection].PointerToRawData = m_nOutputFileAddr;
m_SectionHeaders[nSection].SizeOfRawData = FileAlign(m_nOutputVirtSize);
m_OptionalHeader
.DataDirectory[IMAGE_DIRECTORY_ENTRY_BOUND_IMPORT].VirtualAddress = 0;
m_OptionalHeader
.DataDirectory[IMAGE_DIRECTORY_ENTRY_BOUND_IMPORT].Size = 0;
//////////////////////////////////////////////////////////////////////////
//
if (SetFilePointer(hFile, m_SectionHeaders[nSection].PointerToRawData,
NULL, FILE_BEGIN) == ~0u) {
return FALSE;
}
if (!WriteFile(hFile, pbData, m_SectionHeaders[nSection].SizeOfRawData,
&cbDone, NULL)) {
return FALSE;
}
}
///////////////////////////////////////////////////// Adjust Extra Data.
//
LONG nExtraAdjust = m_nNextFileAddr - m_nExtraOffset;
for (n = 0; n < m_FileHeader.NumberOfSections; n++) {
if (m_SectionHeaders[n].PointerToRawData > m_nExtraOffset)
m_SectionHeaders[n].PointerToRawData += nExtraAdjust;
if (m_SectionHeaders[n].PointerToRelocations > m_nExtraOffset)
m_SectionHeaders[n].PointerToRelocations += nExtraAdjust;
if (m_SectionHeaders[n].PointerToLinenumbers > m_nExtraOffset)
m_SectionHeaders[n].PointerToLinenumbers += nExtraAdjust;
}
if (m_FileHeader.PointerToSymbolTable > m_nExtraOffset)
m_FileHeader.PointerToSymbolTable += nExtraAdjust;
m_OptionalHeader.CheckSum = 0;
m_OptionalHeader.SizeOfImage = m_nNextVirtAddr;
////////////////////////////////////////////////// Adjust Debug Directory.
//
DWORD debugAddr = m_OptionalHeader
.DataDirectory[IMAGE_DIRECTORY_ENTRY_DEBUG].VirtualAddress;
DWORD debugSize = m_OptionalHeader
.DataDirectory[IMAGE_DIRECTORY_ENTRY_DEBUG].Size;
if (debugAddr && debugSize) {
DWORD nFileOffset = RvaToFileOffset(debugAddr);
if (SetFilePointer(hFile, nFileOffset, NULL, FILE_BEGIN) == ~0u) {
return FALSE;
}
PIMAGE_DEBUG_DIRECTORY pDir = (PIMAGE_DEBUG_DIRECTORY)RvaToVa(debugAddr);
if (pDir == NULL) {
return FALSE;
}
DWORD nEntries = debugSize / sizeof(*pDir);
for (DWORD n = 0; n < nEntries; n++) {
IMAGE_DEBUG_DIRECTORY dir = pDir[n];
if (dir.PointerToRawData > m_nExtraOffset) {
dir.PointerToRawData += nExtraAdjust;
}
if (!WriteFile(hFile, &dir, sizeof(dir), &cbDone, NULL)) {
return FALSE;
}
}
}
///////////////////////////////////////////////// Copy Left-over Data.
//
if (m_nFileSize > m_nExtraOffset) {
if (SetFilePointer(hFile, m_nNextFileAddr, NULL, FILE_BEGIN) == ~0u) {
return FALSE;
}
if (!CopyFileData(hFile, m_nExtraOffset, m_nFileSize - m_nExtraOffset)) {
return FALSE;
}
}
//////////////////////////////////////////////////// Finalize Headers.
//
if (SetFilePointer(hFile, m_nFileHeaderOffset, NULL, FILE_BEGIN) == ~0u) {
return FALSE;
}
if (!WriteFile(hFile, &m_FileHeader, sizeof(m_FileHeader), &cbDone, NULL)) {
return FALSE;
}
if (SetFilePointer(hFile, m_nOptionalHeaderOffset, NULL, FILE_BEGIN) == ~0u) {
return FALSE;
}
if (m_f64bit)
{
if (!WriteFile(hFile, &m_OptionalHeader, sizeof(m_OptionalHeader),
&cbDone, NULL)) {
return FALSE;
}
}
else
{
// Convert 32-bit optional header to internal 64-bit optional header
IMAGE_OPTIONAL_HEADER32 oh32;
ZeroMemory(&oh32, sizeof(oh32));
oh32.Magic = m_OptionalHeader.Magic;
oh32.MajorLinkerVersion = m_OptionalHeader.MajorLinkerVersion;
oh32.MinorLinkerVersion = m_OptionalHeader.MinorLinkerVersion;
oh32.SizeOfCode = m_OptionalHeader.SizeOfCode;
oh32.SizeOfInitializedData = m_OptionalHeader.SizeOfInitializedData;
oh32.SizeOfUninitializedData = m_OptionalHeader.SizeOfUninitializedData;
oh32.AddressOfEntryPoint = m_OptionalHeader.AddressOfEntryPoint;
oh32.BaseOfCode = m_OptionalHeader.BaseOfCode;
oh32.ImageBase = (ULONG)m_OptionalHeader.ImageBase;
oh32.SectionAlignment = m_OptionalHeader.SectionAlignment;
oh32.FileAlignment = m_OptionalHeader.FileAlignment;
oh32.MajorOperatingSystemVersion = m_OptionalHeader.MajorOperatingSystemVersion;
oh32.MinorOperatingSystemVersion = m_OptionalHeader.MinorOperatingSystemVersion;
oh32.MajorImageVersion = m_OptionalHeader.MajorImageVersion;
oh32.MinorImageVersion = m_OptionalHeader.MinorImageVersion;
oh32.MajorSubsystemVersion = m_OptionalHeader.MajorSubsystemVersion;
oh32.MinorSubsystemVersion = m_OptionalHeader.MinorSubsystemVersion;
oh32.Win32VersionValue = m_OptionalHeader.Win32VersionValue;
oh32.SizeOfImage = m_OptionalHeader.SizeOfImage;
oh32.SizeOfHeaders = m_OptionalHeader.SizeOfHeaders;
oh32.CheckSum = m_OptionalHeader.CheckSum;
oh32.Subsystem = m_OptionalHeader.Subsystem;
oh32.DllCharacteristics = m_OptionalHeader.DllCharacteristics;
oh32.SizeOfStackReserve = (ULONG)m_OptionalHeader.SizeOfStackReserve;
oh32.SizeOfStackCommit = (ULONG)m_OptionalHeader.SizeOfStackCommit;
oh32.SizeOfHeapReserve = (ULONG)m_OptionalHeader.SizeOfHeapReserve;
oh32.SizeOfHeapCommit = (ULONG)m_OptionalHeader.SizeOfHeapCommit;
oh32.LoaderFlags = m_OptionalHeader.LoaderFlags;
oh32.NumberOfRvaAndSizes = m_OptionalHeader.NumberOfRvaAndSizes;
for (int n = 0; n < IMAGE_NUMBEROF_DIRECTORY_ENTRIES; n++)
{
oh32.DataDirectory[n] = m_OptionalHeader.DataDirectory[n];
}
if (!WriteFile(hFile, &oh32, sizeof(oh32), &cbDone, NULL)) {
return FALSE;
}
}
if (SetFilePointer(hFile, m_nSectionsOffset, NULL, FILE_BEGIN) == ~0u) {
return FALSE;
}
if (!WriteFile(hFile, &m_SectionHeaders,
sizeof(m_SectionHeaders[0])
* m_FileHeader.NumberOfSections,
&cbDone, NULL)) {
return FALSE;
}
return TRUE;
}
//////////////////////////////////////////////////////////////////// CFileMap.
//
class CFileMap
{
public:
CFileMap();
~CFileMap();
public:
BOOL Load(PCWSTR pszFile);
PBYTE Seek(UINT32 cbPos);
UINT32 Size();
VOID Close();
protected:
PBYTE m_pbData;
UINT32 m_cbData;
};
CFileMap::CFileMap()
{
m_pbData = NULL;
m_cbData = 0;
}
CFileMap::~CFileMap()
{
Close();
}
VOID CFileMap::Close()
{
if (m_pbData) {
UnmapViewOfFile(m_pbData);
m_pbData = NULL;
}
m_cbData = 0;
}
UINT32 CFileMap::Size()
{
return m_cbData;
}
PBYTE CFileMap::Seek(UINT32 cbPos)
{
if (m_pbData && cbPos <= m_cbData) {
return m_pbData + cbPos;
}
return NULL;
}
BOOL CFileMap::Load(PCWSTR pszFile)
{
Close();
HANDLE hFile = CreateFile(pszFile,
GENERIC_READ,
FILE_SHARE_READ,
NULL,
OPEN_EXISTING,
0,
NULL);
if (hFile == INVALID_HANDLE_VALUE) {
return FALSE;
}
ULONG cbInFileData = GetFileSize(hFile, NULL);
if (cbInFileData == ~0ul) {
CloseHandle(hFile);
return FALSE;
}
HANDLE hInFileMap = CreateFileMapping(hFile, NULL, PAGE_READONLY, 0, 0, NULL);
CloseHandle(hFile);
if (hInFileMap == NULL) {
return FALSE;
}
m_pbData = (PBYTE)MapViewOfFile(hInFileMap, FILE_MAP_COPY, 0, 0, 0);
CloseHandle(hInFileMap);
if (m_pbData == NULL) {
return FALSE;
}
m_cbData = cbInFileData;
return TRUE;
}
BOOL addsect_files(PCWSTR pszOutput, PCWSTR pszInput, PCWSTR pszData, PCSTR pszSection)
{
HANDLE hInput = INVALID_HANDLE_VALUE;
HANDLE hOutput = INVALID_HANDLE_VALUE;
BOOL bGood = TRUE;
CFileMap cfData;
CImage image;
if (!cfData.Load(pszData)) {
fprintf(stderr, "ADDSECT: Could not open input data file: %ls\n", pszData);
goto end;
}
hInput = CreateFile(pszInput,
GENERIC_READ,
FILE_SHARE_READ,
NULL,
OPEN_EXISTING,
FILE_ATTRIBUTE_NORMAL,
NULL);
if (hInput == INVALID_HANDLE_VALUE) {
printf("ADDSECT: Couldn't open input file: %ls, error: %d\n",
pszInput, GetLastError());
bGood = FALSE;
goto end;
}
hOutput = CreateFile(pszOutput,
GENERIC_WRITE | GENERIC_READ, 0, NULL, CREATE_ALWAYS,
FILE_ATTRIBUTE_NORMAL | FILE_FLAG_SEQUENTIAL_SCAN, NULL);
if (hOutput == INVALID_HANDLE_VALUE) {
printf("ADDSECT: Couldn't open output file: %ls, error: %d\n",
pszOutput, GetLastError());
bGood = FALSE;
goto end;
}
if (!image.Read(hInput)) {
fprintf(stderr, "ADDSECT: Image read failed: %d\n", GetLastError());
bGood = FALSE;
goto end;
}
if (!image.Check(pszSection)) {
fprintf(stderr, "ADDSECT: Can't insert section `%hs' into image: %d\n",
pszSection, GetLastError());
bGood = FALSE;
goto end;
}
if (!image.Write(hOutput, cfData.Seek(0), cfData.Size(), pszSection)) {
fprintf(stderr, "ADDSECT: Image write failed: %d\n", GetLastError());
bGood = FALSE;
}
image.Close();
if (bGood)
{
printf("ADDSECT: Added new section `%hs' of %d bytes to `%ls'.\n",
pszSection, cfData.Size(), pszOutput);
}
end:
if (hOutput != INVALID_HANDLE_VALUE) {
CloseHandle(hOutput);
hOutput = INVALID_HANDLE_VALUE;
}
if (hInput != INVALID_HANDLE_VALUE) {
CloseHandle(hInput);
hInput = INVALID_HANDLE_VALUE;
}
if (!bGood)
{
DeleteFile(pszOutput);
}
return TRUE;
}
int __cdecl wmain(int argc, PWCHAR *argv)
{
BOOL fNeedHelp = FALSE;
PCWSTR pszData = NULL;
PCWSTR pszInput = NULL;
PCWSTR pszOutput = NULL;
CHAR szSection[IMAGE_SIZEOF_SHORT_NAME + 1] = ".ramfs\0\0";
for (int arg = 1; arg < argc; arg++) {
if (argv[arg][0] == '-' || argv[arg][0] == '/') {
PWCHAR argn = argv[arg]+1; // Argument name
PWCHAR argp = argn; // Argument parameter
while (*argp && *argp != ':' && *argp != '=') {
argp++;
}
if (*argp == ':' || *argp == '=')
*argp++ = '\0';
switch (argn[0]) {
case 'd': // Input file.
case 'D':
pszData = argp;
break;
case 'i': // Input file.
case 'I':
pszInput = argp;
break;
case 'o': // Output file.
case 'O':
pszOutput = argp;
break;
case 's': // Section Name.
case 'S':
_snprintf(szSection, arrayof(szSection)-1, "%ls", argp);
szSection[arrayof(szSection)-1] = '\0';
break;
case 'h': // Help
case 'H':
case '?':
fNeedHelp = TRUE;
break;
default:
fprintf(stderr, "ADDSECT: Unknown argument: %ls\n", argv[arg]);
fNeedHelp = TRUE;
break;
}
}
}
if (pszInput == NULL) {
fNeedHelp = TRUE;
}
if (pszOutput == NULL) {
fNeedHelp = TRUE;
}
if (pszData == NULL) {
fNeedHelp = TRUE;
}
if (argc == 1) {
fNeedHelp = TRUE;
}
if (fNeedHelp) {
printf(
"Usage:\n"
" ADDSECT [options] /I:input /O:output /D:data\n"
"Options:\n"
" /O:output Specify output file.\n"
" /I:input Specify input file.\n"
" /D:data Specify data file.\n"
" /S:section Symbol (defaults to .ramfs).\n"
" /H or /? Display this help screen.\n"
"Summary:\n"
" Adds a new section to a PE binary.\n"
);
return 1;
}
if (!addsect_files(pszOutput, pszInput, pszData, szSection))
{
return 2;
}
return 0;
}
//
///////////////////////////////////////////////////////////////// End of File.