Kato Gangstad
58 lines
1.2 KiB
C++
58 lines
1.2 KiB
C++
/**
|
|
* @file
|
|
* @brief BACnet MS/TP application entry point for M5StamPLC
|
|
* @author Kato Gangstad
|
|
*/
|
|
|
|
#include <Arduino.h>
|
|
#include <M5StamPLC.h>
|
|
|
|
#ifndef PLC_INPUT_ACTIVE_LOW
|
|
#define PLC_INPUT_ACTIVE_LOW 0
|
|
#endif
|
|
|
|
extern "C" {
|
|
#include "bacnet_app.h"
|
|
}
|
|
|
|
/**
|
|
* @brief Initialize the MS/TP application and PLC hardware
|
|
*/
|
|
void setup(void)
|
|
{
|
|
Serial.begin(115200);
|
|
delay(100);
|
|
Serial.println("[BOOT] Mode: BACnet MS/TP");
|
|
Serial.println("[BOOT] Init M5StamPLC...");
|
|
M5StamPLC.begin();
|
|
Serial.println("[BOOT] Init BACnet app...");
|
|
bacnet_app_init();
|
|
Serial.println("[BOOT] BACnet MS/TP ready");
|
|
}
|
|
|
|
/**
|
|
* @brief Run the main MS/TP application loop
|
|
*/
|
|
void loop(void)
|
|
{
|
|
M5StamPLC.update();
|
|
|
|
for (uint8_t i = 0; i < bacnet_app_input_count(); i++) {
|
|
bool state = M5StamPLC.readPlcInput(i);
|
|
#if PLC_INPUT_ACTIVE_LOW
|
|
state = !state;
|
|
#endif
|
|
bacnet_app_input_set(i, state);
|
|
}
|
|
|
|
for (uint8_t i = 0; i < bacnet_app_relay_count(); i++) {
|
|
M5StamPLC.writePlcRelay(i, bacnet_app_relay_get(i));
|
|
}
|
|
|
|
bacnet_app_temperature_set(M5StamPLC.getTemp());
|
|
bacnet_app_free_heap_kb_set((float)ESP.getFreeHeap() / 1024.0f);
|
|
|
|
bacnet_app_tick();
|
|
delay(1);
|
|
}
|