/**
|
******************************************************************************
|
* @file : KWireLess.c
|
* @brief : K-WireLess Protocol program body
|
******************************************************************************
|
*/
|
#include "KWireLess2.h"
|
#include "functions.h"
|
#include "string.h"
|
#include "PLCFunctions.h"
|
#include "stm32f0xx_hal.h"
|
|
|
/**************************************************************************************************************************************
|
Demo 程序流程 RadioEnableMaster=true 为主机端，主机端发送一个"PING"数据后切换到接收，等待从机返回的应答"PONG"数据LED闪烁
|
|
RadioEnableMaster=false 为从机端，从机端接收到主机端发过来的"PING"数据后LED闪烁并发送一个"PONG"数据作为应答
|
***************************************************************************************************************************************/
|
|
#define USE_MODEM_LORA
|
//#define USE_MODEM_FSK
|
|
/*
|
#if defined( USE_MODEM_LORA )
|
|
#define LORA_BANDWIDTH 1 // [0: 125 kHz,
|
// 1: 250 kHz,
|
// 2: 500 kHz,
|
// 3: Reserved]
|
#define LORA_SPREADING_FACTOR 8 // [SF5..SF12]
|
#define LORA_CODINGRATE 4 // [1: 4/5,
|
// 2: 4/6,
|
// 3: 4/7,
|
// 4: 4/8]
|
#define LORA_PREAMBLE_LENGTH 4 // Same for Tx and Rx
|
|
*/
|
#define LORA_SYMBOL_TIMEOUT 0 // Symbols
|
#define LORA_FIX_LENGTH_PAYLOAD_ON false
|
#define LORA_IQ_INVERSION_ON false
|
|
/*
|
#elif defined( USE_MODEM_FSK )
|
|
#define FSK_FDEV 20e3 // Hz
|
#define FSK_DATARATE 19.2e3 // bps
|
#define FSK_BANDWIDTH 60e3 // Hz >> DSB in sx126x
|
#define FSK_AFC_BANDWIDTH 200e3 // Hz
|
#define FSK_PREAMBLE_LENGTH 5 // Same for Tx and Rx
|
#define FSK_FIX_LENGTH_PAYLOAD_ON false
|
|
#else
|
#error "Please define a modem in the compiler options."
|
#endif
|
*/
|
/*
|
#define nChannelSpacing 530000 // Hz
|
#define TX_OUTPUT_POWER 16 // 22 dBm
|
*/
|
|
|
extern bool IrqFired;
|
|
//bool RadioEnableMaster=true;//主从选择
|
//uchar nRadioChannel = 0;
|
//uchar nRadioAddr = 1;
|
uint16_t crc_value;
|
|
#define MixAddr(x,y) ((x<<4)|(y))
|
/*!
|
* Radio events function pointer
|
*/
|
#define MASTER_RX_TIMEOUT_VALUE 80 //mS
|
#define SLAVE_RX_TIMEOUT_VALUE 400 //mS
|
#define CYCLE_TIME 80 //mS
|
|
const stWLConfig defaultWLConfig =
|
{
|
.RF_T_Freq = 430620000, // uint32_t Hz
|
.RF_R_Freq = 430620000, // uint32_t //Hz
|
.nChnSpacing = 530, // uint16_t ChannelSpacing; //kHz
|
.nCycleTime = CYCLE_TIME, // CycleTime
|
// .ModemType = 1, // //0: FSK, 1: LoRa
|
.workMode = 3, // 0, None 1, Uni, 2 Thr, 3 Multi1, 4 Multi2, 5 MulMa
|
.nChannel = 0,
|
.bMaster = 0,
|
.nRadioAddr =1 ,
|
.bEnableMulti = 0,
|
|
.Tx_Power = 20, // uchar Tx_Power;
|
.LoraBandWidth = 1, // uchar LoraBandWidth; // [0: 125 kHz, 1: 250 kHz, 2: 500 kHz, 3: Reserved ]
|
.LoRaFactor = 5, // uchar LoRaFactor; // [SF5 .. SF 12]
|
.LoRaCodingRate = 1, // uchar LoRaCodingRate; // [1 : 4/5, 2: 4/6, 3: 4/7, 4: 4/8
|
.NetWorkAddr = 0x00, // uint8_t NetWorkAddr;
|
.DeviceAddr = 0x0102, // uint16_t DeviceAddr;
|
.bEnableAddr = 0, // uchar bEnableAddr;
|
.bEnableEncrypt = 0, // uchar bEnableEncrypt;
|
.bEnableRelay = 0, // uchar bEnableRelay;
|
.LoRaPreambleLen = 4, // uchar LoRaPreamble_Len; // 2 - 12
|
.bAutoPower = 1,
|
.bAutoReSend = 1, // 自动重发
|
};
|
|
//stWLConfig * pWLCfg = (stWLConfig *)&defaultWLConfig;
|
static RadioEvents_t RadioEvents;
|
|
stWLConfig WLCfg ;
|
stWLRunStat KwRunStat;
|
|
typedef enum
|
{
|
LOWPOWER,
|
RX,
|
RX_TIMEOUT,
|
RX_ERROR,
|
TX,
|
TX_TIMEOUT,
|
}States_t;
|
|
|
|
#define WL_RX_BUFFER_SIZE 160 // Define the payload size here
|
#define WL_TX_BUFFER_SIZE 160 // Define the payload size here
|
|
uint16_t nTimeOnAir;
|
/*
|
const uint8_t PingMsg[] = "PING";
|
const uint8_t PongMsg[] = "PONG";
|
*/
|
|
//uint16_t BufferSize = BUFFER_SIZE;
|
uint8_t KwRx_Buffer[WL_RX_BUFFER_SIZE];
|
uint8_t KwTx_Buffer[WL_TX_BUFFER_SIZE];
|
|
#define WL_TT_EACH_SIZE 64 // transparent transmission byte size for each send
|
|
|
States_t State = LOWPOWER;
|
|
int8_t RssiValue = 0;
|
int8_t SnrValue = 0;
|
|
emKWStates KW_State=KW_UNINIT;
|
|
void LedToggle(void)
|
{
|
// GPIO_WriteBit( LED1_PORT, LED1_PIN,Bit_RESET);//LED闪烁
|
// HAL_Delay_nMS(10);
|
// GPIO_WriteBit( LED1_PORT, LED1_PIN,Bit_SET);
|
|
LL_GPIO_TogglePin(GPIOC,LL_GPIO_PIN_13);
|
}
|
|
int LoadKwConfig(void)
|
{
|
stStoredWLConfig * pstStoredWLCFG = (stStoredWLConfig *)(STORE_KWCONFIG_BASE);
|
|
if (pstStoredWLCFG->BlockSign == 0x55AA && pstStoredWLCFG->BlockType == 0x05) {
|
WLCfg = pstStoredWLCFG->WLConfig;
|
} else {
|
WLCfg = defaultWLConfig;
|
}
|
return 0;
|
}
|
|
int SaveKwConfig(void)
|
{
|
// stStoredWLConfig * pstStoredWLCFG = (stStoredWLConfig *)(STORE_KWCONFIG_BASE);
|
|
stStoredWLConfig theStoredWLCFG;
|
theStoredWLCFG.BlockSign = 0x55AA;
|
theStoredWLCFG.BlockType = 0x05;
|
theStoredWLCFG.nSeq = 1;
|
theStoredWLCFG.nSize = sizeof(stWLConfig);
|
theStoredWLCFG.WLConfig = WLCfg;
|
theStoredWLCFG.nCRC16 = 0x0000;
|
EraseAndWriteToFlashMem(&theStoredWLCFG, (void *)STORE_KWCONFIG_BASE, sizeof(stStoredWLConfig));
|
|
return 0;
|
}
|
|
int KWireLessInit(bool bRadioEnableMaster, uint32_t nChannel, uint8_t nRadioAddr)
|
{
|
stWLConfig * pWLCfg = & WLCfg;
|
pWLCfg->bMaster = bRadioEnableMaster;
|
// Radio initialization
|
RadioEvents.TxDone = OnTxDone;
|
RadioEvents.RxDone = OnRxDone;
|
RadioEvents.TxTimeout = OnTxTimeout;
|
RadioEvents.RxTimeout = OnRxTimeout;
|
RadioEvents.RxError = OnRxError;
|
RadioEvents.CadDone = OnCadDone;
|
|
Radio.Init( &RadioEvents );
|
pWLCfg->nChannel = nChannel;
|
KwRunStat.RF_Freq = pWLCfg->RF_T_Freq + pWLCfg->nChannel * pWLCfg->nChnSpacing*1000;
|
Radio.SetChannel( KwRunStat.RF_Freq );
|
pWLCfg->nRadioAddr = nRadioAddr;
|
KwRunStat.nCurClient = 1;
|
// Radio.WriteBuffer(0x06C0,data,2);
|
// Radio.ReadBuffer(0x06C0,test,2);
|
|
#if defined( USE_MODEM_LORA )
|
/*
|
Radio.SetTxConfig( MODEM_LORA, TX_OUTPUT_POWER, 0, LORA_BANDWIDTH,
|
LORA_SPREADING_FACTOR, LORA_CODINGRATE,
|
LORA_PREAMBLE_LENGTH, LORA_FIX_LENGTH_PAYLOAD_ON,
|
true, 0, 0, LORA_IQ_INVERSION_ON, 3000 );
|
|
Radio.SetRxConfig( MODEM_LORA, LORA_BANDWIDTH, LORA_SPREADING_FACTOR,
|
LORA_CODINGRATE, 0, LORA_PREAMBLE_LENGTH,
|
LORA_SYMBOL_TIMEOUT, LORA_FIX_LENGTH_PAYLOAD_ON,
|
0, true, 0, 0, LORA_IQ_INVERSION_ON, false );
|
// */
|
|
Radio.SetTxConfig( MODEM_LORA, pWLCfg->Tx_Power, 0, pWLCfg->LoraBandWidth,
|
pWLCfg->LoRaFactor, pWLCfg->LoRaCodingRate,
|
pWLCfg->LoRaPreambleLen, LORA_FIX_LENGTH_PAYLOAD_ON,
|
true, 0, 0, LORA_IQ_INVERSION_ON, 3000 );
|
|
Radio.SetRxConfig( MODEM_LORA, pWLCfg->LoraBandWidth, pWLCfg->LoRaFactor,
|
pWLCfg->LoRaCodingRate, 0, pWLCfg->LoRaPreambleLen,
|
LORA_SYMBOL_TIMEOUT, LORA_FIX_LENGTH_PAYLOAD_ON,
|
0, true, 0, 0, LORA_IQ_INVERSION_ON, false );
|
|
Radio.SetMaxPayloadLength(MODEM_LORA,32);
|
|
#elif defined( USE_MODEM_FSK )
|
|
Radio.SetTxConfig( MODEM_FSK, TX_OUTPUT_POWER, FSK_FDEV, 0,
|
FSK_DATARATE, 0,
|
FSK_PREAMBLE_LENGTH, FSK_FIX_LENGTH_PAYLOAD_ON,
|
true, 0, 0, 0, 3000 );
|
|
Radio.SetRxConfig( MODEM_FSK, FSK_BANDWIDTH, FSK_DATARATE,
|
0, FSK_AFC_BANDWIDTH, FSK_PREAMBLE_LENGTH,
|
0, FSK_FIX_LENGTH_PAYLOAD_ON, 0, true,
|
0, 0,false, false );
|
#else
|
#error "Please define a modem in the compiler options.."
|
#endif
|
SX126xSetRxTxFallbackMode(0x40); // 0x40-> FS 0x30 -> SD_XOSC 0x20 -> SD_RC
|
|
SX126xSetCadParams(LORA_CAD_02_SYMBOL,22,10,LORA_CAD_ONLY,1);
|
|
nTimeOnAir = Radio.TimeOnAir(MODEM_LORA,14);
|
KwRunStat.nTimeOnAir = nTimeOnAir;
|
// KMem.WDT[38]=nTimeOnAir;
|
KwRunStat.runStep=RS_IDLE;
|
KMem.WDT[0]++;
|
KwRunStat.Tx_Power = WLCfg.Tx_Power;
|
KwRunStat.LoraBandWidth = WLCfg.LoraBandWidth;
|
KwRunStat.LoRaFactor = WLCfg.LoRaFactor;
|
KwRunStat.LoRaCodingRate = WLCfg.LoRaCodingRate;
|
KwRunStat.LoRaPreambleLen = WLCfg.LoRaPreambleLen;
|
|
return 0;
|
}
|
|
int KwResetRf()
|
{
|
// LoadKwConfig();
|
// KWireLessInit(RadioEnableMaster,nRadioChannel);
|
Radio.Standby();
|
KwRunStat.runStep=RS_IDLE;
|
return 0;
|
}
|
|
int KwStartRecv(int nChnd)
|
{
|
|
Radio.Standby();
|
Radio.SetChannel( KwRunStat.RF_Freq );
|
Radio.SetRxConfig( MODEM_LORA, WLCfg.LoraBandWidth, WLCfg.LoRaFactor,
|
WLCfg.LoRaCodingRate, 0, WLCfg.LoRaPreambleLen,
|
LORA_SYMBOL_TIMEOUT, LORA_FIX_LENGTH_PAYLOAD_ON,
|
0, true, 0, 0, LORA_IQ_INVERSION_ON, false );
|
|
Radio.SetMaxPayloadLength(MODEM_LORA,32);
|
|
Radio.Rx( SLAVE_RX_TIMEOUT_VALUE );
|
KwRunStat.runStep=RS_RECVING;
|
|
KwRunStat.ClientStat[KwRunStat.nCurClient].lastActTime = GetTick();
|
KwRunStat.ClientStat[KwRunStat.nCurClient].lastRecvtime = GetTick();
|
return 0;
|
}
|
|
int KWireLessStart(void)
|
{
|
if(WLCfg.bMaster)
|
{
|
KWLMasterSendReqPkt(1);
|
}
|
else
|
{
|
KwStartRecv(1);
|
}
|
|
// while( 1 )
|
// {
|
// Radio.IrqProcess( ); // Process Radio IRQ
|
// }
|
return 0;
|
}
|
|
|
void OnTxDone( void )
|
{
|
KwRunStat.bMasterSent = 1;
|
KwRunStat.bMasterRecved = 0;
|
KwRunStat.runStep=RS_IDLE;
|
KMem.WDT[42]++;
|
KwRunStat.ClientStat[KwRunStat.nCurClient].lastSenttime = GetTick();
|
KwRunStat.ClientStat[KwRunStat.nCurClient].lastAckTime = GetTick();
|
Radio.Standby();
|
if (WLCfg.bMaster) {
|
Radio.Rx( MASTER_RX_TIMEOUT_VALUE ); //进入接收
|
} else {
|
KwStartRecv(1);
|
//Radio.Rx( SLAVE_RX_TIMEOUT_VALUE ); //进入接收
|
}
|
KwRunStat.runStep=RS_RECVING;
|
|
KwRunStat.ClientStat[KwRunStat.nCurClient].lastActTime = GetTick();
|
KwRunStat.ClientStat[KwRunStat.nCurClient].lastRecvtime = GetTick();
|
LL_GPIO_TogglePin(GPIOC,LL_GPIO_PIN_14);
|
// int us2=GetTick();
|
// KMem.ScanTimeuS=us2-KMem.LastScanTime;
|
// KMem.LastScanTime = us2;
|
// if (KMem.ScanTimeuS < KMem.MinScanTimeuS) {KMem.MinScanTimeuS = KMem.ScanTimeuS;}
|
// if (KMem.ScanTimeuS > KMem.MaxScanTimeuS) {KMem.MaxScanTimeuS = KMem.ScanTimeuS;}
|
|
}
|
|
void OnTxTimeout( void )
|
{
|
KwRunStat.runStep=RS_IDLE;
|
KwRunStat.ClientStat[KwRunStat.nCurClient].lastAckTime = GetTick();
|
KwRunStat.ClientStat[KwRunStat.nCurClient].TXErr++;
|
Radio.Standby();
|
// KMem.WDT[44]++;
|
}
|
bool bThisRxError=0;
|
|
void OnRxDone( uint8_t *payload, uint16_t size, int16_t rssi, int8_t snr )
|
{
|
KMem.WDT[44] = size;
|
if (size <= 120) {
|
memcpy( KwRx_Buffer, payload, size );
|
memcpy(&KMem.WDT[64],payload,size);
|
}else
|
{
|
|
}
|
Radio.Standby();
|
KwRunStat.runStep = RS_IDLE;
|
|
|
KwRunStat.curStat = 0;
|
KwRunStat.ClientStat[KwRunStat.nCurClient].latancy = GetTick() - KwRunStat.ClientStat[KwRunStat.nCurClient].lastSendtime;
|
|
RssiValue = rssi;
|
SnrValue = snr;
|
|
KwRunStat.ClientStat[KwRunStat.nCurClient].RSSI = RssiValue;
|
KwRunStat.ClientStat[KwRunStat.nCurClient].SNR = SnrValue;
|
|
KwRunStat.ClientStat[KwRunStat.nCurClient].recvCount++;
|
// KwRunStat.CtnLstPkts=0;
|
|
if(WLCfg.bMaster)
|
{
|
KWLMasterParsePkt(WLCfg.nChannel,size);
|
//KWLMasterSendReqPkt(1);
|
}
|
else //slave
|
{
|
KWLSlaveParsePkt(WLCfg.nChannel,size);
|
}
|
if (bThisRxError) {
|
bThisRxError=0;
|
// return;
|
}
|
}
|
|
void OnRxTimeout( void )
|
{
|
KwRunStat.runStep=RS_IDLE;
|
|
Radio.Standby();
|
stClientStat * pClientStat = &KwRunStat.ClientStat[KwRunStat.nCurClient];
|
pClientStat->lastErrTime = GetTick() - pClientStat->lastAckTime;
|
pClientStat->lastAckTime = GetTick();
|
|
KwRunStat.Tx_Power+=6; //丢包， 增加发射功率
|
if (KwRunStat.Tx_Power > WLCfg.Tx_Power) {KwRunStat.Tx_Power= WLCfg.Tx_Power; }
|
SX126xSetRfTxPower(KwRunStat.Tx_Power);
|
|
|
KMem.WDT[45]++;
|
pClientStat->LostPackets++;
|
pClientStat->CtnLstPkts++;
|
if (pClientStat->CtnLstPkts > pClientStat->MaxCtnLstPkts) {pClientStat->MaxCtnLstPkts = pClientStat->CtnLstPkts;}
|
// KwRunStat.ErrStat=500;
|
if (pClientStat->CtnLstPkts > 2) { KwRunStat.ErrStat=500;}
|
if (pClientStat->CtnLstPkts ==3 ) {pClientStat->Err1Count++;}
|
if (pClientStat->CtnLstPkts > 5) { KwRunStat.ErrStat=5000;}
|
if (pClientStat->CtnLstPkts == 6) {pClientStat->Err2Count++;}
|
if (pClientStat->CtnLstPkts > 9) { KwRunStat.ErrStat=5000; KMem.WFX[1]=0; }
|
if (pClientStat->CtnLstPkts == 10) {pClientStat->Err3Count++;}
|
if ((pClientStat->CtnLstPkts &0x0f) == 0x0f) {
|
KMem.WDT[51]++;
|
KwResetRf();
|
Radio.Standby();
|
// KWireLessStart();
|
}
|
if(WLCfg.bMaster)
|
{
|
//KWLMasterSendReqPkt(1);
|
}
|
else
|
{
|
KwStartRecv(1);
|
// Radio.Standby();
|
// Radio.Rx( SLAVE_RX_TIMEOUT_VALUE );
|
// KwRunStat.runStep=RS_RECVING;
|
// KwRunStat.lastActTime = GetTick();
|
// KwRunStat.lastRecvtime = GetTick();
|
}
|
}
|
|
|
void OnRxError( void )
|
{
|
KwStartRecv(1);
|
// Radio.Standby();
|
// Radio.Rx( SLAVE_RX_TIMEOUT_VALUE );
|
// KwRunStat.runStep=RS_RECVING;
|
// KwRunStat.lastActTime = GetTick();
|
// KwRunStat.lastRecvtime = GetTick();
|
|
KwRunStat.ClientStat[KwRunStat.nCurClient].RXErr++;
|
KMem.WDT[46]++;
|
bThisRxError=1;
|
KwRunStat.ClientStat[KwRunStat.nCurClient].lastErrTime = GetTick() - KwRunStat.ClientStat[KwRunStat.nCurClient].lastAckTime;
|
|
if(WLCfg.bMaster)
|
{
|
// SendPingMsg();
|
}
|
else
|
{
|
/*
|
// Radio.Rx( RX_TIMEOUT_VALUE );
|
//KwRunStat.lastActTime = GetTick();
|
KwRunStat.LostPackets++;
|
KwRunStat.CtnLstPkts++;
|
if (KwRunStat.CtnLstPkts > KwRunStat.MaxCtnLstPkts) {KwRunStat.MaxCtnLstPkts = KwRunStat.CtnLstPkts;}
|
// KwRunStat.ErrStat=500;
|
if (KwRunStat.CtnLstPkts > 1) { KwRunStat.ErrStat=500; }
|
if (KwRunStat.CtnLstPkts == 2) {KwRunStat.Err1Count++;}
|
if (KwRunStat.CtnLstPkts > 3) { KwRunStat.ErrStat=5000;}
|
if (KwRunStat.CtnLstPkts == 4) {KwRunStat.Err2Count++;}
|
if (KwRunStat.CtnLstPkts > 6) { KwRunStat.ErrStat=5000; KMem.WFX[1]=0; }
|
if (KwRunStat.CtnLstPkts == 7) {KwRunStat.Err3Count++;}
|
*/
|
}
|
// Radio.Standby();
|
}
|
|
void OnCadDone( bool channelActivityDetected)
|
{
|
KMem.WDT[60]++;
|
KwRunStat.ClientStat[KwRunStat.nCurClient].CADDoneCount++;
|
KwRunStat.ClientStat[KwRunStat.nCurClient].lastAckTime = GetTick();
|
KMem.WDT[16] = KwRunStat.ClientStat[KwRunStat.nCurClient].lastAckTime - KwRunStat.ClientStat[KwRunStat.nCurClient].lastActTime;
|
if (channelActivityDetected) {
|
KwRunStat.ClientStat[KwRunStat.nCurClient].CADNgCount++;
|
KMem.WDT[61]++;
|
Radio.StartCad();
|
KwRunStat.ClientStat[KwRunStat.nCurClient].lastActTime = GetTick();
|
}
|
else {
|
KwRunStat.ClientStat[KwRunStat.nCurClient].CADOkCount++;
|
KMem.WDT[62]++;
|
if (WLCfg.bMaster) {
|
if (KwRunStat.curStat == 0 ){ //&& stat == RF_IDLE ) //200mS
|
// Radio.Standby();
|
KWireLessStart();
|
}else {
|
Radio.Standby();
|
KWireLessStart();
|
}
|
}else {
|
KWLSlaveSendRplyPkt(1);
|
}
|
}
|
return;
|
}
|
|
int KWLMasterParsePkt(int nChn,int size)
|
{
|
bool CRC_OK =1;
|
///*
|
crc_value=RadioComputeCRC(KwRx_Buffer,size-2,CRC_TYPE_IBM);//计算得出要发送数据包CRC值
|
if (KwRx_Buffer[size-2] != (crc_value&0xff) && KwRx_Buffer[size-1] != (crc_value >> 8))
|
{
|
KwRunStat.ClientStat[KwRunStat.nCurClient].CRCErr++;
|
KwRunStat.ErrStat=500;
|
CRC_OK = 0;
|
}else {
|
CRC_OK = 1;
|
}
|
//*/
|
pstKwPacket p1 = (pstKwPacket) KwRx_Buffer;
|
if(CRC_OK && p1->STSign == enRplySign ) //memcmp(RX_Buffer,PongMsg,4)==0
|
{
|
if (p1->DstAddr == MixAddr(WLCfg.nChannel,WLCfg.nRadioAddr))
|
{
|
KwRunStat.bMasterRecved = 1;
|
LedToggle();//LED闪烁
|
KwRunStat.ClientStat[KwRunStat.nCurClient].lastRecvdtime=GetTick();
|
KwRunStat.ClientStat[KwRunStat.nCurClient].lastAckTime = GetTick();
|
KwRunStat.ClientStat[KwRunStat.nCurClient].CtnLstPkts=0;
|
|
if (p1->Stat==0) {
|
KwRunStat.ClientStat[KwRunStat.nCurClient].tRSSI = KwRx_Buffer[10];
|
KwRunStat.ClientStat[KwRunStat.nCurClient].tSNR = KwRx_Buffer[11];
|
if (KwRunStat.ClientStat[KwRunStat.nCurClient].tRSSI > -50) {
|
if (KwRunStat.Tx_Power > 0) {KwRunStat.Tx_Power--; SX126xSetRfTxPower(KwRunStat.Tx_Power);}
|
}else if (KwRunStat.ClientStat[KwRunStat.nCurClient].tRSSI < -60) {
|
KwRunStat.Tx_Power+=6;
|
if (KwRunStat.Tx_Power > WLCfg.Tx_Power) {KwRunStat.Tx_Power= WLCfg.Tx_Power; }
|
SX126xSetRfTxPower(KwRunStat.Tx_Power);
|
}
|
|
}else if (p1->Stat==1){
|
KwRunStat.ClientStat[KwRunStat.nCurClient].targetSentCount = KwRx_Buffer[8] + (KwRx_Buffer[9]<<8) + (KwRx_Buffer[10]<<16) + (KwRx_Buffer[11]<<24);
|
}else if (p1->Stat==2) {
|
KwRunStat.ClientStat[KwRunStat.nCurClient].targetRecvdCount = KwRx_Buffer[8] + (KwRx_Buffer[9]<<8) + (KwRx_Buffer[10]<<16) + (KwRx_Buffer[11]<<24);
|
}else if (p1->Stat==3) {
|
}
|
|
KMem.WDT[41]=(-KwRunStat.ClientStat[KwRunStat.nCurClient].tRSSI) + ((-KwRunStat.ClientStat[KwRunStat.nCurClient].tSNR)<<8);
|
|
KMem.WFX[1]=(KwRx_Buffer[4]) + (KwRx_Buffer[5]<<8);
|
// KMem.WFX[1]=(RX_Buffer[4]) + (indicator3<<8);
|
|
KMem.WFX[2]=(KwRx_Buffer[6]) + (KwRx_Buffer[7]<<8);
|
|
// 数据透传 数据的发送成功与否，需要在对方的应答包中确认
|
if (KwRunStat.sizesending > 0) {
|
// 确认正在发送的，发送成功
|
KwRunStat.sentsize += KwRunStat.sizesending;
|
KwRunStat.sizesending = 0;
|
|
if (KwRunStat.sentsize >= KwRunStat.sizetosend) {
|
//整体 发送完成
|
KwRunStat.sizetosend =0;
|
KwRunStat.sentsize = 0;
|
KwRunStat.ttAirSize = 0;
|
// 发送完成
|
}
|
}
|
// 接受到对方发来的数据
|
|
if (p1->bHasData && size >= 14+3 ) {
|
// int nFulllen1 = KwRx_Buffer[12];
|
int nthislen2 = KwRx_Buffer[13];
|
if (size >= 14 + nthislen2) {
|
if (p1->bHead) {
|
// 数据包的起始， 一个新的数据包的开始
|
KwRunStat.ttRxSize = 0;
|
// SendPacket(1, "H", 1);
|
|
}
|
memcpy (KwRunStat.ttRxBuf1 + KwRunStat.ttRxSize , KwRx_Buffer + 14 , nthislen2);
|
KwRunStat.ttRxSize += nthislen2;
|
if (p1->bTail)
|
{
|
// 已经收到完整的一个数据包
|
KwRunStat.ttRxRecved =1;
|
KwRunStat.ErrStat=500;
|
// SendPacket(1, "T", 1);
|
|
// 后续数据包处理流程 ;
|
if (Uart1Mode == 1) { // 处于透传模式， 数据发回去。
|
SendPacket(1, KwRunStat.ttRxBuf1, KwRunStat.ttRxSize);
|
}
|
KwRunStat.ttRxSize = 0;
|
KwRunStat.ttRxRecved = 0;
|
|
// 暂时流程，全部发回去。
|
// memcpy (KwRunStat.ttTxBuf1, KwRunStat.ttRxBuf1, KwRunStat.ttRxSize);
|
// KwRunStat.sizetosend = KwRunStat.ttRxSize;
|
// KwRunStat.sentsize = 0;
|
// KwRunStat.sizesending = 0;
|
}
|
|
}
|
}
|
|
/*
|
|
|
|
if (KwRunStat.ttAirSize > 0)
|
{
|
if (KwRunStat.bttAirHeader) { KwRunStat.ttRxRecved=0; }
|
memcpy(KwRunStat.ttRxBuf1 + KwRunStat.ttRxRecved,KwRunStat.ttAirBuf, KwRunStat.ttAirSize);
|
KwRunStat.ttRxRecved += KwRunStat.ttAirSize;
|
|
if (KwRunStat.bttAirTail) {
|
// 收到 一个数据包的最后部分
|
KwRunStat.ttRxSize = KwRunStat.ttRxRecved;
|
if (Uart1Mode == 1) { // 处于透传模式， 数据发回去。
|
SendPacket(1, KwRunStat.ttRxBuf1, KwRunStat.ttRxSize);
|
}
|
KwRunStat.ttRxSize = 0;
|
KwRunStat.ttRxRecved = 0;
|
}
|
KwRunStat.ttAirSize = 0;
|
}
|
*/
|
|
}
|
}
|
|
return 0;
|
}
|
int KWLSlaveParsePkt(int nChn,int size)
|
{
|
bool CRC_OK =1;
|
pstKwPacket p1 = (pstKwPacket) KwRx_Buffer;
|
///*
|
crc_value=RadioComputeCRC(KwRx_Buffer,size-2,CRC_TYPE_IBM);//计算得出要发送数据包CRC值
|
if (KwRx_Buffer[size-2] != (crc_value&0xff) && KwRx_Buffer[size-1] != (crc_value >> 8))
|
{
|
KwRunStat.ClientStat[KwRunStat.nCurClient].CRCErr++;
|
// KwRunStat.ErrStat=500;
|
CRC_OK = 0;
|
}else {
|
CRC_OK = 1;
|
if (p1->STSign != enReqSign) {
|
KwRunStat.ClientStat[KwRunStat.nCurClient].PktErr++;
|
}else {
|
if (p1->DstAddr != MixAddr(WLCfg.nChannel,WLCfg.nRadioAddr)) {
|
KwRunStat.ClientStat[KwRunStat.nCurClient].ChnErr++;
|
KwRunStat.ClientStat[KwRunStat.nCurClient].nErrChn = p1->DstAddr;
|
}
|
}
|
}
|
//*/
|
|
if(CRC_OK && p1->STSign == enReqSign && p1->DstAddr == MixAddr(WLCfg.nChannel,WLCfg.nRadioAddr))// memcmp(RX_Buffer,PingMsg,4)==0 && )
|
{
|
|
LedToggle();//LED闪烁
|
KwRunStat.ClientStat[KwRunStat.nCurClient].lastRecvdtime=GetTick();
|
KwRunStat.ClientStat[KwRunStat.nCurClient].lastAckTime = GetTick();
|
KwRunStat.ClientStat[KwRunStat.nCurClient].CtnLstPkts=0;
|
int nSeq = p1->nSeq;
|
if (nSeq==0) {
|
KwRunStat.ClientStat[KwRunStat.nCurClient].tRSSI = KwRx_Buffer[10];
|
KwRunStat.ClientStat[KwRunStat.nCurClient].tSNR = KwRx_Buffer[11];
|
if (KwRunStat.ClientStat[KwRunStat.nCurClient].tRSSI > -50) {
|
if (KwRunStat.Tx_Power > 0) {KwRunStat.Tx_Power--; SX126xSetRfTxPower(KwRunStat.Tx_Power);}
|
}else if (KwRunStat.ClientStat[KwRunStat.nCurClient].tRSSI < -60) {
|
KwRunStat.Tx_Power+=6;
|
if (KwRunStat.Tx_Power > WLCfg.Tx_Power) {KwRunStat.Tx_Power= WLCfg.Tx_Power; }
|
SX126xSetRfTxPower(KwRunStat.Tx_Power);
|
}
|
}else if (nSeq==1){
|
KwRunStat.ClientStat[KwRunStat.nCurClient].targetSentCount = KwRx_Buffer[8] + (KwRx_Buffer[9]<<8) + (KwRx_Buffer[10]<<16) + (KwRx_Buffer[11]<<24);
|
}else if (nSeq==2) {
|
KwRunStat.ClientStat[KwRunStat.nCurClient].targetRecvdCount = KwRx_Buffer[8] + (KwRx_Buffer[9]<<8) + (KwRx_Buffer[10]<<16) + (KwRx_Buffer[11]<<24);
|
}else if (nSeq==3) {
|
}
|
KMem.WFX[1]=(KwRx_Buffer[4]) + (KwRx_Buffer[5]<<8);
|
// KMem.WFX[1]=(RX_Buffer[4]) + (indicator3<<8);
|
|
KMem.WFX[2]=(KwRx_Buffer[6]) + (KwRx_Buffer[7]<<8);
|
|
// 数据透传 数据的发送成功与否，需要在对方的应答包中确认
|
if (KwRunStat.sizesending > 0) {
|
// 确认正在发送的，发送成功
|
KwRunStat.sentsize += KwRunStat.sizesending;
|
KwRunStat.sizesending = 0;
|
|
if (KwRunStat.sentsize >= KwRunStat.sizetosend) {
|
//整体 发送完成
|
KwRunStat.sizetosend =0;
|
KwRunStat.sentsize = 0;
|
KwRunStat.ttAirSize = 0;
|
// 发送完成
|
}
|
}
|
|
if (p1->bHasData && size >= 14+3 ) {
|
// int nFulllen1 = KwRx_Buffer[12];
|
int nthislen2 = KwRx_Buffer[13];
|
if (size >= 14 + nthislen2) {
|
// 收到一个合格的携带传统数据的 包。
|
if (p1->bHead) {
|
// 数据段的起始， 一个新的数据段的开始
|
KwRunStat.ttRxSize = 0;
|
}
|
memcpy (KwRunStat.ttRxBuf1 + KwRunStat.ttRxSize, KwRx_Buffer + 14 , nthislen2);
|
KwRunStat.ttRxSize += nthislen2;
|
if (p1->bTail) {
|
// 已经收到完整的一个数据段
|
KwRunStat.ttRxRecved =1;
|
KwRunStat.ErrStat=500;
|
|
// 后续数据段处理流程 ;
|
if (Uart1Mode == 1) { // 处于透传模式， 数据发回去。
|
SendPacket(1, KwRunStat.ttRxBuf1, KwRunStat.ttRxSize);
|
}
|
KwRunStat.ttRxSize = 0;
|
KwRunStat.ttRxRecved = 0;
|
|
// 暂时流程，全部发回去。
|
// memcpy (KwRunStat.ttTxBuf1, KwRunStat.ttRxBuf1, KwRunStat.ttRxSize);
|
// KwRunStat.sizetosend = KwRunStat.ttRxSize;
|
// KwRunStat.sentsize = 0;
|
// KwRunStat.sizesending = 0;
|
// KwRunStat.ttRxRecved = 0;
|
// KwRunStat.ttRxSize = 0;
|
|
}
|
|
}
|
|
|
}
|
KWLSlaveSendRplyPkt(1);
|
// Radio.StartCad();
|
// KMem.WFY[0]=(RX_Buffer[4]<<8) + RX_Buffer[5];
|
// KMem.WFY[1]=(RX_Buffer[6]<<8) + RX_Buffer[7];
|
}
|
else
|
{
|
KwStartRecv(1);
|
// Radio.Rx( SLAVE_RX_TIMEOUT_VALUE );
|
// KwRunStat.runStep=RS_RECVING;
|
// KwRunStat.lastActTime = GetTick();
|
// KwRunStat.lastRecvtime = GetTick();
|
|
}
|
return 0;
|
}
|
|
int KWLMasterSendReqPkt(int nChn)
|
{
|
int len1=12;
|
pstKwPacket p1 = (pstKwPacket) KwTx_Buffer;
|
p1->STSign = enReqSign;
|
p1->DstAddr = MixAddr(WLCfg.nChannel,WLCfg.nRadioAddr);
|
p1->Func = 0x3;
|
KwRunStat.nSeq = (KwRunStat.nSeq + 1)&0x03;
|
p1->Stat = KwRunStat.nSeq; //0x00;
|
p1->Data[0]=KMem.WFY[1];
|
p1->Data[1]=KMem.WFY[1]>>8;
|
p1->Data[2]=KMem.WFY[2];
|
p1->Data[3]=KMem.WFY[2]>>8;
|
|
|
if (p1->Stat == 0)
|
{
|
KwTx_Buffer[10] = RssiValue;
|
KwTx_Buffer[11] = SnrValue;
|
}else if (p1->Stat == 1){
|
memcpy(KwTx_Buffer+8,&KwRunStat.ClientStat[KwRunStat.nCurClient].sentCount,4);
|
}else if (p1->Stat == 2) {
|
memcpy(KwTx_Buffer+8,&KwRunStat.ClientStat[KwRunStat.nCurClient].recvCount,4);
|
}else if (p1->Stat == 3) {
|
|
}
|
// 受限于空中包大小的限制， 透传数据可能需要分几次发送。
|
// 发送方负责拆包， 接收方负责 合包， 发送方发送第一个包，有起始标志， 发送方发送最后一个包，有结束标志。
|
// 如果只有一个包的数据，则同时具有起始和结束标志。
|
// 中间的数据包，不具有起始标志，也不具有结束标志。
|
// 利用包序列号来保证 中间 的数据包的 完整性 和顺序正确性。
|
// 先实现1个包的转发。
|
if (KwRunStat.sizetosend > 0) {
|
uchar bStart=0,bEnd=1;
|
int16_t thisToSend = KwRunStat.sizetosend - KwRunStat.sentsize;
|
if (thisToSend > WL_TT_EACH_SIZE) { thisToSend = WL_TT_EACH_SIZE; bEnd=0;}
|
|
if (KwRunStat.sentsize == 0) { // 第一次发送
|
bStart = 1;
|
}
|
|
memcpy(KwRunStat.ttAirBuf, KwRunStat.ttTxBuf1 + KwRunStat.sentsize , thisToSend); // 发送数据， 如果上次有，继续上次的发。
|
|
KwRunStat.sizesending = thisToSend;
|
KwRunStat.ttAirSize = thisToSend;
|
|
// KwRunStat.sentsize = 0;
|
KwRunStat.bttAirHeader = bStart;
|
KwRunStat.bttAirTail = bEnd;
|
|
p1->bHasData=1;
|
p1->bHead = bStart;
|
p1->bTail = bEnd;
|
|
KwTx_Buffer[len1] = KwRunStat.sizetosend;
|
KwTx_Buffer[len1+1] = thisToSend;
|
|
memcpy( KwTx_Buffer + len1 + 2 , KwRunStat.ttTxBuf1 + KwRunStat.sentsize, thisToSend);
|
len1 += 2 + thisToSend;
|
|
}
|
|
|
crc_value=RadioComputeCRC(KwTx_Buffer,len1,CRC_TYPE_IBM);//计算得出要发送数据包CRC值
|
KwTx_Buffer[len1]=crc_value;
|
KwTx_Buffer[len1+1]=crc_value>>8;
|
|
|
KMem.WDT[56]=crc_value;
|
|
KwRunStat.ClientStat[KwRunStat.nCurClient].sentCount++;
|
KwRunStat.ClientStat[KwRunStat.nCurClient].cycleTime = GetTick()- KwRunStat.ClientStat[KwRunStat.nCurClient].lastSendtime ;
|
KwRunStat.ClientStat[KwRunStat.nCurClient].lastSendtime = GetTick();
|
Radio.Send( KwTx_Buffer, len1+2);
|
KwRunStat.runStep=RS_SENDING;
|
KwRunStat.ClientStat[KwRunStat.nCurClient].lastActTime = GetTick();
|
|
return 0;
|
}
|
|
int KWLSlaveSendRplyPkt(int nChn)
|
{
|
int len1=12;
|
pstKwPacket p1 = (pstKwPacket) KwTx_Buffer;
|
p1->STSign = enRplySign;
|
p1->DstAddr = MixAddr(WLCfg.nChannel,WLCfg.nRadioAddr);
|
p1->Func = 0x3;
|
p1->Stat = (p1->Stat + 1) &0x03; //0x00;
|
p1->Data[0]=KMem.WFY[1];
|
p1->Data[1]=KMem.WFY[1]>>8;
|
p1->Data[2]=KMem.WFY[2];
|
p1->Data[3]=KMem.WFY[2]>>8;
|
|
if (p1->Stat == 0)
|
{
|
KwTx_Buffer[10] = RssiValue;
|
KwTx_Buffer[11] = SnrValue;
|
}else if (p1->Stat == 1){
|
memcpy(KwTx_Buffer+8,&KwRunStat.ClientStat[KwRunStat.nCurClient].sentCount,4);
|
}else if (p1->Stat == 2) {
|
memcpy(KwTx_Buffer+8,&KwRunStat.ClientStat[KwRunStat.nCurClient].recvCount,4);
|
}else if (p1->Stat == 3) {
|
|
}
|
|
// 受限于空中包大小的限制， 透传数据可能需要分几次发送。
|
// 发送方负责拆包， 接收方负责 合包， 发送方发送第一个包，有起始标志， 发送方发送最后一个包，有结束标志。
|
// 如果只有一个包的数据，则同时具有起始和结束标志。
|
// 中间的数据包，不具有起始标志，也不具有结束标志。
|
// 利用包序列号来保证 中间 的数据包的 完整性 和顺序正确性。
|
// 先实现1个包的转发。
|
|
if (KwRunStat.sizetosend > 0) {
|
uchar bStart=0,bEnd=1;
|
int16_t thisToSend = KwRunStat.sizetosend - KwRunStat.sentsize;
|
if (thisToSend > WL_TT_EACH_SIZE) { thisToSend = WL_TT_EACH_SIZE; bEnd=0;}
|
|
if (KwRunStat.sentsize == 0) { // 第一次发送
|
bStart = 1;
|
}
|
|
memcpy(KwRunStat.ttAirBuf, KwRunStat.ttTxBuf1 + KwRunStat.sentsize , thisToSend); // 发送数据， 如果上次有，继续上次的发。
|
|
KwRunStat.sizesending = thisToSend;
|
KwRunStat.ttAirSize = thisToSend;
|
|
// KwRunStat.sentsize = 0;
|
KwRunStat.bttAirHeader = bStart;
|
KwRunStat.bttAirTail = bEnd;
|
|
p1->bHasData=1;
|
p1->bHead = bStart;
|
p1->bTail = bEnd;
|
|
KwTx_Buffer[len1] = KwRunStat.sizetosend;
|
KwTx_Buffer[len1+1] = thisToSend;
|
|
memcpy( KwTx_Buffer + len1 + 2 , KwRunStat.ttTxBuf1 + KwRunStat.sentsize, thisToSend);
|
len1 += 2 + thisToSend;
|
|
}
|
|
crc_value=RadioComputeCRC(KwTx_Buffer,len1,CRC_TYPE_IBM);//计算得出要发送数据包CRC值
|
KwTx_Buffer[len1]=crc_value;
|
KwTx_Buffer[len1+1]=crc_value>>8;
|
Radio.Send( KwTx_Buffer, len1+2);
|
KwRunStat.runStep=RS_SENDING;
|
|
KwRunStat.ClientStat[KwRunStat.nCurClient].lastActTime = GetTick();
|
KwRunStat.ClientStat[KwRunStat.nCurClient].sentCount++;
|
KwRunStat.ClientStat[KwRunStat.nCurClient].lastSendtime = GetTick();
|
return 0;
|
}
|
|
|
int KWL_Process(int nChn)
|
{
|
RadioStatus_t rs = SX126xGetStatus();
|
KMem.WDT[1] = rs.Value;
|
|
RadioError_t er = SX126xGetDeviceErrors();
|
KMem.WDT[2] = er.Value;
|
|
KMem.WDT[3] = SX126xGetIrqStatus();
|
|
KMem.WDT[4] = SX126xGetRssiInst();
|
|
KMem.WDT[5] = GetRadioBusyPin();
|
|
RadioState_t stat = Radio.GetStatus();
|
|
KMem.WDT[32]=stat;
|
// KMem.WDT[38]=Radio.Rssi(MODEM_FSK);
|
if (WLCfg.bMaster){
|
|
KWLMasterProc(nChn);
|
}else //slave
|
{
|
KWLSlaveProc(nChn);
|
}
|
if (KwRunStat.RunStat) KwRunStat.RunStat--;
|
if (KwRunStat.ErrStat) KwRunStat.ErrStat--;
|
|
|
return 0;
|
}
|
|
int KWLMasterProc(int nChn)
|
{
|
RadioState_t stat = Radio.GetStatus();
|
|
switch (KwRunStat.runStep){
|
case RS_IDLE:
|
if (GetTick() - KwRunStat.ClientStat[KwRunStat.nCurClient].lastSendtime > (WLCfg.nCycleTime) *10 ||KwRunStat.sizetosend > 0 ){
|
Radio.StartCad();
|
KwRunStat.runStep = RS_MASTER_CAD;
|
KwRunStat.ClientStat[KwRunStat.nCurClient].lastActTime = GetTick();
|
}
|
break;
|
case RS_MASTER_CAD:
|
if (GetTick() - KwRunStat.ClientStat[KwRunStat.nCurClient].lastActTime > 15) {
|
KwRunStat.ClientStat[KwRunStat.nCurClient].CADTimeOut++;
|
KwRunStat.runStep = RS_IDLE;
|
Radio.Standby();
|
KMem.WDT[17]++;
|
KwResetRf();
|
}
|
break;
|
case RS_SENDING:
|
break;
|
case RS_SENT:
|
break;
|
case RS_RECVING:
|
if (GetTick() - KwRunStat.ClientStat[KwRunStat.nCurClient].lastSendtime > (WLCfg.nCycleTime) *10 || KwRunStat.bMasterRecved){
|
KwRunStat.ErrStat=5000;
|
KwRunStat.ClientStat[KwRunStat.nCurClient].LostPackets++;
|
KwRunStat.ClientStat[KwRunStat.nCurClient].CtnLstPkts++;
|
|
KwRunStat.Tx_Power+=6; //丢包， 增加发射功率
|
if (KwRunStat.Tx_Power > WLCfg.Tx_Power) {KwRunStat.Tx_Power= WLCfg.Tx_Power; }
|
SX126xSetRfTxPower(KwRunStat.Tx_Power);
|
|
if (KwRunStat.ClientStat[KwRunStat.nCurClient].CtnLstPkts > KwRunStat.ClientStat[KwRunStat.nCurClient].MaxCtnLstPkts) {KwRunStat.ClientStat[KwRunStat.nCurClient].MaxCtnLstPkts = KwRunStat.ClientStat[KwRunStat.nCurClient].CtnLstPkts;}
|
// KwRunStat.ErrStat=500;
|
if (KwRunStat.ClientStat[KwRunStat.nCurClient].CtnLstPkts > 1) { KwRunStat.ErrStat=2000;}
|
if (KwRunStat.ClientStat[KwRunStat.nCurClient].CtnLstPkts == 2) {KwRunStat.ClientStat[KwRunStat.nCurClient].Err1Count++;}
|
if (KwRunStat.ClientStat[KwRunStat.nCurClient].CtnLstPkts > 3) { KwRunStat.ErrStat=5000;}
|
if (KwRunStat.ClientStat[KwRunStat.nCurClient].CtnLstPkts == 4) {KwRunStat.ClientStat[KwRunStat.nCurClient].Err2Count++;}
|
if (KwRunStat.ClientStat[KwRunStat.nCurClient].CtnLstPkts > 6) { KwRunStat.ErrStat=5000; KMem.WFX[1]=0; }
|
if (KwRunStat.ClientStat[KwRunStat.nCurClient].CtnLstPkts == 7) {KwRunStat.ClientStat[KwRunStat.nCurClient].Err3Count++;}
|
if ((KwRunStat.ClientStat[KwRunStat.nCurClient].CtnLstPkts &0x0f) == 0x0f) {
|
KMem.WDT[51]++;
|
|
KwResetRf();
|
// LoadKwConfig();
|
// KWireLessInit(RadioEnableMaster,nRadioChannel);
|
// Radio.Standby();
|
// KWireLessStart();
|
}
|
|
|
KwRunStat.runStep = RS_IDLE;
|
}
|
|
break;
|
case RS_RECVED:
|
KwRunStat.runStep = RS_IDLE;
|
break;
|
|
default:
|
break;
|
|
}
|
/*
|
if (GetTick() - KwRunStat.lastSendtime > (WLCfg.nCycleTime) *10){
|
if (!KwRunStat.bMasterRecved) {
|
KwRunStat.ErrStat=5000;
|
KwRunStat.LostPackets++;
|
KwRunStat.CtnLstPkts++;
|
if (KwRunStat.CtnLstPkts > KwRunStat.MaxCtnLstPkts) {KwRunStat.MaxCtnLstPkts = KwRunStat.CtnLstPkts;}
|
// KwRunStat.ErrStat=500;
|
if (KwRunStat.CtnLstPkts > 1) { KwRunStat.ErrStat=2000;}
|
if (KwRunStat.CtnLstPkts == 2) {KwRunStat.Err1Count++;}
|
if (KwRunStat.CtnLstPkts > 3) { KwRunStat.ErrStat=5000;}
|
if (KwRunStat.CtnLstPkts == 4) {KwRunStat.Err2Count++;}
|
if (KwRunStat.CtnLstPkts > 6) { KwRunStat.ErrStat=5000; KMem.WFX[1]=0; }
|
if (KwRunStat.CtnLstPkts == 7) {KwRunStat.Err3Count++;}
|
if ((KwRunStat.CtnLstPkts &0x0f) == 0x0f) {
|
KMem.WDT[51]++;
|
// LoadKwConfig();
|
// KWireLessInit(RadioEnableMaster,nRadioChannel);
|
// Radio.Standby();
|
// KWireLessStart();
|
}
|
}
|
}
|
*/
|
/*
|
if (KwRunStat.curStat == 0 ){ //&& stat == RF_IDLE ) //200mS
|
// Radio.Standby();
|
KWireLessStart();
|
}else {
|
Radio.Standby();
|
KWireLessStart();
|
}
|
*/
|
return 0;
|
}
|
|
int KWLSlaveProc(int nChn)
|
{
|
RadioState_t stat = Radio.GetStatus();
|
if (stat == RF_IDLE){
|
KMem.WDT[48]++;
|
Radio.Standby();
|
KWireLessStart();
|
}
|
if (stat == RF_RX_RUNNING ){
|
if (GetTick() - KwRunStat.ClientStat[KwRunStat.nCurClient].lastRecvtime > ((SLAVE_RX_TIMEOUT_VALUE + 10 )*10)){
|
KwRunStat.ClientStat[KwRunStat.nCurClient].lastRecvtime = GetTick();
|
KwRunStat.ClientStat[KwRunStat.nCurClient].StepErr1++;
|
KMem.WDT[49]++;
|
Radio.Standby();
|
KWireLessStart();
|
}
|
}
|
if (stat == RF_CAD && GetTick() - KwRunStat.ClientStat[KwRunStat.nCurClient].lastRecvtime > ((2 )*10)){
|
KwRunStat.ClientStat[KwRunStat.nCurClient].StepErr2++;
|
KwRunStat.ClientStat[KwRunStat.nCurClient].CADTimeOut++;
|
KMem.WDT[50]++;
|
Radio.Standby();
|
KWireLessStart();
|
}
|
if (GetTick() - KwRunStat.ClientStat[KwRunStat.nCurClient].lastRecvdtime > 4000){ // 200mS
|
// KwRunStat.ErrStat=500;
|
KwRunStat.ErrStat=500;
|
// Radio.Standby();
|
// KWireLessStart();
|
}
|
if (GetTick() - KwRunStat.ClientStat[KwRunStat.nCurClient].lastRecvdtime > 12000){ // 1200mS
|
KwRunStat.ErrStat=5000; KMem.WFX[1]=0;
|
}
|
if (GetTick() - KwRunStat.ClientStat[KwRunStat.nCurClient].lastRecvtime > 16000){
|
KMem.WDT[52]++;
|
KwResetRf();
|
Radio.Standby();
|
KWireLessStart();
|
KwRunStat.ClientStat[KwRunStat.nCurClient].lastRecvtime = GetTick();
|
}
|
return 0;
|
}
|
