started safety
This commit is contained in:
parent
9b943ec2c5
commit
97956882dd
4
.vscode/settings.json
vendored
4
.vscode/settings.json
vendored
@ -9,7 +9,9 @@
|
||||
"metrics.h": "c",
|
||||
"freertos.h": "c",
|
||||
"compare": "c",
|
||||
"inputs.h": "c"
|
||||
"inputs.h": "c",
|
||||
"cstdlib": "c",
|
||||
"typeinfo": "c"
|
||||
},
|
||||
"idf.openOcdConfigs": [
|
||||
"board/esp32-wrover-kit-3.3v.cfg"
|
||||
|
@ -39,8 +39,9 @@ Safety <|-- HTTP_Metrics
|
||||
}
|
||||
|
||||
class Safety{
|
||||
+taskSafety()
|
||||
+setSafeState()
|
||||
+initSafety()
|
||||
-taskSafety()
|
||||
-setSafeState()
|
||||
-checkSensorSanity()
|
||||
+getSafetyState()
|
||||
}
|
||||
|
@ -12,6 +12,7 @@
|
||||
#include "freertos/timers.h"
|
||||
#include "nvs_flash.h"
|
||||
|
||||
#include "safety.h"
|
||||
#include "metrics.h"
|
||||
#include "outputs.h"
|
||||
#include "inputs.h"
|
||||
@ -34,9 +35,10 @@ void app_main(void)
|
||||
}
|
||||
ESP_ERROR_CHECK(ret);
|
||||
|
||||
initMetrics();
|
||||
initOutputs();
|
||||
initInputs();
|
||||
initSafety();
|
||||
initMetrics();
|
||||
|
||||
/*TODO: will be done by safety on the future*/
|
||||
setCirculationPumpState(DISABLED);
|
||||
|
108
main/safety.c
108
main/safety.c
@ -0,0 +1,108 @@
|
||||
#include "freertos/FreeRTOS.h"
|
||||
#include "freertos/task.h"
|
||||
#include "esp_log.h"
|
||||
#include "safety.h"
|
||||
#include "outputs.h"
|
||||
#include "inputs.h"
|
||||
|
||||
#define PERIODIC_INTERVAL 1U // run safety checks every 1sec
|
||||
|
||||
typedef struct _TemperatureSensorLimit
|
||||
{
|
||||
float max; // Maximum temperature limit
|
||||
float min; // Minimum temperature limit
|
||||
} sTemperatureSensorLimit;
|
||||
|
||||
static const char *TAG = "smart-oil-heater-control-system-safety";
|
||||
static SemaphoreHandle_t xMutexAccessSafety = NULL;
|
||||
sSafetyStateElement safetyStates[NUMBER_OF_ERROR_STATES] = {
|
||||
{0, "Emergency Stop"},
|
||||
{0, "Safety Door Open"},
|
||||
{0, "Overheating"},
|
||||
{0, "Low Battery"}};
|
||||
|
||||
static const sTemperatureSensorLimit sChamperTemperatureLimit = {75.0f, 15.0f};
|
||||
|
||||
void taskSafety(void *pvParameters);
|
||||
void checkSensorSanity(void);
|
||||
void setSafeState(void);
|
||||
|
||||
void initSafety(void)
|
||||
{
|
||||
xMutexAccessSafety = xSemaphoreCreateBinary();
|
||||
if (xMutexAccessSafety == NULL)
|
||||
{
|
||||
ESP_LOGE(TAG, "Unable to create mutex");
|
||||
}
|
||||
xSemaphoreGive(xMutexAccessSafety);
|
||||
|
||||
BaseType_t taskCreated = xTaskCreate(
|
||||
taskSafety, // Function to implement the task
|
||||
"taskSafety", // Task name
|
||||
2048, // Stack size (in words, not bytes)
|
||||
NULL, // Parameters to the task function (none in this case)
|
||||
5, // Task priority (higher number = higher priority)
|
||||
NULL // Task handle (optional)
|
||||
);
|
||||
|
||||
if (taskCreated == pdPASS)
|
||||
{
|
||||
ESP_LOGI(TAG, "Task created successfully!");
|
||||
}
|
||||
else
|
||||
{
|
||||
ESP_LOGE(TAG, "Failed to create task");
|
||||
}
|
||||
}
|
||||
|
||||
void taskSafety(void *pvParameters)
|
||||
{
|
||||
while (1)
|
||||
{
|
||||
vTaskDelay(PERIODIC_INTERVAL * 1000U / portTICK_PERIOD_MS);
|
||||
|
||||
checkSensorSanity();
|
||||
}
|
||||
}
|
||||
|
||||
void checkSensorSanity(void)
|
||||
{
|
||||
static float fChamperTemperatureLast;
|
||||
static float fOutdoorTemperatureLast;
|
||||
static float fInletFlowTemperatureLast;
|
||||
static float fReturnFlowTemperatureLast;
|
||||
|
||||
const float fChamperTemperatureCurrent = getChamberTemperature(CURRENT);
|
||||
if (fChamperTemperatureCurrent == fChamperTemperatureLast)
|
||||
{
|
||||
ESP_LOGE(TAG, "Champer Temperature Sensor reported unchanged value!");
|
||||
}
|
||||
else
|
||||
{
|
||||
fChamperTemperatureLast = fChamperTemperatureCurrent;
|
||||
|
||||
if (fChamperTemperatureCurrent > sChamperTemperatureLimit.max)
|
||||
{
|
||||
ESP_LOGE(TAG, "Champer Temperature Sensor reported too high value!");
|
||||
}
|
||||
else if (fChamperTemperatureCurrent < sChamperTemperatureLimit.min)
|
||||
{
|
||||
ESP_LOGE(TAG, "Champer Temperature Sensor reported too low value!");
|
||||
}
|
||||
else
|
||||
{
|
||||
// everything ok
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
void setSafeState(void)
|
||||
{
|
||||
setCirculationPumpState(DISABLED);
|
||||
setBurnerState(DISABLED);
|
||||
}
|
||||
|
||||
sSafetyStateElement *getSafetyStates(void)
|
||||
{
|
||||
return safetyStates;
|
||||
}
|
@ -0,0 +1,14 @@
|
||||
#pragma once
|
||||
|
||||
|
||||
#define MAX_ERROR_STRING_SIZE 64U
|
||||
#define NUMBER_OF_ERROR_STATES 4U
|
||||
|
||||
typedef struct _SafetyStateElement{
|
||||
unsigned int status;
|
||||
char name[MAX_ERROR_STRING_SIZE];
|
||||
} sSafetyStateElement;
|
||||
|
||||
void initSafety(void);
|
||||
|
||||
sSafetyStateElement* getSafetyStates(void);
|
Loading…
Reference in New Issue
Block a user