You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.

238 lines
10 KiB

This file contains ambiguous Unicode characters!

This file contains ambiguous Unicode characters that may be confused with others in your current locale. If your use case is intentional and legitimate, you can safely ignore this warning. Use the Escape button to highlight these characters.

using DotNetty.Buffers;
using DotNetty.Codecs;
using DotNetty.Transport.Channels;
using HybirdFrameworkCore.Utils;
using HybirdFrameworkDriver.Session;
using log4net;
using Newtonsoft.Json;
using Service.Charger.Common;
using Service.Charger.Msg;
using Service.Charger.Msg.Bms;
using Service.Charger.Msg.Charger.Req;
using Service.Charger.Msg.Charger.Resp;
using Service.Charger.Msg.Host.Req;
namespace Service.Charger.Codec;
public class Decoder : ByteToMessageDecoder
{
private static readonly ILog Log = LogManager.GetLogger(typeof(Decoder));
private readonly IByteBuffer[] _delimiters = { Unpooled.CopiedBuffer(ChargerConst.StartChar) };
protected override void Decode(IChannelHandlerContext context, IByteBuffer buffer, List<object> output)
{
IByteBuffer? delimiter = FindDelimiter(buffer);
if (delimiter != null)
{
//分隔符索引
int delimiterIndex = IndexOf(buffer, delimiter);
//帧长索引
int frameLengthIndex = delimiterIndex + delimiter.Capacity;
if (delimiterIndex > 0)
{
buffer.SkipBytes(delimiterIndex);
return;
}
if (buffer.ReadableBytes < frameLengthIndex + 2)
{
// 数据不足,等待更多数据
return;
}
// 读取长度字段
int frameLength = buffer.GetUnsignedShortLE(buffer.ReaderIndex + frameLengthIndex);
//总帧长
int totalFrameLength = delimiterIndex + delimiter.Capacity + 2 + frameLength;
if (buffer.ReadableBytes < totalFrameLength)
{
// 数据不足,等待更多数据
return;
}
ASDU asdu = Parse(buffer, totalFrameLength, out var data);
Log.Info($"receive {JsonConvert.SerializeObject(asdu)}:{data} from {ChannelUtils.GetAttr(context.Channel, ChargerConst.ChargerSn)}");
output.Add(asdu);
buffer.Clear();
}
}
private IByteBuffer? FindDelimiter(IByteBuffer buffer)
{
foreach (IByteBuffer delimiter in _delimiters)
{
int delimiterIndex = IndexOf(buffer, delimiter);
if (delimiterIndex >= 0)
{
return delimiter;
}
}
return null;
}
private static int IndexOf(IByteBuffer haystack, IByteBuffer needle)
{
for (int i = haystack.ReaderIndex; i < haystack.WriterIndex; i++)
{
int num = i;
int j;
for (j = 0; j < needle.Capacity && haystack.GetByte(num) == needle.GetByte(j); j++)
{
num++;
if (num == haystack.WriterIndex && j != needle.Capacity - 1)
{
return -1;
}
}
if (j == needle.Capacity)
{
return i - haystack.ReaderIndex;
}
}
return -1;
}
public ASDU Parse(IByteBuffer byteBuffer, int totalFrameLength, out byte[] data)
{
data = new byte[totalFrameLength];
byteBuffer.ReadBytes(data);
//string ou = string.Empty;
//for (int i = 0; i < data.Length; i++)
//{
// ou += data[i].ToString("X2") + " ";
//}
//TODO bug length取值不对上述测试使用
int removeIndex = _delimiters.Length;
ushort cmd = byteBuffer.GetByte(14 + removeIndex);
ushort recordType = byteBuffer.GetByte(23 + removeIndex);
byte[] bytes = new byte[data.Length - (23 + removeIndex)];
Array.Copy(data, 23 + removeIndex, bytes, 0, bytes.Length);
ASDU asdu = cmd switch
{
5 => ModelConvert.Decode<UploadRemoteSignalData>(bytes),
#region 45
45 => recordType switch
{
1 => ModelConvert.Decode<FinishStartCharging>(bytes),
3 => ModelConvert.Decode<StopCharging>(bytes),
6 => ModelConvert.Decode<PowerRegulationRes>(bytes),
10 => ModelConvert.Decode<AuxiliaryPowerRes>(bytes),
11 => ModelConvert.Decode<Login>(bytes),
13 => ModelConvert.Decode<HeartBeat>(bytes),
21 => ModelConvert.Decode<AdjustChargeRateRes>(bytes),
25 => ModelConvert.Decode<AuthRes>(bytes),
34 => ModelConvert.Decode<UpgradeRequestRes>(bytes),
35 => ModelConvert.Decode<UplinkUpgrade>(bytes),
41 => ModelConvert.Decode<VehicleVIN>(bytes),
44 => ModelConvert.Decode<OfflineStopChargingRes>(bytes),
48 => ModelConvert.Decode<ResponseSetting>(bytes),
47 => ModelConvert.Decode<SetPeakValleyTime>(bytes),
49 => ModelConvert.Decode<InquireGatewaySpikesValleys>(bytes),
50 => ModelConvert.Decode<SdUpPkFtValSet>(bytes),
52 => ModelConvert.Decode<AuthVINRes>(bytes),
75 => ModelConvert.Decode<UploadModuleStatus>(bytes),
81 => ModelConvert.Decode<RemoteSignaling>(bytes),
82 => ModelConvert.Decode<BatteryPackData>(bytes),
83 => ModelConvert.Decode<BatteryPackDataVoltage>(bytes),
84 => ModelConvert.Decode<BatteryPackTotalElectricity>(bytes),
85 => ModelConvert.Decode<BatteryPackPortTemperature>(bytes),
86 => ModelConvert.Decode<BatteryPackStateAndFault>(bytes),
87 => ModelConvert.Decode<AcMeter>(bytes),
_ => throw new InvalidOperationException("This should never be reached"),
},
#endregion
#region 46
46 => recordType switch
{
2 => ModelConvert.Decode<Status>(bytes),
3 => ModelConvert.Decode<Alarm1>(bytes),
4 => ModelConvert.Decode<Alarm2>(bytes),
5 => ModelConvert.Decode<PackInfo>(bytes),
6 => ModelConvert.Decode<BranChcurr>(bytes),
7 => ModelConvert.Decode<RelayStatus>(bytes),
8 => ModelConvert.Decode<PackCurrlmt>(bytes),
9 => ModelConvert.Decode<RunStatusInfo>(bytes),
10 => ModelConvert.Decode<SumVolt>(bytes),
11 => ModelConvert.Decode<SumTemp>(bytes),
12 => ModelConvert.Decode<ChrgaccuInfo>(bytes),
13 => ModelConvert.Decode<DisChrgaccuInfo>(bytes),
14 => ModelConvert.Decode<REChrgaccuInfo>(bytes),
15 => ModelConvert.Decode<IsoInfo>(bytes),
16 => ModelConvert.Decode<BrachSumVolt1>(bytes),
17 => ModelConvert.Decode<BrachSumVolt2>(bytes),
18 => ModelConvert.Decode<BrachSumVolt3>(bytes),
19 => ModelConvert.Decode<BrachSumTemp1>(bytes),
20 => ModelConvert.Decode<BrachSumTemp2>(bytes),
21 => ModelConvert.Decode<Volt01>(bytes),
22 => ModelConvert.Decode<Volt02>(bytes),
23 => ModelConvert.Decode<Volt03>(bytes),
24 => ModelConvert.Decode<Volt04>(bytes),
25 => ModelConvert.Decode<Volt05>(bytes),
26 => ModelConvert.Decode<Volt06>(bytes),
27 => ModelConvert.Decode<Volt07>(bytes),
28 => ModelConvert.Decode<Volt08>(bytes),
29 => ModelConvert.Decode<Volt09>(bytes),
30 => ModelConvert.Decode<Volt10>(bytes),
31 => ModelConvert.Decode<Volt11>(bytes),
32 => ModelConvert.Decode<Volt12>(bytes),
33 => ModelConvert.Decode<Volt13>(bytes),
34 => ModelConvert.Decode<Volt14>(bytes),
35 => ModelConvert.Decode<Volt15>(bytes),
36 => ModelConvert.Decode<Volt16>(bytes),
37 => ModelConvert.Decode<Volt17>(bytes),
38 => ModelConvert.Decode<Volt18>(bytes),
39 => ModelConvert.Decode<Volt19>(bytes),
40 => ModelConvert.Decode<Volt20>(bytes),
41 => ModelConvert.Decode<Volt21>(bytes),
42 => ModelConvert.Decode<Volt22>(bytes),
43 => ModelConvert.Decode<Volt23>(bytes),
44 => ModelConvert.Decode<Volt24>(bytes),
45 => ModelConvert.Decode<Volt25>(bytes),
46 => ModelConvert.Decode<Volt26>(bytes),
47 => ModelConvert.Decode<Volt27>(bytes),
48 => ModelConvert.Decode<Volt28>(bytes),
49 => ModelConvert.Decode<Volt29>(bytes),
50 => ModelConvert.Decode<Volt30>(bytes),
51 => ModelConvert.Decode<Temp1>(bytes),
52 => ModelConvert.Decode<Temp2>(bytes),
53 => ModelConvert.Decode<Temp3>(bytes),
54 => ModelConvert.Decode<Temp4>(bytes),
55 => ModelConvert.Decode<Temp5>(bytes),
56 => ModelConvert.Decode<Temp6>(bytes),
57 => ModelConvert.Decode<CscSumVolt>(bytes),
58 => ModelConvert.Decode<CscSumTemp>(bytes),
59 => ModelConvert.Decode<TimingInfo>(bytes),
81 => ModelConvert.Decode<QueryBatterySnRes>(bytes),
142 => ModelConvert.Decode<BattenergyInfo1>(bytes),
143 => ModelConvert.Decode<BattenergyInfo2>(bytes),
144 => ModelConvert.Decode<BattenergyInfo3>(bytes),
145 => ModelConvert.Decode<BattenergyInfo4>(bytes),
146 => ModelConvert.Decode<BattenergyInfo5>(bytes),
147 => ModelConvert.Decode<BattenergyInfo6>(bytes),
148 => ModelConvert.Decode<SysCode>(bytes),
_ => throw new InvalidOperationException("This should never be reached"),
},
#endregion
42 => ModelConvert.Decode<RecordCharge>(bytes),
11 => ModelConvert.Decode<UploadTelemetryData>(bytes),
49 => ModelConvert.Decode<RemoteStartChargingRes>(bytes),
50 => ModelConvert.Decode<RemoteStopChargingRes>(bytes),
_ => new ASDU()
};
ASDU.ParseHeader(byteBuffer, asdu);
return asdu;
}
}