thooge/esp32-nmea2000-obp60
1
0
Fork 0
mirror of https://github.com/thooge/esp32-nmea2000-obp60.git synced 2025-12-13 05:53:06 +01:00
Code Releases Activity

handle bus recovery in driver class

Browse Source
This commit is contained in:
andreas
2023-08-25 20:14:26 +02:00
parent f5e48fcab3
commit 0d5215e00f
3 changed files with 40 additions and 23 deletions
Download Patch File Download Diff File Expand all files Collapse all files

31
lib/nmea2ktwai/Nmea2kTwai.cpp
View File

@@ -5,9 +5,12 @@
#define LOGID(id) ((id >> 8) & 0x1ffff)
Nmea2kTwai::Nmea2kTwai(gpio_num_t _TxPin, gpio_num_t _RxPin):
tNMEA2000(),RxPin(_RxPin),TxPin(_TxPin)
static const int TIMEOUT_OFFLINE=256; //# of timeouts to consider offline
Nmea2kTwai::Nmea2kTwai(gpio_num_t _TxPin, gpio_num_t _RxPin, unsigned long recP):
tNMEA2000(),RxPin(_RxPin),TxPin(_TxPin),recoveryPeriod(recP)
{
lastRecoveryCheck=millis();
}
bool Nmea2kTwai::CANSendFrame(unsigned long id, unsigned char len, const unsigned char *buf, bool wait_sent)
@@ -21,7 +24,7 @@ bool Nmea2kTwai::CANSendFrame(unsigned long id, unsigned char len, const unsigne
esp_err_t rt=twai_transmit(&message,0);
if (rt != ESP_OK){
if (rt == ESP_ERR_TIMEOUT){
txTimeouts++;
if (txTimeouts < TIMEOUT_OFFLINE) txTimeouts++;
}
logDebug(LOG_MSG,"twai transmit for %ld failed: %x",LOGID(id),(int)rt);
return false;
@@ -111,11 +114,31 @@ Nmea2kTwai::Status Nmea2kTwai::getStatus(){
rt.rx_missed=state.rx_missed_count;
rt.rx_overrun=state.rx_overrun_count;
rt.tx_timeouts=txTimeouts;
if (rt.tx_timeouts > 256 && rt.state == ST_RUNNING){
if (rt.tx_timeouts >= TIMEOUT_OFFLINE && rt.state == ST_RUNNING){
rt.state=ST_OFFLINE;
}
return rt;
}
bool Nmea2kTwai::checkRecovery(){
if (recoveryPeriod == 0) return false; //no check
unsigned long now=millis();
if ((lastRecoveryCheck+recoveryPeriod) > now) return false;
lastRecoveryCheck=now;
Status canState=getStatus();
bool strt=false;
if (canState.state != Nmea2kTwai::ST_RUNNING){
if (canState.state == Nmea2kTwai::ST_BUS_OFF){
strt=true;
bool rt=startRecovery();
logDebug(LOG_INFO,"start can recovery - result %d",(int)rt);
}
if (canState.state == Nmea2kTwai::ST_STOPPED){
bool rt=CANOpen();
logDebug(LOG_INFO,"restart can driver - result %d",(int)rt);
}
}
return strt;
}
bool Nmea2kTwai::startRecovery(){
esp_err_t rt=twai_driver_uninstall();

7
lib/nmea2ktwai/Nmea2kTwai.h
View File

@@ -5,7 +5,7 @@
class Nmea2kTwai : public tNMEA2000{
public:
Nmea2kTwai(gpio_num_t _TxPin, gpio_num_t _RxPin);
Nmea2kTwai(gpio_num_t _TxPin, gpio_num_t _RxPin, unsigned long recP=0);
typedef enum{
ST_STOPPED,
ST_RUNNING,
@@ -25,7 +25,7 @@ class Nmea2kTwai : public tNMEA2000{
STATE state=ST_ERROR;
} Status;
Status getStatus();
bool startRecovery();
bool checkRecovery();
static const char * stateStr(const STATE &st);
virtual bool CANOpen();
virtual ~Nmea2kTwai(){};
@@ -47,9 +47,12 @@ class Nmea2kTwai : public tNMEA2000{
private:
void initDriver();
bool startRecovery();
gpio_num_t TxPin;
gpio_num_t RxPin;
uint32_t txTimeouts=0;
unsigned long recoveryPeriod=0;
unsigned long lastRecoveryCheck=0;
};
#endif