/**
 * @file    pin_repository.cpp
 * @brief   I/O pin registry code
 *
 * This job of this class is to make sure that we are not using same hardware pin for two
 * different purposes.
 *
 * @date Jan 15, 2013
 * @author Andrey Belomutskiy, (c) 2012-2020
 */

#include "pch.h"

unsigned int getBrainPinTotalNum(void) {
	return BRAIN_PIN_TOTAL_PINS;
}

const char* & getBrainUsedPin(unsigned int idx) {
	/*if (idx >= getBrainPinTotalNum())
		return NULL;*/
	return engine->pinRepository.PIN_USED[idx];
}

/* Common for firmware and unit tests */
bool isBrainPinValid(brain_pin_e brainPin) {
	if ((brainPin == Gpio::Unassigned) || (brainPin == Gpio::Invalid))
		return false;

	if (brainPin > BRAIN_PIN_LAST)
		/* something terribly wrong */
		return false;

	return true;
}

int brainPin_to_index(brain_pin_e brainPin) {
	unsigned int i;

	if (brainPin < Gpio::A0)
		return -1;

	i = brainPin - Gpio::A0;

	if (i >= getBrainPinTotalNum())
		return -1;

	return i;
}

/**
 * See also brain_pin_markUnused()
 * @return true if this pin was already used, false otherwise
 */

bool brain_pin_markUsed(brain_pin_e brainPin, const char *msg) {
#if ! EFI_BOOTLOADER
	efiPrintf("pin_markUsed: %s on %s", msg, hwPortname(brainPin));
#endif

	int index = brainPin_to_index(brainPin);
	if (index < 0)
		return true;

	if (getBrainUsedPin(index) != NULL) {
		/* TODO: get readable name of brainPin... */
		firmwareError(CUSTOM_ERR_PIN_ALREADY_USED_1, "Pin \"%s\" required by \"%s\" but is used by \"%s\" %s",
				hwPortname(brainPin),
				msg,
				getBrainUsedPin(index),
				getEngine_type_e(engineConfiguration->engineType));
		return true;
	}

	getBrainUsedPin(index) = msg;
	engine->pinRepository.totalPinsUsed++;
	return false;
}

/**
 * See also brain_pin_markUsed()
 */

void brain_pin_markUnused(brain_pin_e brainPin) {
#if ! EFI_BOOTLOADER
	efiPrintf("pin_markUnused: %s", hwPortname(brainPin));
#endif
	int index = brainPin_to_index(brainPin);
	if (index < 0)
		return;

	if (getBrainUsedPin(index) != nullptr)
		engine->pinRepository.totalPinsUsed--;
	getBrainUsedPin(index) = nullptr;
}

#if EFI_PROD_CODE
#include "memstreams.h"
static MemoryStream portNameStream;
static char portNameBuffer[20];
#endif /* EFI_PROD_CODE */

PinRepository::PinRepository() {
#if EFI_PROD_CODE
	msObjectInit(&portNameStream, (uint8_t*) portNameBuffer, sizeof(portNameBuffer), 0);
#endif /* EFI_PROD_CODE */

	memset(PIN_USED, 0, sizeof(PIN_USED));
}

#if EFI_PROD_CODE
#include "os_access.h"
#include "eficonsole.h"
#include "drivers/gpio/gpio_ext.h"
#include "smart_gpio.h"
#include "hardware.h"

void pinDiag2string(char *buffer, size_t size, brain_pin_diag_e pin_diag) {
	/* use autogeneraged helpers here? */
	if (pin_diag == PIN_OK) {
		chsnprintf(buffer, size, "Ok");
	} else if (pin_diag != PIN_INVALID) {
		chsnprintf(buffer, size, "%s%s%s%s%s%s",
			pin_diag & PIN_DRIVER_OFF ? "driver_off " : "",
			pin_diag & PIN_OPEN ? "open_load " : "",
			pin_diag & PIN_SHORT_TO_GND ? "short_to_gnd " : "",
			pin_diag & PIN_SHORT_TO_BAT ? "short_to_bat " : "",
			pin_diag & PIN_OVERLOAD ? "overload " : "",
			pin_diag & PIN_DRIVER_OVERTEMP ? "overtemp": "");
	} else {
		chsnprintf(buffer, size, "INVALID");
	}
}

static brain_pin_e index_to_brainPin(unsigned int i)
{
	if (i < getBrainPinTotalNum())
		return Gpio::A0 + i;

	return Gpio::Invalid;
}

static void reportPins() {
	for (unsigned int i = 0; i < getBrainPinOnchipNum(); i++) {
		const char *pin_user = getBrainUsedPin(i);

		/* show used pins */
		if (pin_user != NULL) {
			brain_pin_e brainPin = index_to_brainPin(i);
			int pin = getBrainPinIndex(brainPin);
			ioportid_t port = getBrainPinPort(brainPin);

			efiPrintf("pin %s%d: %s", portname(port), pin, pin_user);
		}
	}

	#if (BOARD_EXT_GPIOCHIPS > 0)
		for (unsigned int i = getBrainPinOnchipNum() ; i < getBrainPinTotalNum(); i++) {
			static char pin_error[64];
			brain_pin_e brainPin = index_to_brainPin(i);

			const char *pin_name = gpiochips_getPinName(brainPin);
			const char *pin_user = getBrainUsedPin(i);
			brain_pin_diag_e pin_diag = gpiochips_getDiag(brainPin);

			pinDiag2string(pin_error, sizeof(pin_error), pin_diag);

			/* here show all pins, unused too */
			if (pin_name != NULL) {
				// this probably uses a lot of output buffer!
				efiPrintf("ext %s: %s diagnostic: %s",
					pin_name, pin_user ? pin_user : "free", pin_error);
			} else {
				const char *chip_name = gpiochips_getChipName(brainPin);
				/* if chip exist */
				if (chip_name != NULL) {
					efiPrintf("ext %s.%d: %s diagnostic: %s",
						chip_name, gpiochips_getPinOffset(brainPin), pin_user ? pin_user : "free", pin_error);
				}
			}
		}
	#endif

	efiPrintf("Total pins count: %d", engine->pinRepository.totalPinsUsed);
}

