480 lines
11 KiB
C
480 lines
11 KiB
C
/*
|
||
*********************************************************************************************************
|
||
* IAR Development Kits
|
||
* on the
|
||
*
|
||
* Nano100
|
||
*
|
||
* Filename : uart_BDModule.h
|
||
* Version : V1.00
|
||
* Programmer(s) : Qian Xianghong
|
||
*********************************************************************************************************
|
||
*/
|
||
|
||
/*
|
||
*********************************************************************************************************
|
||
* INCLUDE FILES
|
||
*********************************************************************************************************
|
||
*/
|
||
#include "includes.h"
|
||
|
||
const uint8_t BD_APP = RF_APP_AJH;
|
||
const uint8_t BD_PROTOCOL_VER = RF_PROTOCOL_VER_2;
|
||
|
||
#define RF_SelfPSN (dcBuff.configBottle.PSN)
|
||
|
||
uint8_t BD_RF_MAC_FN = 0;
|
||
uint8_t BD_RF_APP_PN = 0;
|
||
uint8_t BD_RF_APP_IDX = 0;
|
||
|
||
// 发送、接收帧
|
||
bd_frame_t BD_Send_Frame, BD_RecvFrame;
|
||
|
||
// 接收自检信息和反馈信息
|
||
volatile uint8_t BD_semZjxx = 0, BD_semFkxx = 0;
|
||
bd_zjxx_t BD_Zjxx;
|
||
bd_fkxx_t BD_Fkxx;
|
||
|
||
// 北斗初始化状态
|
||
uint8_t BD_initStatus = 0;
|
||
|
||
volatile uint8_t BD_hasPowered = 0;
|
||
|
||
// 计算校验和（异或）
|
||
uint8_t bd_cs_nor(uint8_t *message, int16_t len)
|
||
{
|
||
int16_t i;
|
||
uint8_t cs = 0;
|
||
|
||
for(i = 0; i < len; i++)
|
||
cs ^= message[i];
|
||
|
||
return cs;
|
||
}
|
||
|
||
// 初始化帧
|
||
void bd_initial_frame(bd_frame_t *frame, char *cmd)
|
||
{
|
||
memset((uint8_t *) frame, 0, sizeof(bd_frame_t));
|
||
frame->sof = BD_FRAME_SOF;
|
||
memmove(frame->cmd, cmd, 4);
|
||
frame->len = BD_MIN_FRAME_LEN; // 小端模式，发送时再转换成大端模式
|
||
}
|
||
|
||
// 追加负载数据
|
||
uint8_t bd_append_payload(bd_frame_t *frame, uint8_t payload_len, uint8_t *payload)
|
||
{
|
||
if(frame->len < BD_MIN_FRAME_LEN || frame->len + payload_len > BD_MAX_FRAME_LEN)
|
||
return 0;
|
||
|
||
if(payload_len > 0)
|
||
memmove(frame->bd_payload + (frame->len - BD_MIN_FRAME_LEN), payload, payload_len);
|
||
frame->len += payload_len;
|
||
return 1;
|
||
}
|
||
|
||
void bd_prepare_send(bd_frame_t *frame)
|
||
{
|
||
uint8_t *buf = (uint8_t *) frame;
|
||
uint16_t len = frame->len;
|
||
|
||
frame->len = htons(len); // 转换成大端模式
|
||
buf[len - 1] = bd_cs_nor(buf, len - 1); // 填写校验码
|
||
}
|
||
|
||
// 北斗物理层校验
|
||
uint8_t bd_phy_valid(bd_frame_t *frame)
|
||
{
|
||
// 通信信息帧
|
||
if(strncmp(frame->cmd, BD_TXXX, 4) == 0)
|
||
{
|
||
// 通信01、代码1、不回执0、通信0、无密钥0、保留00
|
||
if(frame->txxx.xxlb != 0x60 || ntohs(frame->txxx.bitLen) > 624)
|
||
return 0;
|
||
}
|
||
|
||
// 北斗帧校验成功
|
||
return 1;
|
||
}
|
||
|
||
// 物理层校验
|
||
uint8_t bd_rf_phy_valid(bd_rf_frame_t *frame)
|
||
{
|
||
if(frame->sof != RF_FRAME_SOF || frame->len < BD_RF_MIN_FRAME_LEN || frame->len > BD_RF_MAX_FRAME_LEN)
|
||
return 0;
|
||
if(frame->vendor_id != RF_MARK_LS || frame->app_id != BD_APP || frame->protocol_ver != BD_PROTOCOL_VER)
|
||
return 0;
|
||
if(rf_crc_16((uint8_t *) frame, frame->len) != 0)
|
||
return 0;
|
||
|
||
// 物理层校验成功
|
||
return 1;
|
||
}
|
||
|
||
// mac层校验
|
||
uint8_t bd_rf_mac_valid(bd_rf_frame_t *frame, uint8_t dir)
|
||
{
|
||
if(frame->dir != dir)
|
||
return 0;
|
||
|
||
// mac层校验成功
|
||
return 1;
|
||
}
|
||
|
||
// 重新寻找SOF
|
||
void BD_SearchSOF(uint8_t *buf, uint16_t fromPos, uint16_t *len)
|
||
{
|
||
uint16_t i;
|
||
|
||
for(i = fromPos; i < *len && buf[i] != BD_FRAME_SOF; i++)
|
||
{
|
||
}
|
||
|
||
*len -= i;
|
||
memmove(buf, buf + i, *len);
|
||
}
|
||
|
||
// 分析串口数据，组帧
|
||
void BD_ParseFrame(uint8_t c)
|
||
{
|
||
static uint16_t RdIdx = 0;
|
||
uint8_t *BD_ModuleData = (uint8_t *) &BD_RecvFrame;
|
||
uint8_t frameOk, frameErr;
|
||
uint16_t len;
|
||
|
||
if(RdIdx == 0 && c != BD_FRAME_SOF)
|
||
return;
|
||
|
||
BD_ModuleData[RdIdx++] = c;
|
||
|
||
do
|
||
{
|
||
if(RdIdx < 7)
|
||
break;
|
||
len = (BD_ModuleData[5] << 8) | BD_ModuleData[6];
|
||
|
||
frameErr = (len < BD_MIN_FRAME_LEN || len > BD_MAX_FRAME_LEN);
|
||
if(frameErr)
|
||
{
|
||
// 从1开始寻找SOF
|
||
BD_SearchSOF(BD_ModuleData, 1, &RdIdx);
|
||
|
||
if(RdIdx < 7)
|
||
break;
|
||
len = (BD_ModuleData[5] << 8) | BD_ModuleData[6];
|
||
}
|
||
|
||
frameOk = (len >= BD_MIN_FRAME_LEN && len <= BD_MAX_FRAME_LEN && RdIdx >= len);
|
||
if(frameOk)
|
||
{
|
||
if(bd_cs_nor(BD_ModuleData, len) == 0)
|
||
{
|
||
if(bd_phy_valid(&BD_RecvFrame))
|
||
{
|
||
if(strncmp(BD_RecvFrame.cmd, BD_TXXX, 4) == 0)
|
||
{
|
||
}
|
||
else if(strncmp(BD_RecvFrame.cmd, BD_ZJXX, 4) == 0)
|
||
{
|
||
dcBuff.powerInfo.bdNumber = (BD_RecvFrame.selfAddr[0] << 16) | (BD_RecvFrame.selfAddr[1] << 8) | BD_RecvFrame.selfAddr[2];
|
||
BD_Zjxx = BD_RecvFrame.zjxx;
|
||
BD_semZjxx = 1;
|
||
}
|
||
else if(strncmp(BD_RecvFrame.cmd, BD_FKXX, 4) == 0)
|
||
{
|
||
BD_Fkxx = BD_RecvFrame.fkxx;
|
||
BD_semFkxx = 1;
|
||
}
|
||
}
|
||
|
||
// 继续寻找下一帧
|
||
RdIdx -= len;
|
||
memmove(BD_ModuleData, BD_ModuleData + len, RdIdx);
|
||
// 从0开始寻找SOF
|
||
BD_SearchSOF(BD_ModuleData, 0, &RdIdx);
|
||
}
|
||
else
|
||
{
|
||
// 从1开始寻找SOF
|
||
BD_SearchSOF(BD_ModuleData, 1, &RdIdx);
|
||
}
|
||
}
|
||
} while(frameOk || frameErr);
|
||
}
|
||
|
||
// 自检
|
||
uint8_t BD_Xtzj()
|
||
{
|
||
uint8_t try_cnt;
|
||
uint32_t stop_seconds;
|
||
|
||
bd_initial_frame(&BD_Send_Frame, BD_XTZJ);
|
||
bd_append_payload(&BD_Send_Frame, sizeof(bd_xtzj_t), BD_Send_Frame.bd_payload);
|
||
bd_prepare_send(&BD_Send_Frame);
|
||
for(try_cnt = 0; try_cnt < 1; try_cnt++)
|
||
{
|
||
// 清除返回标志
|
||
BD_semZjxx = 0;
|
||
// 发送命令
|
||
UART_Transmit(&huart3, (uint8_t *) &BD_Send_Frame, ntohs(BD_Send_Frame.len));
|
||
|
||
// 等待返回数据
|
||
stop_seconds = rf_get_seconds() + 2;
|
||
while(rf_get_seconds() < stop_seconds)
|
||
{
|
||
if(BD_semZjxx)
|
||
{
|
||
printf("\nBD Module self check returned.\n");
|
||
if(BD_Zjxx.antennaErr)
|
||
printf("\nThe antenna has error!\n");
|
||
if(BD_Zjxx.boardErr)
|
||
printf("\nThe board has error!\n");
|
||
if(BD_Zjxx.cardErr)
|
||
printf("\nThe card has error!\n");
|
||
if(BD_Zjxx.channelErr)
|
||
printf("\nThe channel has error!\n");
|
||
if(BD_Zjxx.snErr)
|
||
printf("\nThe serial no has error!\n");
|
||
if(BD_Zjxx.dataErr)
|
||
printf("\nThe data has error!\n");
|
||
if(BD_Zjxx.chkErr)
|
||
printf("\nThe check has error!\n");
|
||
if(BD_Zjxx.idErr)
|
||
printf("\nThe id has error!\n");
|
||
if(BD_Zjxx.phyErr)
|
||
printf("\nThe physical has error!\n");
|
||
|
||
if(!BD_Zjxx.antennaErr && !BD_Zjxx.boardErr && !BD_Zjxx.cardErr && !BD_Zjxx.channelErr
|
||
&& !BD_Zjxx.snErr && !BD_Zjxx.dataErr && !BD_Zjxx.chkErr && !BD_Zjxx.idErr && !BD_Zjxx.phyErr)
|
||
{
|
||
return 1;
|
||
}
|
||
break;
|
||
}
|
||
delay_ms(200);
|
||
}
|
||
delay_ms(500);
|
||
}
|
||
return 0;
|
||
}
|
||
|
||
void BD_IRQHandler(USART_Handle *huart)
|
||
{
|
||
uint8_t c = (uint8_t) huart->Instance->RDR;
|
||
|
||
// printf("%02X ", c);
|
||
// 直接处理，分析并组帧
|
||
BD_ParseFrame(c);
|
||
}
|
||
|
||
// 初始化
|
||
void BD_Init()
|
||
{
|
||
LL_GPIO_InitTypeDef GPIO_InitStruct = {0};
|
||
|
||
LL_AHB2_GRP1_EnableClock(LL_AHB2_GRP1_PERIPH_GPIOB);
|
||
/**USART3 GPIO Configuration
|
||
PB10 ------> USART3_TX
|
||
PB11 ------> USART3_RX
|
||
*/
|
||
GPIO_InitStruct.Pin = LL_GPIO_PIN_10|LL_GPIO_PIN_11;
|
||
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(GPIOB, &GPIO_InitStruct);
|
||
}
|
||
|
||
void BD_Open()
|
||
{
|
||
LL_USART_InitTypeDef USART_InitStruct = {0};
|
||
|
||
// 用PSN的CRC校验值作为伪随机数的种子
|
||
srand(rf_crc_16(dcBuff.configBottle.PSN, 6));
|
||
|
||
BD_RF_MAC_FN = rand() % 256;
|
||
BD_RF_APP_PN = rand() % 256;
|
||
|
||
huart3.RxISR = BD_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 = 115200;
|
||
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 bd_rf_initial_frame(bd_rf_frame_t *frame)
|
||
{
|
||
memset((uint8_t *) frame, 0, sizeof(bd_rf_frame_t));
|
||
frame->len = BD_RF_MIN_FRAME_LEN;
|
||
}
|
||
|
||
// 追加负载数据
|
||
uint8_t bd_rf_append_payload(bd_rf_frame_t *frame, uint8_t payload_len, uint8_t *payload)
|
||
{
|
||
if(frame->len < BD_RF_MIN_FRAME_LEN || frame->len + payload_len > BD_RF_MAX_FRAME_LEN)
|
||
return 0;
|
||
|
||
if(payload_len > 0)
|
||
memmove(frame->app_payload + (frame->len - BD_RF_MIN_FRAME_LEN), payload, payload_len);
|
||
frame->len += payload_len;
|
||
return 1;
|
||
}
|
||
|
||
// 模块上电，设置硬件参数
|
||
void BD_PowerOn()
|
||
{
|
||
uint8_t i, count = 0;
|
||
static uint8_t first = 1;
|
||
|
||
if(BD_hasPowered)
|
||
return;
|
||
|
||
printf("\nBD power on ...\n");
|
||
|
||
VCC_BD_ON();
|
||
delay_ms(2700);
|
||
|
||
if(BD_Xtzj())
|
||
{
|
||
// for(i = 0; i < 6; i++)
|
||
// {
|
||
// if(BD_Zjxx.power[i] >= 2)
|
||
// count++;
|
||
// }
|
||
// if(count >= 2)
|
||
{
|
||
// 设置状态：以第一次检测的结果为准
|
||
if(first)
|
||
BD_initStatus = 1;
|
||
}
|
||
}
|
||
|
||
first = 0;
|
||
|
||
BD_hasPowered = 1;
|
||
}
|
||
|
||
void BD_PowerOff()
|
||
{
|
||
if(!BD_hasPowered)
|
||
return;
|
||
|
||
BD_hasPowered = 0;
|
||
|
||
printf("\nBD power off ...\n");
|
||
VCC_BD_OFF();
|
||
delay_ms(200);
|
||
}
|
||
|
||
// 应用层发送：数据
|
||
uint8_t bd_rf_app_send_data(uint8_t payload_len, uint8_t *payload)
|
||
{
|
||
// uint16_t i;
|
||
|
||
uint8_t try_cnt;
|
||
uint32_t stop_seconds;
|
||
uint16_t crc;
|
||
bd_rf_frame_t *rf = (bd_rf_frame_t *) BD_Send_Frame.txsq.bytes;
|
||
S_RTC_TIME_DATA_T sRTC;
|
||
|
||
// 初始化BD帧
|
||
bd_initial_frame(&BD_Send_Frame, BD_TXSQ);
|
||
// 初始化RF帧
|
||
bd_rf_initial_frame(rf);
|
||
|
||
// 应用层
|
||
bd_rf_append_payload(rf, payload_len, payload);
|
||
rf->app_pn = BD_RF_APP_PN;
|
||
rf->app_idx = 0; // 暂不实现分包组包
|
||
rf->app_tbc = 0;
|
||
|
||
// net层
|
||
rf->net_type = RF_NET_TYPE_DATA;
|
||
|
||
// mac层
|
||
rf->dir = RF_DIR_UP;
|
||
rf->mac_type = RF_MAC_TYPE_DATA;
|
||
rf->mac_ack_req = 0;
|
||
rf->mac_fn = BD_RF_MAC_FN;
|
||
|
||
// 物理层
|
||
rf->sof = RF_FRAME_SOF;
|
||
rf->vendor_id = RF_MARK_LS;
|
||
rf->app_id = BD_APP;
|
||
rf->protocol_ver = BD_PROTOCOL_VER;
|
||
memmove(rf->srcPSN, RF_SelfPSN, 6);
|
||
crc = rf_crc_16((uint8_t *) rf, rf->len - 2);
|
||
((uint8_t *) rf)[rf->len - 2] = crc >> 8;
|
||
((uint8_t *) rf)[rf->len - 1] = crc & 0xFF;
|
||
|
||
// 通讯申请
|
||
BD_Send_Frame.txsq.xxlb = 0x46; // 普通报文代码
|
||
BD_Send_Frame.txsq.dstAddr[0] = (dcBuff.configDisplay.bdCommander >> 16) & 0xFF; // 指挥机卡号
|
||
BD_Send_Frame.txsq.dstAddr[1] = (dcBuff.configDisplay.bdCommander >> 8) & 0xFF;
|
||
BD_Send_Frame.txsq.dstAddr[2] = (dcBuff.configDisplay.bdCommander & 0xFF);
|
||
BD_Send_Frame.txsq.bitLen = htons(rf->len * 8);
|
||
// 追加通讯申请内容
|
||
bd_append_payload(&BD_Send_Frame,
|
||
sizeof(BD_Send_Frame.txsq) - sizeof(BD_Send_Frame.txsq.bytes) + payload_len + BD_RF_MIN_FRAME_LEN,
|
||
(uint8_t *) &BD_Send_Frame.txsq);
|
||
// 修改数据格式，计算cs
|
||
bd_prepare_send(&BD_Send_Frame);
|
||
|
||
for(try_cnt = 0; try_cnt < 3; try_cnt++)
|
||
{
|
||
// 清除返回标志
|
||
BD_semFkxx = 0;
|
||
// 发送命令
|
||
UART_Transmit(&huart3, (uint8_t *) &BD_Send_Frame, ntohs(BD_Send_Frame.len));
|
||
|
||
// for(i = 0; i < ntohs(BD_Send_Frame.len); i++)
|
||
// printf("%02X ", ((uint8_t *) &BD_Send_Frame)[i]);
|
||
// printf("\n");
|
||
|
||
// 等待返回数据s
|
||
stop_seconds = rf_get_seconds() + 2;
|
||
while(rf_get_seconds() < stop_seconds)
|
||
{
|
||
if(BD_semFkxx)
|
||
{
|
||
printf("\nBD Module feedback returned.\n");
|
||
if(BD_Fkxx.fkbz == 0 && strncmp(BD_Fkxx.fjxx, BD_TXSQ, 4) == 0)
|
||
{
|
||
printf("\nThe message has send.\n");
|
||
BD_RF_MAC_FN++;
|
||
BD_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;
|
||
}
|
||
printf("\nThe message has not send.\n");
|
||
break;
|
||
}
|
||
delay_ms(200);
|
||
}
|
||
delay_ms(500);
|
||
}
|
||
|
||
return 0;
|
||
}
|