/**************************************************************************** * Copyright (C) 2018 Maschell * * This program is free software: you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by * the Free Software Foundation, either version 3 of the License, or * (at your option) any later version. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * You should have received a copy of the GNU General Public License * along with this program. If not, see . ****************************************************************************/ #include #include #include #include #include #include "ModuleDataFactory.h" #include "utils/utils.h" #include "ElfUtils.h" using namespace ELFIO; std::optional ModuleDataFactory::load(const std::string& path, uint32_t *destination_address_ptr, uint32_t maximum_size, relocation_trampolin_entry_t *trampolin_data, uint32_t trampolin_data_length) { elfio reader; ModuleData moduleData; // Load ELF data if (!reader.load(path)) { DEBUG_FUNCTION_LINE("Can't find or process %s", path.c_str()); return std::nullopt; } uint32_t sec_num = reader.sections.size(); auto **destinations = (uint8_t **) malloc(sizeof(uint8_t *) * sec_num); uint32_t baseOffset = *destination_address_ptr; uint32_t offset_text = baseOffset; uint32_t offset_data = offset_text; uint32_t entrypoint = offset_text + (uint32_t) reader.get_entry() - 0x02000000; uint32_t totalSize = 0; uint32_t endAddress = 0; for (uint32_t i = 0; i < sec_num; ++i) { section *psec = reader.sections[i]; if (psec->get_type() == 0x80000002) { continue; } if ((psec->get_type() == SHT_PROGBITS || psec->get_type() == SHT_NOBITS) && (psec->get_flags() & SHF_ALLOC)) { uint32_t sectionSize = psec->get_size(); totalSize += sectionSize; if(totalSize > maximum_size){ DEBUG_FUNCTION_LINE("Couldn't load setup module because it's too big."); return {}; } auto address = (uint32_t) psec->get_address(); destinations[psec->get_index()] = (uint8_t *) baseOffset; uint32_t destination = baseOffset + address; if ((address >= 0x02000000) && address < 0x10000000) { destination -= 0x02000000; destinations[psec->get_index()] -= 0x02000000; baseOffset += sectionSize; offset_data += sectionSize; } else if ((address >= 0x10000000) && address < 0xC0000000) { destination -= 0x10000000; destinations[psec->get_index()] -= 0x10000000; } else if (address >= 0xC0000000) { destination -= 0xC0000000; destinations[psec->get_index()] -= 0xC0000000; } else { DEBUG_FUNCTION_LINE("Unhandled case"); free(destinations); return std::nullopt; } const char *p = reader.sections[i]->get_data(); if (psec->get_type() == SHT_NOBITS) { DEBUG_FUNCTION_LINE("memset section %s %08X to 0 (%d bytes)", psec->get_name().c_str(), destination, sectionSize); memset((void *) destination, 0, sectionSize); } else if (psec->get_type() == SHT_PROGBITS) { DEBUG_FUNCTION_LINE("Copy section %s %08X -> %08X (%d bytes)", psec->get_name().c_str(), p, destination, sectionSize); memcpy((void *) destination, p, sectionSize); } //nextAddress = ROUNDUP(destination + sectionSize,0x100); if (psec->get_name() == ".bss") { moduleData.setBSSLocation(destination, sectionSize); memset(reinterpret_cast(destination), 0, sectionSize); } else if (psec->get_name() == ".sbss") { moduleData.setSBSSLocation(destination, sectionSize); memset(reinterpret_cast(destination), 0, sectionSize); } moduleData.addSectionInfo(SectionInfo(psec->get_name(), destination, sectionSize)); DEBUG_FUNCTION_LINE("Saved %s section info. Location: %08X size: %08X", psec->get_name().c_str(), destination, sectionSize); if (endAddress < destination + sectionSize) { endAddress = destination + sectionSize; } DCFlushRange((void *) destination, sectionSize); ICInvalidateRange((void *) destination, sectionSize); } } for (uint32_t i = 0; i < sec_num; ++i) { section *psec = reader.sections[i]; if ((psec->get_type() == SHT_PROGBITS || psec->get_type() == SHT_NOBITS) && (psec->get_flags() & SHF_ALLOC)) { DEBUG_FUNCTION_LINE("Linking (%d)... %s", i, psec->get_name().c_str()); if (!linkSection(reader, psec->get_index(), (uint32_t) destinations[psec->get_index()], offset_text, offset_data, trampolin_data, trampolin_data_length)) { DEBUG_FUNCTION_LINE("elfLink failed"); free(destinations); return std::nullopt; } } } std::vector relocationData = getImportRelocationData(reader, destinations); for (auto const &reloc : relocationData) { moduleData.addRelocationData(reloc); } std::optional secInfo = moduleData.getSectionInfo(".wums.exports"); if (secInfo && secInfo->getSize() > 0) { size_t entries_count = secInfo->getSize() / sizeof(wums_entry_t); auto *entries = (wums_entry_t *) secInfo->getAddress(); if (entries != nullptr) { for (size_t j = 0; j < entries_count; j++) { wums_entry_t *exp = &entries[j]; DEBUG_FUNCTION_LINE("Saving export of type %08X, name %s, target: %08X"/*,pluginData.getPluginInformation()->getName().c_str()*/, exp->type, exp->name, (void *) exp->address); ExportData export_data(exp->type, exp->name, exp->address); moduleData.addExportData(export_data); } } } secInfo = moduleData.getSectionInfo(".wums.hooks"); if (secInfo && secInfo->getSize() > 0) { size_t entries_count = secInfo->getSize() / sizeof(wums_hook_t); auto *hooks = (wums_hook_t *) secInfo->getAddress(); if (hooks != nullptr) { for (size_t j = 0; j < entries_count; j++) { wums_hook_t *hook = &hooks[j]; DEBUG_FUNCTION_LINE("Saving hook of type %08X, target: %08X"/*,pluginData.getPluginInformation()->getName().c_str()*/, hook->type, hook->target); HookData hook_data(hook->type, hook->target); moduleData.addHookData(hook_data); } } } secInfo = moduleData.getSectionInfo(".wums.meta"); if (secInfo && secInfo->getSize() > 0) { auto *entries = (wums_entry_t *) secInfo->getAddress(); if (entries != nullptr) { char *curEntry = (char *) secInfo->getAddress(); while ((uint32_t) curEntry < (uint32_t) secInfo->getAddress() + secInfo->getSize()) { if (*curEntry == '\0') { curEntry++; continue; } auto firstFound = std::string(curEntry).find_first_of('='); if (firstFound != std::string::npos) { curEntry[firstFound] = '\0'; std::string key(curEntry); std::string value(curEntry + firstFound + 1); if (key == "export_name") { DEBUG_FUNCTION_LINE("export_name = %s", value.c_str()); moduleData.setExportName(value); } else if (key == "skipEntrypoint") { if (value == "true") { DEBUG_FUNCTION_LINE("skipEntrypoint = %s", value.c_str()); moduleData.setSkipEntrypoint(true); } else { moduleData.setSkipEntrypoint(false); } } else if (key == "initBeforeRelocationDoneHook") { if (value == "true") { DEBUG_FUNCTION_LINE("initBeforeRelocationDoneHook = %s", value.c_str()); moduleData.setInitBeforeRelocationDoneHook(true); } else { moduleData.setInitBeforeRelocationDoneHook(false); } } else if (key == "wums") { if (value != "0.2") { DEBUG_FUNCTION_LINE("Warning: Ignoring module - Unsupported WUMS version: %s.\n", value.c_str()); return std::nullopt; } } } curEntry += strlen(curEntry) + 1; } } } DCFlushRange((void *) *destination_address_ptr, totalSize); ICInvalidateRange((void *) *destination_address_ptr, totalSize); free(destinations); moduleData.setEntrypoint(entrypoint); moduleData.setStartAddress(*destination_address_ptr); moduleData.setEndAddress(endAddress); DEBUG_FUNCTION_LINE("Saved entrypoint as %08X", entrypoint); DEBUG_FUNCTION_LINE("Saved startAddress as %08X", *destination_address_ptr); DEBUG_FUNCTION_LINE("Saved endAddress as %08X", endAddress); *destination_address_ptr = (*destination_address_ptr + totalSize + 0x100) & 0xFFFFFF00; return moduleData; } std::vector ModuleDataFactory::getImportRelocationData(elfio &reader, uint8_t **destinations) { std::vector result; std::map infoMap; uint32_t sec_num = reader.sections.size(); for (uint32_t i = 0; i < sec_num; ++i) { section *psec = reader.sections[i]; if (psec->get_type() == 0x80000002) { infoMap[i] = psec->get_name(); } } for (uint32_t i = 0; i < sec_num; ++i) { section *psec = reader.sections[i]; if (psec->get_type() == SHT_RELA || psec->get_type() == SHT_REL) { DEBUG_FUNCTION_LINE("Found relocation section %s", psec->get_name().c_str()); relocation_section_accessor rel(reader, psec); for (uint32_t j = 0; j < (uint32_t) rel.get_entries_num(); ++j) { Elf64_Addr offset; Elf_Word type; Elf_Sxword addend; std::string sym_name; Elf64_Addr sym_value; Elf_Half sym_section_index; if (!rel.get_entry(j, offset, sym_value, sym_name, type, addend, sym_section_index)) { DEBUG_FUNCTION_LINE("Failed to get relocation"); break; } // uint32_t adjusted_sym_value = (uint32_t) sym_value; if (infoMap.count(sym_section_index) == 0) { continue; } std::optional rplInfo = ImportRPLInformation::createImportRPLInformation(infoMap[sym_section_index]); if (!rplInfo) { DEBUG_FUNCTION_LINE("Failed to create import information"); break; } uint32_t section_index = psec->get_info(); // When these relocations are performed, we don't need the 0xC0000000 offset anymore. RelocationData relocationData(type, offset - 0x02000000, addend, (void *) (destinations[section_index] + 0x02000000), sym_name, rplInfo.value()); //relocationData->printInformation(); result.push_back(relocationData); } } } return result; } bool ModuleDataFactory::linkSection(elfio &reader, uint32_t section_index, uint32_t destination, uint32_t base_text, uint32_t base_data, relocation_trampolin_entry_t *trampolin_data, uint32_t trampolin_data_length) { uint32_t sec_num = reader.sections.size(); for (uint32_t i = 0; i < sec_num; ++i) { section *psec = reader.sections[i]; if (psec->get_info() == section_index) { DEBUG_FUNCTION_LINE("Found relocation section %s", psec->get_name().c_str()); relocation_section_accessor rel(reader, psec); for (uint32_t j = 0; j < (uint32_t) rel.get_entries_num(); ++j) { Elf64_Addr offset; Elf_Word type; Elf_Sxword addend; std::string sym_name; Elf64_Addr sym_value; Elf_Half sym_section_index; if (!rel.get_entry(j, offset, sym_value, sym_name, type, addend, sym_section_index)) { DEBUG_FUNCTION_LINE("Failed to get relocation"); break; } auto adjusted_sym_value = (uint32_t) sym_value; if ((adjusted_sym_value >= 0x02000000) && adjusted_sym_value < 0x10000000) { adjusted_sym_value -= 0x02000000; adjusted_sym_value += base_text; } else if ((adjusted_sym_value >= 0x10000000) && adjusted_sym_value < 0xC0000000) { adjusted_sym_value -= 0x10000000; adjusted_sym_value += base_data; } else if (adjusted_sym_value >= 0xC0000000) { // Skip imports continue; } else if (adjusted_sym_value == 0x0) { // } else { DEBUG_FUNCTION_LINE("Unhandled case %08X", adjusted_sym_value); return false; } if (sym_section_index == SHN_ABS) { // } else if (sym_section_index > SHN_LORESERVE) { DEBUG_FUNCTION_LINE("NOT IMPLEMENTED: %04X", sym_section_index); return false; } if (!ElfUtils::elfLinkOne(type, offset, addend, destination, adjusted_sym_value, trampolin_data, trampolin_data_length, RELOC_TYPE_FIXED)) { DEBUG_FUNCTION_LINE("Link failed"); return false; } } DEBUG_FUNCTION_LINE("done"); } } return true; }