Files
LaserTracing/source/src/main.c
T
YuanHongbin 9b06145341 1、sx127x.h增加了频率可调函数
2、删除了bsp.h的lora通道配置宏定义
3、删除了SGCP.h中MAC的组成参数定义,改为在main.c中进行定义,当使用bootloader时通过读取BootPara结构体参数获取本机MAC,否则将通过App程序自定义MAC
4、BootPara结构体参数增加
2026-05-11 10:10:13 +08:00

596 lines
24 KiB
C

/******************************************************************************
* Include files
******************************************************************************/
#include <stdlib.h>
#include "main.h"
#include "UartDebug.h"
#include "bsp.h"
#include "Algorithm.h"
#include "SGCP.h"
#include "Update.h"
#include "sx127x.h"
#include "lsm6dsl_app.h"
#include "mmc5983.h"
#define SOFTWARE_VERSION 11 //软件版本
#define HARDWARE_VERSION 11 //硬件版本
AppDetect_t App;
extern uint32_t LocalType;
extern uint32_t CommWay;
extern uint32_t DeviceSign;
extern uint32_t AddNumber;
extern uint8_t LocalMAC[6]; //本机MAC地址
extern uint8_t GatewayMAC[6]; //网关MAC地址,注册时全为0
extern uint8_t LocalDataPack[sizeof(SGCP.DevData.LaserTracing)]; //本机数据包 //本机数据包
void Lsm6dDataProcessCallBack(float *Acc, float *Gy)
{
memcpy(App.Sensor.acce, Acc, 12);
memcpy(App.Sensor.gy, Gy, 12);
//DBG_LOG("acc_X:%07.1f, acc_Y:%07.1f, acc_Z:%07.1f\r\n", App.Sensor.acce[X], App.Sensor.acce[Y],App.Sensor.acce[Z]);
//DBG_LOG("gy_X:%07.1f, gy_Y:%07.1f, gy_Z:%07.1f\r\n", App.Sensor.gy[X], App.Sensor.gy[Y],App.Sensor.gy[Z]);
App.AccRead_EndFlag = true;
}
void MmcDataProcessCallBack(float *Mag)
{
memcpy(App.Sensor.mag, Mag, 12);
//DBG_LOG("mag_X:%07.1f, mag_Y:%07.1f, mag_Z:%07.1f\r\n", App.Sensor.mag[X], App.Sensor.mag[Y],App.Sensor.mag[Z]);
App.MagRead_EndFlag = true;
}
static void AppInit(void)
{
memset(&App, 0x00, sizeof(App));
READ_APP_PARA((uint32_t *)&App.Para);
#if(USE_BOOTLOADER == 1)
UpdateInit();
memcpy(&LocalMAC, &BLPara.DevMac[0], 6);
SX1276LoRaSetFreqHz(BLPara.LoraFreq); //Lora频率:433100000ul + 200000*N
LocalType = (BLPara.DevMac[0] | (BLPara.DevMac[1] << 8)); //本机设备类型
CommWay = BLPara.DevMac[2]; //本机通讯方式
DeviceSign = BLPara.DevMac[3] & 0x80; //本机设备标志
AddNumber = ((BLPara.DevMac[3] << 16)+ (BLPara.DevMac[4] << 8) + BLPara.DevMac[5]) - 0x800000; //本机地址编号,数字部分对应唯一地址编号
if(App.Para.FactoryFlag != 0x00)
{
App.Para.FactoryFlag = 0x00;
/*校准参数初始化*/
App.Para.CaliPara.PitchZero = 0;
App.Para.CaliPara.RollZero = 0;
App.Para.CaliPara.YawZero = 0;
SAVE_APP_PARA((uint32_t *)&App.Para);
}
#elif
LocalType = LASER_TRACING; //本机设备类型
CommWay = LORA; //本机通讯方式
DeviceSign = MASTER; //本机设备标志
AddNumber = 0x000023 + DeviceSign;//本机地址编号,数字部分对应唯一地址编号
SX1276LoRaSetFreqHz(CH0); //Lora频率:433100000ul + 200000*N
LocalMAC[0] = LocalType & 0xFF; //本机MAC地址
LocalMAC[1] = (LocalType >> 8) & 0xFF;
LocalMAC[2] = CommWay;
LocalMAC[3] = (AddNumber >> 16) & 0xFF;
LocalMAC[4] = (AddNumber >> 8) & 0xFF;
LocalMAC[5] = AddNumber & 0xFF;
#endif
if(App.Para.RS485Addr > 16 || App.Para.RS485Addr < 1){
App.Para.RS485Addr = 1;
}
if(App.Para.Layout.CollectTime > 240 || App.Para.Layout.CollectTime < 1) {
App.Para.Layout.CollectTime = 10;
}
if(App.Para.Layout.ReportInterval > 1440 || App.Para.Layout.ReportInterval < 10) {
App.Para.Layout.ReportInterval = 40;
}
if(App.Para.Layout.ERInterval > 10 || App.Para.Layout.ERInterval < 2) {
App.Para.Layout.ERInterval = 4;
}
if(App.Para.Layout.ERTime > 240 || App.Para.Layout.ERTime < 20) {
App.Para.Layout.ERTime = 40;
}
DBG_LOG("\r\n\r\n");
DBG_LOG("****************************************************\r\n");
DBG_LOG("** **\r\n");
DBG_LOG("** LaserTracing **\r\n");
DBG_LOG("** SoftWare V:%d.%d **\r\n", SOFTWARE_VERSION / 10, SOFTWARE_VERSION % 10);
DBG_LOG("** HardWare V:%d.%d **\r\n", HARDWARE_VERSION / 10, HARDWARE_VERSION % 10);
DBG_LOG("** Compile: %s %s **\r\n", __DATE__, __TIME__);
DBG_LOG("** **\r\n");
DBG_LOG("****************************************************\r\n\r\n");
DBG_LOG("RS485Addr: %02X\r\n",App.Para.RS485Addr);
DBG_LOG("LocalMAC: %02X %02X %02X %02X %02X %02X\r\n",LocalMAC[0], LocalMAC[1], LocalMAC[2], LocalMAC[3], LocalMAC[4], LocalMAC[5]);
DBG_LOG("CollectTime: %ds\r\n",(App.Para.Layout.CollectTime*30));
DBG_LOG("LoraFreq: %d\r\n\r\n",BLPara.LoraFreq);
//09 00 01 00 00 00
LORAIntEnable();
Sx1276LoRaInit(LORA_RxCallBack); //< LORA芯片初始化
FeedDog();
Lsm6dslInit();
MMC5983Init();
MMC5983Stop();
Lsm6dsStop();
ACCandMMCIntEnable();
LPTimer0_OFF();
uint32_t seed = 0;//< 随机数初始化
seed = seed + LocalMAC[2];
seed = (seed << 8) + LocalMAC[3];
seed = (seed << 8) + LocalMAC[4];
seed = (seed << 8) + LocalMAC[5];
srand(seed);
App.Nonce = rand();
SGCP.LoginOk = false;
SGCP.LoginMess = false;
SGCP.LaserOnOff = false;
SGCP.MasterCaliOk = true;
SGCP.DeviceReadDataOk = false;
SGCP.TimingAcquisition = false;
App.Login2Min30SCount = 0;
App.Login30MinCount = 0;
App.RepeLoginCount = 0;
App.LoginFlag = false;
App.Login_RTC = false;
App.Login_LPTimer0 = true;
//LPTimer0_ON((App.Nonce % 1200) + 300);//定时30s+随机2分钟,最小间隙100ms
LPTimer0_ON(50);
DBG_LOG("Login LPTimer0 Open\r\n");
App.Upload45S10SCount = 0;
App.UploadFlag = false;
App.Upload_LPTimer0 = false;
App.Coll_N = 0;
App.Repor_N = 0;
App.ERInterval_N = 0;
App.ERTime_N = 0;
App.ERFlag = false;
App.MagRead_EndFlag = false;
App.AccRead_EndFlag = false;
App.UpdateOk = false;
App.CaliFlag = false;
App.LaserFlag = false;
App.Status = APP_STATUS_ON;
App.TD1mSDelayCnt = (App.Nonce % 2000) + 2000;
}
static void ReadDataLoopHandler(void)
{
switch (App.RDStatus)
{
case READDATA_STATUS_IDLE:{
break;}
case READDATA_STATUS_UPDAING:{
DBG_LOG("<------------ Sensor Data Updaing ------------> \r\n");
App.UpdateOk = false;
Lsm6dsStart();
MMC5983Start();
App.ReadData1mSDelayCnt = 2000;
App.RDStatus = READDATA_STATUS_WAIT_UPDAING;
break;}
case READDATA_STATUS_WAIT_UPDAING:{
if(App.ReadData1mSDelayCnt <= 0){
if(App.AccRead_EndFlag == false)
DBG_LOG("Lsm6dsl Get Data TimeOut...\r\n");
if(App.MagRead_EndFlag == false)
DBG_LOG("MMC5983 Get Data TimeOut...\r\n");
App.RDStatus = READDATA_STATUS_DATA_HANDLE;
}
else if(App.MagRead_EndFlag == true
&& App.AccRead_EndFlag == true){
App.RDStatus = READDATA_STATUS_DATA_HANDLE;
}
break;}
case READDATA_STATUS_DATA_HANDLE:{
if(App.MagRead_EndFlag == false || App.AccRead_EndFlag == false){
DBG_LOG("<------------ Sensor Data Upda End ------------> \r\n");
App.RDStatus = READDATA_STATUS_IDLE;
App.UpdateOk = false;
break;
}
App.MagRead_EndFlag = false;
App.AccRead_EndFlag = false;
IMU_Update(0, App.Sensor.acce, App.Sensor.mag, &App.AHRSData.Rad, &App.AHRSData.Deg);
App.ConvertedData.Pitch = (int16_t)(App.AHRSData.Deg.pitch * 10);
App.ConvertedData.Roll = (int16_t)(App.AHRSData.Deg.roll * 10);
App.ConvertedData.Yaw = (int16_t)(App.AHRSData.Deg.yaw * 10);
DBG_LOG("PitchAngle:%06.1f, RollAngle:%06.1f, YawAngle:%06.1f\r\n",App.AHRSData.Deg.pitch, App.AHRSData.Deg.roll, App.AHRSData.Deg.yaw);
if(SGCP.MasterCaliOk == true)
{
SGCP.MasterCaliOk = false;
App.CaliFlag = true;
App.Para.CaliPara.PitchZero = App.ConvertedData.Pitch;
App.Para.CaliPara.RollZero = App.ConvertedData.Roll;
App.Para.CaliPara.YawZero = App.ConvertedData.Yaw;
// App.Para.CaliPara.PitchZero = 0;
// App.Para.CaliPara.RollZero = 0;
// App.Para.CaliPara.YawZero = 0;
SAVE_APP_PARA((uint32_t *)&App.Para);
}
if(App.CaliFlag == true && App.ERFlag == false)
{
int16_t PitchDiff,RollDiff;
PitchDiff = App.ConvertedData.Pitch - App.Para.CaliPara.PitchZero;
RollDiff = App.ConvertedData.Roll - App.Para.CaliPara.RollZero;
if((PitchDiff > ERINTERVAL_VPT) || (RollDiff > ERINTERVAL_VPT))
{
//触发紧急上报
App.ERFlag = true;
DBG_LOG("PitchDiff=%04d, PitchDiff=%04d\r\n", PitchDiff,RollDiff);
DBG_LOG("Start emergency reporting!\r\n");
DBG_LOG("ERInterval: %dMin, ERTime: %dMin\r\n", App.Para.Layout.ERInterval/2, App.Para.Layout.ERTime/2);
}
}
SGCP.DevData.LaserTracing.PitchAngle = App.ConvertedData.Pitch;
SGCP.DevData.LaserTracing.RollAngle = App.ConvertedData.Roll;
SGCP.DevData.LaserTracing.YawAngle = App.ConvertedData.Yaw;
#if (USE_VBAT_AD == 1)
SGCP.DevData.LaserTracing.MasterDev.BatLevel = VBAT_Percentage;
#else
SGCP.DevData.LaserTracing.MasterDev.BatLevel = 0x00;
#endif
#if (SGCP_SELECT == 1 || SGCP_SELECT == 2)
SX1276LoCalcRssiSnr(&SGCP.DevData.LaserTracing.MasterDev.RSSI, &SGCP.DevData.LaserTracing.MasterDev.Nsr);//获取信号强度
#else
SGCP.DevData.LaserTracing.MasterDev.RSSI = 0x00;
SGCP.DevData.LaserTracing.MasterDev.Nsr = 0x00;
#endif
memcpy(LocalDataPack, &SGCP.DevData.LaserTracing, sizeof(LocalDataPack));
DBG_LOG("<------------ Sensor Data Upda End ------------> \r\n");
//App.RDStatus = READDATA_STATUS_UPDAING;//持续工作
App.RDStatus = READDATA_STATUS_IDLE;
App.UpdateOk = true;
break;}
}
}
static void AppLoopHandler(void)
{
switch(App.Status) {
case APP_STATUS_IDLE:{
break;}
case APP_STATUS_SLEEP:{
DBG_LOG("Sleep...\r\n\n\n");
FeedDog();
EnterDeepSleep();
FeedDog();
WakeUpInit();
App.Status = APP_STATUS_ON;
break;}
case APP_STATUS_ON:{
if(App.TD1mSDelayCnt <= 0){
App.TD1mSDelayCnt = 1000;//唤醒后待机时间
App.Status = APP_STATUS_ACTION;
}
break;}
case APP_STATUS_OFF:{
LED_OFF();
App.Status = APP_STATUS_SLEEP;
DBG_LOG("Power Off...\r\n");
break;}
case APP_STATUS_ACTION:{
if(SGCP.InStatus != IN_STATUS_IDLE){
break;
}
else if(SGCP.LoginOk == false && App.LoginFlag == true && SGCP.GWStatus == GW_STATUS_IDLE)//设备注册
{
PrintfMess();
App.LoginFlag = false;
LPTimer0_OFF();//关闭低功耗定时器
SGCP.GWStatus = GW_STATUS_LOGIN;//注册
App.Status = APP_STATUS_WAIT_LOGIN;
}
else if(SGCP.TimingAcquisition == true && App.RDStatus == READDATA_STATUS_IDLE)//设备数据获取
{
PrintfMess();
SGCP.TimingAcquisition = false;
App.RDStatus = READDATA_STATUS_UPDAING;
App.Status = APP_STATUS_ACTION;
App.TD1mSDelayCnt = 1000;
}
else if(SGCP.LoginOk == true && App.UploadFlag == true && SGCP.GWStatus == GW_STATUS_IDLE && App.UpdateOk == true)
{
PrintfMess();
App.UploadFlag = false;
LPTimer0_OFF();//关闭低功耗定时器
SGCP.GWStatus = GW_STATUS_UPLOAD_SENSOR;//上传
App.Status = APP_STATUS_WAIT_UPLOAD;
}
else if(App.RDStatus == READDATA_STATUS_IDLE
&& SGCP.GWStatus == GW_STATUS_IDLE
&& SGCP.InStatus == IN_STATUS_IDLE
&& SGCP.TimingAcquisition == false
&& App.TD1mSDelayCnt == 0
&& App.ReadData1mSDelayCnt == 0
&& SGCP.LaserOnOff == false
&& App.TestTimeCnt == 0)
{
//App.Status = APP_STATUS_ACTION;//持续工作
App.Status = APP_STATUS_OFF;
}
else if(App.LaserFlag == true)
{
App.LaserFlag = false;
App.TestTimeCnt = 3000;
LASER1_ON();
}
break;}
case APP_STATUS_WAIT_LOGIN:{
if(SGCP.LoginMess == true)
{
if(SGCP.LoginOk == false)
{
App.Login2Min30SCount++;
if(App.Login2Min30SCount >= 3)
{
PrintfMess();
DBG_LOG("Number of registration failures:%d\r\n",App.Login2Min30SCount);
DBG_LOG("Login RTC Open\r\n");
App.Login2Min30SCount = 0;
App.Login30MinCount = 0;
App.Login_RTC = true;//启动30分注册定时器
}
else
{
PrintfMess();
App.Login_LPTimer0 = true;
LPTimer0_ON((App.Nonce % 1200) + 300);//定时30s+随机2分钟,最小间隙100ms
//LPTimer0_ON(100);//定时10s
DBG_LOG("Number of registration failures:%d\r\n",App.Login2Min30SCount);
DBG_LOG("Login LPTimer0 Open\r\n");
}
}
else if(SGCP.LoginOk == true)
{
App.Login2Min30SCount = 0;
App.Login30MinCount = 0;
App.Upload45S10SCount = 0;
App.UploadFlag = true;
App.RDStatus = READDATA_STATUS_UPDAING;
}
SGCP.LoginMess = false;
App.TD1mSDelayCnt = 1000;
App.Status = APP_STATUS_ACTION;
}
break;}
case APP_STATUS_WAIT_UPLOAD:{
if(SGCP.UploadMess == true)
{
if(SGCP.UploadOk == false)
{
App.Upload45S10SCount++;
if((App.Upload45S10SCount%3) == 0)
{
PrintfMess();
DBG_LOG("Number of failed uploads:%d\r\n",App.Upload45S10SCount);
if(App.Upload45S10SCount >= 9)
{
DBG_LOG("Resend registration information.\r\n");
SGCP.LoginOk = false;
App.LoginFlag = true;
}
}
else
{
PrintfMess();
App.Upload_LPTimer0 = true;
LPTimer0_ON((App.Nonce % 100) + 45);//随机延时100~10000ms+45秒后重新发送
//LPTimer0_ON(100);//定时10s
DBG_LOG("Number of failed uploads:%d\r\n",App.Upload45S10SCount);
DBG_LOG("Upload LPTimer0 Open\r\n");
}
}
else if(SGCP.UploadOk == true)
{
App.Upload45S10SCount = 0;
}
SGCP.UploadMess = false;
App.TD1mSDelayCnt = 1000;
App.Status = APP_STATUS_ACTION;
}
break;}
}
}
static void App1mSRoutine(void)
{
if(App.TD1mSDelayCnt > 0)
App.TD1mSDelayCnt--;
if(App.ReadData1mSDelayCnt > 0)
App.ReadData1mSDelayCnt--;
App.FeedDogDlyCnt++;
if(App.TestTimeCnt > 0)
{
App.TestTimeCnt--;
if(App.TestTimeCnt <= 0)
{
LASER1_OFF();
}
}
}
void FeedDogHandler(void)
{
if(App.FeedDogDlyCnt >= 200) {
FeedDog();
App.FeedDogDlyCnt = 0;
}
}
void SystemResetHandler(void)
{
//系统定时重启
if(App.SysResetTimeCnt > SYSTEM_TIMING_LOGIN) {
delay_ms(5);
SystemReset();
while(1);
}
}
/**
******************************************************************************
** \brief Main function of project
**
** \return uint32_t return value, if needed
**
** This sample
**
******************************************************************************/
int32_t main(void)
{
BspInit();
delay_ms(3000);//上电延时,等待从设备启动
AppInit();
while (1) {
#if(USE_VBAT_AD == 1)
ADCLoopHandler();
#endif
#if(USE_WDT == 1)
FeedDogHandler();
#endif
#if(USE_DEBUG == 1)
DebugLoopHandler();
#endif
Lsm6dslLoopHandler();
MMC5983LoopHandler();
ReadDataLoopHandler();
GwRevLoopHandler();
InRevLoopHandler();
AppLoopHandler();
}
}
/*******************************************************************************
* 中断回调函数
******************************************************************************/
void SysTick_CallBack(void)
{
App1mSRoutine();
SGCP1mSRoutine();
Debug1mSRoutine();
Lsm6dsl1mSRoutine();
MMC59831mSRoutine();
}
void RtcIRQHander(void)
{
//SGCP.TimingAcquisition = true; //30S更新一次数据
#if USE_LORA_CH == CH0
App.Tcnt++;//一分钟开启激光3秒
if(App.Tcnt >= 2)
{
App.Tcnt = 0;
App.LaserFlag = true;
}
#endif
if(SGCP.LoginOk == true)
{
App.RepeLoginCount++;
if(App.RepeLoginCount >= SYSTEM_TIMING_LOGIN){
DBG_LOG("24h Repetition Login\r\n");
App.RepeLoginCount = 0;
SGCP.LoginOk = false;//24h重复注册
App.Login2Min30SCount = 0;
App.Login30MinCount = 0;
App.Login_RTC = false;//关闭30分注册定时器
LPTimer0_ON((App.Nonce % 1200) + 300);//定时30s+随机2分钟,最小间隙100ms
DBG_LOG("Login LPTimer0 Open\r\n");
}
App.Coll_N++;
if(App.Coll_N >= App.Para.Layout.CollectTime)
{
App.Coll_N = 0;
SGCP.TimingAcquisition = true; //定时更新数据
}
if(App.ERFlag == true)
{
App.ERInterval_N++;
App.ERTime_N++;
if(App.ERInterval_N >= App.Para.Layout.ERInterval)
{
App.ERInterval_N = 0;
App.UploadFlag = true;
}
if(App.ERTime_N >= App.Para.Layout.ERTime)
{
App.ERTime_N = 0;
App.ERFlag = false;
SGCP.MasterCaliOk = true;//紧急上报时间结束,重新校准参数
}
}
else{
App.Repor_N++;
if(App.Repor_N >= App.Para.Layout.ReportInterval)
{
App.Repor_N = 0;
App.UploadFlag = true;
}
}
}
if(App.Login_RTC == true)
{
App.Login30MinCount++;
if(App.Login30MinCount >= ERR_TIMING_LOGIN)//30分钟重置注册错误信息
{
PrintfMess();
App.Login30MinCount = 0;
App.Login_RTC = false;//关闭30分注册定时器
DBG_LOG("Login RTC Close\r\n");
App.Login_LPTimer0 = true;
LPTimer0_ON((App.Nonce % 1200) + 300);//定时30s+随机2分钟,最小间隙100ms
//LPTimer0_ON(100);//定时10s
DBG_LOG("Login LPTimer0 Open\r\n");
}
}
}
void LPTimer0IRQHander(void)
{
if(App.Login_LPTimer0 == true)
{
App.Login_LPTimer0 = false;
App.LoginFlag = true;
}
if(App.Upload_LPTimer0 == true)
{
App.Upload_LPTimer0 = false;
App.UploadFlag = true;
}
}