mirror of
https://github.com/dalathegreat/Battery-Emulator.git
synced 2025-10-04 02:09:30 +02:00
33 lines
726 B
C++
33 lines
726 B
C++
#include "ESP32CAN.h"
|
|
#include <Arduino.h>
|
|
|
|
int ESP32CAN::CANInit() {
|
|
return CAN_init();
|
|
}
|
|
int ESP32CAN::CANWriteFrame(const CAN_frame_t* p_frame) {
|
|
static unsigned long start_time;
|
|
int result = -1;
|
|
if (tx_ok) {
|
|
result = CAN_write_frame(p_frame);
|
|
tx_ok = (result == 0) ? true : false;
|
|
if (tx_ok == false) {
|
|
Serial.println("CAN failure! Check wires");
|
|
LEDcolor = 3;
|
|
start_time = millis();
|
|
}
|
|
} else {
|
|
if ((millis() - start_time) >= 2000) {
|
|
tx_ok = true;
|
|
LEDcolor = 0;
|
|
}
|
|
}
|
|
return result;
|
|
}
|
|
int ESP32CAN::CANStop() {
|
|
return CAN_stop();
|
|
}
|
|
int ESP32CAN::CANConfigFilter(const CAN_filter_t* p_filter) {
|
|
return CAN_config_filter(p_filter);
|
|
}
|
|
|
|
ESP32CAN ESP32Can;
|