/*
*********************************************************************************************************
*                                       IAR Development Kits
*                                              on the
*
*                                    M451
*
* Filename      : uart_RFModule.h
* Version       : V1.00
* Programmer(s) : Qian Xianghong
*********************************************************************************************************
*/

/*
*********************************************************************************************************
*                                             INCLUDE FILES
*********************************************************************************************************
*/
#include "includes.h"

const uint8_t RF_APP = RF_APP_AJH;
const uint8_t RF_PROTOCOL_VER = RF_PROTOCOL_VER_1;	

const uint8_t RF_LNG_LORA_CHANNEL = 1;	// 通信信道: 471M
const uint8_t RF_UP_CHANNEL = 28;	// 上行信道: 438M
const uint8_t RF_DOWN_CHANNEL = 29;	// 下行信道: 439M
const uint8_t RF_BROADCAST_PSN[6] = {0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF};
const uint8_t RF_EMPTYPSN[6] = {0, 0, 0, 0, 0, 0};
const uint8_t RF_LNG_LORA_EMPTYPSN[13] = {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0};
uint8_t RF_GatewayPSN[6] = {0, 0, 0, 0, 0, 0};
#define RF_SelfPSN (dcBuff.configBottle.PSN)

uint8_t RF_MAC_FN = 0;
uint8_t RF_APP_PN = 0;
uint8_t RF_APP_IDX = 0;

// 发送、接收帧
rf_frame_t RF_Send_Frame, RF_RecvFrame;
rf_lng_lora_t RF_LNG_LORA_Send_Frame, RF_LNG_LORA_Recv_Frame;
// LNG-LORA发送状态
volatile uint8_t RF_LNG_LORA_State = 0;	// 0-不发送，1-随机延时15秒内应答一次，2-每隔5秒发送一次

// RF串口接收的消息通知
volatile uint8_t RF_semAck = 0;
volatile uint8_t RF_semGateway = 0;
volatile uint8_t RF_semResp = 0;
volatile uint8_t RF_semMatch = 0;

loopbuff_t RF_GatewayBuff;
uint8_t RF_GatewayBuff_Data[6 * (4 + 1)] = {0};
loopbuff_t RF_AckBuff;
uint8_t RF_AckBuff_Data[sizeof(rf_ack_t) * (2 + 1)] = {0};
loopbuff_t RF_RespBuff;
uint8_t RF_RespBuff_Data[sizeof(rf_resp_t) * (2 + 1)] = {0};
loopbuff_t RF_MatchBuff;
uint8_t RF_MatchBuff_Data[sizeof(rf_charge_match_t) * (2 + 1)] = {0};

#define RF_MOD_MD0_1()	LL_GPIO_SetOutputPin(GPIOD, LL_GPIO_PIN_13)
#define RF_MOD_MD0_0()	LL_GPIO_ResetOutputPin(GPIOD, LL_GPIO_PIN_13)
#define RF_MOD_MD1_1()	LL_GPIO_SetOutputPin(GPIOD, LL_GPIO_PIN_12)
#define RF_MOD_MD1_0()	LL_GPIO_ResetOutputPin(GPIOD, LL_GPIO_PIN_12)
#define RF_READY()	(1)

// 射频初始化状态
uint8_t RF_initStatus = 0;

volatile uint8_t RF_hasPowered = 0;

// 多项式为x16+x15+x2+1，LSB顺序
// 同ibutton的crc算法，不同于modbus的crc算法
uint16_t rf_crc_16(uint8_t *message, int16_t len)
{
#if 0	
    int16_t i, j;
    uint16_t crc_reg = 0;
    uint16_t current;
       
    for (i = 0; i < len; i++)
    {
        current = message[i];
        for (j = 0; j < 8; j++)
        {
            if ((crc_reg ^ current) & 0x0001)
                crc_reg = (crc_reg >> 1) ^ 0xA001;
            else
                crc_reg >>= 1;
            current >>= 1;
        }
    }
    // 交换高低字节顺序
    return ((crc_reg & 0xFF) << 8) | ((crc_reg >> 8) & 0xFF);
#else
	return MODBUS_RTU_CRC16(message, len);
#endif	
}

// 计算自启动以来经过的秒数
uint32_t rf_get_seconds()
{
    S_RTC_TIME_DATA_T sRTC;
	
	RTC_GetDateAndTime(&sRTC);
	return Calc_SecondsFromYear(INITIAL_YEAR, sRTC.u32Year, sRTC.u32Month, sRTC.u32Day,
			sRTC.u32Hour, sRTC.u32Minute, sRTC.u32Second);
}

// 设置网关
void rf_set_gateway(uint8_t PSN[6])
{
	memmove(RF_GatewayPSN, PSN, 6);
}

// 清除网关
void rf_clear_gateway()
{
	memmove(RF_GatewayPSN, RF_EMPTYPSN, 6);
}

// 计算通信地址，用于定点传输
uint16_t rf_get_addr(uint8_t PSN[6])
{
	uint16_t addr = rf_crc_16(PSN, 6);
	if(addr == 0xFFFF)	// 不能为广播地址
		return 0;
	return addr;
}

// 物理层校验
uint8_t rf_phy_valid(rf_frame_t *frame)
{
	if(frame->vendor_id != RF_MARK_LS ||  frame->app_id != RF_APP || frame->protocol_ver != RF_PROTOCOL_VER)
	{
		// 物理层校验失败
		return 0;
	}
	return 1;
}

// mac层校验
uint8_t rf_mac_valid(rf_frame_t *frame, uint8_t dir)
{
	if(frame->dir != dir 
		|| (memcmp(frame->destPSN, RF_SelfPSN, 6) != 0 && (dir == RF_DIR_DOWN || memcmp(frame->destPSN, RF_BROADCAST_PSN, 6) != 0))
	)
	{
		// mac层校验失败
		return 0;
	}
	return 1;
}

// 初始化帧
void rf_initial_frame(rf_frame_t *frame)
{
	memset((uint8_t *) frame, 0, sizeof(rf_frame_t));
	frame->len = RF_MIN_FRAME_LEN;
}

