/**
*
*  Copyright (c) 2017, Linaro Ltd. All rights reserved.
*  Copyright (c) 2019, Marvell International Ltd. All rights reserved.
*
*  SPDX-License-Identifier: BSD-2-Clause-Patent
*
**/

#include <Uefi.h>

#include <Library/DebugLib.h>
#include <Library/DevicePathLib.h>
#include <Library/IoLib.h>
#include <Library/MemoryAllocationLib.h>
#include <Library/MvGpioLib.h>
#include <Library/NonDiscoverableDeviceRegistrationLib.h>
#include <Library/UefiBootServicesTableLib.h>

#include <Protocol/NonDiscoverableDevice.h>

#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 mCp0XhciVbusPins[] = {
  {
    MV_GPIO_DRIVER_TYPE_PCA95XX,
    CN9130_DB_IO_EXPANDER0,
    CN9130_DB_VBUS0_PIN,
    TRUE,
  },
  {
    MV_GPIO_DRIVER_TYPE_PCA95XX,
    CN9130_DB_IO_EXPANDER0,
    CN9130_DB_VBUS0_LIMIT_PIN,
    TRUE,
  },
  {
    MV_GPIO_DRIVER_TYPE_PCA95XX,
    CN9130_DB_IO_EXPANDER0,
    CN9130_DB_VBUS1_PIN,
    TRUE,
  },
  {
    MV_GPIO_DRIVER_TYPE_PCA95XX,
    CN9130_DB_IO_EXPANDER0,
    CN9130_DB_VBUS1_LIMIT_PIN,
    TRUE,
  },
};

STATIC
EFI_STATUS
EFIAPI
Cp0XhciInit (
  IN  NON_DISCOVERABLE_DEVICE  *This
  )
{
  return ConfigurePins (mCp0XhciVbusPins,
           ARRAY_SIZE (mCp0XhciVbusPins),
           MV_GPIO_DRIVER_TYPE_PCA95XX);
}

STATIC CONST MV_GPIO_PIN mCp1XhciVbusPins[] = {
  {
    MV_GPIO_DRIVER_TYPE_SOC_CONTROLLER,
    MV_GPIO_CP1_CONTROLLER0,
    CN9131_DB_VBUS0_PIN,
    TRUE,
  },
  {
    MV_GPIO_DRIVER_TYPE_SOC_CONTROLLER,
    MV_GPIO_CP1_CONTROLLER0,
    CN9131_DB_VBUS0_LIMIT_PIN,
    TRUE,
  },
};

STATIC
EFI_STATUS
EFIAPI
Cp1XhciInit (
  IN  NON_DISCOVERABLE_DEVICE  *This
  )
{
  return ConfigurePins (mCp1XhciVbusPins,
           ARRAY_SIZE (mCp1XhciVbusPins),
           MV_GPIO_DRIVER_TYPE_SOC_CONTROLLER);
}

STATIC CONST MV_GPIO_PIN mCp2XhciVbusPins[] = {
  {
    MV_GPIO_DRIVER_TYPE_SOC_CONTROLLER,
    MV_GPIO_CP2_CONTROLLER0,
    CN9132_DB_VBUS0_PIN,
    TRUE,
  },
  {
    MV_GPIO_DRIVER_TYPE_SOC_CONTROLLER,
    MV_GPIO_CP2_CONTROLLER0,
    CN9132_DB_VBUS0_LIMIT_PIN,
    TRUE,
  },
  {
    MV_GPIO_DRIVER_TYPE_SOC_CONTROLLER,
    MV_GPIO_CP2_CONTROLLER0,
    CN9132_DB_VBUS1_PIN,
    TRUE,
  },
  {
    MV_GPIO_DRIVER_TYPE_SOC_CONTROLLER,
    MV_GPIO_CP2_CONTROLLER0,
    CN9132_DB_VBUS1_LIMIT_PIN,
    TRUE,
  },
};

STATIC
EFI_STATUS
EFIAPI
Cp2XhciInit (
  IN  NON_DISCOVERABLE_DEVICE  *This
  )
{
  return ConfigurePins (mCp2XhciVbusPins,
           ARRAY_SIZE (mCp2XhciVbusPins),
           MV_GPIO_DRIVER_TYPE_SOC_CONTROLLER);
}

STATIC CONST MV_GPIO_PIN mApSdMmcPins[] = {
  {
    MV_GPIO_DRIVER_TYPE_PCA95XX,
    CN9130_DB_IO_EXPANDER0,
    CN9130_DB_AP_MMC_VCCQ_PIN,
    TRUE,
  },
};

STATIC
EFI_STATUS
EFIAPI
ApSdMmcInit (
  IN  NON_DISCOVERABLE_DEVICE  *This
  )
{
  return ConfigurePins (mApSdMmcPins,
           ARRAY_SIZE (mApSdMmcPins),
           MV_GPIO_DRIVER_TYPE_PCA95XX);
}

STATIC CONST MV_GPIO_PIN mCp0SdMmcPins[] = {
  {
    MV_GPIO_DRIVER_TYPE_PCA95XX,
    CN9130_DB_IO_EXPANDER0,
    CN9130_DB_SDMMC_VCC_PIN,
    TRUE,
  },
  {
    MV_GPIO_DRIVER_TYPE_PCA95XX,
    CN9130_DB_IO_EXPANDER0,
    CN9130_DB_SDMMC_VCCQ_PIN,
    FALSE,
  },
};

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) {
    switch (Index) {
    case 0:
    case 1:
      return Cp0XhciInit;
    case 2:
      return Cp1XhciInit;
    case 3:
    case 4:
      return Cp2XhciInit;
    }
  }

  if (Type == NonDiscoverableDeviceTypeSdhci) {
    switch (Index) {
    case 0:
      return ApSdMmcInit;
    case 1:
      return Cp0SdMmcInit;
    }
  }

  return NULL;
}