Files
IoTManager/src/modules/sensors/A02Distance/A02Distance.cpp
2023-04-25 22:41:25 +03:00

100 lines
2.8 KiB
C++

#include "Global.h"
#include "classes/IoTItem.h"
#include "modules/sensors/UART/Uart.h"
#define READ_TIMEOUT 100
class A02Distance : public IoTItem
{
private:
public:
A02Distance(String parameters) : IoTItem(parameters)
{
if (myUART)
{
}
}
//Периодическое выполнение программы, в int секунд, которые зададим в конфигурации
void doByInterval()
{
if (myUART)
{
static uint8_t data[4];
if (recieve(data, 4) == 4)
{
if (data[0] == 0xff)
{
int sum;
sum = (data[0] + data[1] + data[2]) & 0x00FF;
if (sum == data[3])
{
float distance = (data[1] << 8) + data[2];
if (distance > 30)
{
value.valD = distance / 10;
//SerialPrint("i", F("A02Distance"), "distance = " + String(value.valD) + "cm");
regEvent(value.valD, "A02Distance");
}
else
{
SerialPrint("E", "A02Distance", "Below the lower limit");
regEvent(NAN, "A02Distance");
}
}
else
{
regEvent(NAN, "A02Distance");
SerialPrint("E", "A02Distance", "Distance data error");
}
}
} else {
regEvent(NAN, "A02Distance");
SerialPrint("E", "A02Distance", "Recieve data error");
}
} else
{
regEvent(NAN, "A02Distance");
SerialPrint("E", "A02Distance", "Not find UART");
}
}
//Приём данных из COM порта
uint16_t recieve(uint8_t *resp, uint16_t len)
{
((SoftwareSerial *)myUART)->listen(); // Start software serial listen
unsigned long startTime = millis(); // Start time for Timeout
uint8_t index = 0; // Bytes we have read
while ((index < len) && (millis() - startTime < READ_TIMEOUT))
{
if (myUART->available() > 0)
{
uint8_t c = (uint8_t)myUART->read();
resp[index++] = c;
}
}
return index;
}
~A02Distance(){};
};
//Функиця ядра, чтобы нашел наш модуль
void *getAPI_A02Distance(String subtype, String param)
{
if (subtype == F("A02Distance"))
{
return new A02Distance(param);
}
else
{
return nullptr;
}
}