SmartPDCode/truing_control/PDU-AC/hardware/electricity/electricity.c

#include "electricity.h"
#include "uart.h"
#include "common.h"
#include "board_cfg.h"
#include "Hlw8110.h"
#include "relay.h"
#include "ADC.h"

static board_t *board = 0;
static void read_ele(uint8_t channel);
static void check_wanning(uint8_t in_out,uint8_t channel);
static void opt_over_func(uint8_t channel);

extern float   F_AC_V;													
extern float   F_AC_I;													
extern float   F_AC_P;													
extern float   F_AC_LINE_Freq;     							
extern float   F_AC_E;													
extern float   F_AC_PF;		

extern uint32_t adc_Avg_value[ADC_CH_N];

float elec[RelaySlaveChaNum] = {0.0};

void electricity_init(void)
{
	board = get_board();
#if (POWER_TYPE == POWER_DC)
	che442e_Init();
	Init_ADC();
	uart1_config(115200);

#else
	uart1_config(9600);
	ch448f_config();
	
	for(int i = 0 ; i < RelaySlaveChaNum;i++)
	{
		select_channel(i);
		Init_HLW8110();
	}
#endif
	board->read_ele = read_ele;
	board->check_wanning = check_wanning;
	board->opt_overfunc = opt_over_func;
}





static void read_ele(uint8_t channel)
{

	if(channel < RelaySlaveChaNum)
	{
#if (POWER_TYPE == POWER_DC)
		if(channel >=4)
		{
			board->md_data.r_data.r_d.ele_out[channel].voltage = read_voltage(STM32_ADC_V_2);
		}else
		{
			board->md_data.r_data.r_d.ele_out[channel].voltage = read_voltage(STM32_ADC_V_1);
		}
		read_adc_val();
		board->md_data.r_data.r_d.ele_out[channel].current = DC_I_calfunction(adc_Avg_value[channel],channel);
		uint32_t temp_v;
		uint32_t temp_i;
		temp_v = board->md_data.r_data.r_d.ele_out[channel].voltage / 10;
		temp_i = board->md_data.r_data.r_d.ele_out[channel].current / 10;
		board->md_data.r_data.r_d.ele_out[channel].power = (temp_v * temp_i) / 10;	
#else
		select_channel(channel);
		Calculate_HLW8110_MeterData();
		board->md_data.r_data.r_d.ele_out[channel].voltage = F_AC_V * 1000;
		board->md_data.r_data.r_d.ele_out[channel].current = F_AC_I * 1000;
		board->md_data.r_data.r_d.ele_out[channel].power = F_AC_P * 1000;
		board->md_data.r_data.r_d.ele_out[channel].freq = F_AC_LINE_Freq * 100;
		board->md_data.r_data.r_d.ele_out[channel].factor = F_AC_PF * 100;
		elec[channel] += F_AC_E;
		board->md_data.r_data.r_d.ele_out[channel].consumer = board->ele_restore[channel] + elec[channel] * 1000;

		if(board->md_data.r_data.r_d.ele_out[channel].voltage < 100)
		{
			board->md_data.r_data.r_d.ele_out[channel].voltage = 0;
			board->md_data.r_data.r_d.ele_out[channel].current = 0;
			board->md_data.r_data.r_d.ele_out[channel].power = 0;
			board->md_data.r_data.r_d.ele_out[channel].factor = 0;
			board->md_data.r_data.r_d.ele_out[channel].freq = 0;
		}else if(board->md_data.r_data.r_d.ele_out[channel].factor < 1)
		{
			board->md_data.r_data.r_d.ele_out[channel].current = 0;
			board->md_data.r_data.r_d.ele_out[channel].power = 0;
			board->md_data.r_data.r_d.ele_out[channel].factor = 0;
		}
#endif
	}
}