// 追加负载数据
uint8_t rf_append_payload(rf_frame_t *frame, uint8_t payload_len, uint8_t *payload)
{
	if(frame->len < RF_MIN_FRAME_LEN || frame->len + payload_len > RF_MAX_FRAME_LEN)
		return 0;
	
	if(payload_len > 0)
		memmove(frame->app_payload + (frame->len - RF_MIN_FRAME_LEN), payload, payload_len);
	frame->len += payload_len;
	return 1;
}

// 物理层发送
uint8_t  rf_uart_send(rf_frame_t *frame)
{
	uint8_t phy_header[3];
	uint16_t crc;
	uint16_t dst;
	uint8_t i;

	// 填写固定字段
	frame->sof = RF_FRAME_SOF;
	frame->vendor_id = RF_MARK_LS;
	frame->app_id = RF_APP;
	frame->protocol_ver = RF_PROTOCOL_VER;
	memmove(frame->srcPSN, RF_SelfPSN, 6);
	crc = rf_crc_16((uint8_t *) frame, frame->len - 2);
	((uint8_t *) frame)[frame->len - 2] = crc >> 8;
	((uint8_t *) frame)[frame->len - 1] = crc & 0xFF;
	
////	// 计算目的地址
////	if(dcBuff.configDisplay.op_BOX_VER) // 泽耀
////	{
////		if(frame->dir == RF_DIR_UP)
////			dst = rf_get_addr((uint8_t *) RF_BROADCAST_PSN);
////		else
////			dst = rf_get_addr(frame->destPSN);
////		phy_header[0] = dst >> 8;
////		phy_header[1] = dst & 0xFF;
////		// 信道
////		if(frame->dir == RF_DIR_UP)
////			phy_header[2] = RF_UP_CHANNEL;
////		else
////			phy_header[2] = RF_DOWN_CHANNEL;
////	}
////	else								// LORA
	{
		// 信道
		if(frame->dir == RF_DIR_UP)
			phy_header[0] = RF_UP_CHANNEL;
		else
			phy_header[0] = RF_DOWN_CHANNEL;
	}

//	while(!RF_READY());

	// 随机延时
	delay_ms((rand() % 10) * (70 + rand() % 20));
	
////	if(dcBuff.configDisplay.op_BOX_VER) // 泽耀
////	{
////		printf("\nRF send to Gateway (%02X %02X %02X, %d bytes):\n", 
////			phy_header[0], phy_header[1], phy_header[2], frame->len);
////	}
////	else								// LORA
	{
		printf("\nRF send to Gateway (%02X, %d bytes):\n", 
			phy_header[0], frame->len);
	}
	for(i = 0; i < frame->len; i++)
		printf(" %02X", ((uint8_t *) frame)[i]);
	printf("\n");
	
	// 因为射频模块接收数据不能中断超过3个字节的时间，故不允许打断。
	__disable_irq();
////	if(dcBuff.configDisplay.op_BOX_VER)			// 泽耀
////		UART_Transmit(&huart3, phy_header, 3);
////	else										// LORA
		UART_Transmit(&huart3, phy_header, 1);		
	UART_Transmit(&huart3, (uint8_t *) frame, frame->len);
	__enable_irq();
	
	return 1;
}

// 物理层发送
uint8_t  rf_uart_send_lng_lora(rf_lng_lora_t *frame)
{
	uint16_t crc;
	uint8_t i;

	// 填写固定字段
	memmove(frame->frame_header, "TANK", 4);	
	crc = rf_crc_16((uint8_t *) frame, sizeof(rf_lng_lora_t) - 2);
	((uint8_t *) frame)[sizeof(rf_lng_lora_t) - 2] = crc >> 8;
	((uint8_t *) frame)[sizeof(rf_lng_lora_t) - 1] = crc & 0xFF;
	
//	while(!RF_READY());

	// 随机延时0.8~1s
	delay_ms(800 + (rand() % 11) * (10 + rand() % 11));
	
	printf("\nRF send to Gateway:\n");
	for(i = 0; i < sizeof(rf_lng_lora_t); i++)
		printf(" %02X", ((uint8_t *) frame)[i]);
	printf("\n");
	
	// 因为射频模块接收数据不能中断超过3个字节的时间，故不允许打断。
	__disable_irq();	
	UART_Transmit(&huart3, (uint8_t *) frame, sizeof(rf_lng_lora_t));
	__enable_irq();
	
	return 1;
}

// mac层发送: ACK
uint8_t rf_mac_send_ack(uint8_t oriDir, uint8_t oriMac_fn, uint8_t oriPSN[6])
{
	rf_initial_frame(&RF_Send_Frame);

	if(oriDir == RF_DIR_UP)
		RF_Send_Frame.dir = RF_DIR_DOWN;
	else
		RF_Send_Frame.dir = RF_DIR_UP;
	RF_Send_Frame.mac_type = RF_MAC_TYPE_ACK;
	RF_Send_Frame.mac_ack_req = 0;
	RF_Send_Frame.mac_fn = oriMac_fn;
	memmove(RF_Send_Frame.destPSN, oriPSN, 6);
	// 调用物理层发送
	return rf_uart_send(&RF_Send_Frame);
}

// mac层发送: 数据
uint8_t rf_mac_send_data(rf_frame_t *frame, uint8_t dir, uint8_t fn, uint8_t destPSN[6])
{
	uint32_t tick;
	rf_ack_t ack;
	uint32_t stop_seconds;
	uint8_t count;

	// 清除回应
	RF_semAck = 0;
	LoopBuff_Clear(&RF_AckBuff);

	// 数据来自上层
	frame->dir = dir;
	frame->mac_type = RF_MAC_TYPE_DATA;
////	if(frame->dir == RF_DIR_UP && frame->net_type == RF_NET_TYPE_DATA)
////		frame->mac_ack_req = 1;
////	else
		frame->mac_ack_req = 0;
	frame->mac_fn = RF_MAC_FN;
	memmove(frame->destPSN, destPSN, 6);
	// 调用物理层发送
	if(!rf_uart_send(frame))
		return 0;

	// 无须ACK确认
	if(!frame->mac_ack_req)
	{
		RF_MAC_FN++;
		return 1;
	}

	// 等待ACK确认
	stop_seconds = rf_get_seconds() + 3;
	while(rf_get_seconds() < stop_seconds)
	{
		tick = GetDelayTick(500);
		while(!IsTickOut(tick))
		{
			if(RF_semAck)
				break;
		}
		count = LoopBuff_GetCount(&RF_AckBuff);
		while(count--)
		{
			memmove(&ack, LoopBuff_GetDataPtr(&RF_AckBuff, RF_AckBuff.info.rdPtr), sizeof(ack));
			LoopBuff_RemoveItems(&RF_AckBuff, 1);
			if(ack.mac_fn == RF_MAC_FN && memcmp(ack.srcPSN, destPSN, 6) == 0)
			{
				RF_MAC_FN++;
				return 1;
			}
		}
	}
	return 0;
}

