| /** @file | |
| UfsHcDxe driver is used to provide platform-dependent info, mainly UFS host controller | |
| MMIO base, to upper layer UFS drivers. | |
| Copyright (c) 2014 - 2015, Intel Corporation. All rights reserved.<BR> | |
| Copyright (c) 2016 - 2017, Linaro Ltd. All rights reserved. | |
| This program and the accompanying materials | |
| are licensed and made available under the terms and conditions of the BSD License | |
| which accompanies this distribution. The full text of the license may be found at | |
| http://opensource.org/licenses/bsd-license.php. | |
| THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS, | |
| WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED. | |
| **/ | |
| #include "DwUfsHcDxe.h" | |
| #include <IndustryStandard/Pci.h> | |
| #include <Protocol/PciIo.h> | |
| // | |
| // Ufs Host Controller Driver Binding Protocol Instance | |
| // | |
| EFI_DRIVER_BINDING_PROTOCOL gUfsHcDriverBinding = { | |
| UfsHcDriverBindingSupported, | |
| UfsHcDriverBindingStart, | |
| UfsHcDriverBindingStop, | |
| 0x10, | |
| NULL, | |
| NULL | |
| }; | |
| // | |
| // Template for Ufs host controller private data. | |
| // | |
| UFS_HOST_CONTROLLER_PRIVATE_DATA gUfsHcTemplate = { | |
| UFS_HC_PRIVATE_DATA_SIGNATURE, // Signature | |
| NULL, // Handle | |
| { // UfsHcProtocol | |
| UfsHcGetMmioBar, | |
| UfsHcAllocateBuffer, | |
| UfsHcFreeBuffer, | |
| UfsHcMap, | |
| UfsHcUnmap, | |
| UfsHcFlush, | |
| UfsHcMmioRead, | |
| UfsHcMmioWrite, | |
| UfsHcPhyInit, | |
| UfsHcPhySetPowerMode, | |
| }, | |
| 0 // RegBase | |
| }; | |
| STATIC | |
| EFI_STATUS | |
| DwUfsDmeSet ( | |
| IN UINTN RegBase, | |
| IN UINT16 Attr, | |
| IN UINT16 Index, | |
| IN UINT32 Value | |
| ) | |
| { | |
| UINT32 Data; | |
| Data = MmioRead32 (RegBase + UFS_HC_STATUS_OFFSET); | |
| if ((Data & UFS_HC_HCS_UCRDY) == 0) { | |
| return EFI_NOT_READY; | |
| } | |
| MmioWrite32 (RegBase + UFS_HC_IS_OFFSET, ~0); | |
| MmioWrite32 (RegBase + UFS_HC_UCMD_ARG1_OFFSET, (Attr << 16) | Index); | |
| MmioWrite32 (RegBase + UFS_HC_UCMD_ARG2_OFFSET, 0); | |
| MmioWrite32 (RegBase + UFS_HC_UCMD_ARG3_OFFSET, Value); | |
| MmioWrite32 (RegBase + UFS_HC_UIC_CMD_OFFSET, UFS_UIC_DME_SET); | |
| do { | |
| Data = MmioRead32 (RegBase + UFS_HC_IS_OFFSET); | |
| if (Data & UFS_HC_IS_UE) { | |
| return EFI_DEVICE_ERROR; | |
| } | |
| } while ((Data & UFS_HC_IS_UCCS) == 0); | |
| MmioWrite32 (RegBase + UFS_HC_IS_OFFSET, UFS_HC_IS_UCCS); | |
| Data = MmioRead32 (RegBase + UFS_HC_UCMD_ARG2_OFFSET); | |
| if (Data) { | |
| return EFI_DEVICE_ERROR; | |
| } | |
| return EFI_SUCCESS; | |
| } | |
| STATIC | |
| EFI_STATUS | |
| DwUfsDmeGet ( | |
| IN UINTN RegBase, | |
| IN UINT16 Attr, | |
| IN UINT16 Index, | |
| OUT UINT32 *Value | |
| ) | |
| { | |
| UINT32 Data; | |
| Data = MmioRead32 (RegBase + UFS_HC_STATUS_OFFSET); | |
| if ((Data & UFS_HC_HCS_UCRDY) == 0) { | |
| return EFI_NOT_READY; | |
| } | |
| MmioWrite32 (RegBase + UFS_HC_IS_OFFSET, ~0); | |
| MmioWrite32 (RegBase + UFS_HC_UCMD_ARG1_OFFSET, (Attr << 16) | Index); | |
| MmioWrite32 (RegBase + UFS_HC_UCMD_ARG2_OFFSET, 0); | |
| MmioWrite32 (RegBase + UFS_HC_UCMD_ARG3_OFFSET, 0); | |
| MmioWrite32 (RegBase + UFS_HC_UIC_CMD_OFFSET, UFS_UIC_DME_GET); | |
| do { | |
| Data = MmioRead32 (RegBase + UFS_HC_IS_OFFSET); | |
| if (Data & UFS_HC_IS_UE) { | |
| return EFI_DEVICE_ERROR; | |
| } | |
| } while ((Data & UFS_HC_IS_UCCS) == 0); | |
| MmioWrite32 (RegBase + UFS_HC_IS_OFFSET, UFS_HC_IS_UCCS); | |
| Data = MmioRead32 (RegBase + UFS_HC_UCMD_ARG2_OFFSET); | |
| if (Data) { | |
| return EFI_DEVICE_ERROR; | |
| } | |
| *Value = MmioRead32 (RegBase + UFS_HC_UCMD_ARG3_OFFSET); | |
| return EFI_SUCCESS; | |
| } | |
| /** | |
| Get the MMIO base of the UFS host controller. | |
| @param[in] This A pointer to the EFI_UFS_HOST_CONTROLLER_PROTOCOL instance. | |
| @param[out] MmioBar The MMIO base address of UFS host controller. | |
| @retval EFI_SUCCESS The operation succeeds. | |
| @retval others The operation fails. | |
| **/ | |
| EFI_STATUS | |
| EFIAPI | |
| UfsHcGetMmioBar ( | |
| IN EDKII_UFS_HOST_CONTROLLER_PROTOCOL *This, | |
| OUT UINTN *MmioBar | |
| ) | |
| { | |
| UFS_HOST_CONTROLLER_PRIVATE_DATA *Private; | |
| if ((This == NULL) || (MmioBar == NULL)) { | |
| return EFI_INVALID_PARAMETER; | |
| } | |
| Private = UFS_HOST_CONTROLLER_PRIVATE_DATA_FROM_UFSHC (This); | |
| *MmioBar = Private->RegBase; | |
| return EFI_SUCCESS; | |
| } | |
| /** | |
| Provides the UFS controller-specific addresses needed to access system memory. | |
| @param This A pointer to the EFI_UFS_HOST_CONTROLLER_PROTOCOL instance. | |
| @param Operation Indicates if the bus master is going to read or write to system memory. | |
| @param HostAddress The system memory address to map to the UFS controller. | |
| @param NumberOfBytes On input the number of bytes to map. On output the number of bytes | |
| that were mapped. | |
| @param DeviceAddress The resulting map address for the bus master UFS controller to use to | |
| access the hosts HostAddress. | |
| @param Mapping A resulting value to pass to Unmap(). | |
| @retval EFI_SUCCESS The range was mapped for the returned NumberOfBytes. | |
| @retval EFI_UNSUPPORTED The HostAddress cannot be mapped as a common buffer. | |
| @retval EFI_INVALID_PARAMETER One or more parameters are invalid. | |
| @retval EFI_OUT_OF_RESOURCES The request could not be completed due to a lack of resources. | |
| @retval EFI_DEVICE_ERROR The system hardware could not map the requested address. | |
| **/ | |
| EFI_STATUS | |
| EFIAPI | |
| UfsHcMap ( | |
| IN EDKII_UFS_HOST_CONTROLLER_PROTOCOL *This, | |
| IN EDKII_UFS_HOST_CONTROLLER_OPERATION Operation, | |
| IN VOID *HostAddress, | |
| IN OUT UINTN *NumberOfBytes, | |
| OUT EFI_PHYSICAL_ADDRESS *DeviceAddress, | |
| OUT VOID **Mapping | |
| ) | |
| { | |
| DMA_MAP_OPERATION DmaOperation; | |
| if ((This == NULL) || (HostAddress == NULL) || (NumberOfBytes == NULL) || (DeviceAddress == NULL) || (Mapping == NULL)) { | |
| return EFI_INVALID_PARAMETER; | |
| } | |
| if (Operation == EdkiiUfsHcOperationBusMasterRead) { | |
| DmaOperation = MapOperationBusMasterRead; | |
| } else if (Operation == EdkiiUfsHcOperationBusMasterWrite) { | |
| DmaOperation = MapOperationBusMasterWrite; | |
| } else if (Operation == EdkiiUfsHcOperationBusMasterCommonBuffer) { | |
| DmaOperation = MapOperationBusMasterCommonBuffer; | |
| } else { | |
| return EFI_INVALID_PARAMETER; | |
| } | |
| if ((*NumberOfBytes & (BIT0 | BIT1)) != 0) { | |
| *NumberOfBytes += BIT0 | BIT1; | |
| *NumberOfBytes &= ~(BIT0 | BIT1); | |
| } | |
| return DmaMap (DmaOperation, HostAddress, NumberOfBytes, DeviceAddress, Mapping); | |
| } | |
| /** | |
| Completes the Map() operation and releases any corresponding resources. | |
| @param This A pointer to the EFI_UFS_HOST_CONTROLLER_PROTOCOL instance. | |
| @param Mapping The mapping value returned from Map(). | |
| @retval EFI_SUCCESS The range was unmapped. | |
| @retval EFI_DEVICE_ERROR The data was not committed to the target system memory. | |
| **/ | |
| EFI_STATUS | |
| EFIAPI | |
| UfsHcUnmap ( | |
| IN EDKII_UFS_HOST_CONTROLLER_PROTOCOL *This, | |
| IN VOID *Mapping | |
| ) | |
| { | |
| if ((This == NULL) || (Mapping == NULL)) { | |
| return EFI_INVALID_PARAMETER; | |
| } | |
| return DmaUnmap (Mapping); | |
| } | |
| /** | |
| Allocates pages that are suitable for an EfiUfsHcOperationBusMasterCommonBuffer | |
| mapping. | |
| @param This A pointer to the EFI_UFS_HOST_CONTROLLER_PROTOCOL instance. | |
| @param Type This parameter is not used and must be ignored. | |
| @param MemoryType The type of memory to allocate, EfiBootServicesData or | |
| EfiRuntimeServicesData. | |
| @param Pages The number of pages to allocate. | |
| @param HostAddress A pointer to store the base system memory address of the | |
| allocated range. | |
| @param Attributes The requested bit mask of attributes for the allocated range. | |
| @retval EFI_SUCCESS The requested memory pages were allocated. | |
| @retval EFI_UNSUPPORTED Attributes is unsupported. The only legal attribute bits are | |
| MEMORY_WRITE_COMBINE and MEMORY_CACHED. | |
| @retval EFI_INVALID_PARAMETER One or more parameters are invalid. | |
| @retval EFI_OUT_OF_RESOURCES The memory pages could not be allocated. | |
| **/ | |
| EFI_STATUS | |
| EFIAPI | |
| UfsHcAllocateBuffer ( | |
| IN EDKII_UFS_HOST_CONTROLLER_PROTOCOL *This, | |
| IN EFI_ALLOCATE_TYPE Type, | |
| IN EFI_MEMORY_TYPE MemoryType, | |
| IN UINTN Pages, | |
| OUT VOID **HostAddress, | |
| IN UINT64 Attributes | |
| ) | |
| { | |
| if ((This == NULL) || (HostAddress == NULL)) { | |
| return EFI_INVALID_PARAMETER; | |
| } | |
| return DmaAllocateBuffer (MemoryType, Pages, HostAddress); | |
| } | |
| /** | |
| Frees memory that was allocated with AllocateBuffer(). | |
| @param This A pointer to the EFI_UFS_HOST_CONTROLLER_PROTOCOL instance. | |
| @param Pages The number of pages to free. | |
| @param HostAddress The base system memory address of the allocated range. | |
| @retval EFI_SUCCESS The requested memory pages were freed. | |
| @retval EFI_INVALID_PARAMETER The memory range specified by HostAddress and Pages | |
| was not allocated with AllocateBuffer(). | |
| **/ | |
| EFI_STATUS | |
| EFIAPI | |
| UfsHcFreeBuffer ( | |
| IN EDKII_UFS_HOST_CONTROLLER_PROTOCOL *This, | |
| IN UINTN Pages, | |
| IN VOID *HostAddress | |
| ) | |
| { | |
| if ((This == NULL) || (HostAddress == NULL)) { | |
| return EFI_INVALID_PARAMETER; | |
| } | |
| return DmaFreeBuffer (Pages, HostAddress); | |
| } | |
| /** | |
| Flushes all posted write transactions from the UFS bus to attached UFS device. | |
| @param This A pointer to the EFI_UFS_HOST_CONTROLLER_PROTOCOL instance. | |
| @retval EFI_SUCCESS The posted write transactions were flushed from the UFS bus | |
| to attached UFS device. | |
| @retval EFI_DEVICE_ERROR The posted write transactions were not flushed from the UFS | |
| bus to attached UFS device due to a hardware error. | |
| **/ | |
| EFI_STATUS | |
| EFIAPI | |
| UfsHcFlush ( | |
| IN EDKII_UFS_HOST_CONTROLLER_PROTOCOL *This | |
| ) | |
| { | |
| ArmInstructionSynchronizationBarrier (); | |
| ArmDataSynchronizationBarrier (); | |
| return EFI_SUCCESS; | |
| } | |
| /** | |
| Enable a UFS bus driver to access UFS MMIO registers in the UFS Host Controller memory space. | |
| @param This A pointer to the EDKII_UFS_HOST_CONTROLLER_PROTOCOL instance. | |
| @param Width Signifies the width of the memory operations. | |
| @param Offset The offset within the UFS Host Controller MMIO space to start the | |
| memory operation. | |
| @param Count The number of memory operations to perform. | |
| @param Buffer For read operations, the destination buffer to store the results. | |
| For write operations, the source buffer to write data from. | |
| @retval EFI_SUCCESS The data was read from or written to the UFS host controller. | |
| @retval EFI_UNSUPPORTED The address range specified by Offset, Width, and Count is not | |
| valid for the UFS Host Controller memory space. | |
| @retval EFI_OUT_OF_RESOURCES The request could not be completed due to a lack of resources. | |
| @retval EFI_INVALID_PARAMETER One or more parameters are invalid. | |
| **/ | |
| EFI_STATUS | |
| EFIAPI | |
| UfsHcMmioRead ( | |
| IN EDKII_UFS_HOST_CONTROLLER_PROTOCOL *This, | |
| IN EDKII_UFS_HOST_CONTROLLER_PROTOCOL_WIDTH Width, | |
| IN UINT64 Offset, | |
| IN UINTN Count, | |
| IN OUT VOID *Buffer | |
| ) | |
| { | |
| UFS_HOST_CONTROLLER_PRIVATE_DATA *Private; | |
| UINTN Index; | |
| Private = UFS_HOST_CONTROLLER_PRIVATE_DATA_FROM_UFSHC (This); | |
| switch (Width) { | |
| case EfiUfsHcWidthUint8: | |
| for (Index = 0; Index < Count; Index++) { | |
| *((UINT8 *)Buffer + Index) = MmioRead8 (Private->RegBase + Offset); | |
| } | |
| break; | |
| case EfiUfsHcWidthUint16: | |
| for (Index = 0; Index < Count; Index++) { | |
| *((UINT16 *)Buffer + Index) = MmioRead16 (Private->RegBase + Offset); | |
| } | |
| break; | |
| case EfiUfsHcWidthUint32: | |
| for (Index = 0; Index < Count; Index++) { | |
| *((UINT32 *)Buffer + Index) = MmioRead32 (Private->RegBase + Offset); | |
| } | |
| break; | |
| case EfiUfsHcWidthUint64: | |
| for (Index = 0; Index < Count; Index++) { | |
| *((UINT64 *)Buffer + Index) = MmioRead64 (Private->RegBase + Offset); | |
| } | |
| break; | |
| default: | |
| return EFI_INVALID_PARAMETER; | |
| } | |
| return EFI_SUCCESS; | |
| } | |
| /** | |
| Enable a UFS bus driver to access UFS MMIO registers in the UFS Host Controller memory space. | |
| @param This A pointer to the EDKII_UFS_HOST_CONTROLLER_PROTOCOL instance. | |
| @param Width Signifies the width of the memory operations. | |
| @param Offset The offset within the UFS Host Controller MMIO space to start the | |
| memory operation. | |
| @param Count The number of memory operations to perform. | |
| @param Buffer For read operations, the destination buffer to store the results. | |
| For write operations, the source buffer to write data from. | |
| @retval EFI_SUCCESS The data was read from or written to the UFS host controller. | |
| @retval EFI_UNSUPPORTED The address range specified by Offset, Width, and Count is not | |
| valid for the UFS Host Controller memory space. | |
| @retval EFI_OUT_OF_RESOURCES The request could not be completed due to a lack of resources. | |
| @retval EFI_INVALID_PARAMETER One or more parameters are invalid. | |
| **/ | |
| EFI_STATUS | |
| EFIAPI | |
| UfsHcMmioWrite ( | |
| IN EDKII_UFS_HOST_CONTROLLER_PROTOCOL *This, | |
| IN EDKII_UFS_HOST_CONTROLLER_PROTOCOL_WIDTH Width, | |
| IN UINT64 Offset, | |
| IN UINTN Count, | |
| IN OUT VOID *Buffer | |
| ) | |
| { | |
| UFS_HOST_CONTROLLER_PRIVATE_DATA *Private; | |
| EFI_STATUS Status = EFI_SUCCESS; | |
| UINTN Index; | |
| Private = UFS_HOST_CONTROLLER_PRIVATE_DATA_FROM_UFSHC (This); | |
| switch (Width) { | |
| case EfiUfsHcWidthUint8: | |
| for (Index = 0; Index < Count; Index++) { | |
| Status = MmioWrite8 (Private->RegBase + Offset, *((UINT8 *)Buffer + Index)); | |
| } | |
| break; | |
| case EfiUfsHcWidthUint16: | |
| for (Index = 0; Index < Count; Index++) { | |
| Status = MmioWrite16 (Private->RegBase + Offset, *((UINT16 *)Buffer + Index)); | |
| } | |
| break; | |
| case EfiUfsHcWidthUint32: | |
| for (Index = 0; Index < Count; Index++) { | |
| Status = MmioWrite32 (Private->RegBase + Offset, *((UINT32 *)Buffer + Index)); | |
| } | |
| break; | |
| case EfiUfsHcWidthUint64: | |
| for (Index = 0; Index < Count; Index++) { | |
| Status = MmioWrite64 (Private->RegBase + Offset, *((UINT64 *)Buffer + Index)); | |
| } | |
| break; | |
| default: | |
| return EFI_INVALID_PARAMETER; | |
| } | |
| return Status; | |
| } | |
| EFI_STATUS | |
| EFIAPI | |
| UfsHcPhyInit ( | |
| IN EDKII_UFS_HOST_CONTROLLER_PROTOCOL *This | |
| ) | |
| { | |
| UFS_HOST_CONTROLLER_PRIVATE_DATA *Private; | |
| EFI_STATUS Status; | |
| UINT32 Data, Fsm0, Fsm1; | |
| Private = UFS_HOST_CONTROLLER_PRIVATE_DATA_FROM_UFSHC (This); | |
| DwUfsDmeSet (Private->RegBase, 0xd0c1, 0, 1); | |
| DwUfsDmeSet (Private->RegBase, 0xd0c1, 0, 1); | |
| DwUfsDmeSet (Private->RegBase, 0x156a, 0, 2); | |
| DwUfsDmeSet (Private->RegBase, 0x8114, 0, 1); | |
| DwUfsDmeSet (Private->RegBase, 0x8121, 0, 0x2d); | |
| DwUfsDmeSet (Private->RegBase, 0x8122, 0, 1); | |
| DwUfsDmeSet (Private->RegBase, 0xd085, 0, 1); | |
| DwUfsDmeSet (Private->RegBase, 0x800d, 4, 0x58); | |
| DwUfsDmeSet (Private->RegBase, 0x800d, 5, 0x58); | |
| DwUfsDmeSet (Private->RegBase, 0x800e, 4, 0xb); | |
| DwUfsDmeSet (Private->RegBase, 0x800e, 5, 0xb); | |
| DwUfsDmeSet (Private->RegBase, 0x8009, 4, 0x1); | |
| DwUfsDmeSet (Private->RegBase, 0x8009, 5, 0x1); | |
| DwUfsDmeSet (Private->RegBase, 0xd085, 0, 1); | |
| DwUfsDmeSet (Private->RegBase, 0x8113, 0, 1); | |
| DwUfsDmeSet (Private->RegBase, 0xd085, 0, 1); | |
| DwUfsDmeSet (Private->RegBase, 0x0095, 4, 0x4a); | |
| DwUfsDmeSet (Private->RegBase, 0x0095, 5, 0x4a); | |
| DwUfsDmeSet (Private->RegBase, 0x0094, 4, 0x4a); | |
| DwUfsDmeSet (Private->RegBase, 0x0094, 5, 0x4a); | |
| DwUfsDmeSet (Private->RegBase, 0x008f, 4, 0x7); | |
| DwUfsDmeSet (Private->RegBase, 0x008f, 5, 0x7); | |
| DwUfsDmeSet (Private->RegBase, 0x000f, 0, 0x5); | |
| DwUfsDmeSet (Private->RegBase, 0x000f, 1, 0x5); | |
| DwUfsDmeSet (Private->RegBase, 0xd085, 0, 1); | |
| Status = DwUfsDmeGet (Private->RegBase, 0xd0c1, 0, &Data); | |
| ASSERT_EFI_ERROR (Status); | |
| ASSERT (Data == 1); | |
| DwUfsDmeSet (Private->RegBase, 0xd0c1, 0, 0); | |
| for (;;) { | |
| Status = DwUfsDmeGet (Private->RegBase, 0x0041, 0, &Fsm0); | |
| ASSERT_EFI_ERROR (Status); | |
| Status = DwUfsDmeGet (Private->RegBase, 0x0041, 1, &Fsm1); | |
| ASSERT_EFI_ERROR (Status); | |
| if ((Fsm0 == 1) && (Fsm1 == 1)) { | |
| break; | |
| } | |
| } | |
| MmioWrite32 (Private->RegBase + UFS_HC_HCLKDIV_OFFSET, 0xE4); | |
| Data = MmioRead32 (Private->RegBase + UFS_HC_AHIT_OFFSET); | |
| Data &= ~0x3FF; | |
| MmioWrite32 (Private->RegBase + UFS_HC_AHIT_OFFSET, Data); | |
| DwUfsDmeSet (Private->RegBase, 0x155e, 0, 0); | |
| DwUfsDmeSet (Private->RegBase, 0xd0ab, 0, 0); | |
| Status = DwUfsDmeGet (Private->RegBase, 0xd0ab, 0, &Data); | |
| ASSERT_EFI_ERROR ((Status) && (Data == 0)); | |
| DwUfsDmeSet (Private->RegBase, 0x2044, 0, 0); | |
| DwUfsDmeSet (Private->RegBase, 0x2045, 0, 0); | |
| DwUfsDmeSet (Private->RegBase, 0x2040, 0, 9); | |
| return EFI_SUCCESS; | |
| } | |
| EFI_STATUS | |
| EFIAPI | |
| UfsHcPhySetPowerMode ( | |
| IN EDKII_UFS_HOST_CONTROLLER_PROTOCOL *This, | |
| IN UINT32 DevQuirks | |
| ) | |
| { | |
| UFS_HOST_CONTROLLER_PRIVATE_DATA *Private; | |
| UINT32 Data, TxLanes, RxLanes; | |
| Private = UFS_HOST_CONTROLLER_PRIVATE_DATA_FROM_UFSHC (This); | |
| if (DevQuirks & UFS_DEVICE_QUIRK_HOST_VS_DEBUGSAVECONFIGTIME) { | |
| DEBUG ((DEBUG_INFO | DEBUG_LOAD, "ufs: H**** device must set VS_DebugSaveConfigTime 0x10\n")); | |
| /* VS_DebugSaveConfigTime */ | |
| DwUfsDmeSet (Private->RegBase, 0xD0A0, 0x0, 0x10); | |
| /* sync length */ | |
| DwUfsDmeSet (Private->RegBase, 0x1556, 0x0, 0x48); | |
| } | |
| // PA_Tactive | |
| DwUfsDmeGet (Private->RegBase, 0x15A8, 0, &Data); | |
| if (Data < 7) { | |
| DwUfsDmeSet (Private->RegBase, 0x15A8, 4, 7); | |
| } | |
| DwUfsDmeGet (Private->RegBase, 0x1561, 0, &TxLanes); | |
| DwUfsDmeGet (Private->RegBase, 0x1581, 0, &RxLanes); | |
| // PA TxSkip | |
| DwUfsDmeSet (Private->RegBase, 0x155C, 0, 0); | |
| // PA TxGear | |
| DwUfsDmeSet (Private->RegBase, 0x1568, 0, 3); | |
| // PA RxGear | |
| DwUfsDmeSet (Private->RegBase, 0x1583, 0, 3); | |
| // PA HSSeries | |
| DwUfsDmeSet (Private->RegBase, 0x156A, 0, 2); | |
| // PA TxTermination | |
| DwUfsDmeSet (Private->RegBase, 0x1569, 0, 1); | |
| // PA RxTermination | |
| DwUfsDmeSet (Private->RegBase, 0x1584, 0, 1); | |
| // PA Scrambling | |
| DwUfsDmeSet (Private->RegBase, 0x1585, 0, 0); | |
| // PA ActiveTxDataLines | |
| DwUfsDmeSet (Private->RegBase, 0x1560, 0, TxLanes); | |
| // PA ActiveRxDataLines | |
| DwUfsDmeSet (Private->RegBase, 0x1580, 0, RxLanes); | |
| // PA_PWRModeUserData0 = 8191 | |
| DwUfsDmeSet (Private->RegBase, 0x15B0, 0, 8191); | |
| // PA_PWRModeUserData1 = 65535 | |
| DwUfsDmeSet (Private->RegBase, 0x15B1, 0, 65535); | |
| // PA_PWRModeUserData2 = 32767 | |
| DwUfsDmeSet (Private->RegBase, 0x15B2, 0, 32767); | |
| // DME_FC0ProtectionTimeOutVal = 8191 | |
| DwUfsDmeSet (Private->RegBase, 0xD041, 0, 8191); | |
| // DME_TC0ReplayTimeOutVal = 65535 | |
| DwUfsDmeSet (Private->RegBase, 0xD042, 0, 65535); | |
| // DME_AFC0ReqTimeOutVal = 32767 | |
| DwUfsDmeSet (Private->RegBase, 0xD043, 0, 32767); | |
| // PA_PWRModeUserData3 = 8191 | |
| DwUfsDmeSet (Private->RegBase, 0x15B3, 0, 8191); | |
| // PA_PWRModeUserData4 = 65535 | |
| DwUfsDmeSet (Private->RegBase, 0x15B4, 0, 65535); | |
| // PA_PWRModeUserData5 = 32767 | |
| DwUfsDmeSet (Private->RegBase, 0x15B5, 0, 32767); | |
| // DME_FC1ProtectionTimeOutVal = 8191 | |
| DwUfsDmeSet (Private->RegBase, 0xD044, 0, 8191); | |
| // DME_TC1ReplayTimeOutVal = 65535 | |
| DwUfsDmeSet (Private->RegBase, 0xD045, 0, 65535); | |
| // DME_AFC1ReqTimeOutVal = 32767 | |
| DwUfsDmeSet (Private->RegBase, 0xD046, 0, 32767); | |
| DwUfsDmeSet (Private->RegBase, 0x1571, 0, 0x11); | |
| do { | |
| Data = MmioRead32(Private->RegBase + UFS_HC_IS_OFFSET); | |
| } while ((Data & UFS_INT_UPMS) == 0); | |
| MmioWrite32(Private->RegBase + UFS_HC_IS_OFFSET, UFS_INT_UPMS); | |
| Data = MmioRead32(Private->RegBase + UFS_HC_STATUS_OFFSET); | |
| if ((Data & HCS_UPMCRS_MASK) == HCS_PWR_LOCAL) { | |
| DEBUG ((DEBUG_INFO, "ufs: change power mode success\n")); | |
| } else { | |
| DEBUG ((DEBUG_ERROR, "ufs: HCS.UPMCRS error, HCS:0x%x\n", Data)); | |
| } | |
| return EFI_SUCCESS; | |
| } | |
| /** | |
| Tests to see if this driver supports a given controller. If a child device is provided, | |
| it further tests to see if this driver supports creating a handle for the specified child device. | |
| This function checks to see if the driver specified by This supports the device specified by | |
| ControllerHandle. Drivers will typically use the device path attached to | |
| ControllerHandle and/or the services from the bus I/O abstraction attached to | |
| ControllerHandle to determine if the driver supports ControllerHandle. This function | |
| may be called many times during platform initialization. In order to reduce boot times, the tests | |
| performed by this function must be very small, and take as little time as possible to execute. This | |
| function must not change the state of any hardware devices, and this function must be aware that the | |
| device specified by ControllerHandle may already be managed by the same driver or a | |
| different driver. This function must match its calls to AllocatePages() with FreePages(), | |
| AllocatePool() with FreePool(), and OpenProtocol() with CloseProtocol(). | |
| Since ControllerHandle may have been previously started by the same driver, if a protocol is | |
| already in the opened state, then it must not be closed with CloseProtocol(). This is required | |
| to guarantee the state of ControllerHandle is not modified by this function. | |
| @param[in] This A pointer to the EFI_DRIVER_BINDING_PROTOCOL instance. | |
| @param[in] ControllerHandle The handle of the controller to test. This handle | |
| must support a protocol interface that supplies | |
| an I/O abstraction to the driver. | |
| @param[in] RemainingDevicePath A pointer to the remaining portion of a device path. This | |
| parameter is ignored by device drivers, and is optional for bus | |
| drivers. For bus drivers, if this parameter is not NULL, then | |
| the bus driver must determine if the bus controller specified | |
| by ControllerHandle and the child controller specified | |
| by RemainingDevicePath are both supported by this | |
| bus driver. | |
| @retval EFI_SUCCESS The device specified by ControllerHandle and | |
| RemainingDevicePath is supported by the driver specified by This. | |
| @retval EFI_ALREADY_STARTED The device specified by ControllerHandle and | |
| RemainingDevicePath is already being managed by the driver | |
| specified by This. | |
| @retval EFI_ACCESS_DENIED The device specified by ControllerHandle and | |
| RemainingDevicePath is already being managed by a different | |
| driver or an application that requires exclusive access. | |
| Currently not implemented. | |
| @retval EFI_UNSUPPORTED The device specified by ControllerHandle and | |
| RemainingDevicePath is not supported by the driver specified by This. | |
| **/ | |
| EFI_STATUS | |
| EFIAPI | |
| UfsHcDriverBindingSupported ( | |
| IN EFI_DRIVER_BINDING_PROTOCOL *This, | |
| IN EFI_HANDLE Controller, | |
| IN EFI_DEVICE_PATH_PROTOCOL *RemainingDevicePath | |
| ) | |
| { | |
| EFI_STATUS Status; | |
| BOOLEAN UfsHcFound; | |
| EFI_DEVICE_PATH_PROTOCOL *ParentDevicePath = NULL; | |
| EFI_PCI_IO_PROTOCOL *PciIo = NULL; | |
| PCI_TYPE00 PciData; | |
| ParentDevicePath = NULL; | |
| UfsHcFound = FALSE; | |
| // | |
| // UfsHcDxe is a device driver, and should ingore the | |
| // "RemainingDevicePath" according to EFI spec | |
| // | |
| Status = gBS->OpenProtocol ( | |
| Controller, | |
| &gEfiDevicePathProtocolGuid, | |
| (VOID *) &ParentDevicePath, | |
| This->DriverBindingHandle, | |
| Controller, | |
| EFI_OPEN_PROTOCOL_BY_DRIVER | |
| ); | |
| if (EFI_ERROR (Status)) { | |
| // | |
| // EFI_ALREADY_STARTED is also an error | |
| // | |
| return Status; | |
| } | |
| // | |
| // Close the protocol because we don't use it here | |
| // | |
| gBS->CloseProtocol ( | |
| Controller, | |
| &gEfiDevicePathProtocolGuid, | |
| This->DriverBindingHandle, | |
| Controller | |
| ); | |
| // | |
| // Now test the EfiPciIoProtocol | |
| // | |
| Status = gBS->OpenProtocol ( | |
| Controller, | |
| &gEfiPciIoProtocolGuid, | |
| (VOID **) &PciIo, | |
| This->DriverBindingHandle, | |
| Controller, | |
| EFI_OPEN_PROTOCOL_BY_DRIVER | |
| ); | |
| if (EFI_ERROR (Status)) { | |
| return Status; | |
| } | |
| // | |
| // Now further check the PCI header: Base class (offset 0x0B) and | |
| // Sub Class (offset 0x0A). This controller should be an UFS controller | |
| // | |
| Status = PciIo->Pci.Read ( | |
| PciIo, | |
| EfiPciIoWidthUint8, | |
| 0, | |
| sizeof (PciData), | |
| &PciData | |
| ); | |
| if (EFI_ERROR (Status)) { | |
| gBS->CloseProtocol ( | |
| Controller, | |
| &gEfiPciIoProtocolGuid, | |
| This->DriverBindingHandle, | |
| Controller | |
| ); | |
| return EFI_UNSUPPORTED; | |
| } | |
| // | |
| // Since we already got the PciData, we can close protocol to avoid to carry it on for multiple exit points. | |
| // | |
| gBS->CloseProtocol ( | |
| Controller, | |
| &gEfiPciIoProtocolGuid, | |
| This->DriverBindingHandle, | |
| Controller | |
| ); | |
| // | |
| // Examine UFS Host Controller PCI Configuration table fields | |
| // | |
| if (PciData.Hdr.ClassCode[2] == PCI_CLASS_MASS_STORAGE) { | |
| if (PciData.Hdr.ClassCode[1] == 0x09 ) { //UFS Controller Subclass | |
| UfsHcFound = TRUE; | |
| } | |
| } | |
| if (!UfsHcFound) { | |
| return EFI_UNSUPPORTED; | |
| } | |
| return Status; | |
| } | |
| /** | |
| Starts a device controller or a bus controller. | |
| The Start() function is designed to be invoked from the EFI boot service ConnectController(). | |
| As a result, much of the error checking on the parameters to Start() has been moved into this | |
| common boot service. It is legal to call Start() from other locations, | |
| but the following calling restrictions must be followed or the system behavior will not be deterministic. | |
| 1. ControllerHandle must be a valid EFI_HANDLE. | |
| 2. If RemainingDevicePath is not NULL, then it must be a pointer to a naturally aligned | |
| EFI_DEVICE_PATH_PROTOCOL. | |
| 3. Prior to calling Start(), the Supported() function for the driver specified by This must | |
| have been called with the same calling parameters, and Supported() must have returned EFI_SUCCESS. | |
| @param[in] This A pointer to the EFI_DRIVER_BINDING_PROTOCOL instance. | |
| @param[in] ControllerHandle The handle of the controller to start. This handle | |
| must support a protocol interface that supplies | |
| an I/O abstraction to the driver. | |
| @param[in] RemainingDevicePath A pointer to the remaining portion of a device path. This | |
| parameter is ignored by device drivers, and is optional for bus | |
| drivers. For a bus driver, if this parameter is NULL, then handles | |
| for all the children of Controller are created by this driver. | |
| If this parameter is not NULL and the first Device Path Node is | |
| not the End of Device Path Node, then only the handle for the | |
| child device specified by the first Device Path Node of | |
| RemainingDevicePath is created by this driver. | |
| If the first Device Path Node of RemainingDevicePath is | |
| the End of Device Path Node, no child handle is created by this | |
| driver. | |
| @retval EFI_SUCCESS The device was started. | |
| @retval EFI_DEVICE_ERROR The device could not be started due to a device error.Currently not implemented. | |
| @retval EFI_OUT_OF_RESOURCES The request could not be completed due to a lack of resources. | |
| @retval Others The driver failded to start the device. | |
| **/ | |
| EFI_STATUS | |
| EFIAPI | |
| UfsHcDriverBindingStart ( | |
| IN EFI_DRIVER_BINDING_PROTOCOL *This, | |
| IN EFI_HANDLE Controller, | |
| IN EFI_DEVICE_PATH_PROTOCOL *RemainingDevicePath | |
| ) | |
| { | |
| EFI_STATUS Status; | |
| EFI_PCI_IO_PROTOCOL *PciIo; | |
| UFS_HOST_CONTROLLER_PRIVATE_DATA *Private; | |
| UINT64 Supports; | |
| UINT8 BarIndex; | |
| EFI_ACPI_ADDRESS_SPACE_DESCRIPTOR *BarDesc; | |
| UINT32 BaseAddress; | |
| PciIo = NULL; | |
| Private = NULL; | |
| Supports = 0; | |
| BarDesc = NULL; | |
| BaseAddress = PcdGet32 (PcdDwUfsHcDxeBaseAddress); | |
| // | |
| // Now test and open the EfiPciIoProtocol | |
| // | |
| Status = gBS->OpenProtocol ( | |
| Controller, | |
| &gEfiPciIoProtocolGuid, | |
| (VOID **) &PciIo, | |
| This->DriverBindingHandle, | |
| Controller, | |
| EFI_OPEN_PROTOCOL_BY_DRIVER | |
| ); | |
| // | |
| // Status == 0 - A normal execution flow, SUCCESS and the program proceeds. | |
| // Status == ALREADY_STARTED - A non-zero Status code returned. It indicates | |
| // that the protocol has been opened and should be treated as a | |
| // normal condition and the program proceeds. The Protocol will not | |
| // opened 'again' by this call. | |
| // Status != ALREADY_STARTED - Error status, terminate program execution | |
| // | |
| if (EFI_ERROR (Status)) { | |
| // | |
| // EFI_ALREADY_STARTED is also an error | |
| // | |
| return Status; | |
| } | |
| //BaseAddress = PcdGet32 (PcdDwUfsHcDxeBaseAddress); | |
| Private = AllocateCopyPool (sizeof (UFS_HOST_CONTROLLER_PRIVATE_DATA), &gUfsHcTemplate); | |
| if (Private == NULL) { | |
| Status = EFI_OUT_OF_RESOURCES; | |
| goto Done; | |
| } | |
| Private->RegBase = (UINTN)BaseAddress; | |
| Private->PciIo = PciIo; | |
| for (BarIndex = 0; BarIndex < PCI_MAX_BAR; BarIndex++) { | |
| Status = PciIo->GetBarAttributes ( | |
| PciIo, | |
| BarIndex, | |
| NULL, | |
| (VOID**) &BarDesc | |
| ); | |
| if (Status == EFI_UNSUPPORTED) { | |
| continue; | |
| } else if (EFI_ERROR (Status)) { | |
| goto Done; | |
| } | |
| if (BarDesc->ResType == ACPI_ADDRESS_SPACE_TYPE_MEM) { | |
| Private->BarIndex = BarIndex; | |
| FreePool (BarDesc); | |
| break; | |
| } | |
| FreePool (BarDesc); | |
| } | |
| Status = PciIo->Attributes ( | |
| PciIo, | |
| EfiPciIoAttributeOperationGet, | |
| 0, | |
| &Private->PciAttributes | |
| ); | |
| if (EFI_ERROR (Status)) { | |
| goto Done; | |
| } | |
| Status = PciIo->Attributes ( | |
| PciIo, | |
| EfiPciIoAttributeOperationSupported, | |
| 0, | |
| &Supports | |
| ); | |
| if (!EFI_ERROR (Status)) { | |
| Supports &= (UINT64)EFI_PCI_DEVICE_ENABLE; | |
| Status = PciIo->Attributes ( | |
| PciIo, | |
| EfiPciIoAttributeOperationEnable, | |
| Supports, | |
| NULL | |
| ); | |
| } else { | |
| goto Done; | |
| } | |
| /// | |
| /// Install UFS_HOST_CONTROLLER protocol | |
| /// | |
| Status = gBS->InstallProtocolInterface ( | |
| &Controller, | |
| &gEdkiiUfsHostControllerProtocolGuid, | |
| EFI_NATIVE_INTERFACE, | |
| (VOID*)&(Private->UfsHc) | |
| ); | |
| Done: | |
| if (EFI_ERROR (Status)) { | |
| if ((Private != NULL) && (Private->PciAttributes != 0)) { | |
| // | |
| // Restore original PCI attributes | |
| // | |
| Status = PciIo->Attributes ( | |
| PciIo, | |
| EfiPciIoAttributeOperationSet, | |
| Private->PciAttributes, | |
| NULL | |
| ); | |
| ASSERT_EFI_ERROR (Status); | |
| } | |
| gBS->CloseProtocol ( | |
| Controller, | |
| &gEfiPciIoProtocolGuid, | |
| This->DriverBindingHandle, | |
| Controller | |
| ); | |
| if (Private != NULL) { | |
| FreePool (Private); | |
| } | |
| } | |
| return Status; | |
| } | |
| /** | |
| Stops a device controller or a bus controller. | |
| The Stop() function is designed to be invoked from the EFI boot service DisconnectController(). | |
| As a result, much of the error checking on the parameters to Stop() has been moved | |
| into this common boot service. It is legal to call Stop() from other locations, | |
| but the following calling restrictions must be followed or the system behavior will not be deterministic. | |
| 1. ControllerHandle must be a valid EFI_HANDLE that was used on a previous call to this | |
| same driver's Start() function. | |
| 2. The first NumberOfChildren handles of ChildHandleBuffer must all be a valid | |
| EFI_HANDLE. In addition, all of these handles must have been created in this driver's | |
| Start() function, and the Start() function must have called OpenProtocol() on | |
| ControllerHandle with an Attribute of EFI_OPEN_PROTOCOL_BY_CHILD_CONTROLLER. | |
| @param[in] This A pointer to the EFI_DRIVER_BINDING_PROTOCOL instance. | |
| @param[in] ControllerHandle A handle to the device being stopped. The handle must | |
| support a bus specific I/O protocol for the driver | |
| to use to stop the device. | |
| @param[in] NumberOfChildren The number of child device handles in ChildHandleBuffer. | |
| @param[in] ChildHandleBuffer An array of child handles to be freed. May be NULL | |
| if NumberOfChildren is 0. | |
| @retval EFI_SUCCESS The device was stopped. | |
| @retval EFI_DEVICE_ERROR The device could not be stopped due to a device error. | |
| **/ | |
| EFI_STATUS | |
| EFIAPI | |
| UfsHcDriverBindingStop ( | |
| IN EFI_DRIVER_BINDING_PROTOCOL *This, | |
| IN EFI_HANDLE Controller, | |
| IN UINTN NumberOfChildren, | |
| IN EFI_HANDLE *ChildHandleBuffer | |
| ) | |
| { | |
| EFI_STATUS Status; | |
| UFS_HOST_CONTROLLER_PRIVATE_DATA *Private; | |
| EDKII_UFS_HOST_CONTROLLER_PROTOCOL *UfsHc; | |
| /// | |
| /// Get private data | |
| /// | |
| Status = gBS->OpenProtocol ( | |
| Controller, | |
| &gEdkiiUfsHostControllerProtocolGuid, | |
| (VOID **) &UfsHc, | |
| This->DriverBindingHandle, | |
| Controller, | |
| EFI_OPEN_PROTOCOL_GET_PROTOCOL | |
| ); | |
| if (EFI_ERROR (Status)) { | |
| return EFI_DEVICE_ERROR; | |
| } | |
| Private = UFS_HOST_CONTROLLER_PRIVATE_DATA_FROM_UFSHC (UfsHc); | |
| Status = gBS->UninstallProtocolInterface ( | |
| Controller, | |
| &gEdkiiUfsHostControllerProtocolGuid, | |
| &(Private->UfsHc) | |
| ); | |
| if (!EFI_ERROR (Status)) { | |
| // | |
| // Restore original PCI attributes | |
| // | |
| Status = Private->PciIo->Attributes ( | |
| Private->PciIo, | |
| EfiPciIoAttributeOperationSet, | |
| Private->PciAttributes, | |
| NULL | |
| ); | |
| ASSERT_EFI_ERROR (Status); | |
| // | |
| // Close protocols opened by UFS host controller driver | |
| // | |
| gBS->CloseProtocol ( | |
| Controller, | |
| &gEfiPciIoProtocolGuid, | |
| This->DriverBindingHandle, | |
| Controller | |
| ); | |
| FreePool (Private); | |
| } | |
| return Status; | |
| } | |
| /** | |
| The entry point for UFS host controller driver, used to install this driver on the ImageHandle. | |
| @param[in] ImageHandle The firmware allocated handle for this driver image. | |
| @param[in] SystemTable Pointer to the EFI system table. | |
| @retval EFI_SUCCESS Driver loaded. | |
| @retval other Driver not loaded. | |
| **/ | |
| EFI_STATUS | |
| EFIAPI | |
| UfsHcDriverEntry ( | |
| IN EFI_HANDLE ImageHandle, | |
| IN EFI_SYSTEM_TABLE *SystemTable | |
| ) | |
| { | |
| EFI_STATUS Status; | |
| Status = EfiLibInstallDriverBindingComponentName2 ( | |
| ImageHandle, | |
| SystemTable, | |
| &gUfsHcDriverBinding, | |
| ImageHandle, | |
| &gUfsHcComponentName, | |
| &gUfsHcComponentName2 | |
| ); | |
| ASSERT_EFI_ERROR (Status); | |
| return Status; | |
| } |