mirror of
https://github.com/Fennix-Project/Kernel.git
synced 2025-05-28 15:34:33 +00:00
87 lines
3.0 KiB
C++
87 lines
3.0 KiB
C++
#include "../api.hpp"
|
|
|
|
#include <interrupts.hpp>
|
|
#include <memory.hpp>
|
|
#include <task.hpp>
|
|
#include <lock.hpp>
|
|
#include <printf.h>
|
|
#include <cwalk.h>
|
|
#include <md5.h>
|
|
|
|
#include "../../../kernel.h"
|
|
#include "../../../DAPI.hpp"
|
|
#include "../../../Fex.hpp"
|
|
|
|
namespace Driver
|
|
{
|
|
DriverCode Driver::DriverLoadBindInput(void *DrvExtHdr, uintptr_t DriverAddress, size_t Size, bool IsElf)
|
|
{
|
|
UNUSED(DrvExtHdr);
|
|
UNUSED(IsElf);
|
|
Memory::MemMgr *MemMgr = new Memory::MemMgr;
|
|
Fex *fex = (Fex *)MemMgr->RequestPages(TO_PAGES(Size));
|
|
memcpy(fex, (void *)DriverAddress, Size);
|
|
FexExtended *fexExtended = (FexExtended *)((uintptr_t)fex + EXTENDED_SECTION_ADDRESS);
|
|
debug("Driver allocated at %#lx-%#lx", fex, (uintptr_t)fex + Size);
|
|
#ifdef DEBUG
|
|
uint8_t *result = md5File((uint8_t *)fex, Size);
|
|
debug("MD5: %02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x",
|
|
result[0], result[1], result[2], result[3], result[4], result[5], result[6], result[7],
|
|
result[8], result[9], result[10], result[11], result[12], result[13], result[14], result[15]);
|
|
kfree(result);
|
|
#endif
|
|
KernelAPI *KAPI = (KernelAPI *)MemMgr->RequestPages(TO_PAGES(sizeof(KernelAPI)));
|
|
|
|
if (CallDriverEntryPoint(fex, KAPI) != DriverCode::OK)
|
|
{
|
|
delete MemMgr;
|
|
return DriverCode::DRIVER_RETURNED_ERROR;
|
|
}
|
|
debug("Starting driver %s (offset: %#lx)", fexExtended->Driver.Name, fex);
|
|
|
|
KernelCallback *KCallback = (KernelCallback *)MemMgr->RequestPages(TO_PAGES(sizeof(KernelCallback)));
|
|
|
|
switch (fexExtended->Driver.Type)
|
|
{
|
|
case FexDriverType::FexDriverType_Input:
|
|
{
|
|
fixme("Input driver: %s", fexExtended->Driver.Name);
|
|
KCallback->RawPtr = nullptr;
|
|
break;
|
|
KCallback->Reason = CallbackReason::ConfigurationReason;
|
|
int CallbackRet = ((int (*)(KernelCallback *))((uintptr_t)fexExtended->Driver.Callback + (uintptr_t)fex))(KCallback);
|
|
if (CallbackRet == DriverReturnCode::NOT_IMPLEMENTED)
|
|
{
|
|
delete MemMgr;
|
|
error("Driver %s is not implemented", fexExtended->Driver.Name);
|
|
break;
|
|
}
|
|
else if (CallbackRet != DriverReturnCode::OK)
|
|
{
|
|
delete MemMgr;
|
|
error("Driver %s returned error %d", fexExtended->Driver.Name, CallbackRet);
|
|
break;
|
|
}
|
|
|
|
fixme("Input driver: %s", fexExtended->Driver.Name);
|
|
|
|
DriverFile *DrvFile = new DriverFile;
|
|
DrvFile->DriverUID = this->DriverUIDs - 1;
|
|
DrvFile->Address = (void *)fex;
|
|
DrvFile->MemTrk = MemMgr;
|
|
DrvFile->InterruptHook[0] = nullptr;
|
|
Drivers.push_back(DrvFile);
|
|
break;
|
|
}
|
|
default:
|
|
{
|
|
warn("Unknown driver type: %d", fexExtended->Driver.Type);
|
|
delete MemMgr;
|
|
break;
|
|
}
|
|
}
|
|
|
|
return DriverCode::OK;
|
|
}
|
|
}
|