// net层发送：寻找中继器
uint8_t rf_net_send_find_relay()
{
	// 清除回应
	RF_semGateway = 0;
	LoopBuff_Clear(&RF_GatewayBuff);

	rf_initial_frame(&RF_Send_Frame);

	RF_Send_Frame.net_type = RF_NET_TYPE_FIND_RELAY;
	// 调用mac层发送
	return rf_mac_send_data(&RF_Send_Frame, RF_DIR_UP, RF_MAC_TYPE_DATA, (uint8_t *) RF_BROADCAST_PSN);
}

// net层发送：回应中继器
uint8_t rf_net_send_resp_relay(uint8_t oriPSN[6])
{
	rf_initial_frame(&RF_Send_Frame);

	RF_Send_Frame.net_type = RF_NET_TYPE_RESP_RELAY;
	// 调用mac层发送
	return rf_mac_send_data(&RF_Send_Frame, RF_DIR_DOWN, RF_MAC_TYPE_DATA, oriPSN);
}

// net层发送：充装匹配
uint8_t rf_net_send_charge_match(uint8_t charging)
{
	rf_charge_match_t *pMatch = (rf_charge_match_t *) RF_Send_Frame.app_payload;

	// 清除回应
	RF_semMatch = 0;
	LoopBuff_Clear(&RF_MatchBuff);

	rf_initial_frame(&RF_Send_Frame);
	RF_Send_Frame.net_type = RF_NET_TYPE_CHARGE_MATCH;
	
	pMatch->posState = dcBuff.dtuData.posState;
	pMatch->longitude = dcBuff.dtuData.longitude;
	pMatch->latitude = dcBuff.dtuData.latitude;
	pMatch->source = dcBuff.configBottle.source;
	pMatch->charging = charging;
	rf_append_payload(&RF_Send_Frame, sizeof(rf_charge_match_t), (uint8_t *) pMatch);
	// 调用mac层发送
	return rf_mac_send_data(&RF_Send_Frame, RF_DIR_UP, RF_MAC_TYPE_DATA, (uint8_t *) RF_BROADCAST_PSN);
}

// net层发送：回应充装匹配
uint8_t rf_net_send_resp_charge_match(uint8_t oriPSN[6], uint8_t charging)
{
	rf_charge_match_t *pMatch = (rf_charge_match_t *) RF_Send_Frame.app_payload;
	
	rf_initial_frame(&RF_Send_Frame);

	RF_Send_Frame.net_type = RF_NET_TYPE_CHARGE_MATCH;
	pMatch->posState = dcBuff.dtuData.posState;
	pMatch->longitude = dcBuff.dtuData.longitude;
	pMatch->latitude = dcBuff.dtuData.latitude;
	pMatch->source = dcBuff.configBottle.source;
	pMatch->charging = charging;
	rf_append_payload(&RF_Send_Frame, sizeof(rf_charge_match_t), (uint8_t *) pMatch);
	
	// 调用mac层发送
	return rf_mac_send_data(&RF_Send_Frame, RF_DIR_DOWN, RF_MAC_TYPE_DATA, oriPSN);
}

// net层发送：回应遥控命令
uint8_t rf_net_send_resp_remote_ctrl(uint8_t oriPSN[6], uint8_t func)
{
	rf_initial_frame(&RF_Send_Frame);

	RF_Send_Frame.net_type = RF_NET_TYPE_REMOTE_CTRL;
	rf_append_payload(&RF_Send_Frame, 1, &func);
	
	// 调用mac层发送
	return rf_mac_send_data(&RF_Send_Frame, RF_DIR_DOWN, RF_MAC_TYPE_DATA, oriPSN);
}

// net层发送：数据
uint8_t rf_net_send_data(rf_frame_t *frame, uint8_t dir, uint8_t destPSN[6])
{
	// 数据来自应用层

	frame->net_type = RF_NET_TYPE_DATA;
	// 调用mac层发送
	return rf_mac_send_data(frame, dir, RF_MAC_TYPE_DATA, destPSN);
}

// 应用层发送：回应
uint8_t rf_app_send_resp(uint8_t oriPSN[6], uint8_t oriApp_pn, uint8_t payload_len, uint8_t *payload)
{
	rf_initial_frame(&RF_Send_Frame);
	rf_append_payload(&RF_Send_Frame, payload_len, payload);
	
	RF_Send_Frame.app_pn = oriApp_pn;
	RF_Send_Frame.app_idx = 0;	// 暂不实现分包组包
	RF_Send_Frame.app_tbc = 0;
	// 调用net层发送
	return rf_net_send_data(&RF_Send_Frame, RF_DIR_DOWN, oriPSN);
}

// 应用层发送：数据
uint8_t rf_app_send_data(uint8_t payload_len, uint8_t *payload)
{
	uint32_t tick;
	rf_resp_t resp;
	uint32_t stop_seconds;
	uint8_t count;
	S_RTC_TIME_DATA_T sRTC;

	// 清除回应
	RF_semResp = 0;
	LoopBuff_Clear(&RF_RespBuff);
	
	rf_initial_frame(&RF_Send_Frame);
	rf_append_payload(&RF_Send_Frame, payload_len, payload);
	
	RF_Send_Frame.app_pn = RF_APP_PN;
	RF_Send_Frame.app_idx = 0;	// 暂不实现分包组包
	RF_Send_Frame.app_tbc = 0;
	// 调用net层发送
	if(rf_net_send_data(&RF_Send_Frame, RF_DIR_UP, RF_GatewayPSN) == 0)
		return 0;
	
	// 等待服务器返回：15秒
	stop_seconds = rf_get_seconds() + 15;
	while(rf_get_seconds() < stop_seconds)
	{
		tick = GetDelayTick(500);
		while(!IsTickOut(tick))
		{
			if(RF_semResp)
				break;
		}
		count = LoopBuff_GetCount(&RF_RespBuff);
		while(count--)
		{
			memmove(&resp, LoopBuff_GetDataPtr(&RF_RespBuff, RF_RespBuff.info.rdPtr), sizeof(resp));
			LoopBuff_RemoveItems(&RF_RespBuff, 1);
			if(resp.app_pn == RF_APP_PN && memcmp(resp.srcPSN, RF_GatewayPSN, 6) == 0)
			{
				// print app_payload
				RF_APP_PN++;
				// 记录发送成功的时间
				RTC_GetDateAndTime(&sRTC);
				DTU_succTime = Calc_SecondsFromYear(INITIAL_YEAR, sRTC.u32Year, sRTC.u32Month, sRTC.u32Day,
						sRTC.u32Hour, sRTC.u32Minute, sRTC.u32Second);
				return 1;
			}
		}
	}
	return 0;
}

