979 lines
30 KiB
C++
979 lines
30 KiB
C++
|
//////////////////////////////////////////////////////////////////////////////
|
||
|
//
|
||
|
//
|
||
|
// 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.
|