/** * * Copyright (c) 2017, Linaro Ltd. All rights reserved. * Copyright (c) 2018, Marvell International Ltd. All rights reserved. * * SPDX-License-Identifier: BSD-2-Clause-Patent * **/ #include #include #include #include #include #include #include #include #include #include "NonDiscoverableInitLib.h" STATIC EFI_STATUS EFIAPI ConfigurePins ( IN CONST MV_GPIO_PIN *VbusPin, IN UINTN PinCount, IN MV_GPIO_DRIVER_TYPE DriverType ) { EMBEDDED_GPIO_MODE Mode; EMBEDDED_GPIO_PIN Gpio; EMBEDDED_GPIO *GpioProtocol; EFI_STATUS Status; UINTN Index; Status = MvGpioGetProtocol (DriverType, &GpioProtocol); if (EFI_ERROR (Status)) { DEBUG ((DEBUG_ERROR, "%a: Unable to find GPIO protocol\n", __FUNCTION__)); return Status; } for (Index = 0; Index < PinCount; Index++) { Mode = VbusPin->ActiveHigh ? GPIO_MODE_OUTPUT_1 : GPIO_MODE_OUTPUT_0; Gpio = GPIO (VbusPin->ControllerId, VbusPin->PinNumber); GpioProtocol->Set (GpioProtocol, Gpio, Mode); VbusPin++; } return EFI_SUCCESS; } STATIC CONST MV_GPIO_PIN mXhciVbusPins[] = { { MV_GPIO_DRIVER_TYPE_PCA95XX, ARMADA_70x0_DB_IO_EXPANDER0, ARMADA_70x0_DB_VBUS0_PIN, TRUE, }, { MV_GPIO_DRIVER_TYPE_PCA95XX, ARMADA_70x0_DB_IO_EXPANDER0, ARMADA_70x0_DB_VBUS0_LIMIT_PIN, TRUE, }, { MV_GPIO_DRIVER_TYPE_PCA95XX, ARMADA_70x0_DB_IO_EXPANDER0, ARMADA_70x0_DB_VBUS1_PIN, TRUE, }, { MV_GPIO_DRIVER_TYPE_PCA95XX, ARMADA_70x0_DB_IO_EXPANDER0, ARMADA_70x0_DB_VBUS1_LIMIT_PIN, TRUE, }, }; STATIC EFI_STATUS EFIAPI XhciInit ( IN NON_DISCOVERABLE_DEVICE *This ) { return ConfigurePins (mXhciVbusPins, ARRAY_SIZE (mXhciVbusPins), MV_GPIO_DRIVER_TYPE_PCA95XX); } STATIC CONST MV_GPIO_PIN mCp0SdMmcPins[] = { { MV_GPIO_DRIVER_TYPE_PCA95XX, ARMADA_70x0_DB_IO_EXPANDER0, ARMADA_70x0_DB_SDMMC_CP0_VCCQ_PIN, TRUE, }, }; STATIC EFI_STATUS EFIAPI Cp0SdMmcInit ( IN NON_DISCOVERABLE_DEVICE *This ) { return ConfigurePins (mCp0SdMmcPins, ARRAY_SIZE (mCp0SdMmcPins), MV_GPIO_DRIVER_TYPE_PCA95XX); } NON_DISCOVERABLE_DEVICE_INIT EFIAPI NonDiscoverableDeviceInitializerGet ( IN NON_DISCOVERABLE_DEVICE_TYPE Type, IN UINTN Index ) { if (Type == NonDiscoverableDeviceTypeXhci) { return XhciInit; } if (Type == NonDiscoverableDeviceTypeSdhci) { switch (Index) { case 1: return Cp0SdMmcInit; } } return NULL; }