ES ordening
This commit is contained in:
Rens Pastoor
@@ -0,0 +1,74 @@
|
||||
#include "SerialProcess.h"
|
||||
#include <Arduino.h>
|
||||
|
||||
// Constructor
|
||||
SerialProcess::SerialProcess(int addr)
|
||||
: address(addr), ndx(0), rc(0), newData(false), rcCheck(false) {
|
||||
Serial.begin(115200);
|
||||
}
|
||||
|
||||
// Processes Serial Input
|
||||
void SerialProcess::SerialInput() {
|
||||
while (Serial.available() > 0) {
|
||||
rc = static_cast<char>(Serial.read());
|
||||
|
||||
if (rc == beginMarker) {
|
||||
rcCheck = true; // Start reading after the begin marker
|
||||
ndx = 0; // Reset index for new message
|
||||
}
|
||||
|
||||
if (rcCheck) {
|
||||
// Store the character if within bounds
|
||||
if (ndx < numChars - 1) {
|
||||
receivedChars[ndx++] = rc;
|
||||
}
|
||||
|
||||
// Check for end marker
|
||||
if (rc == endMarker) {
|
||||
receivedChars[ndx] = '\0'; // Null-terminate the string
|
||||
newData = true; // Mark new data as available
|
||||
rcCheck = false; // Stop reading until the next begin marker
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
// Check if new data is available
|
||||
bool SerialProcess::isNewDataAvailable() {
|
||||
return newData;
|
||||
}
|
||||
|
||||
// Get the received data
|
||||
char* SerialProcess::getReceivedData() {
|
||||
if (newData) {
|
||||
newData = false; // Reset the flag after accessing the data
|
||||
return receivedChars;
|
||||
}
|
||||
return nullptr; // No new data
|
||||
}
|
||||
|
||||
// Process the received message
|
||||
void SerialProcess::getPayload(char *payload) {
|
||||
if (newData) {
|
||||
uint8_t source;
|
||||
uint8_t destination;
|
||||
char data[255]; // Allocate a buffer for the data
|
||||
int parsed = sscanf(receivedChars, "#%hhu:%hhu:%63s;", &source, &destination, data);
|
||||
if (parsed == 3 && destination == address) { // Ensure all fields are parsed correctly
|
||||
strcpy(payload, data); // Copy data to the provided buffer
|
||||
newData = false; // Mark the data as processed
|
||||
} else if (address != source) {
|
||||
Serial.print(receivedChars); // Forward the message
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
// Send a message in the correct format
|
||||
void SerialProcess::sendMessage(int receiver, const char* payload) {
|
||||
Serial.printf("#%u:%u:%s;", address, receiver, payload);
|
||||
}
|
||||
|
||||
|
||||
void SerialProcess::changeAddress(int addr) {
|
||||
address = addr; // Update the device address
|
||||
}
|
||||
@@ -0,0 +1,39 @@
|
||||
#include <Arduino.h>
|
||||
#ifndef SERIALPROCESS_H
|
||||
#define SERIALPROCESS_H
|
||||
|
||||
class SerialProcess {
|
||||
private:
|
||||
uint8_t ndx; // Current index for the buffer
|
||||
const char beginMarker = '#'; // Marker to indicate the start of a message
|
||||
const char endMarker = ';'; // Marker to indicate the end of a message
|
||||
char rc; // Character read from Serial
|
||||
int address; // Device address
|
||||
bool newData; // Flag for new data availability
|
||||
static const uint8_t numChars = 255; // Maximum size of the buffer
|
||||
char receivedChars[numChars]; // Buffer for incoming data
|
||||
bool rcCheck;
|
||||
|
||||
public:
|
||||
// Constructor
|
||||
explicit SerialProcess(int addr);
|
||||
|
||||
// Store Serial Input (if available)
|
||||
void SerialInput();
|
||||
|
||||
// Check if new data is available
|
||||
bool isNewDataAvailable();
|
||||
|
||||
// Get the received data
|
||||
char* getReceivedData();
|
||||
|
||||
// Process the received message
|
||||
void getPayload(char* payload);
|
||||
|
||||
// Send message in the correct format
|
||||
void sendMessage(int receiver, const char* payload);
|
||||
|
||||
void changeAddress(int addr);
|
||||
};
|
||||
|
||||
#endif // SERIALPROCESS_H
|
||||
@@ -0,0 +1,186 @@
|
||||
#include <SoftwareSerial.h>
|
||||
SoftwareSerial mySerial(16, 17); // RX, TX
|
||||
|
||||
const int red = 14;
|
||||
const int yellow = 33;
|
||||
const int green = 12;
|
||||
|
||||
const unsigned long greenDuration = 5000;
|
||||
const unsigned long yellowDuration = 2000;
|
||||
const unsigned long redDuration = 5000;
|
||||
const unsigned long transitionDuration = 2000;
|
||||
const unsigned long heartbeatInterval = 1000;
|
||||
const unsigned long heartbeatTimeout = 3000;
|
||||
const unsigned long blinkInterval = 500;
|
||||
|
||||
String receivedData = "";
|
||||
bool receiving = false;
|
||||
|
||||
unsigned long previousMillis = 0;
|
||||
unsigned long lastHeartbeatMillis = 0;
|
||||
unsigned long lastBlinkMillis = 0;
|
||||
bool blinkState = false;
|
||||
bool isError = false;
|
||||
|
||||
enum State { GREEN, YELLOW, RED, TRANSITION, ERROR };
|
||||
State currentState = GREEN;
|
||||
|
||||
#define REPEAT_SEND false
|
||||
|
||||
void sendCommand(String cmd) {
|
||||
mySerial.print("<");
|
||||
mySerial.print(cmd);
|
||||
mySerial.println(">");
|
||||
Serial.print("Sent: ");
|
||||
Serial.println(cmd);
|
||||
}
|
||||
|
||||
void sendHeartbeat() {
|
||||
mySerial.print("<HB>");
|
||||
Serial.println("Sent: Heartbeat");
|
||||
}
|
||||
|
||||
void ledRed() {
|
||||
digitalWrite(red, HIGH);
|
||||
digitalWrite(yellow, LOW);
|
||||
digitalWrite(green, LOW);
|
||||
}
|
||||
|
||||
void ledYellow() {
|
||||
digitalWrite(red, LOW);
|
||||
digitalWrite(yellow, HIGH);
|
||||
digitalWrite(green, LOW);
|
||||
}
|
||||
|
||||
void ledGreen() {
|
||||
digitalWrite(red, LOW);
|
||||
digitalWrite(yellow, LOW);
|
||||
digitalWrite(green, HIGH);
|
||||
}
|
||||
|
||||
void updateLights() {
|
||||
switch (currentState) {
|
||||
case GREEN:
|
||||
ledGreen();
|
||||
sendCommand("G");
|
||||
break;
|
||||
case YELLOW:
|
||||
ledYellow();
|
||||
sendCommand("Y");
|
||||
break;
|
||||
case RED:
|
||||
ledRed();
|
||||
sendCommand("R");
|
||||
break;
|
||||
case TRANSITION:
|
||||
sendCommand("T");
|
||||
break;
|
||||
case ERROR:
|
||||
if (millis() - lastBlinkMillis >= blinkInterval) {
|
||||
blinkState = !blinkState;
|
||||
digitalWrite(yellow, blinkState ? HIGH : LOW);
|
||||
lastBlinkMillis = millis();
|
||||
}
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
void setup() {
|
||||
pinMode(green, OUTPUT);
|
||||
pinMode(yellow, OUTPUT);
|
||||
pinMode(red, OUTPUT);
|
||||
mySerial.begin(115200);
|
||||
Serial.begin(115200);
|
||||
previousMillis = millis();
|
||||
lastHeartbeatMillis = millis();
|
||||
updateLights();
|
||||
}
|
||||
|
||||
void loop() {
|
||||
unsigned long currentMillis = millis();
|
||||
|
||||
// Send heartbeat regularly
|
||||
if (currentMillis - lastHeartbeatMillis >= heartbeatInterval) {
|
||||
sendHeartbeat();
|
||||
lastHeartbeatMillis = currentMillis;
|
||||
}
|
||||
|
||||
// Heartbeat timeout check
|
||||
if (currentMillis - lastHeartbeatMillis >= heartbeatTimeout) {
|
||||
if (!isError) {
|
||||
isError = true;
|
||||
}
|
||||
}
|
||||
|
||||
// State transitions
|
||||
switch (currentState) {
|
||||
case GREEN:
|
||||
if (currentMillis - previousMillis >= greenDuration) {
|
||||
currentState = YELLOW;
|
||||
previousMillis = currentMillis;
|
||||
updateLights();
|
||||
}
|
||||
break;
|
||||
case YELLOW:
|
||||
if (currentMillis - previousMillis >= yellowDuration) {
|
||||
currentState = RED;
|
||||
previousMillis = currentMillis;
|
||||
updateLights();
|
||||
}
|
||||
break;
|
||||
case RED:
|
||||
if (currentMillis - previousMillis >= redDuration) {
|
||||
currentState = TRANSITION;
|
||||
previousMillis = currentMillis;
|
||||
updateLights();
|
||||
}
|
||||
break;
|
||||
case TRANSITION:
|
||||
if (currentMillis - previousMillis >= transitionDuration) {
|
||||
currentState = GREEN;
|
||||
previousMillis = millis();
|
||||
updateLights();
|
||||
}
|
||||
break;
|
||||
case ERROR:
|
||||
updateLights();
|
||||
break;
|
||||
}
|
||||
|
||||
// Handle received data
|
||||
while (mySerial.available()) {
|
||||
char incomingByte = mySerial.read();
|
||||
|
||||
if (incomingByte == '<') {
|
||||
receivedData = "";
|
||||
receiving = true;
|
||||
} else if (incomingByte == '>') {
|
||||
receiving = false;
|
||||
Serial.print("Received Data: ");
|
||||
Serial.println(receivedData);
|
||||
|
||||
if (receivedData == "HB") {
|
||||
lastHeartbeatMillis = millis();
|
||||
if (isError) {
|
||||
digitalWrite(yellow, LOW);
|
||||
}
|
||||
isError = false;
|
||||
}
|
||||
|
||||
receivedData = "";
|
||||
} else if (receiving) {
|
||||
if (incomingByte >= 32 && incomingByte <= 126) {
|
||||
receivedData += incomingByte;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
// Blinking yellow light in error state
|
||||
if (isError) {
|
||||
if (currentMillis - lastBlinkMillis >= blinkInterval) {
|
||||
blinkState = !blinkState;
|
||||
digitalWrite(yellow, blinkState ? HIGH : LOW);
|
||||
lastBlinkMillis = currentMillis;
|
||||
}
|
||||
}
|
||||
}
|
||||
Reference in New Issue
Block a user