NucuCar/NucuCar.Sensors/SensorWorker.cs

77 lines
2.9 KiB
C#
Raw Normal View History

using System;
using System.Threading;
using System.Threading.Tasks;
using Microsoft.Extensions.Hosting;
using Microsoft.Extensions.Logging;
2020-08-01 15:07:13 +00:00
using NucuCar.Sensors.Abstractions;
using NucuCar.Telemetry.Abstractions;
using NucuCarSensorsProto;
namespace NucuCar.Sensors
{
/// <summary>
/// Generic Sensor background service worker. Each sensor's worker class should extend this one.
/// It does periodic reads from the sensors and publishes telemetry data if the option is enabled.
/// </summary>
public abstract class SensorWorker : BackgroundService
{
private int _intializationDelay = 10000;
protected int MeasurementInterval;
protected ILogger Logger;
protected TelemetryPublisher TelemetryPublisher;
protected GenericTelemeterSensor Sensor;
protected override async Task ExecuteAsync(CancellationToken stoppingToken)
{
if (Sensor == null)
{
return;
}
var sensorIdentifier = Sensor.GetIdentifier();
Logger?.LogInformation($"Starting sensor worker for {sensorIdentifier}");
try
{
TelemetryPublisher?.RegisterTelemeter(Sensor);
Sensor.Initialize();
while (!stoppingToken.IsCancellationRequested)
{
var sensorState = Sensor.GetState();
/* If sensor is ok attempt to read. */
if (sensorState == SensorStateEnum.Initialized)
{
Logger?.LogTrace($"{sensorIdentifier} is taking a measurement!");
await Sensor.TakeMeasurementAsync();
}
/* Else attempt to re-initialize. */
else if (sensorState == SensorStateEnum.Uninitialized ||
sensorState == SensorStateEnum.Error)
{
Logger?.LogWarning(
$"{sensorIdentifier} is in {sensorState}! Attempting to re-initialize in {_intializationDelay}ms.");
_intializationDelay += 10000;
await Task.Delay(_intializationDelay, stoppingToken);
Sensor.Initialize();
}
else if (sensorState == SensorStateEnum.Disabled)
{
// Break from while.
Logger?.LogInformation($"{sensorIdentifier} has been disabled!");
break;
}
await Task.Delay(MeasurementInterval, stoppingToken);
}
TelemetryPublisher?.UnRegisterTelemeter(Sensor);
}
catch (Exception e)
{
Logger?.LogError($"Unhandled exception in SensorWorker {sensorIdentifier}: {e.Message}");
Logger?.LogDebug(e.StackTrace);
}
}
}
}