forked from amkovkov/GranuSightSoftware2
Первый коммит
This commit is contained in:
@@ -0,0 +1,221 @@
|
||||
using System;
|
||||
using System.Device.Gpio;
|
||||
using System.Device.Pwm;
|
||||
using System.Device.Pwm.Drivers;
|
||||
using System.IO;
|
||||
using System.Threading;
|
||||
using Microsoft.Extensions.Logging;
|
||||
|
||||
namespace GSS2.Core.Hardware;
|
||||
|
||||
public class IlluminatorService : IDisposable
|
||||
{
|
||||
public class IlluminatorServiceConfiguration
|
||||
{
|
||||
public static IlluminatorServiceConfiguration Default => new IlluminatorServiceConfiguration
|
||||
{
|
||||
WhitePwmPin = 13,
|
||||
Uv254PwmPin = 18,
|
||||
Uv365PwmPin = 12,
|
||||
WhiteRelayPin = 16,
|
||||
Uv254RelayPin = 15,
|
||||
Uv365RelayPin = 20,
|
||||
FanPin = 21,
|
||||
|
||||
PwmFrequency = 200,
|
||||
|
||||
MaxWhitePwmDuty = 1.0,
|
||||
MaxUv254PwmDuty = 1.0,
|
||||
MaxUv365PwmDuty = 1.0
|
||||
};
|
||||
|
||||
public int WhitePwmPin { get; set; }
|
||||
public int Uv254PwmPin { get; set; }
|
||||
public int Uv365PwmPin { get; set; }
|
||||
public int WhiteRelayPin { get; set; }
|
||||
public int Uv254RelayPin { get; set; }
|
||||
public int Uv365RelayPin { get; set; }
|
||||
public int FanPin { get; set; }
|
||||
|
||||
public int PwmFrequency { get; set; }
|
||||
|
||||
public double MaxWhitePwmDuty { get; set; }
|
||||
public double MaxUv254PwmDuty { get; set; }
|
||||
public double MaxUv365PwmDuty { get; set; }
|
||||
}
|
||||
|
||||
private static readonly Dictionary<int, int> PinPwmChips = new()
|
||||
{
|
||||
{ 12, 0 },
|
||||
{ 13, 0 },
|
||||
{ 14, 0 },
|
||||
{ 15, 0 },
|
||||
{ 18, 0 },
|
||||
{ 19, 0 },
|
||||
};
|
||||
private static readonly Dictionary<int, int> PinPwmChannels = new()
|
||||
{
|
||||
{ 12, 0 },
|
||||
{ 13, 1 },
|
||||
{ 14, 2 },
|
||||
{ 15, 3 },
|
||||
{ 18, 2 },
|
||||
{ 19, 3 }
|
||||
};
|
||||
|
||||
private bool _disposedValue;
|
||||
private readonly ILogger<IlluminatorService> _logger;
|
||||
private readonly IlluminatorServiceConfiguration _configuration;
|
||||
|
||||
private readonly GpioController _gpio;
|
||||
private readonly PwmChannel _whitePwm;
|
||||
private readonly PwmChannel _uv254Pwm;
|
||||
private readonly PwmChannel _uv365Pwm;
|
||||
private readonly GpioPin _whiteRelay;
|
||||
private readonly GpioPin _uv254Relay;
|
||||
private readonly GpioPin _uv365Relay;
|
||||
private readonly GpioPin _fanRelay;
|
||||
|
||||
public IlluminatorService(ILogger<IlluminatorService> logger, IlluminatorServiceConfiguration? configuration = null)
|
||||
{
|
||||
_logger = logger;
|
||||
|
||||
_logger.LogInformation("Illuminator initialization");
|
||||
|
||||
if (configuration is null)
|
||||
{
|
||||
_logger.LogWarning("Illuminator configuration not set. Using default configuration.");
|
||||
_configuration = IlluminatorServiceConfiguration.Default;
|
||||
}
|
||||
else
|
||||
{
|
||||
_configuration = configuration;
|
||||
}
|
||||
|
||||
_logger.LogDebug(@$"Illuminator use following configuration:
|
||||
WhitePwmPin: {_configuration.WhitePwmPin}
|
||||
Uv254PwmPin: {_configuration.Uv254PwmPin}
|
||||
Uv365PwmPin: {_configuration.Uv365PwmPin}
|
||||
WhiteRelayPin: {_configuration.WhiteRelayPin}
|
||||
Uv254RelayPin: {_configuration.Uv254RelayPin}
|
||||
Uv365RelayPin: {_configuration.Uv365RelayPin}
|
||||
FanPin: {_configuration.FanPin}
|
||||
PwmFrequency: {_configuration.PwmFrequency}
|
||||
MaxWhitePwmDuty: {_configuration.MaxWhitePwmDuty}
|
||||
MaxUv254PwmDuty: {_configuration.MaxUv254PwmDuty}
|
||||
MaxUv365PwmDuty: {_configuration.MaxUv365PwmDuty}
|
||||
");
|
||||
|
||||
CheckPwmPin(_configuration.WhitePwmPin);
|
||||
CheckPwmPin(_configuration.Uv254PwmPin);
|
||||
CheckPwmPin(_configuration.Uv365PwmPin);
|
||||
|
||||
try
|
||||
{
|
||||
_gpio = new GpioController();
|
||||
_whitePwm = PwmChannel.Create(PinPwmChips[_configuration.WhitePwmPin], PinPwmChannels[_configuration.WhitePwmPin], _configuration.PwmFrequency, CalculateDuty(0, _configuration.MaxWhitePwmDuty));
|
||||
_uv254Pwm = PwmChannel.Create(PinPwmChips[_configuration.Uv254PwmPin], PinPwmChannels[_configuration.Uv254PwmPin], _configuration.PwmFrequency, CalculateDuty(0, _configuration.MaxUv254PwmDuty));
|
||||
_uv365Pwm = PwmChannel.Create(PinPwmChips[_configuration.Uv365PwmPin], PinPwmChannels[_configuration.Uv365PwmPin], _configuration.PwmFrequency, CalculateDuty(0, _configuration.MaxUv365PwmDuty));
|
||||
|
||||
_whiteRelay = _gpio.OpenPin(_configuration.WhiteRelayPin, PinMode.Output, PinValue.Low);
|
||||
_uv254Relay = _gpio.OpenPin(_configuration.Uv254RelayPin, PinMode.Output, PinValue.Low);
|
||||
_uv365Relay = _gpio.OpenPin(_configuration.Uv365RelayPin, PinMode.Output, PinValue.Low);
|
||||
_fanRelay = _gpio.OpenPin(_configuration.FanPin, PinMode.Output, PinValue.Low);
|
||||
}
|
||||
catch (Exception e)
|
||||
{
|
||||
_logger.LogCritical(e, "An exception occurred while illuminator initialization");
|
||||
throw;
|
||||
}
|
||||
}
|
||||
|
||||
public void SetIntensity(double? white = null, double? uv365 = null, double? uv254 = null)
|
||||
{
|
||||
try
|
||||
{
|
||||
if (white is not null) _whitePwm.DutyCycle = CalculateDuty(white.Value, _configuration.MaxWhitePwmDuty);
|
||||
if (uv365 is not null) _uv365Pwm.DutyCycle = CalculateDuty(uv365.Value, _configuration.MaxUv365PwmDuty);
|
||||
if (uv254 is not null) _uv254Pwm.DutyCycle = CalculateDuty(uv254.Value, _configuration.MaxUv254PwmDuty);
|
||||
}
|
||||
catch (Exception e)
|
||||
{
|
||||
_logger.LogError(e, "An exception occurred while setting illuminator intensity");
|
||||
}
|
||||
}
|
||||
public void TurnOn()
|
||||
{
|
||||
try
|
||||
{
|
||||
_fanRelay.Write(PinValue.High);
|
||||
|
||||
_whitePwm.Start();
|
||||
_uv254Pwm.Start();
|
||||
_uv365Pwm.Start();
|
||||
|
||||
_whiteRelay.Write(PinValue.High);
|
||||
_uv254Relay.Write(PinValue.High);
|
||||
_uv365Relay.Write(PinValue.High);
|
||||
}
|
||||
catch (Exception e)
|
||||
{
|
||||
_logger.LogError(e, "An exception occurred while turning on illuminator");
|
||||
}
|
||||
}
|
||||
public void TurnOff()
|
||||
{
|
||||
try
|
||||
{
|
||||
_whitePwm.Stop();
|
||||
_uv254Pwm.Stop();
|
||||
_uv365Pwm.Stop();
|
||||
|
||||
_whiteRelay.Write(PinValue.Low);
|
||||
_uv254Relay.Write(PinValue.Low);
|
||||
_uv365Relay.Write(PinValue.Low);
|
||||
|
||||
_fanRelay.Write(PinValue.Low);
|
||||
}
|
||||
catch (Exception e)
|
||||
{
|
||||
_logger.LogError(e, "An exception occurred while turning off illuminator");
|
||||
}
|
||||
}
|
||||
|
||||
protected virtual void Dispose(bool disposing)
|
||||
{
|
||||
if (!_disposedValue)
|
||||
{
|
||||
if (disposing)
|
||||
{
|
||||
try
|
||||
{
|
||||
TurnOff();
|
||||
}
|
||||
catch { }
|
||||
|
||||
_whiteRelay?.Dispose();
|
||||
_uv254Relay?.Dispose();
|
||||
_uv365Relay?.Dispose();
|
||||
_fanRelay?.Dispose();
|
||||
_whitePwm?.Dispose();
|
||||
_uv254Pwm?.Dispose();
|
||||
_uv365Pwm?.Dispose();
|
||||
_gpio?.Dispose();
|
||||
}
|
||||
|
||||
_disposedValue = true;
|
||||
}
|
||||
}
|
||||
void IDisposable.Dispose()
|
||||
{
|
||||
Dispose(disposing: true);
|
||||
GC.SuppressFinalize(this);
|
||||
}
|
||||
|
||||
private static void CheckPwmPin(int pin)
|
||||
{
|
||||
if (!PinPwmChips.TryGetValue(pin, out var _) || !PinPwmChannels.TryGetValue(pin, out var _))
|
||||
throw new ArgumentException($"Unsupported PWM pin {pin}");
|
||||
}
|
||||
private static double CalculateDuty(double intensity, double maxDuty) => Math.Clamp(intensity, 0.0, 1.0) * Math.Clamp(maxDuty, 0.0, 1.0);
|
||||
}
|
||||
@@ -0,0 +1,445 @@
|
||||
using System.Drawing;
|
||||
using System.Runtime.CompilerServices;
|
||||
using Grpc.Core;
|
||||
using Grpc.Net.Client;
|
||||
using GSS2.LightsControl.CSharpClient;
|
||||
using Microsoft.Extensions.Logging;
|
||||
|
||||
namespace GSS2.Core.Hardware;
|
||||
|
||||
public class LightsService
|
||||
{
|
||||
public class LightsServiceConfiguration()
|
||||
{
|
||||
public static LightsServiceConfiguration Default => new LightsServiceConfiguration
|
||||
{
|
||||
ServerAddress = "localhost:50051"
|
||||
};
|
||||
|
||||
public string ServerAddress { get; set; } = string.Empty;
|
||||
}
|
||||
|
||||
private readonly ILogger<LightsService> _logger;
|
||||
private readonly LightsServiceConfiguration _configuration;
|
||||
private readonly Lights.LightsClient _client;
|
||||
|
||||
public LightsService(ILogger<LightsService> logger, LightsServiceConfiguration? configuration = null)
|
||||
{
|
||||
_logger = logger;
|
||||
|
||||
_logger.LogInformation("Lights initialization");
|
||||
|
||||
if (configuration is null)
|
||||
{
|
||||
_logger.LogWarning("Lights configuration not set. Using default configuration.");
|
||||
_configuration = LightsServiceConfiguration.Default;
|
||||
}
|
||||
else
|
||||
{
|
||||
_configuration = configuration;
|
||||
}
|
||||
|
||||
_logger.LogDebug(@$"Lights use following configuration:
|
||||
ServerAddress: {_configuration.ServerAddress}
|
||||
");
|
||||
|
||||
_client = new Lights.LightsClient(GrpcChannel.ForAddress(_configuration.ServerAddress));
|
||||
}
|
||||
|
||||
public async Task Run(CancellationToken cancellationToken)
|
||||
{
|
||||
_logger.LogInformation("LightsService started");
|
||||
|
||||
while (!cancellationToken.IsCancellationRequested)
|
||||
{
|
||||
await PingAsync(cancellationToken);
|
||||
try
|
||||
{
|
||||
await Task.Delay(TimeSpan.FromMinutes(1), cancellationToken);
|
||||
}
|
||||
catch (TaskCanceledException)
|
||||
{
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
_logger.LogInformation("LightsService stopped");
|
||||
}
|
||||
|
||||
private void SendRequest<T>(Func<T, Metadata, DateTime?, CancellationToken, Empty> method, T request, CancellationToken cancellationToken = default, [CallerMemberName] string sender = "")
|
||||
{
|
||||
try
|
||||
{
|
||||
#pragma warning disable CS8625
|
||||
method.Invoke(request, null, null, cancellationToken); ;
|
||||
#pragma warning restore CS8625
|
||||
_logger.LogTrace("Request \"{}\" sent", sender);
|
||||
}
|
||||
catch (RpcException ex)
|
||||
{
|
||||
_logger.LogWarning(ex, "Request \"{}\" RPC error", sender);
|
||||
}
|
||||
catch (Exception ex)
|
||||
{
|
||||
_logger.LogWarning(ex, "Request \"{}\" Unexpected error", method);
|
||||
}
|
||||
}
|
||||
private async Task SendRequestAsync<T>(Func<T, Metadata, DateTime?, CancellationToken, AsyncUnaryCall<Empty>> method, T request, CancellationToken cancellationToken = default, [CallerMemberName] string sender = "")
|
||||
{
|
||||
try
|
||||
{
|
||||
#pragma warning disable CS8625
|
||||
await method.Invoke(request, null, null, cancellationToken); ;
|
||||
#pragma warning restore CS8625
|
||||
_logger.LogTrace("Request \"{}\" sent", sender);
|
||||
}
|
||||
catch (RpcException ex)
|
||||
{
|
||||
_logger.LogWarning(ex, "Request \"{}\" RPC error", sender);
|
||||
}
|
||||
catch (Exception ex)
|
||||
{
|
||||
_logger.LogWarning(ex, "Request \"{}\" Unexpected error", method);
|
||||
}
|
||||
}
|
||||
|
||||
public void Ping(CancellationToken cancellationToken = default) => SendRequest(_client.Ping, new Empty(), cancellationToken);
|
||||
public void Off(CancellationToken cancellationToken = default) => SendRequest(_client.SetOff, new Empty(), cancellationToken);
|
||||
public void StaticColor(double brightness, Color color, CancellationToken cancellationToken = default) => SendRequest(_client.SetStaticColor, new StaticColorRequest
|
||||
{
|
||||
Brightness = brightness,
|
||||
R = color.R,
|
||||
G = color.G,
|
||||
B = color.B
|
||||
}, cancellationToken);
|
||||
public void StaticGradient2(double brightness, Color leftColor, Color rightColor, CancellationToken cancellationToken = default) => SendRequest(_client.SetStaticGradient2, new StaticGradient2Request
|
||||
{
|
||||
Brightness = brightness,
|
||||
LeftR = leftColor.R,
|
||||
LeftG = leftColor.G,
|
||||
LeftB = leftColor.B,
|
||||
RightR = rightColor.R,
|
||||
RightG = rightColor.G,
|
||||
RightB = rightColor.B
|
||||
}, cancellationToken);
|
||||
public void StaticGradient3(double brightness, Color leftColor, Color middleColor, Color rightColor, CancellationToken cancellationToken = default) => SendRequest(_client.SetStaticGradient3, new StaticGradient3Request
|
||||
{
|
||||
Brightness = brightness,
|
||||
LeftR = leftColor.R,
|
||||
LeftG = leftColor.G,
|
||||
LeftB = leftColor.B,
|
||||
MiddleR = middleColor.R,
|
||||
MiddleG = middleColor.G,
|
||||
MiddleB = middleColor.B,
|
||||
RightR = rightColor.R,
|
||||
RightG = rightColor.G,
|
||||
RightB = rightColor.B
|
||||
}, cancellationToken);
|
||||
public void StaticRainbow(double brightness, CancellationToken cancellationToken = default) => SendRequest(_client.SetStaticRainbow, new StaticRainbowRequest
|
||||
{
|
||||
Brightness = brightness
|
||||
}, cancellationToken);
|
||||
public void BreathingColor(double brightness, double speed, Color color, CancellationToken cancellationToken = default) => SendRequest(_client.SetBreathingColor, new BreathingColorRequest
|
||||
{
|
||||
Brightness = brightness,
|
||||
Speed = speed,
|
||||
R = color.R,
|
||||
G = color.G,
|
||||
B = color.B
|
||||
}, cancellationToken);
|
||||
public void BreathingGradient2(double brightness, double speed, Color leftColor, Color rightColor, CancellationToken cancellationToken = default) => SendRequest(_client.SetBreathingGradient2, new BreathingGradient2Request
|
||||
{
|
||||
Brightness = brightness,
|
||||
Speed = speed,
|
||||
LeftR = leftColor.R,
|
||||
LeftG = leftColor.G,
|
||||
LeftB = leftColor.B,
|
||||
RightR = rightColor.R,
|
||||
RightG = rightColor.G,
|
||||
RightB = rightColor.B
|
||||
}, cancellationToken);
|
||||
public void BreathingGradient3(double brightness, double speed, Color leftColor, Color middleColor, Color rightColor, CancellationToken cancellationToken = default) => SendRequest(_client.SetBreathingGradient3, new BreathingGradient3Request
|
||||
{
|
||||
Brightness = brightness,
|
||||
Speed = speed,
|
||||
LeftR = leftColor.R,
|
||||
LeftG = leftColor.G,
|
||||
LeftB = leftColor.B,
|
||||
MiddleR = middleColor.R,
|
||||
MiddleG = middleColor.G,
|
||||
MiddleB = middleColor.B,
|
||||
RightR = rightColor.R,
|
||||
RightG = rightColor.G,
|
||||
RightB = rightColor.B
|
||||
}, cancellationToken);
|
||||
public void BreathingRainbow(double brightness, double speed, CancellationToken cancellationToken = default) => SendRequest(_client.SetBreathingRainbow, new BreathingRainbowRequest
|
||||
{
|
||||
Brightness = brightness,
|
||||
Speed = speed
|
||||
}, cancellationToken);
|
||||
public void RunningColor(double brightness, double speed, int length, int fade, Color color, CancellationToken cancellationToken = default) => SendRequest(_client.SetRunningColor, new RunningColorRequest
|
||||
{
|
||||
Brightness = brightness,
|
||||
Speed = speed,
|
||||
Length = length,
|
||||
Fade = fade,
|
||||
R = color.R,
|
||||
G = color.G,
|
||||
B = color.B
|
||||
}, cancellationToken);
|
||||
public void RunningGradient2(double brightness, double speed, Color leftColor, Color rightColor, CancellationToken cancellationToken = default) => SendRequest(_client.SetRunningGradient2, new RunningGradient2Request
|
||||
{
|
||||
Brightness = brightness,
|
||||
Speed = speed,
|
||||
LeftR = leftColor.R,
|
||||
LeftG = leftColor.G,
|
||||
LeftB = leftColor.B,
|
||||
RightR = rightColor.R,
|
||||
RightG = rightColor.G,
|
||||
RightB = rightColor.B
|
||||
}, cancellationToken);
|
||||
public void RunningGradient3(double brightness, double speed, Color leftColor, Color middleColor, Color rightColor, CancellationToken cancellationToken = default) => SendRequest(_client.SetRunningGradient3, new RunningGradient3Request
|
||||
{
|
||||
Brightness = brightness,
|
||||
Speed = speed,
|
||||
LeftR = leftColor.R,
|
||||
LeftG = leftColor.G,
|
||||
LeftB = leftColor.B,
|
||||
MiddleR = middleColor.R,
|
||||
MiddleG = middleColor.G,
|
||||
MiddleB = middleColor.B,
|
||||
RightR = rightColor.R,
|
||||
RightG = rightColor.G,
|
||||
RightB = rightColor.B
|
||||
}, cancellationToken);
|
||||
public void RunningRainbow(double brightness, double speed, CancellationToken cancellationToken = default) => SendRequest(_client.SetRunningRainbow, new RunningRainbowRequest
|
||||
{
|
||||
Brightness = brightness,
|
||||
Speed = speed
|
||||
}, cancellationToken);
|
||||
public void Snake(double brightness, double speed, int headLength, int tailLength, Color headColor, Color tailColor, CancellationToken cancellationToken = default) => SendRequest(_client.SetSnake, new SnakeRequest
|
||||
{
|
||||
Brightness = brightness,
|
||||
Speed = speed,
|
||||
HeadLength = headLength,
|
||||
TailLength = tailLength,
|
||||
HeadR = headColor.R,
|
||||
HeadG = headColor.G,
|
||||
HeadB = headColor.B,
|
||||
TailR = tailColor.R,
|
||||
TailG = tailColor.G,
|
||||
TailB = tailColor.B
|
||||
}, cancellationToken);
|
||||
public void Fire(double brightness, double speed, Color color, CancellationToken cancellationToken = default) => SendRequest(_client.SetFire, new FireRequest
|
||||
{
|
||||
Brightness = brightness,
|
||||
Speed = speed,
|
||||
R = color.R,
|
||||
G = color.G,
|
||||
B = color.B
|
||||
}, cancellationToken);
|
||||
public void Snowfall(double brightness, double speed, Color color, CancellationToken cancellationToken = default) => SendRequest(_client.SetSnowfall, new SnowfallRequest
|
||||
{
|
||||
Brightness = brightness,
|
||||
Speed = speed,
|
||||
R = color.R,
|
||||
G = color.G,
|
||||
B = color.B
|
||||
}, cancellationToken);
|
||||
public void Flash(double brightness, double speed, Color color, CancellationToken cancellationToken = default) => SendRequest(_client.SetFlash, new FlashRequest
|
||||
{
|
||||
Brightness = brightness,
|
||||
Speed = speed,
|
||||
R = color.R,
|
||||
G = color.G,
|
||||
B = color.B
|
||||
}, cancellationToken);
|
||||
public void Load(double brightness, double speed, double percent, double lastPercent, Color color, CancellationToken cancellationToken = default) => SendRequest(_client.SetLoad, new LoadRequest
|
||||
{
|
||||
Brightness = brightness,
|
||||
Speed = speed,
|
||||
Percent = percent,
|
||||
LastPercent = lastPercent,
|
||||
R = color.R,
|
||||
G = color.G,
|
||||
B = color.B,
|
||||
}, cancellationToken);
|
||||
public void CpuLoad(double brightness, double speed, Color color, CancellationToken cancellationToken = default) => SendRequest(_client.SetCpuLoad, new CpuLoadRequest
|
||||
{
|
||||
Brightness = brightness,
|
||||
Speed = speed,
|
||||
R = color.R,
|
||||
G = color.G,
|
||||
B = color.B
|
||||
}, cancellationToken);
|
||||
|
||||
public async Task PingAsync(CancellationToken cancellationToken = default) => await SendRequestAsync(_client.PingAsync, new Empty(), cancellationToken);
|
||||
public async Task OffAsync(CancellationToken cancellationToken = default) => await SendRequestAsync(_client.SetOffAsync, new Empty(), cancellationToken);
|
||||
public async Task StaticColorAsync(double brightness, Color color, CancellationToken cancellationToken = default) => await SendRequestAsync(_client.SetStaticColorAsync, new StaticColorRequest
|
||||
{
|
||||
Brightness = brightness,
|
||||
R = color.R,
|
||||
G = color.G,
|
||||
B = color.B
|
||||
}, cancellationToken);
|
||||
public async Task StaticGradient2Async(double brightness, Color leftColor, Color rightColor, CancellationToken cancellationToken = default) => await SendRequestAsync(_client.SetStaticGradient2Async, new StaticGradient2Request
|
||||
{
|
||||
Brightness = brightness,
|
||||
LeftR = leftColor.R,
|
||||
LeftG = leftColor.G,
|
||||
LeftB = leftColor.B,
|
||||
RightR = rightColor.R,
|
||||
RightG = rightColor.G,
|
||||
RightB = rightColor.B
|
||||
}, cancellationToken);
|
||||
public async Task StaticGradient3Async(double brightness, Color leftColor, Color middleColor, Color rightColor, CancellationToken cancellationToken = default) => await SendRequestAsync(_client.SetStaticGradient3Async, new StaticGradient3Request
|
||||
{
|
||||
Brightness = brightness,
|
||||
LeftR = leftColor.R,
|
||||
LeftG = leftColor.G,
|
||||
LeftB = leftColor.B,
|
||||
MiddleR = middleColor.R,
|
||||
MiddleG = middleColor.G,
|
||||
MiddleB = middleColor.B,
|
||||
RightR = rightColor.R,
|
||||
RightG = rightColor.G,
|
||||
RightB = rightColor.B
|
||||
}, cancellationToken);
|
||||
public async Task StaticRainbowAsync(double brightness, CancellationToken cancellationToken = default) => await SendRequestAsync(_client.SetStaticRainbowAsync, new StaticRainbowRequest
|
||||
{
|
||||
Brightness = brightness
|
||||
}, cancellationToken);
|
||||
public async Task BreathingColorAsync(double brightness, double speed, Color color, CancellationToken cancellationToken = default) => await SendRequestAsync(_client.SetBreathingColorAsync, new BreathingColorRequest
|
||||
{
|
||||
Brightness = brightness,
|
||||
Speed = speed,
|
||||
R = color.R,
|
||||
G = color.G,
|
||||
B = color.B
|
||||
}, cancellationToken);
|
||||
public async Task BreathingGradient2Async(double brightness, double speed, Color leftColor, Color rightColor, CancellationToken cancellationToken = default) => await SendRequestAsync(_client.SetBreathingGradient2Async, new BreathingGradient2Request
|
||||
{
|
||||
Brightness = brightness,
|
||||
Speed = speed,
|
||||
LeftR = leftColor.R,
|
||||
LeftG = leftColor.G,
|
||||
LeftB = leftColor.B,
|
||||
RightR = rightColor.R,
|
||||
RightG = rightColor.G,
|
||||
RightB = rightColor.B
|
||||
}, cancellationToken);
|
||||
public async Task BreathingGradient3Async(double brightness, double speed, Color leftColor, Color middleColor, Color rightColor, CancellationToken cancellationToken = default) => await SendRequestAsync(_client.SetBreathingGradient3Async, new BreathingGradient3Request
|
||||
{
|
||||
Brightness = brightness,
|
||||
Speed = speed,
|
||||
LeftR = leftColor.R,
|
||||
LeftG = leftColor.G,
|
||||
LeftB = leftColor.B,
|
||||
MiddleR = middleColor.R,
|
||||
MiddleG = middleColor.G,
|
||||
MiddleB = middleColor.B,
|
||||
RightR = rightColor.R,
|
||||
RightG = rightColor.G,
|
||||
RightB = rightColor.B
|
||||
}, cancellationToken);
|
||||
public async Task BreathingRainbowAsync(double brightness, double speed, CancellationToken cancellationToken = default) => await SendRequestAsync(_client.SetBreathingRainbowAsync, new BreathingRainbowRequest
|
||||
{
|
||||
Brightness = brightness,
|
||||
Speed = speed
|
||||
}, cancellationToken);
|
||||
public async Task RunningColorAsync(double brightness, double speed, int length, int fade, Color color, CancellationToken cancellationToken = default) => await SendRequestAsync(_client.SetRunningColorAsync, new RunningColorRequest
|
||||
{
|
||||
Brightness = brightness,
|
||||
Speed = speed,
|
||||
Length = length,
|
||||
Fade = fade,
|
||||
R = color.R,
|
||||
G = color.G,
|
||||
B = color.B
|
||||
}, cancellationToken);
|
||||
public async Task RunningGradient2Async(double brightness, double speed, Color leftColor, Color rightColor, CancellationToken cancellationToken = default) => await SendRequestAsync(_client.SetRunningGradient2Async, new RunningGradient2Request
|
||||
{
|
||||
Brightness = brightness,
|
||||
Speed = speed,
|
||||
LeftR = leftColor.R,
|
||||
LeftG = leftColor.G,
|
||||
LeftB = leftColor.B,
|
||||
RightR = rightColor.R,
|
||||
RightG = rightColor.G,
|
||||
RightB = rightColor.B
|
||||
}, cancellationToken);
|
||||
public async Task RunningGradient3Async(double brightness, double speed, Color leftColor, Color middleColor, Color rightColor, CancellationToken cancellationToken = default) => await SendRequestAsync(_client.SetRunningGradient3Async, new RunningGradient3Request
|
||||
{
|
||||
Brightness = brightness,
|
||||
Speed = speed,
|
||||
LeftR = leftColor.R,
|
||||
LeftG = leftColor.G,
|
||||
LeftB = leftColor.B,
|
||||
MiddleR = middleColor.R,
|
||||
MiddleG = middleColor.G,
|
||||
MiddleB = middleColor.B,
|
||||
RightR = rightColor.R,
|
||||
RightG = rightColor.G,
|
||||
RightB = rightColor.B
|
||||
}, cancellationToken);
|
||||
public async Task RunningRainbowAsync(double brightness, double speed, CancellationToken cancellationToken = default) => await SendRequestAsync(_client.SetRunningRainbowAsync, new RunningRainbowRequest
|
||||
{
|
||||
Brightness = brightness,
|
||||
Speed = speed
|
||||
}, cancellationToken);
|
||||
public async Task SnakeAsync(double brightness, double speed, int headLength, int tailLength, Color headColor, Color tailColor, CancellationToken cancellationToken = default) => await SendRequestAsync(_client.SetSnakeAsync, new SnakeRequest
|
||||
{
|
||||
Brightness = brightness,
|
||||
Speed = speed,
|
||||
HeadLength = headLength,
|
||||
TailLength = tailLength,
|
||||
HeadR = headColor.R,
|
||||
HeadG = headColor.G,
|
||||
HeadB = headColor.B,
|
||||
TailR = tailColor.R,
|
||||
TailG = tailColor.G,
|
||||
TailB = tailColor.B
|
||||
}, cancellationToken);
|
||||
public async Task FireAsync(double brightness, double speed, Color color, CancellationToken cancellationToken = default) => await SendRequestAsync(_client.SetFireAsync, new FireRequest
|
||||
{
|
||||
Brightness = brightness,
|
||||
Speed = speed,
|
||||
R = color.R,
|
||||
G = color.G,
|
||||
B = color.B
|
||||
}, cancellationToken);
|
||||
public async Task SnowfallAsync(double brightness, double speed, Color color, CancellationToken cancellationToken = default) => await SendRequestAsync(_client.SetSnowfallAsync, new SnowfallRequest
|
||||
{
|
||||
Brightness = brightness,
|
||||
Speed = speed,
|
||||
R = color.R,
|
||||
G = color.G,
|
||||
B = color.B
|
||||
}, cancellationToken);
|
||||
public async Task FlashAsync(double brightness, double speed, Color color, CancellationToken cancellationToken = default) => await SendRequestAsync(_client.SetFlashAsync, new FlashRequest
|
||||
{
|
||||
Brightness = brightness,
|
||||
Speed = speed,
|
||||
R = color.R,
|
||||
G = color.G,
|
||||
B = color.B
|
||||
}, cancellationToken);
|
||||
public async Task LoadAsync(double brightness, double speed, double percent, double lastPercent, Color color, CancellationToken cancellationToken = default) => await SendRequestAsync(_client.SetLoadAsync, new LoadRequest
|
||||
{
|
||||
Brightness = brightness,
|
||||
Speed = speed,
|
||||
Percent = percent,
|
||||
LastPercent = lastPercent,
|
||||
R = color.R,
|
||||
G = color.G,
|
||||
B = color.B,
|
||||
}, cancellationToken);
|
||||
public async Task CpuLoadAsync(double brightness, double speed, Color color, CancellationToken cancellationToken = default) => await SendRequestAsync(_client.SetCpuLoadAsync, new CpuLoadRequest
|
||||
{
|
||||
Brightness = brightness,
|
||||
Speed = speed,
|
||||
R = color.R,
|
||||
G = color.G,
|
||||
B = color.B
|
||||
}, cancellationToken);
|
||||
}
|
||||
@@ -0,0 +1,174 @@
|
||||
using System.Device.I2c;
|
||||
using Microsoft.Extensions.Logging;
|
||||
|
||||
namespace GSS2.Core.Hardware;
|
||||
|
||||
public class TemperatureHumidityService : IDisposable
|
||||
{
|
||||
public class TemperatureHumidityServiceConfiguration
|
||||
{
|
||||
public static TemperatureHumidityServiceConfiguration Default => new TemperatureHumidityServiceConfiguration
|
||||
{
|
||||
Bus = 0,
|
||||
Address = 0x44
|
||||
};
|
||||
|
||||
public int Bus { get; set; }
|
||||
public int Address { get; set; }
|
||||
}
|
||||
private bool _disposedValue;
|
||||
private readonly ILogger<TemperatureHumidityService> _logger;
|
||||
private readonly TemperatureHumidityServiceConfiguration _configuration;
|
||||
|
||||
private readonly I2cDevice _sensor;
|
||||
|
||||
public TemperatureHumidityService(ILogger<TemperatureHumidityService> logger, TemperatureHumidityServiceConfiguration? configuration = null)
|
||||
{
|
||||
_logger = logger;
|
||||
|
||||
_logger.LogInformation("Temperature and humidity sensor initialization");
|
||||
|
||||
if (configuration is null)
|
||||
{
|
||||
_logger.LogWarning("Temperature and humidity sensor configuration not set. Using default configuration.");
|
||||
_configuration = TemperatureHumidityServiceConfiguration.Default;
|
||||
}
|
||||
else
|
||||
{
|
||||
_configuration = configuration;
|
||||
}
|
||||
|
||||
_logger.LogDebug(@$"Temperature and humidity sensor use following configuration:
|
||||
Bus: {_configuration.Bus}
|
||||
Address: {_configuration.Address}
|
||||
");
|
||||
|
||||
try
|
||||
{
|
||||
_sensor = I2cDevice.Create(new I2cConnectionSettings(_configuration.Bus, _configuration.Address));
|
||||
}
|
||||
catch (Exception e)
|
||||
{
|
||||
_logger.LogCritical(e, "An exception occurred while temperature and humidity sensor initialization");
|
||||
throw;
|
||||
}
|
||||
}
|
||||
|
||||
public async Task<(double temperature, double relativeHumidity)> MeasureAsync(int measurementsCount = 1, CancellationToken cancellationToken = default)
|
||||
{
|
||||
// В соответствии с даташитом на SHT45-AD1B-R2 псевдокод измерения с высокой точностью следующий:
|
||||
// i2c_write(i2c_addr=0x44, tx_bytes=[0xFD])
|
||||
// wait_seconds(0.01)
|
||||
// rx_bytes = i2c_read(i2c_addr=0x44, number_of_bytes=6)
|
||||
// t_ticks = rx_bytes[0] * 256 + rx_bytes[1]
|
||||
// checksum_t = rx_bytes[2]
|
||||
// rh_ticks = rx_bytes[3] * 256 + rx_bytes[4]
|
||||
// checksum_rh = rx_bytes[5]
|
||||
// t_degC = -45 + 175 * t_ticks/65535
|
||||
// rh_pRH = -6 + 125 * rh_ticks/65535
|
||||
// if (rh_pRH > 100):
|
||||
// rh_pRH = 100
|
||||
// if (rh_pRH < 0):
|
||||
// rh_pRH = 0
|
||||
|
||||
if (measurementsCount <= 0)
|
||||
throw new ArgumentOutOfRangeException(nameof(measurementsCount));
|
||||
|
||||
double sumTemperature = 0;
|
||||
double sumRelativeHumidity = 0;
|
||||
int successMeasurementsCount = 0;
|
||||
|
||||
Span<byte> command = stackalloc byte[] { 0xFD };
|
||||
Span<byte> data = stackalloc byte[6];
|
||||
|
||||
for (int i = 0; i < measurementsCount; i++)
|
||||
{
|
||||
cancellationToken.ThrowIfCancellationRequested();
|
||||
|
||||
try
|
||||
{
|
||||
// Отправляем команду
|
||||
_sensor.Write(command);
|
||||
// 10 мс ожидания
|
||||
await Task.Delay(10, cancellationToken);
|
||||
// Читаем данные
|
||||
_sensor.Read(data);
|
||||
|
||||
// Распаковываем данные [2 * 8-bit T-data; 8-bit CRC; 2 * 8-bit RH-data; 8-bit CRC]
|
||||
ushort temperatureTicks = BitConverter.ToUInt16(data.ToArray(), 0);
|
||||
byte temperatureChecksum = data[2];
|
||||
int relativeHumidityTicks = BitConverter.ToUInt16(data.ToArray(), 3);
|
||||
byte relativeHumidityChecksum = data[5];
|
||||
|
||||
// Проверка по CRC
|
||||
if (!CheckCrc(data.Slice(0, 2), temperatureChecksum) ||
|
||||
!CheckCrc(data.Slice(3, 2), relativeHumidityChecksum))
|
||||
{
|
||||
_logger.LogWarning("Temperature and humidity sensor CRC error");
|
||||
continue;
|
||||
}
|
||||
|
||||
// Пересчёт
|
||||
double temperature = -45 + 175 * (temperatureTicks / 65535.0);
|
||||
double relativeHumidity = -6 + 125 * (relativeHumidityTicks / 65535.0);
|
||||
relativeHumidity = Math.Clamp(relativeHumidity, 0, 100);
|
||||
|
||||
// Сумма для усреднения
|
||||
sumTemperature += temperature;
|
||||
sumRelativeHumidity += relativeHumidity;
|
||||
successMeasurementsCount++;
|
||||
}
|
||||
catch (Exception e)
|
||||
{
|
||||
_logger.LogWarning(e, "Temperature and humidity sensor not available on I2C bus");
|
||||
}
|
||||
}
|
||||
|
||||
if (successMeasurementsCount == 0)
|
||||
{
|
||||
_logger.LogError("Temperature and humidity sensor: no successful measurements");
|
||||
return (double.NaN, double.NaN);
|
||||
}
|
||||
|
||||
return (sumTemperature / successMeasurementsCount, sumRelativeHumidity / successMeasurementsCount);
|
||||
}
|
||||
|
||||
private static bool CheckCrc(Span<byte> data, byte expectedCrc)
|
||||
{
|
||||
byte crc = 0xFF;
|
||||
foreach (var b in data)
|
||||
{
|
||||
crc ^= b;
|
||||
for (int i = 0; i < 8; i++)
|
||||
{
|
||||
if ((crc & 0x80) != 0)
|
||||
crc = (byte)((crc << 1) ^ 0x31);
|
||||
else
|
||||
crc <<= 1;
|
||||
}
|
||||
}
|
||||
return crc == expectedCrc;
|
||||
}
|
||||
|
||||
protected virtual void Dispose(bool disposing)
|
||||
{
|
||||
if (!_disposedValue)
|
||||
{
|
||||
if (disposing)
|
||||
{
|
||||
try
|
||||
{
|
||||
_sensor?.Dispose();
|
||||
}
|
||||
catch { }
|
||||
}
|
||||
|
||||
_disposedValue = true;
|
||||
}
|
||||
}
|
||||
void IDisposable.Dispose()
|
||||
{
|
||||
Dispose(disposing: true);
|
||||
GC.SuppressFinalize(this);
|
||||
}
|
||||
}
|
||||
Reference in New Issue
Block a user