static void check_wanning(uint8_t in_out,uint8_t channel)
{
	if(in_out == ELE_INPUT)
	{
			if(IS_VOLTAGE_MAX_EN(board->in_wanning_en[channel]) && 
						(board->md_data.r_data.r_d.ele_3_in.info[channel].voltage > board->md_data.rw_data.rw_d.th_in[channel].th_voltage_max))
			{
				SET_WANNING_VOLTAGE_MAX(board->md_data.r_data.r_d.ele_3_in.info[channel].wanning);
			}else
			{
				UNSET_WANNING_VOLTAGE_MAX(board->md_data.r_data.r_d.ele_3_in.info[channel].wanning);
			}
			if(IS_VOLTAGE_MIN_EN(board->in_wanning_en[channel]) && 
							board->md_data.r_data.r_d.ele_3_in.info[channel].voltage < board->md_data.rw_data.rw_d.th_in[channel].th_voltage_min)
			{
				SET_WANNING_VOLTAGE_MIN(board->md_data.r_data.r_d.ele_3_in.info[channel].wanning);
			}else
			{
				UNSET_WANNING_VOLTAGE_MIN(board->md_data.r_data.r_d.ele_3_in.info[channel].wanning);
			}
			if(IS_CURRENT_MAX_EN(board->in_wanning_en[channel]) && 
							board->md_data.r_data.r_d.ele_3_in.info[channel].current > board->md_data.rw_data.rw_d.th_in[channel].th_current_max)
			{
				SET_WANNING_CURRENT_MAX(board->md_data.r_data.r_d.ele_3_in.info[channel].wanning);
			}else
			{
				UNSET_WANNING_CURRENT_MAX(board->md_data.r_data.r_d.ele_3_in.info[channel].wanning);
			}			
			if(IS_POWER_MAX_EN(board->in_wanning_en[channel]) && 
							board->md_data.r_data.r_d.ele_3_in.info[channel].power > board->md_data.rw_data.rw_d.th_in[channel].th_power_max)
			{
				SET_WANNING_POWER_MAX(board->md_data.r_data.r_d.ele_3_in.info[channel].wanning);
			}else
			{
				UNSET_WANNING_POWER_MAX(board->md_data.r_data.r_d.ele_3_in.info[channel].wanning);
			}			
			
			if(IS_CONSUMER_MAX_EN(board->in_wanning_en[channel]) && 
							board->md_data.r_data.r_d.ele_3_in.info[channel].consumer > board->md_data.rw_data.rw_d.th_in[channel].th_consumer_max)
			{
				SET_WANNING_CONSUMER_MAX(board->md_data.r_data.r_d.ele_3_in.info[channel].wanning);
			}else
			{
				UNSET_WANNING_CONSUMER_MAX(board->md_data.r_data.r_d.ele_3_in.info[channel].wanning);
			}				
			
		
	}else
	{
			if(channel < RelaySlaveChaNum)
			{
				if(IS_VOLTAGE_MAX_EN(board->out_wanning_en[channel]) && 
								board->md_data.r_data.r_d.ele_out[channel].voltage > board->md_data.rw_data.rw_d.th_out[channel].th_voltage_max)
				{
					SET_WANNING_VOLTAGE_MAX(board->md_data.r_data.r_d.ele_out[channel].wanning);
					if(IS_OVERFUNC_VOLTAGE_MAX(board->md_data.rw_data.rw_d.over_func_out[channel]))
					{
						board->over_func[channel] = 1;
					}
				}else
				{
					UNSET_WANNING_VOLTAGE_MAX(board->md_data.r_data.r_d.ele_out[channel].wanning);
				}
				
				if(IS_VOLTAGE_MIN_EN(board->out_wanning_en[channel]) && 
								board->md_data.r_data.r_d.ele_out[channel].voltage < board->md_data.rw_data.rw_d.th_out[channel].th_voltage_min)
				{
					SET_WANNING_VOLTAGE_MIN(board->md_data.r_data.r_d.ele_out[channel].wanning);
					if(IS_OVERFUNC_VOLTAGE_MIN(board->md_data.rw_data.rw_d.over_func_out[channel]))
					{
						board->over_func[channel] = 1;
					}
				}else
				{
					UNSET_WANNING_VOLTAGE_MIN(board->md_data.r_data.r_d.ele_out[channel].wanning);
				}
				
				if(IS_CURRENT_MAX_EN(board->out_wanning_en[channel]) && 
								board->md_data.r_data.r_d.ele_out[channel].current > board->md_data.rw_data.rw_d.th_out[channel].th_current_max)
				{
					SET_WANNING_CURRENT_MAX(board->md_data.r_data.r_d.ele_out[channel].wanning);
					if(IS_OVERFUNC_CURRENT_MAX(board->md_data.rw_data.rw_d.over_func_out[channel]))
					{
						board->over_func[channel] = 1;
					}
				}else
				{
					UNSET_WANNING_CURRENT_MAX(board->md_data.r_data.r_d.ele_out[channel].wanning);
				}

				if(IS_POWER_MAX_EN(board->out_wanning_en[channel]) && 
								board->md_data.r_data.r_d.ele_out[channel].voltage > board->md_data.rw_data.rw_d.th_out[channel].th_power_max)
				{
					SET_WANNING_POWER_MAX(board->md_data.r_data.r_d.ele_out[channel].wanning);
					if(IS_OVERFUNC_POWER_MAX(board->md_data.rw_data.rw_d.over_func_out[channel]))
					{
						board->over_func[channel] = 1;
					}
				}else
				{
					UNSET_WANNING_POWER_MAX(board->md_data.r_data.r_d.ele_out[channel].wanning);
				}

				if(IS_CONSUMER_MAX_EN(board->out_wanning_en[channel]) && 
								board->md_data.r_data.r_d.ele_out[channel].voltage > board->md_data.rw_data.rw_d.th_out[channel].th_consumer_max)
				{
					SET_WANNING_CONSUMER_MAX(board->md_data.r_data.r_d.ele_out[channel].wanning);
					if(IS_OVERFUNC_CONSUMER_MAX(board->md_data.rw_data.rw_d.over_func_out[channel]))
					{
						board->over_func[channel] = 1;
					}
				}else
				{
					UNSET_WANNING_CONSUMER_MAX(board->md_data.r_data.r_d.ele_out[channel].wanning);
				}
			}
	}
}


