SmartPDCode/truing_control/PDU-AC/common/common.c

#include "common.h"
#include "board_cfg.h"

#if EEPROM_TEST		

#define TEST_ADDR  (120 * 32)
#define LENTH      (32)

#endif



void reset_config_for_eeprom(void)
{
	board_t *board = get_board();
	if(board)
	{
		//board->write_eeprom_page(EEPROM_DEVICES_ADDR,(uint8_t *)&board->md_data.r_data.r_d.dev_chn,EEPROM_DEVICES_LENTH);
		
		//board->write_eeprom_page(EEPROM_STATUS_ADDR,(uint8_t *)&board->relay_staging_staus[0],EEPROM_STATUS_LENTH);
#if (POWER_TYPE == POWER_AC_3_3)
			int p = 0;
			for(int i = 0; i < MAX_CHANNEL;i+=3)
			{
				board->md_data.rw_data.rw_d.delay_chn[i].delay_open  = (1+p) *100;
				board->md_data.rw_data.rw_d.delay_chn[i].delay_close = (1+p) *100;
				
				board->md_data.rw_data.rw_d.delay_chn[i+1].delay_open  = (1+p) *100;
				board->md_data.rw_data.rw_d.delay_chn[i+1].delay_close = (1+p) *100;
				
				board->md_data.rw_data.rw_d.delay_chn[i+2].delay_open  = (1+p) *100;
				board->md_data.rw_data.rw_d.delay_chn[i+2].delay_close = (1+p) *100;

				board->md_data.rw_data.rw_d.combin_chn[i/3].delay_open = (1+p) *100;
				board->md_data.rw_data.rw_d.combin_chn[i/3].delay_close = (1+p) *100;
				
				p++;
			}
	#if (ZERO_CONTRL == ZERO_LINE_CTRL_YES)
			for(int i = 0; i < 3;i++)
			{
				board->md_data.rw_data.rw_d.zero_chn[i].delay_open  = (1+i) *100;
				board->md_data.rw_data.rw_d.zero_chn[i].delay_close = (1+i) *100;				
			}
	#endif
#elif (POWER_TYPE == POWER_AC_3_2)
			
			
#else
			for(int i = 0; i < MAX_CHANNEL;i++)
			{
				board->md_data.rw_data.rw_d.delay_chn[i].delay_open  = (1+i) *100;
				board->md_data.rw_data.rw_d.delay_chn[i].delay_close = (1+i) *100;
			}
#endif
		memset(&board->md_data.rw_data.rw_d.delay_chn[0],0,sizeof(rw_data_t)-EEPROM_STATUS_LENTH);
		board->write_eeprom_page(EEPROM_OTHER_ADDR,(uint8_t *)&board->md_data.rw_data.rw_d.delay_chn[0], sizeof(rw_data_t)-EEPROM_STATUS_LENTH);
			//config phase information
		uint8_t buff[EEPROM_CHANNEL_LENTH] = {0};
		board->write_eeprom_page(EEPROM_CHANNEL_PHASE,buff,EEPROM_CHANNEL_LENTH);
		//for(int i = 0 ; i < MAX_ROW;i++)
		//	board->write_eeprom_page(EEPROM_CONSUMER_ADDR +(CONSUM_PAGE*i),&board->con_da.iic_da.iic_con,CONSUM_PAGE);	
	}
}


