Method Controller

Kernel/src/storage/nvme.cpp:82–167

    }

    Controller::Controller(PCIDevice* pciDev){
        pciDevice = pciDev;

        cRegs = reinterpret_cast<Registers*>(Memory::KernelAllocate4KPages(4));
        Memory::KernelMapVirtualMemory4K(pciDevice->GetBaseAddressRegister(0), (uintptr_t)cRegs, 4);
        
        pciDevice->EnableBusMastering();
        pciDevice->EnableMemorySpace();
        pciDevice->EnableInterrupts();

        Disable();

        {
            unsigned spin = 500;
            while(spin-- && (cRegs->status & NVME_CSTS_READY)) Timer::Wait(1);

            if(spin <= 0){
                Log::Warning("[NVMe] Controller not disabled! (NVME_CSTS_READY == 1)");
                dStatus = DriverStatus::ControllerError;
                return;
            }
        }

        cRegs->config = NVME_CFG_DEFAULT_IOCQES | NVME_CFG_DEFAULT_IOSQES;

        if(GetMinMemoryPageSize() > PAGE_SIZE_4K || GetMaxMemoryPageSize() < PAGE_SIZE_4K){
            Log::Error("[NVMe] Error: Controller does not support 4K pages");
            return;
        }

        SetMemoryPageSize(PAGE_SIZE_4K);
        SetCommandSet(NVMeConfigCmdSetNVM);

        uintptr_t admCQBase = Memory::AllocatePhysicalMemoryBlock();
        uintptr_t admSQBase = Memory::AllocatePhysicalMemoryBlock();
        void* admCQ = Memory::KernelAllocate4KPages(1);
        void* admSQ = Memory::KernelAllocate4KPages(1);

        cRegs->adminCompletionQ = admCQBase;
        cRegs->adminSubmissionQ = admSQBase;

        Memory::KernelMapVirtualMemory4K(admCQBase, (uintptr_t)admCQ, 1);
        Memory::KernelMapVirtualMemory4K(admSQBase, (uintptr_t)admSQ, 1);
        
        adminQueue = NVMeQueue(0 /* admin queue ID is 0 */, admCQBase, admSQBase, admCQ, admSQ, GetCompletionDoorbell(0), GetSubmissionDoorbell(0), MIN(PAGE_SIZE_4K, GetMaxQueueEntries() * sizeof(NVMeCompletion)), MIN(PAGE_SIZE_4K, GetMaxQueueEntries() * sizeof(NVMeCommand)));

        SetAdminCompletionQueueSize(adminQueue.CQSize());
        SetAdminSubmissionQueueSize(adminQueue.SQSize());

        Enable();

        {
            unsigned spin = 500;
            while(spin-- && !(cRegs->status & NVME_CSTS_READY)) Timer::Wait(1);

            if(spin <= 0){
                Log::Warning("[NVMe] Controller not ready! (NVME_CSTS_READY != 1)");
                dStatus = DriverStatus::ControllerError;