From mboxrd@z Thu Jan 1 00:00:00 1970 Received: from mga14.intel.com (mga14.intel.com [192.55.52.115]) by mx.groups.io with SMTP id smtpd.web11.31395.1654519543115066885 for ; Mon, 06 Jun 2022 05:45:43 -0700 Authentication-Results: mx.groups.io; dkim=fail reason="unable to parse pub key" header.i=@intel.com header.s=intel header.b=GYKmVY5p; spf=pass (domain: intel.com, ip: 192.55.52.115, mailfrom: maciej.czajkowski@intel.com) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/simple; d=intel.com; i=@intel.com; q=dns/txt; s=Intel; t=1654519543; x=1686055543; h=from:to:cc:subject:date:message-id:in-reply-to: references:mime-version:content-transfer-encoding; bh=a+w35+0hpAz2kE/8AepOXqiKFFTxXxeCCixtUVn36LA=; b=GYKmVY5pC6DfUBOqz9wkYV0D2zFuSivhWuvPHQk7ZnsoZlHTQJq+DLma xRH/MqZgqCC6HxxkZynLc/C1Boj9KI2cFSUL/80/upeQafAX9Qr89JhBh im1Ysv5R0zQFRiPqsd8Y2wPZ1ezcgXNWpO3S+Uhp8H0y1PPlCGcLvckUJ TOmKVMSXTksoO+Y7I3R5cRjc4KEx4FbpZ72bIUnFC5WUMdalnIohRxxu9 PTloDtT0k2waSJKRLdwl9S9BKKYMh68wyD5689U4UDPuyrT/TIemnLeK3 MsSURha5toyHgSP/SoFZKws9/pm3s/AEBf5oGaar1/SYvVbNwXi02Lgjm A==; X-IronPort-AV: E=McAfee;i="6400,9594,10369"; a="276692331" X-IronPort-AV: E=Sophos;i="5.91,280,1647327600"; d="scan'208";a="276692331" Received: from fmsmga007.fm.intel.com ([10.253.24.52]) by fmsmga103.fm.intel.com with ESMTP/TLS/ECDHE-RSA-AES256-GCM-SHA384; 06 Jun 2022 05:45:42 -0700 X-IronPort-AV: E=Sophos;i="5.91,280,1647327600"; d="scan'208";a="583620409" Received: from mczajkow-mobl.ger.corp.intel.com ([10.252.44.149]) by fmsmga007-auth.fm.intel.com with ESMTP/TLS/ECDHE-RSA-AES256-GCM-SHA384; 06 Jun 2022 05:45:41 -0700 From: "Maciej Czajkowski" To: devel@edk2.groups.io Cc: Hao A Wu , Ray Ni Subject: [edk2-devel][PATCH v1 2/2] MdeModulePkg/AhciPei: Use PCI_DEVICE_PPI to manage AHCI device Date: Mon, 6 Jun 2022 14:45:29 +0200 Message-Id: <20220606124529.2152-3-maciej.czajkowski@intel.com> X-Mailer: git-send-email 2.27.0.windows.1 In-Reply-To: <20220606124529.2152-1-maciej.czajkowski@intel.com> References: <20220606124529.2152-1-maciej.czajkowski@intel.com> MIME-Version: 1.0 Content-Type: text/plain; charset="us-ascii" Content-Transfer-Encoding: quoted-printable REF: https://bugzilla.tianocore.org/show_bug.cgi?id=3D3907 This change modifies AhciPei library to allow usage both EDKII_PCI_DEVICE_P= PI and EDKII_PEI_ATA_AHCI_HOST_CONTROLLER_PPI to manage ATA HDD working under AHCI mode. Cc: Hao A Wu Cc: Ray Ni Signed-off-by: Maciej Czajkowski --- MdeModulePkg/Bus/Ata/AhciPei/AhciPei.c | 615 +++++++++++++++----- MdeModulePkg/Bus/Ata/AhciPei/DevicePath.c | 44 -- MdeModulePkg/Bus/Ata/AhciPei/AhciPei.inf | 5 +- 3 files changed, 458 insertions(+), 206 deletions(-) diff --git a/MdeModulePkg/Bus/Ata/AhciPei/AhciPei.c b/MdeModulePkg/Bus/Ata/= AhciPei/AhciPei.c index 208b7e9a3606..31bb3c0760ab 100644 --- a/MdeModulePkg/Bus/Ata/AhciPei/AhciPei.c +++ b/MdeModulePkg/Bus/Ata/AhciPei/AhciPei.c @@ -9,6 +9,47 @@ **/ = #include "AhciPei.h" +#include +#include +#include + +/** + Callback for EDKII_ATA_AHCI_HOST_CONTROLLER_PPI installation. + + @param[in] PeiServices Pointer to PEI Services Table. + @param[in] NotifyDescriptor Pointer to the descriptor for the Notific= ation + event that caused this function to execut= e. + @param[in] Ppi Pointer to the PPI data associated with t= his function. + + @retval EFI_SUCCESS The function completes successfully + +**/ +EFI_STATUS +EFIAPI +AtaAhciHostControllerPpiInstallationCallback ( + IN EFI_PEI_SERVICES **PeiServices, + IN EFI_PEI_NOTIFY_DESCRIPTOR *NotifyDescriptor, + IN VOID *Ppi + ); + +/** + Callback for EDKII_PCI_DEVICE_PPI installation. + + @param[in] PeiServices Pointer to PEI Services Table. + @param[in] NotifyDescriptor Pointer to the descriptor for the Notific= ation + event that caused this function to execut= e. + @param[in] Ppi Pointer to the PPI data associated with t= his function. + + @retval EFI_SUCCESS The function completes successfully + +**/ +EFI_STATUS +EFIAPI +AtaAhciPciDevicePpiInstallationCallback ( + IN EFI_PEI_SERVICES **PeiServices, + IN EFI_PEI_NOTIFY_DESCRIPTOR *NotifyDescriptor, + IN VOID *Ppi + ); = EFI_PEI_PPI_DESCRIPTOR mAhciAtaPassThruPpiListTemplate =3D { (EFI_PEI_PPI_DESCRIPTOR_PPI | EFI_PEI_PPI_DESCRIPTOR_TERMINATE_LIST), @@ -40,6 +81,18 @@ EFI_PEI_NOTIFY_DESCRIPTOR mAhciEndOfPeiNotifyListTempla= te =3D { AhciPeimEndOfPei }; = +EFI_PEI_NOTIFY_DESCRIPTOR mAtaAhciHostControllerNotify =3D { + (EFI_PEI_PPI_DESCRIPTOR_NOTIFY_CALLBACK | EFI_PEI_PPI_DESCRIPTOR_TERMINA= TE_LIST), + &gEdkiiPeiAtaAhciHostControllerPpiGuid, + AtaAhciHostControllerPpiInstallationCallback +}; + +EFI_PEI_NOTIFY_DESCRIPTOR mPciDevicePpiNotify =3D { + (EFI_PEI_PPI_DESCRIPTOR_NOTIFY_CALLBACK | EFI_PEI_PPI_DESCRIPTOR_TERMINA= TE_LIST), + &gEdkiiPeiPciDevicePpiGuid, + AtaAhciPciDevicePpiInstallationCallback +}; + /** Free the DMA resources allocated by an ATA AHCI controller. = @@ -111,33 +164,28 @@ AhciPeimEndOfPei ( } = /** - Entry point of the PEIM. + Initialize and install PrivateData PPIs. = - @param[in] FileHandle Handle of the file being invoked. - @param[in] PeiServices Describes the list of possible PEI Services. - - @retval EFI_SUCCESS PPI successfully installed. + @param[in] Private A pointer to the PEI_AHCI_CONTROLLER_PRIVATE_DATA = data + structure. = + @retval EFI_SUCCESS AHCI controller initialized and PPIs installed + @retval others Failed to initialize AHCI controller **/ EFI_STATUS -EFIAPI -AtaAhciPeimEntry ( - IN EFI_PEI_FILE_HANDLE FileHandle, - IN CONST EFI_PEI_SERVICES **PeiServices +AtaAhciInitPrivateData ( + IN UINTN MmioBase, + IN EFI_DEVICE_PATH_PROTOCOL *DevicePath, + IN UINTN DevicePathLength ) { - EFI_STATUS Status; - EFI_BOOT_MODE BootMode; - EDKII_ATA_AHCI_HOST_CONTROLLER_PPI *AhciHcPpi; - UINT8 Controller; - UINTN MmioBase; - UINTN DevicePathLength; - EFI_DEVICE_PATH_PROTOCOL *DevicePath; - UINT32 PortBitMap; - PEI_AHCI_CONTROLLER_PRIVATE_DATA *Private; - UINT8 NumberOfPorts; + EFI_STATUS Status; + UINT32 PortBitMap; + UINT8 NumberOfPorts; + PEI_AHCI_CONTROLLER_PRIVATE_DATA *Private; + EFI_BOOT_MODE BootMode; = - DEBUG ((DEBUG_INFO, "%a: Enters.\n", __FUNCTION__)); + DEBUG ((DEBUG_INFO, "Initializing private data for ATA\n")); = // // Get the current boot mode. @@ -149,19 +197,149 @@ AtaAhciPeimEntry ( } = // - // Locate the ATA AHCI host controller PPI. - // - Status =3D PeiServicesLocatePpi ( - &gEdkiiPeiAtaAhciHostControllerPpiGuid, - 0, - NULL, - (VOID **)&AhciHcPpi - ); + // Check validity of the device path of the ATA AHCI controller. + // + Status =3D AhciIsHcDevicePathValid (DevicePath, DevicePathLength); + if (EFI_ERROR (Status)) { + DEBUG (( + DEBUG_ERROR, + "%a: The device path is invalid.\n", + __FUNCTION__ + )); + return Status; + } + + // + // For S3 resume performance consideration, not all ports on an ATA AHCI + // controller will be enumerated/initialized. The driver consumes the + // content within S3StorageDeviceInitList LockBox to get the ports that + // will be enumerated/initialized during S3 resume. + // + if (BootMode =3D=3D BOOT_ON_S3_RESUME) { + NumberOfPorts =3D AhciS3GetEumeratePorts (DevicePath, DevicePathLength= , &PortBitMap); + if (NumberOfPorts =3D=3D 0) { + return EFI_SUCCESS; + } + } else { + PortBitMap =3D MAX_UINT32; + } + + // + // Memory allocation for controller private data. + // + Private =3D AllocateZeroPool (sizeof (PEI_AHCI_CONTROLLER_PRIVATE_DATA)); + if (Private =3D=3D NULL) { + DEBUG (( + DEBUG_ERROR, + "%a: Fail to allocate private data.\n", + __FUNCTION__ + )); + return EFI_OUT_OF_RESOURCES; + } + + // + // Initialize controller private data. + // + Private->Signature =3D AHCI_PEI_CONTROLLER_PRIVATE_DATA_SIGNATURE; + Private->MmioBase =3D MmioBase; + Private->DevicePathLength =3D DevicePathLength; + Private->DevicePath =3D DevicePath; + Private->PortBitMap =3D PortBitMap; + InitializeListHead (&Private->DeviceList); + + Status =3D AhciModeInitialization (Private); if (EFI_ERROR (Status)) { - DEBUG ((DEBUG_ERROR, "%a: Failed to locate AtaAhciHostControllerPpi.\n= ", __FUNCTION__)); - return EFI_UNSUPPORTED; + return Status; + } + + Private->AtaPassThruMode.Attributes =3D EFI_ATA_PASS_THRU_ATTRIBUTES_PHY= SICAL | + EFI_ATA_PASS_THRU_ATTRIBUTES_LOGIC= AL; + Private->AtaPassThruMode.IoAlign =3D sizeof (UINTN); + Private->AtaPassThruPpi.Revision =3D EDKII_PEI_ATA_PASS_THRU_PPI_RE= VISION; + Private->AtaPassThruPpi.Mode =3D &Private->AtaPassThruMode; + Private->AtaPassThruPpi.PassThru =3D AhciAtaPassThruPassThru; + Private->AtaPassThruPpi.GetNextPort =3D AhciAtaPassThruGetNextPort; + Private->AtaPassThruPpi.GetNextDevice =3D AhciAtaPassThruGetNextDevice; + Private->AtaPassThruPpi.GetDevicePath =3D AhciAtaPassThruGetDevicePath; + CopyMem ( + &Private->AtaPassThruPpiList, + &mAhciAtaPassThruPpiListTemplate, + sizeof (EFI_PEI_PPI_DESCRIPTOR) + ); + Private->AtaPassThruPpiList.Ppi =3D &Private->AtaPassThruPpi; + PeiServicesInstallPpi (&Private->AtaPassThruPpiList); + + Private->BlkIoPpi.GetNumberOfBlockDevices =3D AhciBlockIoGetDeviceNo; + Private->BlkIoPpi.GetBlockDeviceMediaInfo =3D AhciBlockIoGetMediaInfo; + Private->BlkIoPpi.ReadBlocks =3D AhciBlockIoReadBlocks; + CopyMem ( + &Private->BlkIoPpiList, + &mAhciBlkIoPpiListTemplate, + sizeof (EFI_PEI_PPI_DESCRIPTOR) + ); + Private->BlkIoPpiList.Ppi =3D &Private->BlkIoPpi; + PeiServicesInstallPpi (&Private->BlkIoPpiList); + + Private->BlkIo2Ppi.Revision =3D EFI_PEI_RECOVERY_BLOCK_IO= 2_PPI_REVISION; + Private->BlkIo2Ppi.GetNumberOfBlockDevices =3D AhciBlockIoGetDeviceNo2; + Private->BlkIo2Ppi.GetBlockDeviceMediaInfo =3D AhciBlockIoGetMediaInfo2; + Private->BlkIo2Ppi.ReadBlocks =3D AhciBlockIoReadBlocks2; + CopyMem ( + &Private->BlkIo2PpiList, + &mAhciBlkIo2PpiListTemplate, + sizeof (EFI_PEI_PPI_DESCRIPTOR) + ); + Private->BlkIo2PpiList.Ppi =3D &Private->BlkIo2Ppi; + PeiServicesInstallPpi (&Private->BlkIo2PpiList); + + if (Private->TrustComputingDevices !=3D 0) { + DEBUG (( + DEBUG_INFO, + "%a: Security Security Command PPI will be produced.\n", + __FUNCTION__ + )); + Private->StorageSecurityPpi.Revision =3D EDKII_STORAGE_SECUR= ITY_PPI_REVISION; + Private->StorageSecurityPpi.GetNumberofDevices =3D AhciStorageSecurity= GetDeviceNo; + Private->StorageSecurityPpi.GetDevicePath =3D AhciStorageSecurity= GetDevicePath; + Private->StorageSecurityPpi.ReceiveData =3D AhciStorageSecurity= ReceiveData; + Private->StorageSecurityPpi.SendData =3D AhciStorageSecurity= SendData; + CopyMem ( + &Private->StorageSecurityPpiList, + &mAhciStorageSecurityPpiListTemplate, + sizeof (EFI_PEI_PPI_DESCRIPTOR) + ); + Private->StorageSecurityPpiList.Ppi =3D &Private->StorageSecurityPpi; + PeiServicesInstallPpi (&Private->StorageSecurityPpiList); } = + CopyMem ( + &Private->EndOfPeiNotifyList, + &mAhciEndOfPeiNotifyListTemplate, + sizeof (EFI_PEI_NOTIFY_DESCRIPTOR) + ); + PeiServicesNotifyPpi (&Private->EndOfPeiNotifyList); + + return EFI_SUCCESS; +} + +/** + Initialize AHCI controller from EDKII_ATA_AHCI_HOST_CONTROLLER_PPI insta= nce. + + @param[in] AhciHcPpi Pointer to the AHCI Host Controller PPI instance. + + @retval EFI_SUCCESS PPI successfully installed. +**/ +EFI_STATUS +AtaAhciInitPrivateDataFromHostControllerPpi ( + IN EDKII_ATA_AHCI_HOST_CONTROLLER_PPI *AhciHcPpi + ) +{ + UINT8 Controller; + UINTN MmioBase; + UINTN DevicePathLength; + EFI_DEVICE_PATH_PROTOCOL *DevicePath; + EFI_STATUS Status; + Controller =3D 0; MmioBase =3D 0; while (TRUE) { @@ -193,65 +371,7 @@ AtaAhciPeimEntry ( return Status; } = - // - // Check validity of the device path of the ATA AHCI controller. - // - Status =3D AhciIsHcDevicePathValid (DevicePath, DevicePathLength); - if (EFI_ERROR (Status)) { - DEBUG (( - DEBUG_ERROR, - "%a: The device path is invalid for Controller %d.\n", - __FUNCTION__, - Controller - )); - Controller++; - continue; - } - - // - // For S3 resume performance consideration, not all ports on an ATA AH= CI - // controller will be enumerated/initialized. The driver consumes the - // content within S3StorageDeviceInitList LockBox to get the ports that - // will be enumerated/initialized during S3 resume. - // - if (BootMode =3D=3D BOOT_ON_S3_RESUME) { - NumberOfPorts =3D AhciS3GetEumeratePorts (DevicePath, DevicePathLeng= th, &PortBitMap); - if (NumberOfPorts =3D=3D 0) { - // - // No ports need to be enumerated for this controller. - // - Controller++; - continue; - } - } else { - PortBitMap =3D MAX_UINT32; - } - - // - // Memory allocation for controller private data. - // - Private =3D AllocateZeroPool (sizeof (PEI_AHCI_CONTROLLER_PRIVATE_DATA= )); - if (Private =3D=3D NULL) { - DEBUG (( - DEBUG_ERROR, - "%a: Fail to allocate private data for Controller %d.\n", - __FUNCTION__, - Controller - )); - return EFI_OUT_OF_RESOURCES; - } - - // - // Initialize controller private data. - // - Private->Signature =3D AHCI_PEI_CONTROLLER_PRIVATE_DATA_SIGNATU= RE; - Private->MmioBase =3D MmioBase; - Private->DevicePathLength =3D DevicePathLength; - Private->DevicePath =3D DevicePath; - Private->PortBitMap =3D PortBitMap; - InitializeListHead (&Private->DeviceList); - - Status =3D AhciModeInitialization (Private); + Status =3D AtaAhciInitPrivateData (MmioBase, DevicePath, DevicePathLen= gth); if (EFI_ERROR (Status)) { DEBUG (( DEBUG_ERROR, @@ -260,86 +380,261 @@ AtaAhciPeimEntry ( Controller, Status )); - Controller++; - continue; - } - - Private->AtaPassThruMode.Attributes =3D EFI_ATA_PASS_THRU_ATTRIBUTES_P= HYSICAL | - EFI_ATA_PASS_THRU_ATTRIBUTES_LOG= ICAL; - Private->AtaPassThruMode.IoAlign =3D sizeof (UINTN); - Private->AtaPassThruPpi.Revision =3D EDKII_PEI_ATA_PASS_THRU_PPI_= REVISION; - Private->AtaPassThruPpi.Mode =3D &Private->AtaPassThruMode; - Private->AtaPassThruPpi.PassThru =3D AhciAtaPassThruPassThru; - Private->AtaPassThruPpi.GetNextPort =3D AhciAtaPassThruGetNextPort; - Private->AtaPassThruPpi.GetNextDevice =3D AhciAtaPassThruGetNextDevice; - Private->AtaPassThruPpi.GetDevicePath =3D AhciAtaPassThruGetDevicePath; - CopyMem ( - &Private->AtaPassThruPpiList, - &mAhciAtaPassThruPpiListTemplate, - sizeof (EFI_PEI_PPI_DESCRIPTOR) - ); - Private->AtaPassThruPpiList.Ppi =3D &Private->AtaPassThruPpi; - PeiServicesInstallPpi (&Private->AtaPassThruPpiList); - - Private->BlkIoPpi.GetNumberOfBlockDevices =3D AhciBlockIoGetDeviceNo; - Private->BlkIoPpi.GetBlockDeviceMediaInfo =3D AhciBlockIoGetMediaInfo; - Private->BlkIoPpi.ReadBlocks =3D AhciBlockIoReadBlocks; - CopyMem ( - &Private->BlkIoPpiList, - &mAhciBlkIoPpiListTemplate, - sizeof (EFI_PEI_PPI_DESCRIPTOR) - ); - Private->BlkIoPpiList.Ppi =3D &Private->BlkIoPpi; - PeiServicesInstallPpi (&Private->BlkIoPpiList); - - Private->BlkIo2Ppi.Revision =3D EFI_PEI_RECOVERY_BLOCK_= IO2_PPI_REVISION; - Private->BlkIo2Ppi.GetNumberOfBlockDevices =3D AhciBlockIoGetDeviceNo2; - Private->BlkIo2Ppi.GetBlockDeviceMediaInfo =3D AhciBlockIoGetMediaInfo= 2; - Private->BlkIo2Ppi.ReadBlocks =3D AhciBlockIoReadBlocks2; - CopyMem ( - &Private->BlkIo2PpiList, - &mAhciBlkIo2PpiListTemplate, - sizeof (EFI_PEI_PPI_DESCRIPTOR) - ); - Private->BlkIo2PpiList.Ppi =3D &Private->BlkIo2Ppi; - PeiServicesInstallPpi (&Private->BlkIo2PpiList); - - if (Private->TrustComputingDevices !=3D 0) { + } else { DEBUG (( DEBUG_INFO, - "%a: Security Security Command PPI will be produced for Controller= %d.\n", + "%a: Controller %d has been successfully initialized.\n", __FUNCTION__, Controller )); - Private->StorageSecurityPpi.Revision =3D EDKII_STORAGE_SEC= URITY_PPI_REVISION; - Private->StorageSecurityPpi.GetNumberofDevices =3D AhciStorageSecuri= tyGetDeviceNo; - Private->StorageSecurityPpi.GetDevicePath =3D AhciStorageSecuri= tyGetDevicePath; - Private->StorageSecurityPpi.ReceiveData =3D AhciStorageSecuri= tyReceiveData; - Private->StorageSecurityPpi.SendData =3D AhciStorageSecuri= tySendData; - CopyMem ( - &Private->StorageSecurityPpiList, - &mAhciStorageSecurityPpiListTemplate, - sizeof (EFI_PEI_PPI_DESCRIPTOR) - ); - Private->StorageSecurityPpiList.Ppi =3D &Private->StorageSecurityPpi; - PeiServicesInstallPpi (&Private->StorageSecurityPpiList); } = - CopyMem ( - &Private->EndOfPeiNotifyList, - &mAhciEndOfPeiNotifyListTemplate, - sizeof (EFI_PEI_NOTIFY_DESCRIPTOR) - ); - PeiServicesNotifyPpi (&Private->EndOfPeiNotifyList); - - DEBUG (( - DEBUG_INFO, - "%a: Controller %d has been successfully initialized.\n", - __FUNCTION__, - Controller - )); Controller++; } = return EFI_SUCCESS; } + +/** + Callback for EDKII_ATA_AHCI_HOST_CONTROLLER_PPI installation. + + @param[in] PeiServices Pointer to PEI Services Table. + @param[in] NotifyDescriptor Pointer to the descriptor for the Notific= ation + event that caused this function to execut= e. + @param[in] Ppi Pointer to the PPI data associated with t= his function. + + @retval EFI_SUCCESS The function completes successfully + +**/ +EFI_STATUS +EFIAPI +AtaAhciHostControllerPpiInstallationCallback ( + IN EFI_PEI_SERVICES **PeiServices, + IN EFI_PEI_NOTIFY_DESCRIPTOR *NotifyDescriptor, + IN VOID *Ppi + ) +{ + EDKII_ATA_AHCI_HOST_CONTROLLER_PPI *AhciHcPpi; + + if (Ppi =3D=3D NULL) { + return EFI_INVALID_PARAMETER; + } + + AhciHcPpi =3D (EDKII_ATA_AHCI_HOST_CONTROLLER_PPI*) Ppi; + + return AtaAhciInitPrivateDataFromHostControllerPpi (AhciHcPpi); +} + +/** + Callback for EDKII_PCI_DEVICE_PPI installation. + + @param[in] PeiServices Pointer to PEI Services Table. + @param[in] NotifyDescriptor Pointer to the descriptor for the Notific= ation + event that caused this function to execut= e. + @param[in] Ppi Pointer to the PPI data associated with t= his function. + + @retval EFI_SUCCESS The function completes successfully + +**/ +EFI_STATUS +EFIAPI +AtaAhciPciDevicePpiInstallationCallback ( + IN EFI_PEI_SERVICES **PeiServices, + IN EFI_PEI_NOTIFY_DESCRIPTOR *NotifyDescriptor, + IN VOID *Ppi + ) +{ + EDKII_PCI_DEVICE_PPI *PciDevice; + PCI_TYPE00 PciData; + UINTN MmioBase; + EFI_DEVICE_PATH_PROTOCOL *DevicePath; + UINTN DevicePathLength; + EFI_STATUS Status; + + PciDevice =3D (EDKII_PCI_DEVICE_PPI*) Ppi; + + // + // Now further check the PCI header: Base Class (offset 0x0B) and + // Sub Class (offset 0x0A). This controller should be an SATA controller + // + Status =3D PciDevice->PciIo.Pci.Read ( + &PciDevice->PciIo, + EfiPciIoWidthUint8, + PCI_CLASSCODE_OFFSET, + sizeof (PciData.Hdr.ClassCode), + PciData.Hdr.ClassCode + ); + if (EFI_ERROR (Status)) { + return EFI_UNSUPPORTED; + } + + if (!IS_PCI_IDE (&PciData) && !IS_PCI_SATADPA (&PciData)) { + return EFI_UNSUPPORTED; + } + + Status =3D PciDevice->PciIo.Attributes ( + &PciDevice->PciIo, + EfiPciIoAttributeOperationSet, + EFI_PCI_DEVICE_ENABLE, + NULL + ); + if (EFI_ERROR (Status)) { + return EFI_UNSUPPORTED; + } + + Status =3D PciDevice->PciIo.Pci.Read ( + &PciDevice->PciIo, + EfiPciIoWidthUint32, + 0x24, + sizeof (UINTN), + &MmioBase + ); + if (EFI_ERROR (Status)) { + return EFI_UNSUPPORTED; + } + + DevicePathLength =3D GetDevicePathSize (PciDevice->DevicePath); + DevicePath =3D PciDevice->DevicePath; + + Status =3D AtaAhciInitPrivateData (MmioBase, DevicePath, DevicePathLengt= h); + if (EFI_ERROR (Status)) { + DEBUG (( + DEBUG_INFO, + "%a: Failed to init controller, with Status - %r\n", + __FUNCTION__, + Status + )); + } + + return EFI_SUCCESS; +} + +EFI_STATUS +AtaAhciInitPrivateDataFromPciDevice ( + VOID + ) +{ + EFI_STATUS Status; + UINTN ControllerIndex; + EDKII_PCI_DEVICE_PPI *PciDevice; + PCI_TYPE00 PciData; + UINTN MmioBase; + EFI_DEVICE_PATH_PROTOCOL *DevicePath; + UINTN DevicePathLength; + + Status =3D EFI_SUCCESS; + for (ControllerIndex =3D 0; Status !=3D EFI_NOT_FOUND; ControllerIndex++= ) { + Status =3D PeiServicesLocatePpi ( + &gEdkiiPeiPciDevicePpiGuid, + ControllerIndex, + NULL, + (VOID**) &PciDevice + ); + if (EFI_ERROR (Status)) { + continue; + } + + // + // Now further check the PCI header: Base Class (offset 0x0B) and + // Sub Class (offset 0x0A). This controller should be an SATA controll= er + // + Status =3D PciDevice->PciIo.Pci.Read ( + &PciDevice->PciIo, + EfiPciIoWidthUint8, + PCI_CLASSCODE_OFFSET, + sizeof (PciData.Hdr.ClassCode), + PciData.Hdr.ClassCode + ); + if (EFI_ERROR (Status)) { + continue; + } + + if (!IS_PCI_IDE (&PciData) && !IS_PCI_SATADPA (&PciData)) { + continue; + } + + Status =3D PciDevice->PciIo.Attributes ( + &PciDevice->PciIo, + EfiPciIoAttributeOperationSet, + EFI_PCI_DEVICE_ENABLE, + NULL + ); + if (EFI_ERROR (Status)) { + continue; + } + + Status =3D PciDevice->PciIo.Pci.Read ( + &PciDevice->PciIo, + EfiPciIoWidthUint32, + 0x24, + sizeof (UINTN), + &MmioBase + ); + if (EFI_ERROR (Status)) { + continue; + } + + DevicePathLength =3D GetDevicePathSize (PciDevice->DevicePath); + DevicePath =3D PciDevice->DevicePath; + + Status =3D AtaAhciInitPrivateData (MmioBase, DevicePath, DevicePathLen= gth); + if (EFI_ERROR (Status)) { + DEBUG (( + DEBUG_INFO, + "%a: Failed to init controller, with Status - %r\n", + __FUNCTION__, + Status + )); + } + // + // Override the status to continue the for loop + // + Status =3D EFI_SUCCESS; + } + + return EFI_SUCCESS; +} + +/** + Entry point of the PEIM. + + @param[in] FileHandle Handle of the file being invoked. + @param[in] PeiServices Describes the list of possible PEI Services. + + @retval EFI_SUCCESS PPI successfully installed. + +**/ +EFI_STATUS +EFIAPI +AtaAhciPeimEntry ( + IN EFI_PEI_FILE_HANDLE FileHandle, + IN CONST EFI_PEI_SERVICES **PeiServices + ) +{ + EFI_STATUS Status; + EDKII_ATA_AHCI_HOST_CONTROLLER_PPI *AhciHcPpi; + + DEBUG ((DEBUG_INFO, "%a: Enters.\n", __FUNCTION__)); + + PeiServicesNotifyPpi (&mAtaAhciHostControllerNotify); + + PeiServicesNotifyPpi (&mPciDevicePpiNotify); + + Status =3D AtaAhciInitPrivateDataFromPciDevice (); + + // + // Locate the ATA AHCI host controller PPI. + // + Status =3D PeiServicesLocatePpi ( + &gEdkiiPeiAtaAhciHostControllerPpiGuid, + 0, + NULL, + (VOID **)&AhciHcPpi + ); + if (!EFI_ERROR (Status)) { + DEBUG ((DEBUG_ERROR, "%a: Using AtaAhciHostControllerPpi to initialize= private data.\n", __FUNCTION__)); + Status =3D AtaAhciInitPrivateDataFromHostControllerPpi (AhciHcPpi); + } + + return Status; +} diff --git a/MdeModulePkg/Bus/Ata/AhciPei/DevicePath.c b/MdeModulePkg/Bus/A= ta/AhciPei/DevicePath.c index 81f8743d40d8..cf0955929dde 100644 --- a/MdeModulePkg/Bus/Ata/AhciPei/DevicePath.c +++ b/MdeModulePkg/Bus/Ata/AhciPei/DevicePath.c @@ -38,50 +38,6 @@ EFI_DEVICE_PATH_PROTOCOL mAhciEndDevicePathNodeTemplate= =3D { } }; = -/** - Returns the 16-bit Length field of a device path node. - - Returns the 16-bit Length field of the device path node specified by Nod= e. - Node is not required to be aligned on a 16-bit boundary, so it is recomm= ended - that a function such as ReadUnaligned16() be used to extract the content= s of - the Length field. - - If Node is NULL, then ASSERT(). - - @param Node A pointer to a device path node data structure. - - @return The 16-bit Length field of the device path node specified by Nod= e. - -**/ -UINTN -DevicePathNodeLength ( - IN CONST VOID *Node - ) -{ - ASSERT (Node !=3D NULL); - return ReadUnaligned16 ((UINT16 *)&((EFI_DEVICE_PATH_PROTOCOL *)(Node))-= >Length[0]); -} - -/** - Returns a pointer to the next node in a device path. - - If Node is NULL, then ASSERT(). - - @param Node A pointer to a device path node data structure. - - @return a pointer to the device path node that follows the device path n= ode - specified by Node. - -**/ -EFI_DEVICE_PATH_PROTOCOL * -NextDevicePathNode ( - IN CONST VOID *Node - ) -{ - ASSERT (Node !=3D NULL); - return (EFI_DEVICE_PATH_PROTOCOL *)((UINT8 *)(Node) + DevicePathNodeLeng= th (Node)); -} - /** Get the size of the current device path instance. = diff --git a/MdeModulePkg/Bus/Ata/AhciPei/AhciPei.inf b/MdeModulePkg/Bus/At= a/AhciPei/AhciPei.inf index 912ff7a8ba4f..788660b33299 100644 --- a/MdeModulePkg/Bus/Ata/AhciPei/AhciPei.inf +++ b/MdeModulePkg/Bus/Ata/AhciPei/AhciPei.inf @@ -50,11 +50,13 @@ [LibraryClasses] TimerLib LockBoxLib PeimEntryPoint + DevicePathLib = [Ppis] gEdkiiPeiAtaAhciHostControllerPpiGuid ## CONSUMES gEdkiiIoMmuPpiGuid ## CONSUMES gEfiEndOfPeiSignalPpiGuid ## CONSUMES + gEdkiiPeiPciDevicePpiGuid ## CONSUMES gEdkiiPeiAtaPassThruPpiGuid ## SOMETIMES_PRODUCES gEfiPeiVirtualBlockIoPpiGuid ## SOMETIMES_PRODUCES gEfiPeiVirtualBlockIo2PpiGuid ## SOMETIMES_PRODUCES @@ -65,8 +67,7 @@ [Guids] = [Depex] gEfiPeiMemoryDiscoveredPpiGuid AND - gEfiPeiMasterBootModePpiGuid AND - gEdkiiPeiAtaAhciHostControllerPpiGuid + gEfiPeiMasterBootModePpiGuid = [UserExtensions.TianoCore."ExtraFiles"] AhciPeiExtra.uni -- = 2.27.0.windows.1 --------------------------------------------------------------------- Intel Technology Poland sp. z o.o. ul. Slowackiego 173 | 80-298 Gdansk | Sad Rejonowy Gdansk Polnoc | VII Wydz= ial Gospodarczy Krajowego Rejestru Sadowego - KRS 101882 | NIP 957-07-52-31= 6 | Kapital zakladowy 200.000 PLN. Ta wiadomosc wraz z zalacznikami jest przeznaczona dla okreslonego adresata= i moze zawierac informacje poufne. W razie przypadkowego otrzymania tej wi= adomosci, prosimy o powiadomienie nadawcy oraz trwale jej usuniecie; jakiek= olwiek przegladanie lub rozpowszechnianie jest zabronione. This e-mail and any attachments may contain confidential material for the s= ole use of the intended recipient(s). If you are not the intended recipient= , please contact the sender and delete all copies; any review or distributi= on by others is strictly prohibited.