// 检查当前是否已经设置了网关
uint8_t rf_has_gateway()
{
	return (memcmp(RF_GatewayPSN, RF_EMPTYPSN, 6) != 0);
}

// 终端模块搜寻网关：发送搜寻命令，等待回应。
// 搜寻5次，取回应次数最多的作为通信网关。
// 最多接收10个网关
uint8_t rf_check_gateway()
{
	uint32_t tick;
	uint8_t PSN_List[10][6];		// 接收到的网关PSN列表
	uint8_t CNT_List[10];			// 接收到网关应答的次数
	uint8_t PSN[6];
	uint32_t stop_seconds;
	uint8_t i, j, k;
	uint8_t count;
	uint8_t done = 0;

	// 重新搜索网关
	memset(PSN_List, 0, sizeof(PSN_List));
	memset(CNT_List, 0, sizeof(CNT_List));
	
	// 搜寻3次（如果和原来的中继相同，则只搜寻1次）
	for(i = 0; i < 3 && !done; i++)
	{
		// 发送搜寻命令
		rf_net_send_find_relay();
		// 4秒内没有收到网关回应，则停止等待
		stop_seconds = rf_get_seconds() + 4;
		while(rf_get_seconds() <= stop_seconds)
		{
			tick = GetDelayTick(500);
			while(!IsTickOut(tick))
			{
				if(RF_semGateway)
					break;
			}
			count = LoopBuff_GetCount(&RF_GatewayBuff);
			while(count--)
			{
				memmove(PSN, LoopBuff_GetDataPtr(&RF_GatewayBuff, RF_GatewayBuff.info.rdPtr), 6);
				LoopBuff_RemoveItems(&RF_GatewayBuff, 1);
				
				// 如果和原来的中继相同，则只搜寻1次
				if(memcmp(RF_GatewayPSN, PSN, 6) == 0)
					done = 1;
				
				for(j = 0; j < 10; j++)
				{
					// 找到该PSN所在位置，或者第一个空位置
					if(memcmp(PSN_List[j], PSN, 6) == 0 || CNT_List[j] == 0)
					{
						memmove(PSN_List[j], PSN, 6);
						CNT_List[j]++;
						break;
					}
					// 没有位置则丢弃
				}
				// 延迟等待3秒
				stop_seconds = rf_get_seconds() + 3;
			}
		}
	}
	
	// 使用收到次数最多的一个
	k = 0;
	i = CNT_List[0];
	for(j = 1; j < 10; j++)
	{
		if(CNT_List[j] > i)
		{
			k = j;
			i = CNT_List[j];
		}
	}

	if(i == 0)
	{
		rf_clear_gateway();
		return 0;
	}

	rf_set_gateway(PSN_List[k]);
	printf("RF_GatewayPSN: 20%02d%02d%02d%02d%03d\n", RF_GatewayPSN[0], RF_GatewayPSN[1], 
		RF_GatewayPSN[2], RF_GatewayPSN[3], (RF_GatewayPSN[4] << 8) | RF_GatewayPSN[5]);

	return 1;
}

// 判断储罐和槽车是否匹配
uint32_t rf_is_charge_match(rf_charge_match_t *pMatch)
{
	// 判断介质
	if(pMatch->source != dcBuff.configBottle.source)
		return 0;

	// 判断槽车处于静止状态
	if(dcBuff.configDisplay.op_SEND_GPS_DATA && Motion_Status && dcBuff.dtuData.posState && dcBuff.dtuData.speed >= 5)
		return 0;
	
	// 无法判断距离
	if(pMatch->posState == 0 || dcBuff.dtuData.posState == 0)
		return 1;
	
	// 判断储罐和槽车之间的距离
	if(GetDistance(pMatch->latitude, pMatch->longitude, dcBuff.dtuData.latitude, dcBuff.dtuData.longitude) > 500)
		return 0;
	
	return 1;
}

// 判断槽车是否离开原地
uint32_t rf_is_truck_leave()
{
	// 无法判断距离
	if(Pump_Stop_posState == 0 || dcBuff.dtuData.posState == 0)
		return 0;
	
	// 判断槽车处于运动状态
	if(!Motion_Status || dcBuff.dtuData.speed < 5)
		return 0;
	
	// 判断槽车离原点之间的距离
	if(GetDistance(Pump_Stop_Latitude, Pump_Stop_Longitude, dcBuff.dtuData.latitude, dcBuff.dtuData.longitude) < 2000)
		return 0;
	
	return 1;
}

// 储罐发送充装匹配命令，并等待应答
uint8_t rf_charge_match(uint8_t charging)
{
	uint32_t tick;
	uint32_t stop_tick;
	rf_charge_match_t match;
	uint8_t count;
	uint8_t try_count = 2;

	// 发送2次
	while(try_count--)
	{
		// 发送匹配命令
		rf_net_send_charge_match(charging);
		
		// 等待3秒内的有效应答
		stop_tick = GetDelayTick(3000);
		while(!IsTickOut(stop_tick))
		{
			tick = GetDelayTick(500);
			while(!IsTickOut(tick))
			{
				if(RF_semMatch)
					break;
			}
			count = LoopBuff_GetCount(&RF_MatchBuff);
			while(count--)
			{
				memmove(&match, LoopBuff_GetDataPtr(&RF_MatchBuff, RF_MatchBuff.info.rdPtr), sizeof(match));
				LoopBuff_RemoveItems(&RF_MatchBuff, 1);
				
				// 判断匹配是否合法
				if(rf_is_charge_match(&match) && match.charging == charging)
					return 1;
			}
		}
	}
	
	return 0;
}