void read_config_from_eeprom(void)
{
	board_t *board = get_board();
	if(board)
	{
		uint16_t device = 0;
		board->read_eeprom(EEPROM_DEVICES_ADDR,(uint8_t *)&device,EEPROM_DEVICES_LENTH);

#if EEPROM_TEST		
		uint8_t test_buff[32] ={0};
		for(int i =0;i < 32;i++)
			test_buff[i]=i;
		board->write_eeprom_page(TEST_ADDR,test_buff,LENTH);
		
		for(int i =0;i < 32;i++)
			test_buff[i]=0;
		board->read_eeprom_page(TEST_ADDR,test_buff,LENTH);
		
#endif
		
		
		if(device != board->md_data.r_data.r_d.dev_chn)
		{
			//default write eeprom
			board->write_eeprom_page(EEPROM_DEVICES_ADDR,(uint8_t *)&board->md_data.r_data.r_d.dev_chn,EEPROM_DEVICES_LENTH);
			board->write_eeprom_page(EEPROM_STATUS_ADDR,(uint8_t *)&board->relay_staging_staus[0],EEPROM_STATUS_LENTH);
			
#if (POWER_TYPE == POWER_AC_3_3)
			int p = 0;
			for(int i = 0; i < MAX_CHANNEL;i+=3)
			{
				board->md_data.rw_data.rw_d.delay_chn[i].delay_open  = (1+p) *100;
				board->md_data.rw_data.rw_d.delay_chn[i].delay_close = (1+p) *100;
				
				board->md_data.rw_data.rw_d.delay_chn[i+1].delay_open  = (1+p) *100;
				board->md_data.rw_data.rw_d.delay_chn[i+1].delay_close = (1+p) *100;
				
				board->md_data.rw_data.rw_d.delay_chn[i+2].delay_open  = (1+p) *100;
				board->md_data.rw_data.rw_d.delay_chn[i+2].delay_close = (1+p) *100;

				board->md_data.rw_data.rw_d.combin_chn[i/3].delay_open = (1+p) *100;
				board->md_data.rw_data.rw_d.combin_chn[i/3].delay_close = (1+p) *100;
				
				p++;
				
			}
	#if (ZERO_CONTRL == ZERO_LINE_CTRL_YES)
			for(int i = 0; i < 3;i++)
			{
				board->md_data.rw_data.rw_d.zero_chn[i].delay_open  = (1+i) *100;
				board->md_data.rw_data.rw_d.zero_chn[i].delay_close = (1+i) *100;				
			}
	#endif
#elif (POWER_TYPE == POWER_AC_3_2)
			int p = 0;
			for(int i = 0; i < PT_SUB_COUNT;i++)
			{
				board->md_data.rw_data.rw_d.delay_chn[i].delay_open  = (1+p) *100;
				board->md_data.rw_data.rw_d.delay_chn[i].delay_close = (1+p) *100;
				
				board->md_data.rw_data.rw_d.delay_chn[i+PT_SUB_COUNT].delay_open  = (1+p) *100;
				board->md_data.rw_data.rw_d.delay_chn[i+PT_SUB_COUNT].delay_close = (1+p) *100;
				
				board->md_data.rw_data.rw_d.combin_chn[i].delay_open = (1+p) *100;
				board->md_data.rw_data.rw_d.combin_chn[i].delay_close = (1+p) *100;
				p++;
			}
#else
			for(int i = 0; i < MAX_CHANNEL;i++)
			{
				board->md_data.rw_data.rw_d.delay_chn[i].delay_open  = (1+i) *100;
				board->md_data.rw_data.rw_d.delay_chn[i].delay_close = (1+i) *100;
			}
#endif
			board->write_eeprom_page(EEPROM_OTHER_ADDR,(uint8_t *)&board->md_data.rw_data.rw_d.delay_chn[0], sizeof(rw_data_t)-EEPROM_STATUS_LENTH);
			//config phase information
			uint8_t buff[EEPROM_CHANNEL_LENTH] = {0};
			board->write_eeprom_page(EEPROM_CHANNEL_PHASE,buff,EEPROM_CHANNEL_LENTH);
			
			iic_data chache={0};
			for(int i = 0 ; i < MAX_ROW;i++)
				board->write_eeprom_page(EEPROM_CONSUMER_ADDR +(CONSUM_PAGE*i),(uint8_t*)&chache.data[0],CONSUM_PAGE);
			
			for(int i = 0;i < MAX_CHANNEL;i++)
			{
				board->md_data.rw_data.rw_d.chn_ctrl[i] = CTRL_YES;
			}
		}
		{
			//channel open or close
			board->read_eeprom_page(EEPROM_STATUS_ADDR,(uint8_t *)&board->relay_staging_staus[0],2*EEPROM_STATUS_LENTH);
			{
				for(int i =0 ;i < RelaySlaveChaNum;i++)
				{
					if(board->relay_staging_staus[i])
					{
						SET_RL_ON_DELAY_FLAG(board->relay_staging_staus[i]);
						CLEAR_RL_OFF_DELAY_FLAG(board->relay_staging_staus[i]);
						SET_RL_ORDER_FLAG(board->relay_staging_staus[i]);
					}
				}
#if (ZERO_CONTRL == ZERO_LINE_CTRL_YES)
				for(int i = 0; i < ZERO_CTRL_NUM;i++)
				{
					if(board->relay_zero_staging_status[i])
					{
						SET_RL_ON_DELAY_FLAG(board->relay_zero_staging_status[i]);
						CLEAR_RL_OFF_DELAY_FLAG(board->relay_zero_staging_status[i]);
						SET_RL_ORDER_FLAG(board->relay_zero_staging_status[i]);						
					}
				}		
#endif
			}
			board->read_eeprom_page(EEPROM_OTHER_ADDR,(uint8_t *)&board->md_data.rw_data.rw_d.delay_chn[0],2*(START_RW_LENTH-EEPROM_STATUS_LENTH));
						//get phase information
			uint8_t buff[EEPROM_CHANNEL_LENTH] = {0};
			board->read_eeprom_page(EEPROM_CHANNEL_PHASE,buff,EEPROM_CHANNEL_LENTH);
#if (POWER_TYPE == POWER_AC_3_3)
			for(int i = 0; i < 3; i++)
			{
				board->check_threshold(THRESHOLD_IN,i);
			}
#else
			for(int i = 0 ; i < INPUT_PT_NUM;i++)
			{
				board->check_threshold(THRESHOLD_IN,i);
			}
#endif
			for(int i = 0; i < RelaySlaveChaNum; i++)
			{
				board->md_data.r_data.r_d.ele_out[i].resever = buff[i];   //config phase information
				board->check_threshold(THRESHOLD_OUT,i);
				if(board->md_data.rw_data.rw_d.chn_ctrl[i] > 2)
				{
					board->md_data.rw_data.rw_d.chn_ctrl[i] = 0;
				}					
			}
			iic_data chache={0};
			for(int i = 0 ; i < MAX_ROW;i++)
			{
				board->read_eeprom_page(EEPROM_CONSUMER_ADDR +(CONSUM_PAGE*i),&chache,sizeof(iic_data));
				if(board->con_da.index > chache.iic_con.recode_index1)
				{
					
				}else
				{
					board->con_da.index = chache.iic_con.recode_index1;
					board->con_da.row = i;
				}
			}	
			board->read_eeprom_page(EEPROM_CONSUMER_ADDR +(CONSUM_PAGE*(board->con_da.row)),&chache,sizeof(iic_data));
			for(int i = 0 ; i < RelaySlaveChaNum;i++)
			{
					board->ele_restore[i] = chache.iic_con.iic_consumer[i];
			}

			board->con_da.row++;      //point next write row
			if(board->con_da.row >= MAX_ROW)
			{
				board->con_da.row = 0;
			}
			board->con_da.index++;		//point next write consumer index
			if(board->con_da.index > 0XFFFFFFFFFFFFFFFF)
			{
				iic_data chache1={0};
				board->con_da.index = 0;
				for(int i = 0 ; i < MAX_ROW;i++)
					board->write_eeprom_page(EEPROM_CONSUMER_ADDR +(CONSUM_PAGE*i),&chache1,CONSUM_PAGE);
			}
			//read chn ctrl
		}
	}
}