static void opt_over_func(uint8_t channel)
{
#if (POWER_TYPE == POWER_AC_3_1 || POWER_TYPE == POWER_AC || POWER_TYPE == POWER_DC)
	if(board->over_func[channel])
	{
		board->over_func[channel] = 0;
		if(board->md_data.rw_data.rw_d.relay_status[channel] == RELAY_OPEN && board->md_data.rw_data.rw_d.chn_ctrl[channel] == 0)
		{
				async_data da = {0};
				da.channel = channel;
				da.fire_or_zero = _FIRE;
				da.method = PROMPT_CTRL;
				da.reg = &board->relay_staging_staus[channel];
				da.status = RELAY_CLOSE;
				da.w_eep_flag = FLAG_N_W_EEP;
				set_relay_sta_async(&da);				
		}
	}
#elif (POWER_TYPE == POWER_AC_3_3)
	if((channel+1) % 3 == 0)
	{
		if(board->over_func[channel] || board->over_func[channel-1] || board->over_func[channel-2])
		{
			if(	board->md_data.rw_data.rw_d.relay_status[channel ] == RELAY_OPEN ||
					board->md_data.rw_data.rw_d.relay_status[channel-1] == RELAY_OPEN ||
					board->md_data.rw_data.rw_d.relay_status[channel-2] == RELAY_OPEN)
			{
				async_data da = {0};
				if(board->md_data.rw_data.rw_d.relay_status[channel ] == RELAY_OPEN && 
						board->md_data.rw_data.rw_d.chn_ctrl[channel] == 0)
				{
					da.channel = channel;
					da.fire_or_zero = _FIRE;
					da.method = PROMPT_CTRL;
					da.reg = &board->relay_staging_staus[channel];
					da.status = RELAY_CLOSE;
					da.w_eep_flag = FLAG_N_W_EEP;
					set_relay_sta_async(&da);
				}
				if(board->md_data.rw_data.rw_d.relay_status[channel-1]  == RELAY_OPEN && 
						board->md_data.rw_data.rw_d.chn_ctrl[channel-1] == 0)
				{				
					da.channel = channel-1;
					da.fire_or_zero = _FIRE;
					da.method = PROMPT_CTRL;
					da.reg = &board->relay_staging_staus[channel-1];
					da.status = RELAY_CLOSE;
					da.w_eep_flag = FLAG_N_W_EEP;
					set_relay_sta_async(&da);	
				}					
				if(board->md_data.rw_data.rw_d.relay_status[channel-2] == RELAY_OPEN && 
						board->md_data.rw_data.rw_d.chn_ctrl[channel-2] == 0)
				{
					da.channel = channel-2;
					da.fire_or_zero = _FIRE;
					da.method = PROMPT_CTRL;
					da.reg = &board->relay_staging_staus[channel-2];
					da.status = RELAY_CLOSE;
					da.w_eep_flag = FLAG_N_W_EEP;
					set_relay_sta_async(&da);	
				}
			}
				board->over_func[channel] = 0;
				board->over_func[channel-1] =0;
				board->over_func[channel-2] =0;
		}
	}
	
	
	
#endif
}