#include "../api.hpp" #include #include #include #include #include #include #include #include "../../../kernel.h" #include "../../../DAPI.hpp" #include "../../../Fex.hpp" namespace Driver { DriverCode Driver::DriverLoadBindInput(void *DrvExtHdr, uint64_t DriverAddress, uint64_t Size, bool IsElf) { Fex *fex = (Fex *)KernelAllocator.RequestPages(TO_PAGES(Size)); memcpy(fex, (void *)DriverAddress, Size); FexExtended *fexExtended = (FexExtended *)((uint64_t)fex + EXTENDED_SECTION_ADDRESS); debug("Driver allocated at %#lx-%#lx", fex, (uint64_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 if (CallDriverEntryPoint(fex) != DriverCode::OK) { KernelAllocator.FreePages(fex, TO_PAGES(Size)); return DriverCode::DRIVER_RETURNED_ERROR; } debug("Starting driver %s (offset: %#lx)", fexExtended->Driver.Name, fex); KernelCallback *KCallback = (KernelCallback *)KernelAllocator.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 *))((uint64_t)fexExtended->Driver.Callback + (uint64_t)fex))(KCallback); if (CallbackRet == DriverReturnCode::NOT_IMPLEMENTED) { KernelAllocator.FreePages(fex, TO_PAGES(Size)); KernelAllocator.FreePages(KCallback, TO_PAGES(sizeof(KernelCallback))); error("Driver %s does not implement the configuration callback", fexExtended->Driver.Name); break; } else if (CallbackRet != DriverReturnCode::OK) { KernelAllocator.FreePages(fex, TO_PAGES(Size)); KernelAllocator.FreePages(KCallback, TO_PAGES(sizeof(KernelCallback))); error("Driver %s returned error %d", fexExtended->Driver.Name, CallbackRet); break; } KernelAllocator.FreePages(fex, TO_PAGES(Size)); KernelAllocator.FreePages(KCallback, TO_PAGES(sizeof(KernelCallback))); DriverFile *DrvFile = new DriverFile; DrvFile->DriverUID = KAPI.Info.DriverUID; DrvFile->Address = (void *)fex; DrvFile->InterruptHook[0] = nullptr; Drivers.push_back(DrvFile); break; } default: { warn("Unknown driver type: %d", fexExtended->Driver.Type); break; } } return DriverCode::OK; } }