void printSpiConfig(const char *msg, spi_device_e device) {
#if HAL_USE_SPI
	efiPrintf("%s %s mosi=%s", msg, getSpi_device_e(device), hwPortname(getMosiPin(device)));
	efiPrintf("%s %s miso=%s", msg, getSpi_device_e(device), hwPortname(getMisoPin(device)));
	efiPrintf("%s %s sck=%s",  msg, getSpi_device_e(device), hwPortname(getSckPin(device)));
#endif // HAL_USE_SPI
}

__attribute__((weak)) const char * getBoardSpecificPinName(brain_pin_e /*brainPin*/) {
	return nullptr;
}

const char *hwPortname(brain_pin_e brainPin) {
	if (brainPin == Gpio::Invalid) {
		return "INVALID";
	}
	if (brainPin == Gpio::Unassigned) {
		return "NONE";
	}
	const char * boardSpecificPinName = getBoardSpecificPinName(brainPin);
	if (boardSpecificPinName != nullptr) {
		return boardSpecificPinName;
	}

	portNameStream.eos = 0; // reset
	if (brain_pin_is_onchip(brainPin)) {

		ioportid_t hwPort = getHwPort("hostname", brainPin);
		if (hwPort == GPIO_NULL) {
			return "NONE";
		}
		int hwPin = getHwPin("hostname", brainPin);
		chprintf((BaseSequentialStream *) &portNameStream, "%s%d", portname(hwPort), hwPin);
	}
	#if (BOARD_EXT_GPIOCHIPS > 0)
		else {

			const char *pin_name = gpiochips_getPinName(brainPin);

			if (pin_name) {
				chprintf((BaseSequentialStream *) &portNameStream, "ext:%s",
					pin_name);
			} else {
				chprintf((BaseSequentialStream *) &portNameStream, "ext:%s.%d",
					gpiochips_getChipName(brainPin), gpiochips_getPinOffset(brainPin));
			}
		}
	#endif
	portNameStream.buffer[portNameStream.eos] = 0; // need to terminate explicitly

	return portNameBuffer;
}

void initPinRepository(void) {
	/**
	 * this method cannot use console because this method is invoked before console is initialized
	 */

	addConsoleAction(CMD_PINS, reportPins);

#if (BOARD_TLE8888_COUNT > 0)
	addConsoleAction("tle8888", tle8888_dump_regs);
	addConsoleAction("tle8888init", tle8888_req_init);
#endif
}

bool brain_pin_is_onchip(brain_pin_e brainPin)
{
	if ((brainPin < Gpio::A0) || (brainPin > BRAIN_PIN_ONCHIP_LAST))
		return false;

	return true;
}

bool brain_pin_is_ext(brain_pin_e brainPin)
{
	if (brainPin > BRAIN_PIN_ONCHIP_LAST)
		return true;

	return false;
}

/**
 * Marks on-chip gpio port-pin as used. Works only for on-chip gpios
 * To be replaced with brain_pin_markUsed later
 */

bool gpio_pin_markUsed(ioportid_t port, ioportmask_t pin, const char *msg) {
	int index = getPortPinIndex(port, pin);

	if (getBrainUsedPin(index) != NULL) {
		/**
		 * todo: the problem is that this warning happens before the console is even
		 * connected, so the warning is never displayed on the console and that's quite a problem!
		 */
//		warning(OBD_PCM_Processor_Fault, "%s%d req by %s used by %s", portname(port), pin, msg, getBrainUsedPin(index));
		firmwareError(CUSTOM_ERR_PIN_ALREADY_USED_1, "%s%d req by %s used by %s", portname(port), pin, msg, getBrainUsedPin(index));
		return true;
	}
	getBrainUsedPin(index) = msg;
	engine->pinRepository.totalPinsUsed++;
	return false;
}

/**
 * Marks on-chip gpio port-pin as UNused. Works only for on-chip gpios
 * To be replaced with brain_pin_markUnused later
 */

void gpio_pin_markUnused(ioportid_t port, ioportmask_t pin) {
	int index = getPortPinIndex(port, pin);

	if (getBrainUsedPin(index) != NULL)
		engine->pinRepository.totalPinsUsed--;
	getBrainUsedPin(index) = nullptr;
}

const char *getPinFunction(brain_input_pin_e brainPin) {
	int index;

	index = brainPin_to_index(brainPin);
	if (index < 0)
		return NULL;

	return getBrainUsedPin(index);
}
#else
const char *hwPortname(brain_pin_e brainPin) {
	(void)brainPin;
	return "N/A";
}
#endif /* EFI_PROD_CODE */