// 重新寻找SOF
void RF_SearchSOF(uint8_t *buf, uint16_t fromPos, uint16_t *len)
{
	uint16_t i;
	
	for(i = fromPos; i < *len && buf[i] != RF_FRAME_SOF; i++)
	{
	}
	
	*len -= i;
	memmove(buf, buf + i, *len);
}

// 重新寻找HEADER
void RF_SearchHeader(uint8_t *buf, uint16_t fromPos, uint16_t *len)
{
	uint16_t i;
	
	for(i = fromPos; i < *len && buf[i] != 'L'; i++)
	{
	}
	
	*len -= i;
	memmove(buf, buf + i, *len);
}

// 模块任务主体：处理射频接收数据
void RF_ParseFrame(uint8_t c)
{
	static uint16_t RdIdx = 0;
	static uint32_t outTick = 0;
	uint8_t *RF_ModuleData = (uint8_t *) &RF_RecvFrame;
	rf_ack_t ack;
	rf_resp_t resp;
	rf_charge_match_t match;
	uint16_t i;
	uint8_t frameOk, frameErr;

	if(IsTickOut(outTick))
		RdIdx = 0;
	outTick = GetDelayTick(50);

	if(RdIdx == 0 && c != RF_FRAME_SOF)
		return;
	
	RF_ModuleData[RdIdx++] = c;

	do
	{
		frameErr = (RdIdx >= 2 &&
			(RF_ModuleData[1] < RF_MIN_FRAME_LEN || RF_ModuleData[1] > RF_MAX_FRAME_LEN));
		if(frameErr)
		{
			// 从1开始寻找SOF
			RF_SearchSOF(RF_ModuleData, 1, &RdIdx);
		}

		frameOk = (RdIdx >= 2 && RF_ModuleData[1] >= RF_MIN_FRAME_LEN && RF_ModuleData[1] <= RF_MAX_FRAME_LEN
			&& RdIdx >= RF_ModuleData[1]);
		if(frameOk)
		{
			if(rf_crc_16(RF_ModuleData, RF_ModuleData[1]) == 0)
			{
				if(rf_phy_valid(&RF_RecvFrame) && rf_mac_valid(&RF_RecvFrame, RF_DIR_DOWN))
				{
					// 收到一帧
					printf("\nRF recv from Gateway (%d bytes):\n", RF_ModuleData[1]);
					for(i = 0; i < RF_ModuleData[1]; i++)
						printf(" %02X", RF_ModuleData[i]);
					printf("\n");
					
					// 判断帧类型
					if(RF_RecvFrame.mac_type == RF_MAC_TYPE_ACK)
					{
						// Ack确认帧
						memmove(ack.srcPSN, RF_RecvFrame.srcPSN, 6);
						ack.mac_fn = RF_RecvFrame.mac_fn;
						LoopBuff_PutItem(&RF_AckBuff, (uint8_t *) &ack);
						// 发消息给任务
						RF_semAck = 1;
					}
					else if(RF_RecvFrame.net_type == RF_NET_TYPE_RESP_RELAY)
					{
						// 中继应答帧
						LoopBuff_PutItem(&RF_GatewayBuff, RF_RecvFrame.srcPSN);
						// 发消息给任务
						RF_semGateway = 1;
					}
					else if(RF_RecvFrame.net_type == RF_NET_TYPE_DATA)
					{
						// 服务器应答帧
						memmove(resp.srcPSN, RF_RecvFrame.srcPSN, 6);
						resp.app_pn = RF_RecvFrame.app_pn;
						resp.payload_len = RF_RecvFrame.len - RF_MIN_FRAME_LEN;
						memmove(resp.payload, RF_RecvFrame.app_payload, resp.payload_len);
						LoopBuff_PutItem(&RF_RespBuff, (uint8_t *) &resp);
						// 发消息给任务
						RF_semResp = 1;
					}
					else if(RF_RecvFrame.net_type == RF_NET_TYPE_CHARGE_MATCH)
					{
						if(!dcBuff.configDisplay.op_SEND_GPS_DATA)
						{
							// 储罐收到来自槽车的匹配帧
							memmove(&match, RF_RecvFrame.app_payload, sizeof(match));
							LoopBuff_PutItem(&RF_MatchBuff, (uint8_t *) &match);

							// 发消息给任务
							RF_semMatch = 1;
						}
					}
				}
				else if(dcBuff.configDisplay.op_SEND_GPS_DATA 
					&& rf_phy_valid(&RF_RecvFrame) && rf_mac_valid(&RF_RecvFrame, RF_DIR_UP))
				{
					// 收到一帧
					printf("\nRF recv from remote (%d bytes):\n", RF_ModuleData[1]);
					for(i = 0; i < RF_ModuleData[1]; i++)
						printf(" %02X", RF_ModuleData[i]);
					printf("\n");
					
					// 判断帧类型
					if(RF_RecvFrame.net_type == RF_NET_TYPE_CHARGE_MATCH)
					{
						// 槽车收到来自储罐的匹配帧
						
						// 判断是否匹配，如匹配则应答
						
						memmove(&match, RF_RecvFrame.app_payload, sizeof(match));
						if(rf_is_charge_match(&match))
						{
							if(!match.charging)
							{
								// 记录关泵的时间和GPS地址
								Pump_Stop_Time = rf_get_seconds();
								Pump_Stop_posState = dcBuff.dtuData.posState;
								Pump_Stop_Longitude = dcBuff.dtuData.longitude;
								Pump_Stop_Latitude = dcBuff.dtuData.latitude;
								// 断开充液泵
								KZ_PUMP_OFF();
							}
							rf_net_send_resp_charge_match(RF_RecvFrame.srcPSN, match.charging);
						}
					}
					else if(RF_RecvFrame.net_type == RF_NET_TYPE_REMOTE_CTRL)
					{
						// 槽车收到遥控器命令
						if(RF_RecvFrame.app_payload[0] == 3) // 配对
						{
							if(MeterInSamplePage())				// 标定页面：允许遥控配对
								rf_net_send_resp_remote_ctrl(RF_RecvFrame.srcPSN, 3);
						}
						else if(RF_RecvFrame.app_payload[0] == 1 || RF_RecvFrame.app_payload[0] == 2) // 遥控泵
						{
							if(memcmp(RF_RecvFrame.destPSN, dcBuff.configBottle.PSN, 6) == 0)
							{
								if(RF_RecvFrame.app_payload[0] == 1) // 开泵
								{
									KZ_VALUE_ENABLE();
									rf_net_send_resp_remote_ctrl(RF_RecvFrame.srcPSN, 1);
								}
								else // 关泵
								{
									KZ_VALUE_DISABLE();									
									rf_net_send_resp_remote_ctrl(RF_RecvFrame.srcPSN, 2);
								}
							}
						}
					}
				}
				
				// 继续寻找下一帧
				RdIdx -= RF_ModuleData[1];
				memmove(RF_ModuleData, RF_ModuleData + RF_ModuleData[1], RdIdx);
				// 从0开始寻找SOF
				RF_SearchSOF(RF_ModuleData, 0, &RdIdx);
			}
			else
			{
				// 从1开始寻找SOF
				RF_SearchSOF(RF_ModuleData, 1, &RdIdx);
			}
		}
	} while(frameOk || frameErr);
}