void set_relay_sta_async(async_data *data)
{
	if(!data)
		goto failed;
	board_t *board = get_board();
	if(board)
	{
		if(data->fire_or_zero == _FIRE)
		{
			//if(board->md_data.rw_data.rw_d.chn_ctrl[data->channel] != 0)  goto failed;
			if(data->w_eep_flag == FLAG_W_EEP)
			{
				w_eeprom_data_t da = {0};
				da.lenth =2;
				memcpy(&da.data,&data->status,2);
				da.start_addr = (EEPROM_STATUS_ADDR+(data->channel*2));
				board->q_cache.en_queue(&da);
			}
		}
		else if(data->fire_or_zero == _ZERO)
		{
	#if (ZERO_CONTRL == ZERO_LINE_CTRL_YES)
			if(data->w_eep_flag == FLAG_W_EEP)
			{
				w_eeprom_data_t da = {0};
				da.lenth =2;
				memcpy(&da.data,&data->status,2);
				da.start_addr = (EEPROM_STATUS_ADDR+((data->channel+13)*2));
				board->q_cache.en_queue(&da);	
			}			
	#else
				goto failed;
	#endif			
		}
		else
		{
			goto failed;
		}
		SET_RL_STATUS(*data->reg,data->status);
		if(data->method == DELAY_CTRL)
		{
				if(data->status)
				{
					SET_RL_ON_DELAY_FLAG(*(data->reg));
					CLEAR_RL_OFF_DELAY_FLAG(*(data->reg));
				}else
				{
					CLEAR_RL_ON_DELAY_FLAG(*(data->reg));
					SET_RL_OFF_DELAY_FLAG(*(data->reg));
				}						
		}else
		{
			if(data->status)
			{
				CLEAR_RL_ON_DELAY_FLAG(*(data->reg));
				CLEAR_RL_OFF_DELAY_FLAG(*(data->reg));
			}else
			{
				CLEAR_RL_ON_DELAY_FLAG(*(data->reg));
				CLEAR_RL_OFF_DELAY_FLAG(*(data->reg));
			}						
		}
		SET_RL_ORDER_FLAG(*(data->reg));
	}
failed:
	return;
}



void set_relay_status_async(uint16_t *reg,uint8_t method,uint16_t status)
{
	board_t *board = get_board();
	SET_RL_STATUS(*reg,status);
	if(method == DELAY_CTRL)
	{
		if(status)
		{
			SET_RL_ON_DELAY_FLAG(*reg);
			CLEAR_RL_OFF_DELAY_FLAG(*reg);
		}else
		{
			CLEAR_RL_ON_DELAY_FLAG(*reg);
			SET_RL_OFF_DELAY_FLAG(*reg);
		}
	}else 
	{
		 if(status)
		 {
			 CLEAR_RL_ON_DELAY_FLAG(*reg);
			 CLEAR_RL_OFF_DELAY_FLAG(*reg);
		 }else
		 {
			 CLEAR_RL_ON_DELAY_FLAG(*reg);
			 CLEAR_RL_OFF_DELAY_FLAG(*reg);
		 }
	}
	SET_RL_ORDER_FLAG(*reg);
}