#include "app_task_485.h"
#include "../msp/uart0.h"
#include "../msp/uart2.h"
#include "../app/app_common.h"

//#define MODBUS_SLAVER_DW20_REG_START 0x02
//#define MODBUS_SLAVER_DW20_REG_NUM 0x02
#define MODBUS_SLAVER_RETRY_MAX_TIME 3

TS_485 ts_485;

void L3_task_485_init(void)
{
	L1_task_init(&ts_485.task);
	L3_task_s_go(ts_485,D_task_init);
	ts_485.slaverIndex = 0;
	ts_485.pkglen = 0;
	ts_485.retryTimes = 0;
	ts_485.ackFlag = 0;
}

#define D_task_485_constructor_modbus_pkg 0x51
#define D_task_485_send_modbus_pkg 0x52
#define D_task_485_wait_modbus_ack 0x53
#define D_task_485_switch_next_slaver 0x54

void L3_task_485_handle(TS_485 *s)
{
  TTSS_Task_init();
		L2_task_go(D_task_485_constructor_modbus_pkg);
		
	TTSS_Task_step(D_task_485_constructor_modbus_pkg)
		#if 0
		if(s->slaverIndex == 1)
		{
			L0_uart0_uc(s->slaverIndex);
			Lc_delay_ms(100);
			L0_uart0_uc(G.md_slaver_info[s->slaverIndex].slaver);		
			Lc_delay_ms(100);
			L0_uart0_uc(G.md_slaver_info[s->slaverIndex].oper);	
			Lc_delay_ms(100);
			L0_uart0_uc(G.md_slaver_info[s->slaverIndex].reg);
			Lc_delay_ms(100);
			L0_uart0_uc(G.md_slaver_info[s->slaverIndex].regnum);
			Lc_delay_ms(100);
			L0_uart0_uc(G.md_slaver_info[s->slaverIndex].bytes);
			Lc_delay_ms(100);
			L0_uart0_uc(G.md_slaver_info[s->slaverIndex].mask);
		}
		#endif
		if(G.md_slaver_info[s->slaverIndex].mask > 0)
		{
			s->pkglen = L3_pack_modbus(&s->loopPkg,G.md_slaver_info + s->slaverIndex);
			s->ackFlag = 0;
			s->retryTimes = 0;
			L2_task_go(D_task_485_send_modbus_pkg);
		}
		else
		{
			L2_task_go(D_task_485_switch_next_slaver);
		}
		
	TTSS_Task_step(D_task_485_send_modbus_pkg)
		//Lc_delay_ms(70);
		//L0_uart2_uc(s->pkglen);
		//Lc_delay_ms(70);
		L0_uart2_sendArray((U8*)&s->loopPkg,s->pkglen);
		s->sendStamp = s_nos_tick.t_5ms;
		L2_task_go(D_task_485_wait_modbus_ack);
		
    TTSS_Task_step(D_task_485_wait_modbus_ack)
		if(s_nos_tick.t_5ms - s->sendStamp >= 20)
		{
			if(s_uart2_rec.ok)
			{
				s_uart2_rec.ok = 0;
				s->pAckPkg = (TS_PH4_modbus*)(s_uart2_rec.buf);
				if(s->pAckPkg->salver == G.md_slaver_info[s->slaverIndex].slaver)
				{
					s->ackFlag = 1;
					if(s->pAckPkg->salver == G.md_slaver_info[0].slaver && s->pAckPkg->oper == MODBUS_OPER_READ)
					{
						G.total_weight = 
							(S32)(s->pAckPkg->buf[1]) << 24 | (S32)(s->pAckPkg->buf[2]) << 16 | (S32)(s->pAckPkg->buf[3]) << 8
								| (S32)(s->pAckPkg->buf[4]);
					}
				}
			}
			s->retryTimes++;
			if(s->ackFlag || s->retryTimes >= MODBUS_SLAVER_RETRY_MAX_TIME)
			{	
				if(G.md_slaver_info[s->slaverIndex].mask == 1)
				{
					G.md_slaver_info[s->slaverIndex].mask = 0;
				}
				L2_task_go(D_task_485_switch_next_slaver);
			}
			else
			{
				L2_task_go(D_task_485_send_modbus_pkg);
			}
		}
		
	TTSS_Task_step(D_task_485_switch_next_slaver)
		if(++ s->slaverIndex >= MD_SLAVER_INFO_MAX)
		{
			s->slaverIndex = 0;
		}
		L2_task_go(D_task_485_constructor_modbus_pkg);
		
	TTSS_Task_end();
}