// 模块任务主体：处理射频接收数据
void RF_ParseLNGLora(uint8_t c)
{
	static uint16_t RdIdx = 0;
	static uint32_t outTick = 0;
	uint8_t *RF_ModuleData = (uint8_t *) &RF_LNG_LORA_Recv_Frame;
	uint16_t i;
	uint8_t frameOk, frameErr;
	char psn[14];

	if(IsTickOut(outTick))
		RdIdx = 0;
	outTick = GetDelayTick(50);

	if(RdIdx == 0 && c != 'L')
		return;
	
	RF_ModuleData[RdIdx++] = c;

	do
	{
		frameErr = ((RdIdx >= 2 && RF_ModuleData[1] != 'N') 
				 || (RdIdx >= 3 && RF_ModuleData[2] != 'G') 
				 || (RdIdx >= 4 && RF_ModuleData[3] != 'C'));
		if(frameErr)
		{
			// 从1开始寻找SOF
			RF_SearchHeader(RF_ModuleData, 1, &RdIdx);
		}
		frameOk = (RdIdx >= sizeof(rf_lng_lora_t) && memcmp(RF_ModuleData, "LNGC", 4) == 0);
		if(frameOk)
		{
			if(rf_crc_16(RF_ModuleData, sizeof(rf_lng_lora_t)) == 0)
			{
				// 收到一帧
				printf("\nRF recv from Gateway (%d bytes):\n", sizeof(rf_lng_lora_t));
				for(i = 0; i < sizeof(rf_lng_lora_t); i++)
					printf(" %02X", RF_ModuleData[i]);
				printf("\n");
					
				sprintf(psn, "20%02d%02d%02d%02d%03d", 
					dcBuff.configBottle.PSN[0], dcBuff.configBottle.PSN[1], dcBuff.configBottle.PSN[2],
					dcBuff.configBottle.PSN[3], (dcBuff.configBottle.PSN[4] << 8) | dcBuff.configBottle.PSN[5]);
				if(memcmp(RF_LNG_LORA_Recv_Frame.tank_psn, RF_LNG_LORA_EMPTYPSN, 13) == 0)
				{
					if(RF_LNG_LORA_State == 0)
						RF_LNG_LORA_State = 1;
				}
				else if(memcmp(RF_LNG_LORA_Recv_Frame.tank_psn, psn, 13) == 0)
				{
					if(RF_LNG_LORA_Recv_Frame.send_mod == 0)
						RF_LNG_LORA_State = 0;
					else
						RF_LNG_LORA_State = 2;
				}

				// 继续寻找下一帧
				RdIdx -= sizeof(rf_lng_lora_t);
				memmove(RF_ModuleData, RF_ModuleData + sizeof(rf_lng_lora_t), RdIdx);
				// 从0开始寻找SOF
				RF_SearchHeader(RF_ModuleData, 0, &RdIdx);				
			}
			else
			{
				// 从1开始寻找SOF
				RF_SearchHeader(RF_ModuleData, 1, &RdIdx);
			}
		}
	} while(frameOk || frameErr);
}

void RF_IRQHandler(USART_Handle *huart)
{
	uint8_t c = (uint8_t) huart->Instance->RDR;
	
//	printf("%02X ", c);
	// 直接解析帧
	if(dcBuff.configDisplay.op_LNG_LORA)
		RF_ParseLNGLora(c);
	else
		RF_ParseFrame(c);
}

void RF_Uart_Open(u32 baudrate)
{
	LL_USART_InitTypeDef USART_InitStruct = {0};

	huart3.RxISR = RF_IRQHandler;

	/* Peripheral clock enable */
	LL_APB1_GRP1_EnableClock(LL_APB1_GRP1_PERIPH_USART3);

	/* USART3 interrupt Init */
	NVIC_SetPriority(USART3_IRQn, NVIC_EncodePriority(NVIC_GetPriorityGrouping(),5, 0));
	NVIC_EnableIRQ(USART3_IRQn);

	USART_InitStruct.BaudRate = baudrate;
	USART_InitStruct.DataWidth = LL_USART_DATAWIDTH_8B;
	USART_InitStruct.StopBits = LL_USART_STOPBITS_1;
	USART_InitStruct.Parity = LL_USART_PARITY_NONE;
	USART_InitStruct.TransferDirection = LL_USART_DIRECTION_TX_RX;
	USART_InitStruct.HardwareFlowControl = LL_USART_HWCONTROL_NONE;
	USART_InitStruct.OverSampling = LL_USART_OVERSAMPLING_16;
	LL_USART_Init(USART3, &USART_InitStruct);
	LL_USART_ConfigAsyncMode(USART3);

	SET_BIT(USART3->CR1, USART_CR1_PEIE | USART_CR1_RXNEIE);
	LL_USART_Enable(USART3);	
}

