Update the main loop and reorganise the ESS mode enum

This commit is contained in:
atef 2025-09-18 12:35:44 +02:00
parent 6a0cd3d5a7
commit ce51af8510
2 changed files with 122 additions and 79 deletions

View File

@ -2,8 +2,8 @@ namespace InnovEnergy.App.GrowattCommunication.ESS;
public enum EssMode public enum EssMode
{ {
Off, LoadPriority,
GridPriority,
BatteryPriority, BatteryPriority,
LoadPriority GridPriority,
Off
} }

View File

@ -16,6 +16,8 @@ using Newtonsoft.Json;
using Formatting = Newtonsoft.Json.Formatting; using Formatting = Newtonsoft.Json.Formatting;
using JsonSerializer = System.Text.Json.JsonSerializer; using JsonSerializer = System.Text.Json.JsonSerializer;
using System.Diagnostics.CodeAnalysis; using System.Diagnostics.CodeAnalysis;
using System.Reactive.Linq;
using System.Reactive.Threading.Tasks;
using InnovEnergy.App.GrowattCommunication.DataTypes; using InnovEnergy.App.GrowattCommunication.DataTypes;
using InnovEnergy.Lib.Devices.WITGrowatt4_15K.DataType; using InnovEnergy.Lib.Devices.WITGrowatt4_15K.DataType;
using static InnovEnergy.App.GrowattCommunication.MiddlewareClasses.MiddlewareAgent; using static InnovEnergy.App.GrowattCommunication.MiddlewareClasses.MiddlewareAgent;
@ -24,7 +26,7 @@ namespace InnovEnergy.App.GrowattCommunication;
public static class Program public static class Program
{ {
private static readonly TimeSpan UpdateInterval = TimeSpan.FromSeconds(2); private static readonly TimeSpan UpdateInterval = TimeSpan.FromSeconds(5);
private const UInt16 NbrOfFileToConcatenate = 15; // add this to config file private const UInt16 NbrOfFileToConcatenate = 15; // add this to config file
private static UInt16 _fileCounter = 0; private static UInt16 _fileCounter = 0;
// //
@ -70,6 +72,7 @@ public static class Program
} }
[RequiresUnreferencedCode("Calls InnovEnergy.App.GrowattCommunication.Program.SaveModbusTcpFile(StatusRecord)")]
private static async Task Run() private static async Task Run()
{ {
Watchdog.NotifyReady(); Watchdog.NotifyReady();
@ -80,7 +83,7 @@ public static class Program
// var growattDevices = new WITGrowattDevices(new List<WITGrowatDevice> { growattDeviceT415K }); // var growattDevices = new WITGrowattDevices(new List<WITGrowatDevice> { growattDeviceT415K });
StatusRecord ReadStatus() StatusRecord? ReadStatus()
{ {
var config = Config.Load(); var config = Config.Load();
var growattRecord = growattDeviceT415K.Read(); var growattRecord = growattDeviceT415K.Read();
@ -88,20 +91,29 @@ public static class Program
return new StatusRecord return new StatusRecord
{ {
AcDcGrowatt = growattRecord, AcDcGrowatt = growattRecord,
Config = config // load from disk every iteration, so config can be changed while running Config = config // load from disk every iteration, so config can be changed while running
}; };
} }
while (true) while (true)
{
await Observable
.Interval(UpdateInterval)
.Select(_ => RunIteration())
.SelectMany(status =>
DataLogging(status, DateTime.Now.Round(UpdateInterval))
.ContinueWith(_ => status)) // back to StatusRecord
.SelectMany(SaveModbusTcpFile)
.SelectError()
.ToTask();
}
StatusRecord? RunIteration()
{ {
try try
{ {
Watchdog.NotifyAlive(); Watchdog.NotifyAlive();
var timestamp = DateTime.Now.Round(UpdateInterval).ToUnixTime();
$"{timestamp} : {DateTime.Now.Round(UpdateInterval):dd/MM/yyyy HH:mm:ss}".WriteLine();
var startTime = DateTime.Now; var startTime = DateTime.Now;
Console.WriteLine("***************************** Reading Battery Data *********************************************"); Console.WriteLine("***************************** Reading Battery Data *********************************************");
Console.WriteLine(startTime.ToString("HH:mm:ss.fff")); Console.WriteLine(startTime.ToString("HH:mm:ss.fff"));
@ -111,46 +123,102 @@ public static class Program
SendSalimaxStateAlarm(GetSodiHomeStateAlarm(statusrecord),statusrecord); SendSalimaxStateAlarm(GetSodiHomeStateAlarm(statusrecord),statusrecord);
await DataLogging(statusrecord, timestamp); // save a csv file locally //await DataLogging(statusrecord, timestamp); // save a csv file locally
await SaveModbusTcpFile(statusrecord); // save the json file for modbuscTCP //await SaveModbusTcpFile(statusrecord); // save the json file for modbuscTCP
statusrecord.AcDcGrowatt.RemotePowerControl.WriteLine(" = RemotePowerControl");
statusrecord.AcDcGrowatt.EnableCommand.WriteLine(" = EnableCommand");
statusrecord.AcDcGrowatt.ControlPermession.WriteLine(" ControlPermession");
statusrecord.AcDcGrowatt.MeterPower.WriteLine(" MeterPower");
statusrecord.AcDcGrowatt.GridMeterPower.WriteLine(" GridMeterPower");
var x = CalculateActivePower(statusrecord);
x.WriteLine(" Calculated Grid Power");
statusrecord.AcDcGrowatt.InverterActivePower.WriteLine(" InverterActivePower");
statusrecord.AcDcGrowatt.BatteryChargeCutoffVoltage.WriteLine(" BatteryChargeCutoffVoltage "); //30409 we set power here
statusrecord.AcDcGrowatt.BatteryDischargeCutoffVoltage.WriteLine(" BatteryDishargeCutoffVoltage "); //30409 we set power here
statusrecord.AcDcGrowatt.PowerFactor.WriteLine(" = PowerFactor");
statusrecord.AcDcGrowatt.Batteries[0].Soc.WriteLine(" SOC");
statusrecord.AcDcGrowatt.Batteries[0].Power.WriteLine(" Battery Power");
statusrecord.AcDcGrowatt.Batteries[0].Current.WriteLine(" Battery Current");
statusrecord.AcDcGrowatt.Batteries[0].Voltage.WriteLine(" Battery Voltage");
statusrecord.AcDcGrowatt.BatteryMaxChargeCurrent.WriteLine(" BatteryMaxChargeCurrent "); //30409 we set power here
statusrecord.AcDcGrowatt.BatteryMaxdischargeCurrent.WriteLine(" BatteryMaxDischargeCurrent "); //30409 we set power here
statusrecord.AcDcGrowatt.SystemOperatingMode.WriteLine(" = SystemOperatingMode");
statusrecord.AcDcGrowatt.BatteryOperatingMode.WriteLine(" = BatteryOperatingMode");
statusrecord.AcDcGrowatt.OperatingPriority.WriteLine(" = OperatingPriority"); // 30408 this the duration
statusrecord.AcDcGrowatt.FaultMainCode.WriteLine(" = FaultMainCode"); // 30408 this the duration
statusrecord.AcDcGrowatt.FaultSubCode.WriteLine(" = FaultSubCode"); // 30408 this the duration
statusrecord.AcDcGrowatt.WarningMainCode.WriteLine(" = WarningMainCode"); // 30408 this the duration
statusrecord.AcDcGrowatt.WarningSubCode.WriteLine(" = WarningSubCode"); // 30408 this the duration
EssModeControl(statusrecord,EssMode.LoadPriority); // this should moved to config file
EssModeControl(statusrecord);
statusrecord.ApplyDefaultSettings(); statusrecord.ApplyDefaultSettings();
statusrecord.Config.Save(); // save the config file
Console.WriteLine( " ************************************ We are writing ************************************"); Console.WriteLine( " ************************************ We are writing ************************************");
statusrecord.Config.Save(); // save the config file
growattDeviceT415K.Write(statusrecord.AcDcGrowatt); growattDeviceT415K.Write(statusrecord.AcDcGrowatt);
var stopTime = DateTime.Now;
// Wait for 2 seconds before the next reading Console.WriteLine(stopTime.ToString("HH:mm:ss.fff"));
// await Task.Delay(1000); // Delay in milliseconds (1000ms = 1 seconds) return statusrecord;
await Task.Delay(2000); // Delay in milliseconds (1000ms = 1 seconds)
} }
catch (Exception e) catch (Exception e)
{ {
// Handle exception and print the error // Handle exception and print the error
Console.WriteLine(e ); Console.WriteLine(e );
// await Task.Delay(2000); // Delay in milliseconds (2000ms = 2 seconds) // await Task.Delay(2000); // Delay in milliseconds (2000ms = 2 seconds)
return null;
} }
} }
} }
private static void ApplyConfigFile(this StatusRecord status, Configuration? config) public static double CalculateActivePower(this StatusRecord? status)
{
// Convert raw registers to engineering units
double Vab = status.AcDcGrowatt.GridAbLineVoltage * 0.1;
double Vbc = status.AcDcGrowatt.GridBcLineVoltage * 0.1;
double Vca = status.AcDcGrowatt.GridCaLineVoltage * 0.1;
double Ia = status.AcDcGrowatt.PhaseACurrent * 0.1;
double Ib = status.AcDcGrowatt.PhaseBCurrent * 0.1;
double Ic = status.AcDcGrowatt.PhaseCCurrent * 0.1;
// Average line-to-line voltage
double Vll = (Vab + Vbc + Vca) / 3.0;
// Average line current (absolute values, in case of signed currents)
double Il = (Math.Abs(Ia) + Math.Abs(Ib) + Math.Abs(Ic)) / 3.0;
// Apparent power (kVA)
double S_kVA = Math.Sqrt(3) * Vll * Il / 1000.0;
// Active power (kW)
double P_kW = S_kVA * 1;
return P_kW;
}
private static void ApplyConfigFile(this StatusRecord? status, Configuration? config)
{ {
if (config == null) return; if (config == null) return;
if (status == null) return;
status.Config.MinSoc = config.MinimumSoC; status.Config.MinSoc = config.MinimumSoC;
status.Config.GridSetPoint = config.GridSetPoint * 1000; // converted from kW to W status.Config.GridSetPoint = config.GridSetPoint * 1000; // converted from kW to W
status.Config.MaximumChargingCurrent = config.MaximumChargingCurrent; status.Config.MaximumChargingCurrent = config.MaximumChargingCurrent;
status.Config.MaximumDischargingCurrent = config.MaximumDischargingCurrent; // converted from kW to W status.Config.MaximumDischargingCurrent = config.MaximumDischargingCurrent;
status.Config.OperatingPriority = config.OperatingPriority;
} }
private static String EssModeControl(StatusRecord statusrecord, EssMode mode) private static String EssModeControl(StatusRecord? statusrecord)
{ {
var mode = statusrecord?.Config.OperatingPriority;
switch (mode) switch (mode)
{ {
case EssMode.Off: case EssMode.Off:
@ -168,7 +236,7 @@ public static class Program
statusrecord.AcDcGrowatt.RemotePowerControl = true; statusrecord.AcDcGrowatt.RemotePowerControl = true;
statusrecord.AcDcGrowatt.RemotePowerControlChargeDuration = 0; // 30408 this the duration statusrecord.AcDcGrowatt.RemotePowerControlChargeDuration = 0; // 30408 this the duration
statusrecord.AcDcGrowatt.RemoteChargDischargePower = 100; //30409 we set power here // for grid priority from 0 to 100 statusrecord.AcDcGrowatt.RemoteChargDischargePower = 100; //30409 we set power here // for battery priority from 0 to 100
statusrecord.AcDcGrowatt.ActualChargeDischargePowerControlValue.WriteLine(" register 30474");; // this to check what was set statusrecord.AcDcGrowatt.ActualChargeDischargePowerControlValue.WriteLine(" register 30474");; // this to check what was set
return "Battery priority mode active"; return "Battery priority mode active";
case EssMode.LoadPriority: case EssMode.LoadPriority:
@ -179,7 +247,7 @@ public static class Program
} }
} }
private static StatusMessage GetSodiHomeStateAlarm(StatusRecord record) private static StatusMessage GetSodiHomeStateAlarm(StatusRecord? record)
{ {
var s3Bucket = Config.Load().S3?.Bucket; var s3Bucket = Config.Load().S3?.Bucket;
@ -240,7 +308,7 @@ public static class Program
return int.TryParse(part, out var id) ? id : 0; // is 0 a default safe value? check with Marios return int.TryParse(part, out var id) ? id : 0; // is 0 a default safe value? check with Marios
} }
private static void SendSalimaxStateAlarm(StatusMessage currentSalimaxState, StatusRecord record) private static void SendSalimaxStateAlarm(StatusMessage currentSalimaxState, StatusRecord? record)
{ {
var s3Bucket = Config.Load().S3?.Bucket; var s3Bucket = Config.Load().S3?.Bucket;
var subscribedNow = false; var subscribedNow = false;
@ -276,16 +344,14 @@ public static class Program
return; return;
st.AcDcGrowatt.BatteryMaxChargeCurrent = st.Config.MaximumChargingCurrent; st.AcDcGrowatt.BatteryMaxChargeCurrent = st.Config.MaximumChargingCurrent;
st.AcDcGrowatt.BatteryMaxdischargeCurrent = st.Config.MaximumDischargingCurrent; st.AcDcGrowatt.BatteryMaxdischargeCurrent = st.Config.MaximumDischargingCurrent ;
st.AcDcGrowatt.DischargeCutoffSoc = st.Config.MinSoc;
st.AcDcGrowatt.EmsCommunicationFailureTime = 20; // 20 sec st.AcDcGrowatt.EmsCommunicationFailureTime = 20; // 20 sec
st.AcDcGrowatt.EnableEmsCommunicationFailureTime = false; st.AcDcGrowatt.EnableEmsCommunicationFailureTime = true;
st.AcDcGrowatt.EnableCommand = true; st.AcDcGrowatt.EnableCommand = true;
st.AcDcGrowatt.ControlPermession = true; st.AcDcGrowatt.ControlPermession = true;
st.AcDcGrowatt.BatteryChargeCutoffVoltage = 100; //st.Config.BatteryChargeCutoffVoltage; st.AcDcGrowatt.BatteryChargeCutoffVoltage = 60; //st.Config.BatteryChargeCutoffVoltage;
st.AcDcGrowatt.BatteryDischargeCutoffVoltage = 20; //st.Config.BatteryDischargeCutoffVoltage; st.AcDcGrowatt.BatteryDischargeCutoffVoltage = 20; //st.Config.BatteryDischargeCutoffVoltage;
st.AcDcGrowatt.BatteryMaxChargeCurrent = 200; //st.Config.BatteryChargeCutoffVoltage;
st.AcDcGrowatt.BatteryMaxdischargeCurrent = 200; //st.Config.BatteryChargeCutoffVoltage;
} }
private static Dictionary<String, UInt16> ConvertToModbusRegisters(Object value, String outputType, Int32 startingAddress) private static Dictionary<String, UInt16> ConvertToModbusRegisters(Object value, String outputType, Int32 startingAddress)
@ -323,18 +389,18 @@ public static class Program
} }
[RequiresUnreferencedCode("Calls System.Text.Json.JsonSerializer.Serialize<System.Collections.Generic.Dictionary<string, ushort>>(System.Collections.Generic.Dictionary<string, ushort>, System.Text.Json.JsonSerializerOptions?)")] [RequiresUnreferencedCode("Calls System.Text.Json.JsonSerializer.Serialize<System.Collections.Generic.Dictionary<string, ushort>>(System.Collections.Generic.Dictionary<string, ushort>, System.Text.Json.JsonSerializerOptions?)")]
private static async Task SaveModbusTcpFile(StatusRecord status) private static async Task<Boolean> SaveModbusTcpFile(StatusRecord status)
{ {
var modbusData = new Dictionary<String, UInt16>(); var modbusData = new Dictionary<String, UInt16>();
const Double protcolNumber = 1.1; const Double protcolNumber = 1.1; // to be communicated by yinyin maybe add this to config file
var pv1Power = status.AcDcGrowatt.Pv1Current * status.AcDcGrowatt.Pv1Voltage; var pv1Power = status.AcDcGrowatt.Pv1Current * status.AcDcGrowatt.Pv1Voltage;
var pv2Power = status.AcDcGrowatt.Pv2Current * status.AcDcGrowatt.Pv2Voltage; var pv2Power = status.AcDcGrowatt.Pv2Current * status.AcDcGrowatt.Pv2Voltage;
// SYSTEM DATA // SYSTEM DATA
var result1 = ConvertToModbusRegisters((protcolNumber * 10), "UInt16", 30000); // this to be updated to modbusTCP version var result1 = ConvertToModbusRegisters((protcolNumber * 10), "UInt16", 30001); // this to be updated to modbusTCP version
var result2 = ConvertToModbusRegisters(status.AcDcGrowatt.SystemDateTime.ToUnixTime(), "UInt32", 30001); var result2 = ConvertToModbusRegisters(status.AcDcGrowatt.SystemDateTime.ToUnixTime(), "UInt32", 30002);
var result3 = ConvertToModbusRegisters(status.AcDcGrowatt.SystemOperatingMode, "UInt16", 30003); var result3 = ConvertToModbusRegisters(status.AcDcGrowatt.SystemOperatingMode, "UInt16", 30004);
var result17 = ConvertToModbusRegisters(status.AcDcGrowatt.OperatingPriority, "UInt16", 30004); var result17 = ConvertToModbusRegisters(status.AcDcGrowatt.OperatingPriority, "UInt16", 30005);
// BATTERY SUMMARY (assuming single battery [0]) // this to be improved // BATTERY SUMMARY (assuming single battery [0]) // this to be improved
var battery = status.AcDcGrowatt.BatteriesRecords!.Batteries[0]; var battery = status.AcDcGrowatt.BatteriesRecords!.Batteries[0];
@ -348,20 +414,25 @@ public static class Program
var result10 = ConvertToModbusRegisters((battery.MaxAllowableDischargePower.Value * 10), "UInt32", 31011); var result10 = ConvertToModbusRegisters((battery.MaxAllowableDischargePower.Value * 10), "UInt32", 31011);
var result11 = ConvertToModbusRegisters((battery.MaxAllowableDischargePower.Value * 10), "UInt32", 31013); var result11 = ConvertToModbusRegisters((battery.MaxAllowableDischargePower.Value * 10), "UInt32", 31013);
var result12 = ConvertToModbusRegisters((battery.Voltage.Value * 10), "Int16", 31015); var result12 = ConvertToModbusRegisters((battery.Voltage.Value * 10), "Int16", 31016);
var result13 = ConvertToModbusRegisters((battery.Current.Value * 10), "Int32", 31016); var result13 = ConvertToModbusRegisters((battery.Current.Value * 10), "Int32", 31017);
var result14 = ConvertToModbusRegisters((battery.Soc.Value * 100), "UInt16", 31018); var result14 = ConvertToModbusRegisters((battery.Soc.Value * 100), "UInt16", 31019);
var result15 = ConvertToModbusRegisters((status.AcDcGrowatt.BatteriesRecords!.AverageSoh * 100), "UInt16", 31020); var result15 = ConvertToModbusRegisters((status.AcDcGrowatt.BatteriesRecords!.AverageSoh * 100), "UInt16", 31022);
var result16 = ConvertToModbusRegisters((battery.BatteryAmbientTemperature.Value * 100), "UInt16", 31021); var result16 = ConvertToModbusRegisters((battery.BatteryAmbientTemperature.Value * 100), "UInt16", 31023);
var result18 = ConvertToModbusRegisters(((pv1Power + pv2Power) * 10), "UInt32", 31999); var result18 = ConvertToModbusRegisters(((pv1Power + pv2Power) * 10), "UInt32", 31999);
var result19 = ConvertToModbusRegisters((status.AcDcGrowatt.GridMeterPower.Value * 10), "Int32", 32999); var result19 = ConvertToModbusRegisters((status.AcDcGrowatt.GridMeterPower.Value * 10), "Int32", 32999);
var result20 = ConvertToModbusRegisters((status.AcDcGrowatt.DischargeCutoffSoc * 100), "UInt16", 31020);
var result21 = ConvertToModbusRegisters((status.AcDcGrowatt.BatteryMaxChargeCurrent * 10), "UInt16", 31024);
var result22 = ConvertToModbusRegisters((status.AcDcGrowatt.BatteryMaxdischargeCurrent * 10), "UInt16", 31025);
var result23 = ConvertToModbusRegisters((status.AcDcGrowatt.BatteryChargeCutoffVoltage * 10), "UInt16", 31026);
// Merge all results into one dictionary // Merge all results into one dictionary
var allResults = new[] var allResults = new[]
{ {
result1,result2, result3, result17, result4, result5, result6, result7, result8, result1,result2, result3, result17, result4, result5, result6, result7, result8,
result9, result10, result11, result12, result13, result14, result15, result16, result18, result19 result9, result10, result11, result12, result13, result14, result15, result16, result18, result19,result20,
result21, result22, result23
}; };
foreach (var result in allResults) foreach (var result in allResults)
@ -377,9 +448,10 @@ public static class Program
//Console.WriteLine("JSON file written successfully."); //Console.WriteLine("JSON file written successfully.");
//Console.WriteLine(json); //Console.WriteLine(json);
return true;
} }
private static async Task<Boolean> DataLogging(StatusRecord status, Int64 timestamp) private static async Task<Boolean> DataLogging(StatusRecord status, DateTime timeStamp)
{ {
var csv = status.ToCsv(); var csv = status.ToCsv();
@ -389,7 +461,7 @@ public static class Program
// Console.WriteLine(item + ""); // Console.WriteLine(item + "");
//} //}
await SavingLocalCsvFile(timestamp, csv); await SavingLocalCsvFile(timeStamp.ToUnixTime(), csv);
var jsonData = new Dictionary<String, Object>(); var jsonData = new Dictionary<String, Object>();
@ -401,7 +473,7 @@ public static class Program
return false; return false;
//Concatenating 15 files in one file //Concatenating 15 files in one file
return await ConcatinatingAndCompressingFiles(timestamp, s3Config); return await ConcatinatingAndCompressingFiles(timeStamp.ToUnixTime(), s3Config);
} }
private static String ConvertToJson(String csv, Dictionary<String, Object> jsonData) private static String ConvertToJson(String csv, Dictionary<String, Object> jsonData)
@ -651,33 +723,4 @@ public static class Program
return compressedBytes; return compressedBytes;
} }
private static byte[] ComputeCrc16Appended(byte[] data)
{
ushort crc = 0xFFFF;
foreach (byte b in data)
{
crc ^= b;
for (int i = 0; i < 8; i++)
{
bool lsb = (crc & 0x0001) != 0;
crc >>= 1;
if (lsb)
{
crc ^= 0xA001;
}
}
}
byte crcLow = (byte)(crc & 0xFF);
byte crcHigh = (byte)((crc >> 8) & 0xFF);
// Create a new array with space for CRC
byte[] result = new byte[data.Length + 2];
Array.Copy(data, result, data.Length);
result[result.Length - 2] = crcLow;
result[result.Length - 1] = crcHigh;
return result;
}
} }