Method Port

Kernel/src/storage/ahciport.cpp:15–168

namespace AHCI{
	Port::Port(int num, hba_port_t* portStructure, hba_mem_t* hbaMem){
        registers = portStructure;

		registers->cmd &= ~HBA_PxCMD_ST;
		registers->cmd &= ~HBA_PxCMD_FRE;

        stopCMD(registers);

        uintptr_t phys;
        
		// Command list entry size = 32
		// Command list entry maxim count = 32
		// Command list maxim size = 32*32 = 1K per port
        phys = Memory::AllocatePhysicalMemoryBlock();
		registers->clb = (uint32_t)(phys & 0xFFFFFFFF);
		registers->clbu = (uint32_t)(phys >> 32);
	
		// FIS entry size = 256 bytes per port
        phys = Memory::AllocatePhysicalMemoryBlock();
		registers->fb = (uint32_t)(phys & 0xFFFFFFFF);
		registers->fbu = (uint32_t)(phys >> 32);
	
		// Command list size = 256*32 = 8K per port
		commandList = (hba_cmd_header_t*)Memory::GetIOMapping(static_cast<uintptr_t>(registers->clb));
        memset(commandList, 0, PAGE_SIZE_4K);

		// FIS
		fis = reinterpret_cast<hba_fis_t*>(Memory::GetIOMapping(static_cast<uintptr_t>(registers->fb)));
        memset((void*)(fis), 0, PAGE_SIZE_4K);

        fis->dsfis.fis_type = FIS_TYPE_DMA_SETUP;
        fis->psfis.fis_type = FIS_TYPE_PIO_SETUP;
        fis->rfis.fis_type = FIS_TYPE_REG_D2H;
        fis->sdbfis[0] = FIS_TYPE_DEV_BITS;

        for(int i = 0; i < 8 /*Support for 8 command slots*/; i++){
            commandList[i].prdtl = 1;

            phys = Memory::AllocatePhysicalMemoryBlock();
            commandList[i].ctba = (uint32_t)(phys & 0xFFFFFFFF);
            commandList[i].ctbau = (uint32_t)(phys >> 32);

            commandTables[i] = (hba_cmd_tbl_t*)Memory::GetIOMapping(phys);
            memset(commandTables[i],0,PAGE_SIZE_4K);
        }

        registers->sctl |= (SCTL_PORT_IPM_NOPART | SCTL_PORT_IPM_NOSLUM | SCTL_PORT_IPM_NODSLP);

        if(hbaMem->cap & AHCI_CAP_SALP){
            registers->cmd &= ~HBA_PxCMD_ASP; // Disable aggressive slumber and partial
        }

        registers->is = 0; // Clear interrupts
        registers->ie = 1;
        registers->fbs &= ~(0xFFFFF000U);

        registers->cmd |= HBA_PxCMD_POD;
        registers->cmd |= HBA_PxCMD_SUD;