// 模块上电，设置硬件参数
void RF_PowerOn()
{
	uint32_t stop_seconds;
	char last_c = 0, c;	
	uint8_t cfg[6];
	static uint8_t first = 1;
		
	uint16_t addr = rf_get_addr(RF_SelfPSN);
	// 槽车版本，类似中继器的角色
	if(dcBuff.configDisplay.op_SEND_GPS_DATA)
		addr = rf_get_addr((uint8_t *) RF_BROADCAST_PSN);

	if(RF_hasPowered)
		return;
	
	printf("\nRF power on ...\n");
	VCC_RF_ON();
	delay_ms(500);

	// 将串口更改为9600bps
	LL_USART_Disable(huart3.Instance);
	RF_Uart_Open(9600);
	NVIC_DisableIRQ(USART3_IRQn);

//	while(!RF_READY());

	// 进入休眠模式：模式3
	RF_MOD_MD1_1();
	RF_MOD_MD0_1();
	delay_ms(50);
	
	cfg[0] = 0xC2;	// 设置的参数掉电不保存，每次上电都重新设置
	cfg[1] = addr >> 8;
	cfg[2] = addr & 0xFF;
	if(dcBuff.configDisplay.op_LNG_LORA)
		cfg[3] = 2 | (7 << 3) | (3 << 6);	// sf=8, 115200bps, cr=4/8
////	else if(dcBuff.configDisplay.op_BOX_VER)
////		cfg[3] = 0x3C; 		// 泽耀模块:【00 111 100】: UART 8N1, 115200bps, 空中速率9.6k
	else
		cfg[3] = 6 | (7 << 3) | (0 << 6);	// sf=12, 115200bps, cr=4/5
	cfg[4] = RF_DOWN_CHANNEL;
	// LNG-LORA版本
	if(dcBuff.configDisplay.op_LNG_LORA)
		cfg[4] = RF_LNG_LORA_CHANNEL;
	// 槽车版本，类似中继器的角色
	else if(dcBuff.configDisplay.op_SEND_GPS_DATA)
		cfg[4] = RF_UP_CHANNEL;
	
	if(dcBuff.configDisplay.op_LNG_LORA)
		cfg[5] = 1 | (0 << 2) | (9 << 3) | (0 << 7);		// freqcast=0, bw=500kHz, unicast=0 
////	else if(dcBuff.configDisplay.op_BOX_VER)
////		cfg[5] = 0xC0;		// 泽耀模块:【1 1 000 0 00】：定点-ON，推挽输出，唤醒，FEC-OFF，20dbm（100mW）
	else
		cfg[5] = 1 | (1 << 2) | (9 << 3) | (0 << 7);		// freqcast=1, bw=500kHz, unicast=0 
	
	printf("\nInitialize RF Module: %02X %02X %02X %02X %02X %02X\n", 
		cfg[0], cfg[1], cfg[2], cfg[3], cfg[4], cfg[5]);
	
	UART_Transmit(&huart3, cfg, 6);
	stop_seconds = rf_get_seconds() + 2;
	while(rf_get_seconds() < stop_seconds)
	{
		if(huart3.Instance->ISR & USART_ISR_RXNE)
		{
			c = huart3.Instance->RDR;
			printf("%c", c);
			if(last_c == 'O' && c == 'K')
			{
				// 设置状态：以第一次检测的结果为准
				if(first)
					RF_initStatus = 1;
				break;
			}
			last_c = c;
		}
	}
	
	first = 0;

	// 进入工作模式：模式0
	RF_MOD_MD1_0();
	RF_MOD_MD0_0();
	delay_ms(50);

//	while(!RF_READY());

	// 将串口更改为115200bps
	LL_USART_Disable(huart3.Instance);
	RF_Uart_Open(115200ul);
	NVIC_EnableIRQ(USART3_IRQn);
	
	RF_hasPowered = 1;
}

void RF_PowerOff()
{
	if(!RF_hasPowered)
		return;
	
	RF_hasPowered = 0;

	printf("\nRF power off ...\n");
	VCC_RF_OFF();
	delay_ms(200);
}

// 初始化
void RF_Init()
{
	LL_GPIO_InitTypeDef GPIO_InitStruct = {0};

	// RF MD0, MD1
	LL_AHB2_GRP1_EnableClock(LL_AHB2_GRP1_PERIPH_GPIOD);

	GPIO_InitStruct.Mode = LL_GPIO_MODE_OUTPUT;
	GPIO_InitStruct.Speed = LL_GPIO_SPEED_FREQ_LOW;
	GPIO_InitStruct.OutputType = LL_GPIO_OUTPUT_PUSHPULL;
	GPIO_InitStruct.Pull = LL_GPIO_PULL_NO;

	GPIO_InitStruct.Pin = LL_GPIO_PIN_12|LL_GPIO_PIN_13;
	LL_GPIO_Init(GPIOD, &GPIO_InitStruct);

	LL_AHB2_GRP1_EnableClock(LL_AHB2_GRP1_PERIPH_GPIOD);
	/**USART3 GPIO Configuration  
	PD8   ------> USART3_TX
	PD9   ------> USART3_RX 
	*/
	GPIO_InitStruct.Pin = LL_GPIO_PIN_8|LL_GPIO_PIN_9;
	GPIO_InitStruct.Mode = LL_GPIO_MODE_ALTERNATE;
	GPIO_InitStruct.Speed = LL_GPIO_SPEED_FREQ_MEDIUM;
	GPIO_InitStruct.OutputType = LL_GPIO_OUTPUT_PUSHPULL;
	GPIO_InitStruct.Pull = LL_GPIO_PULL_NO;
	GPIO_InitStruct.Alternate = LL_GPIO_AF_7;
	LL_GPIO_Init(GPIOD, &GPIO_InitStruct);
}

void RF_UnInit()
{
	LL_GPIO_InitTypeDef GPIO_InitStruct = {0};

	// 反初始化串口
	LL_USART_DeInit(USART3);

	// 恢复引脚
	GPIO_InitStruct.Mode = LL_GPIO_MODE_ANALOG;
	GPIO_InitStruct.Pull = LL_GPIO_PULL_NO;

	LL_AHB2_GRP1_EnableClock(LL_AHB2_GRP1_PERIPH_GPIOD);
	GPIO_InitStruct.Pin = LL_GPIO_PIN_8|LL_GPIO_PIN_9|LL_GPIO_PIN_12|LL_GPIO_PIN_13;
	LL_GPIO_Init(GPIOD, &GPIO_InitStruct);
}

