#include "gpiodriver.h"

void MyGPIO_Init(MyGPIO_Struct_TypeDef * GPIOStructPtr)
{
	uint8_t voyons = GPIOStructPtr->GPIO_Pin;
	RCC->APB2ENR |= GPIO2Int(GPIOStructPtr->GPIO);
	//We get the pointer of the CRH/CRL depending on the IO_Pin number
	volatile uint32_t * CRAny = GPIOStructPtr->GPIO_Pin > 0x08 ? &(GPIOStructPtr->GPIO->CRH):&(GPIOStructPtr->GPIO->CRL);
	//setup high or low
	*CRAny &= ~(0xF << (GPIOStructPtr->GPIO_Pin%8)*4);											//reset
	//for input pull or push
	switch(GPIOStructPtr->GPIO_Conf)
	{
		case In_PullUp:
			GPIOStructPtr->GPIO->ODR |= (0x01 << GPIOStructPtr->GPIO_Pin);	//if pullup -> ODR = 1
			*CRAny |= (In_PullDown << (GPIOStructPtr->GPIO_Pin%8)*4);	//set pin mode -> force to In_PullDown because PullDown is modified
			break;
		case In_PullDown:
			GPIOStructPtr->GPIO->ODR &= ~(0x01 << GPIOStructPtr->GPIO_Pin);	//if pullup -> ODR = 0
		default:
			*CRAny |= (GPIOStructPtr->GPIO_Conf << (GPIOStructPtr->GPIO_Pin%8)*4);	//set pin mode for any input/output
			break;	
	}
}

int MyGPIO_Read(GPIO_TypeDef * GPIO, uint8_t GPIO_Pin)
{
	return 0;
}

void MyGPIO_Set(GPIO_TypeDef * GPIO, uint8_t GPIO_Pin)
{
	
}

void MyGPIO_Reset(GPIO_TypeDef * GPIO, uint8_t GPIO_Pin)
{
	
}

void MyGPIO_Toggle(GPIO_TypeDef * GPIO, uint8_t GPIO_Pin)
{
	
}

int GPIO2Int(GPIO_TypeDef * GPIOX)
{
	if(GPIOX == GPIOA)
	{
		return (0x01 << 2);
	} else if (GPIOX == GPIOB){
		return (0x01 << 3);
	} else if (GPIOX == GPIOC){
		return (0x01 << 4);
	} else if (GPIOX == GPIOD){
		return (0x01 << 5);
	} else if (GPIOX == GPIOE){
		return (0x01 << 6);
	} else if (GPIOX == GPIOF){
		return (0x01 << 7);
	} else if (GPIOX == GPIOE){
		return (0x01 << 8);
	} else {
		return -1;
	};
}