/*
 * channel_control.c
 *
 *  Created on: Mar 10, 2025
 *      Author: janek
 */

#include "channel_control.h"
#include "current_monitoring.h"
#include "main.h"

extern enable_gpios update_ports;
extern current_measurements current_measurements_adc_val;

extern int inhibit_SDC;
volatile int prev_epsc_state;

void ChannelControl_init(){
	update_ports.porta.porta = 0;
	update_ports.portb.portb = 0;
	update_ports.portb.alwayson = 1;
	ChannelControl_UpdateGPIOs(update_ports);
	prev_epsc_state = 0;
}


void ChannelControl_UpdateGPIOs(enable_gpios UpdatePorts){
	UpdatePorts.portb.alwayson = 1;								// ensure always on stays always on
	if (inhibit_SDC == 1){
		UpdatePorts.portb.sdc = 0;
		HAL_GPIO_WritePin(LED1_GPIO_Port, LED1_Pin, 1);
	}
	HAL_GPIO_WritePin(IN1_GPIO_Port, IN1_Pin, (GPIO_PinState)UpdatePorts.porta.acc_cooling);	// Acc-Cooling
	HAL_GPIO_WritePin(IN2_GPIO_Port, IN2_Pin, (GPIO_PinState)UpdatePorts.porta.ts_cooling);		// TS-Cooling
	HAL_GPIO_WritePin(IN3_GPIO_Port, IN3_Pin, (GPIO_PinState)UpdatePorts.porta.drs);			// DRS
	HAL_GPIO_WritePin(IN4_GPIO_Port, IN4_Pin, (GPIO_PinState)UpdatePorts.porta.acu);			// ACU

	if (prev_epsc_state == 0 && UpdatePorts.porta.epsc == 1){
		HAL_GPIO_WritePin(PC_EN_GPIO_Port, PC_EN_Pin, 1);														// enable precharge
		if (current_measurements_adc_val.epsc_precharge >= (0.95f * current_measurements_adc_val.asms_v)) {		// check if precharge is complete (no while loop needed, this function is called by the main while-loop)
			HAL_GPIO_WritePin(IN5_GPIO_Port, IN5_Pin, (GPIO_PinState)UpdatePorts.porta.epsc);					// switch on PROFET
			HAL_GPIO_WritePin(PC_EN_GPIO_Port, PC_EN_Pin, 0);													// disengage precharge
			prev_epsc_state = UpdatePorts.porta.epsc;
		}
	}
	if ((prev_epsc_state == 1 && UpdatePorts.porta.epsc == 0) || (prev_epsc_state == UpdatePorts.porta.epsc)){
		HAL_GPIO_WritePin(PC_EN_GPIO_Port, PC_EN_Pin, 0);														// ensure precharge is disabled, when not needed or stopped before completion
		HAL_GPIO_WritePin(IN5_GPIO_Port, IN5_Pin, (GPIO_PinState)UpdatePorts.porta.epsc);
		prev_epsc_state = UpdatePorts.porta.epsc;
	}

	HAL_GPIO_WritePin(IN6_GPIO_Port, IN6_Pin, (GPIO_PinState)UpdatePorts.porta.inverter);		// inverter
	HAL_GPIO_WritePin(IN7_GPIO_Port, IN7_Pin, (GPIO_PinState)UpdatePorts.porta.lidar);			// lidar
	HAL_GPIO_WritePin(IN8_GPIO_Port, IN8_Pin, (GPIO_PinState)UpdatePorts.porta.misc);			// MISC
	HAL_GPIO_WritePin(IN9_GPIO_Port, IN9_Pin, (GPIO_PinState)UpdatePorts.portb.alwayson);		// always on
	HAL_GPIO_WritePin(IN10_GPIO_Port, IN10_Pin, (GPIO_PinState)UpdatePorts.portb.sdc);			// SDC
	HAL_GPIO_WritePin(IN11_GPIO_Port, IN11_Pin, (GPIO_PinState)UpdatePorts.portb.ebs1);			// EBS 1
	HAL_GPIO_WritePin(IN12_GPIO_Port, IN12_Pin, (GPIO_PinState)UpdatePorts.portb.ebs2);			// EBS 2
	HAL_GPIO_WritePin(IN13_GPIO_Port, IN13_Pin, (GPIO_PinState)UpdatePorts.portb.ebs3);			// EBS 3
}