void RF_Open()
{
	// 用PSN的CRC校验值作为伪随机数的种子
	srand(rf_crc_16(dcBuff.configBottle.PSN, 6));

	RF_MAC_FN = rand() % 256;
	RF_APP_PN = rand() % 256;

	// 创建消息队列
	LoopBuff_Create(&RF_GatewayBuff, 6, 4, 0, (uint32_t) RF_GatewayBuff_Data);
	LoopBuff_Create(&RF_AckBuff, sizeof(rf_ack_t), 2, 0, (uint32_t) RF_AckBuff_Data);
	LoopBuff_Create(&RF_RespBuff, sizeof(rf_resp_t), 2, 0, (uint32_t) RF_RespBuff_Data);
	LoopBuff_Create(&RF_MatchBuff, sizeof(rf_charge_match_t), 2, 0, (uint32_t) RF_MatchBuff_Data);

	RF_Uart_Open(9600);
}

void rf_pack_lng_lora_data()
{
	memset(&RF_LNG_LORA_Send_Frame, 0, sizeof(RF_LNG_LORA_Send_Frame));
	
	// psn
	sprintf(RF_LNG_LORA_Send_Frame.tank_psn, "20%02d%02d%02d%02d%03d", 
		dcBuff.configBottle.PSN[0], dcBuff.configBottle.PSN[1], dcBuff.configBottle.PSN[2],
		dcBuff.configBottle.PSN[3], (dcBuff.configBottle.PSN[4] << 8) | dcBuff.configBottle.PSN[5]);
	// send_mod
	RF_LNG_LORA_Send_Frame.send_mod = (RF_LNG_LORA_State == 2 ? 0x5A : 0);
	// status
	if(dcBuff.sampleData.staDPress.notConnect)
		RF_LNG_LORA_Send_Frame.level_conn = 1;
	if(dcBuff.sampleData.staExtTempr[0].notConnect)
		RF_LNG_LORA_Send_Frame.tempr_conn = 1;
	if(dcBuff.sampleData.staPress.notConnect)
		RF_LNG_LORA_Send_Frame.press_conn = 1;
	if(dcBuff.sampleData.vacuum[0].staVacuum == VACUUM_STATUS_COMM_FAULT)
		RF_LNG_LORA_Send_Frame.vacuu_conn = 1;
	if(dcBuff.sampleData.staDPress.underFlow || dcBuff.sampleData.staDPress.overFlow)
		RF_LNG_LORA_Send_Frame.level_fault = 1;
	if(dcBuff.sampleData.staExtTempr[0].underFlow || dcBuff.sampleData.staExtTempr[0].overFlow)
		RF_LNG_LORA_Send_Frame.tempr_fault = 1;
	if(dcBuff.sampleData.staPress.underFlow || dcBuff.sampleData.staPress.overFlow)
		RF_LNG_LORA_Send_Frame.press_fault = 1;
	if(dcBuff.sampleData.vacuum[0].staVacuum != VACUUM_STATUS_COMM_FAULT && (dcBuff.sampleData.vacuum[0].vacuum <= 0.00999999 || dcBuff.sampleData.vacuum[0].vacuum > 99.99999999))
		RF_LNG_LORA_Send_Frame.vacuu_fault = 1;
	// liquid_level、volume、volumePct
	if(RF_LNG_LORA_Send_Frame.level_conn || RF_LNG_LORA_Send_Frame.level_fault)
	{
		RF_LNG_LORA_Send_Frame.liquid_level = 0;
		RF_LNG_LORA_Send_Frame.volume = 0;
		RF_LNG_LORA_Send_Frame.volumePct = 0;
	}
	else
	{
		RF_LNG_LORA_Send_Frame.liquid_level = KPa2mmH2O(dcBuff.sampleData.diff);
		RF_LNG_LORA_Send_Frame.volume = dcBuff.sampleData.volume;
		RF_LNG_LORA_Send_Frame.volumePct = dcBuff.sampleData.volumePct;
	}
	// temperature
	if(RF_LNG_LORA_Send_Frame.tempr_conn || RF_LNG_LORA_Send_Frame.tempr_fault)
		RF_LNG_LORA_Send_Frame.temp = 0;
	else
		RF_LNG_LORA_Send_Frame.temp = dcBuff.sampleData.extTempr[0];
	// press
	if(RF_LNG_LORA_Send_Frame.press_conn || RF_LNG_LORA_Send_Frame.press_fault)
		RF_LNG_LORA_Send_Frame.pressure = 0;
	else
		RF_LNG_LORA_Send_Frame.pressure = dcBuff.sampleData.pressure * 0.001;

	// vacuum
	if(RF_LNG_LORA_Send_Frame.vacuu_conn || RF_LNG_LORA_Send_Frame.vacuu_fault)
		RF_LNG_LORA_Send_Frame.vacuum = 0;
	else
		RF_LNG_LORA_Send_Frame.vacuum = dcBuff.sampleData.vacuum[0].vacuum;
}

void LNG_LORA_Task(void *p_arg)
{
	uint32_t seconds = 0;
	uint32_t sendSeconds = 0;
	uint8_t last_state = 0;
	uint32_t resetSeconds = rf_get_seconds() + 300;

	while(1)
	{
		osDelay(500);
		
		// 获取当前时间
		seconds = rf_get_seconds();
		
		if(RF_LNG_LORA_State == 1)
		{
			// 只应答一次
			RF_LNG_LORA_State = 0;

			// 随机延时14秒以内（升级发送的时候还要随机延时0.8~1s，总共在15秒以内）
			osDelay((rand() % 29) * (250 + rand() % 251));
			rf_pack_lng_lora_data();
			rf_uart_send_lng_lora(&RF_LNG_LORA_Send_Frame);
		}
		else if(RF_LNG_LORA_State == 2)
		{
			if(RF_LNG_LORA_State != last_state)
				sendSeconds = seconds;
			if(seconds >= sendSeconds)
			{
				// 下次发送的时间
				sendSeconds = seconds + 5;
				
				rf_pack_lng_lora_data();
				rf_uart_send_lng_lora(&RF_LNG_LORA_Send_Frame);
			}
		}
		else 	// 如果LORA处于不发送状态，且持续5分钟，则重启LORA模块
		{
			if(RF_LNG_LORA_State != last_state)
				resetSeconds = seconds + 300;
			if(seconds >= resetSeconds)
			{
				// 下次重启的时间
				resetSeconds = seconds + 300;
				
				RF_PowerOff();
				RF_PowerOn();
			}
		}
		
		last_state = RF_LNG_LORA_State;
	}
}