123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664 |
- using System;
- using System.Collections.Generic;
- using System.Linq;
- namespace Edge.Core.Parser.BinaryParser.Util
- {
- public static class ExtentionMethod
- {
-
-
-
-
-
- public static byte[] ToBCD(this string value)
- {
- if (value.Length % 2 != 0)
- {
- value = "0" + value;
- }
- List<byte> result = new List<byte>();
- for (int i = 0; i < value.Length; i += 2)
- {
- int parsed = -1;
- try
- {
- parsed = int.Parse(value[i].ToString());
- }
- catch
- {
- throw new ArgumentException(value[i].ToString() + " in string: " + value + ", can't convert to int.");
- }
- byte b = (byte)(parsed << 4);
- if (i + 1 <= value.Length - 1)
- {
- try
- {
- parsed = int.Parse(value[i + 1].ToString());
- }
- catch
- {
- throw new ArgumentException(value[i + 1].ToString() + " in string: " + value + ", can't convert to int.");
- }
- b += (byte)parsed;
- }
- result.Add(b);
- }
- return result.ToArray();
- }
-
-
-
-
-
-
- public static string ToHexLogString(this IEnumerable<byte> bytes)
- {
- if (bytes == null)
- throw new ArgumentNullException("'bytes' argument for ToHexLogString must not be null");
- if (bytes.Any())
- return bytes.Select(s => s.ToString("X").PadLeft(2, '0')).Aggregate((acc, n) => acc + " " + n);
- else return "";
- }
- public static string ToHexLogString(this byte target)
- {
- return target.ToString("X").PadLeft(2, '0');
- }
- public static string ToHexLogString(this int value)
- {
- return BitConverter.GetBytes(value).Reverse().ToHexLogString();
- }
-
-
-
-
-
- public static int GetBCD(this IEnumerable<byte> bytes)
- {
- if (bytes == null || !bytes.Any()) throw new ArgumentException("invalid bytes for BCD convert, it's null or empty");
- string final = bytes.Aggregate(string.Empty, (current, b) => current + b.GetBCDString());
- return int.Parse(final);
- }
-
-
-
-
-
- public static long GetBcdLong(this IEnumerable<byte> bytes)
- {
- if (bytes == null || !bytes.Any()) throw new ArgumentException("invalid bytes for BCD convert, it's null or empty");
- string final = bytes.Aggregate(string.Empty, (current, b) => current + b.GetBCDString());
- return long.Parse(final);
- }
-
-
-
-
-
- public static int GetBCD(this byte oneByte)
- {
- int low = oneByte - (oneByte >> 4) * 16;
- int high = oneByte >> 4;
- if (high > 9 || low > 9) throw new ArgumentException("invalid BCD number conversion for raw byte: 0x" + oneByte.ToString("X").PadLeft(2, '0'));
- return low + high * 10;
- }
-
-
-
-
-
- public static string GetBCDString(this byte oneByte)
- {
- return oneByte.GetBCD() < 10 ? oneByte.GetBCD().ToString().PadLeft(2, '0') : oneByte.GetBCD().ToString();
- }
-
-
-
-
-
- public static string GetBCDString(this byte[] targetBytes)
- {
- string result = "";
- for (int i = 0; i < targetBytes.Length; i++)
- {
- result += targetBytes[i].GetBCD() < 10 ? targetBytes[i].GetBCD().ToString().PadLeft(2, '0') : targetBytes[i].GetBCD().ToString();
- }
- return result;
- }
-
-
-
-
-
-
- public static int ToInt32(this IEnumerable<byte> targetBytes)
- {
- int accu = 0;
- for (int i = 0; i < targetBytes.Count(); i++)
- {
- accu += targetBytes.ElementAt(i) << ((targetBytes.Count() - i - 1) * 8);
- }
- return accu;
- }
-
-
-
-
-
-
-
-
-
- public static byte SetBit(this byte target, int bitStartIndex, int bitEndIndex, int replacedValue)
- {
- if (bitStartIndex < 0 || bitEndIndex > 7 || bitEndIndex < bitStartIndex)
- {
- throw new ArgumentException("bitStartIndex or bitEndIndex value is not valid");
- }
- byte mask = 0;
- for (int i = 0; i < bitEndIndex - bitStartIndex + 1; i++)
- {
- mask += (byte)Math.Pow(2, i);
- }
- if (replacedValue > mask)
- {
- throw new ArgumentOutOfRangeException("Replaced value: " + replacedValue + " cannot fit the bits range");
- }
- byte maskedValue = (byte)(target & (255 - (mask << bitStartIndex)));
- return (byte)(maskedValue + (replacedValue << bitStartIndex));
- }
-
-
-
-
-
-
-
- public static byte GetBit(this byte target, int index)
- {
- if (index < 0 || index > 7)
- {
- throw new ArgumentException("index value is not valid");
- }
- var turn = (target >> (index));
- var t = (turn << 7).GetBinBytes(4).Last() >> 7;
- return (byte)t;
- }
-
-
-
-
-
-
- public static byte[] ToBytes(this string targetHexString)
- {
- targetHexString = targetHexString.Trim().Replace(" ", "");
- if (targetHexString.Length % 2 != 0)
- {
- throw new ArgumentException("The targetHexString length is not even.");
- }
- List<byte> result = new List<byte>();
- for (int i = 0; i < targetHexString.Length; i += 2)
- {
- var middle = targetHexString.Substring(i, 2);
- result.Add(Convert.ToByte(middle, 16));
- }
- return result.ToArray();
- }
-
-
-
-
-
-
-
- public static byte[] AppendToHeader(this byte[] baseBytes, byte[] bytesToAppending)
- {
- return bytesToAppending.Concat(baseBytes).ToArray();
- }
-
-
-
-
-
-
-
- public static byte[] GetBCDBytes(this long targetInt, int outputTotalBytes)
- {
-
- var process = targetInt.ToString().Select(b => (byte)int.Parse(b.ToString())).ToList();
-
- if (process.Count() % 2 != 0)
- {
- process = process.ToArray().AppendToHeader(new byte[] { 0 }).ToList();
- }
-
-
- for (int i = process.Count() - 1; i >= 0; i--)
- {
- process[i] += (byte)(process.ToArray()[i - 1] << 4);
- process.RemoveAt(i - 1);
- i = i - 1;
- }
- var diff = outputTotalBytes - process.Count;
- if (diff > 0)
- {
- var v = Enumerable.Repeat(0, diff).Select(p => (byte)p).Concat(process).ToArray();
- return v;
- }
- return process.ToArray();
- }
- public static byte[] GetBCDBytes(this System.Numerics.BigInteger targetInt, int outputTotalBytes)
- {
-
- var process = targetInt.ToString().Select(b => (byte)int.Parse(b.ToString())).ToList();
-
- if (process.Count() % 2 != 0)
- {
- process = process.ToArray().AppendToHeader(new byte[] { 0 }).ToList();
- }
-
-
- for (int i = process.Count() - 1; i >= 0; i--)
- {
- process[i] += (byte)(process.ToArray()[i - 1] << 4);
- process.RemoveAt(i - 1);
- i = i - 1;
- }
- var diff = outputTotalBytes - process.Count;
- if (diff > 0)
- {
- var v = Enumerable.Repeat(0, diff).Select(p => (byte)p).Concat(process).ToArray();
- return v;
- }
- return process.ToArray();
- }
- public static byte[] GetBCDBytes(this int targetInt, int outputTotalBytes)
- {
-
- var process = targetInt.ToString().Select(b => (byte)int.Parse(b.ToString())).ToList();
-
- if (process.Count() % 2 != 0)
- {
- process = process.ToArray().AppendToHeader(new byte[] { 0 }).ToList();
- }
-
-
- for (int i = process.Count() - 1; i >= 0; i--)
- {
- process[i] += (byte)(process.ToArray()[i - 1] << 4);
- process.RemoveAt(i - 1);
- i = i - 1;
- }
- var diff = outputTotalBytes - process.Count;
- if (diff > 0)
- {
- var v = Enumerable.Repeat(0, diff).Select(p => (byte)p).Concat(process).ToArray();
- return v;
- }
- return process.ToArray();
- }
-
-
-
-
-
-
-
-
-
-
-
- public static byte[] GetBinBytes(this int targetInt, int outputTotalBytes)
- {
- if (outputTotalBytes > 4) throw new ArgumentOutOfRangeException("GetBinBytes support max 4 bytes output");
- var r = BitConverter.GetBytes(targetInt);
- if (outputTotalBytes == 0) return r;
- if (outputTotalBytes < r.Length)
- {
- for (int index = r.Length - 1; index > outputTotalBytes - 1; index--)
- {
- if (r[index] > 0)
- {
- throw new ArgumentException(string.Format("Target integer value {0} is too large to be converted into {1} bytes", targetInt, outputTotalBytes));
- }
- }
- }
- if (outputTotalBytes > 0)
- {
- return r.Take(outputTotalBytes).Reverse().ToArray();
- }
- return r.Reverse().ToArray();
- }
- public static byte[] GetBinBytes(this long targetInt, int outputTotalBytes)
- {
- if (outputTotalBytes > 4) throw new ArgumentOutOfRangeException("GetBinBytes support max 4 bytes output");
- var r = BitConverter.GetBytes(targetInt);
- if (outputTotalBytes == 0) return r;
- if (outputTotalBytes < r.Length)
- {
- for (int index = r.Length - 1; index > outputTotalBytes - 1; index--)
- {
- if (r[index] > 0)
- {
- throw new ArgumentException(string.Format("Target integer value {0} is too large to be converted into {1} bytes", targetInt, outputTotalBytes));
- }
- }
- }
- if (outputTotalBytes > 0)
- {
- return r.Take(outputTotalBytes).Reverse().ToArray();
- }
- return r.Reverse().ToArray();
- }
-
-
-
-
-
- public static string GetHexString(this IEnumerable<byte> target)
- {
- return target.Select(b => b.ToString("X").Length == 1 ? b.ToString("X").PadLeft(2, '0') : b.ToString("X")).Aggregate((p, n) => { return p + n; });
- }
- public static bool ValueEquals(this IEnumerable<byte> array1, IEnumerable<byte> array2)
- {
- if (array1 == null && array2 == null)
- {
- return true;
- }
- if ((array1 == null) || (array2 == null))
- {
- return false;
- }
- if (array1.Count() != array2.Count())
- {
- return false;
- }
- if (array1.Equals(array2))
- {
- return true;
- }
- else
- {
- for (int Index = 0; Index < array1.Count(); Index++)
- {
- if (!Equals(array1.ElementAt(Index), array2.ElementAt(Index)))
- {
- return false;
- }
- }
- }
- return true;
- }
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
- static ushort[] table = new ushort[256];
- const ushort polynomial = 0xA001;
- private static ushort ComputeChecksum(byte[] bytes)
- {
- ushort crc = 0;
- for (int i = 0; i < bytes.Length; ++i)
- {
- byte index = (byte)(crc ^ bytes[i]);
- crc = (ushort)((crc >> 8) ^ table[index]);
- }
- return crc;
- }
- public static byte[] ComputeChecksumBytesCrc16(this byte[] bytes)
- {
- ushort crc = ComputeChecksum(bytes);
- var result = BitConverter.GetBytes(crc);
- return result.Reverse().ToArray();
- }
- private static ushort ComputeChecksumModBus(byte[] bytes)
- {
- ushort crc = 0xFFFF;
- for (int i = 0; i < bytes.Length; ++i)
- {
- byte index = (byte)(crc ^ bytes[i]);
- crc = (ushort)((crc >> 8) ^ table[index]);
- }
- return crc;
- }
- public static byte[] ComputeChecksumBytesCrc16ModBus(this byte[] bytes)
- {
- ushort crc = ComputeChecksumModBus(bytes);
- var result = BitConverter.GetBytes(crc);
- return result.Reverse().ToArray();
- }
- private static readonly ushort[] CrcTable =
- {
- 0X0000, 0XC0C1, 0XC181, 0X0140, 0XC301, 0X03C0, 0X0280, 0XC241,
- 0XC601, 0X06C0, 0X0780, 0XC741, 0X0500, 0XC5C1, 0XC481, 0X0440,
- 0XCC01, 0X0CC0, 0X0D80, 0XCD41, 0X0F00, 0XCFC1, 0XCE81, 0X0E40,
- 0X0A00, 0XCAC1, 0XCB81, 0X0B40, 0XC901, 0X09C0, 0X0880, 0XC841,
- 0XD801, 0X18C0, 0X1980, 0XD941, 0X1B00, 0XDBC1, 0XDA81, 0X1A40,
- 0X1E00, 0XDEC1, 0XDF81, 0X1F40, 0XDD01, 0X1DC0, 0X1C80, 0XDC41,
- 0X1400, 0XD4C1, 0XD581, 0X1540, 0XD701, 0X17C0, 0X1680, 0XD641,
- 0XD201, 0X12C0, 0X1380, 0XD341, 0X1100, 0XD1C1, 0XD081, 0X1040,
- 0XF001, 0X30C0, 0X3180, 0XF141, 0X3300, 0XF3C1, 0XF281, 0X3240,
- 0X3600, 0XF6C1, 0XF781, 0X3740, 0XF501, 0X35C0, 0X3480, 0XF441,
- 0X3C00, 0XFCC1, 0XFD81, 0X3D40, 0XFF01, 0X3FC0, 0X3E80, 0XFE41,
- 0XFA01, 0X3AC0, 0X3B80, 0XFB41, 0X3900, 0XF9C1, 0XF881, 0X3840,
- 0X2800, 0XE8C1, 0XE981, 0X2940, 0XEB01, 0X2BC0, 0X2A80, 0XEA41,
- 0XEE01, 0X2EC0, 0X2F80, 0XEF41, 0X2D00, 0XEDC1, 0XEC81, 0X2C40,
- 0XE401, 0X24C0, 0X2580, 0XE541, 0X2700, 0XE7C1, 0XE681, 0X2640,
- 0X2200, 0XE2C1, 0XE381, 0X2340, 0XE101, 0X21C0, 0X2080, 0XE041,
- 0XA001, 0X60C0, 0X6180, 0XA141, 0X6300, 0XA3C1, 0XA281, 0X6240,
- 0X6600, 0XA6C1, 0XA781, 0X6740, 0XA501, 0X65C0, 0X6480, 0XA441,
- 0X6C00, 0XACC1, 0XAD81, 0X6D40, 0XAF01, 0X6FC0, 0X6E80, 0XAE41,
- 0XAA01, 0X6AC0, 0X6B80, 0XAB41, 0X6900, 0XA9C1, 0XA881, 0X6840,
- 0X7800, 0XB8C1, 0XB981, 0X7940, 0XBB01, 0X7BC0, 0X7A80, 0XBA41,
- 0XBE01, 0X7EC0, 0X7F80, 0XBF41, 0X7D00, 0XBDC1, 0XBC81, 0X7C40,
- 0XB401, 0X74C0, 0X7580, 0XB541, 0X7700, 0XB7C1, 0XB681, 0X7640,
- 0X7200, 0XB2C1, 0XB381, 0X7340, 0XB101, 0X71C0, 0X7080, 0XB041,
- 0X5000, 0X90C1, 0X9181, 0X5140, 0X9301, 0X53C0, 0X5280, 0X9241,
- 0X9601, 0X56C0, 0X5780, 0X9741, 0X5500, 0X95C1, 0X9481, 0X5440,
- 0X9C01, 0X5CC0, 0X5D80, 0X9D41, 0X5F00, 0X9FC1, 0X9E81, 0X5E40,
- 0X5A00, 0X9AC1, 0X9B81, 0X5B40, 0X9901, 0X59C0, 0X5880, 0X9841,
- 0X8801, 0X48C0, 0X4980, 0X8941, 0X4B00, 0X8BC1, 0X8A81, 0X4A40,
- 0X4E00, 0X8EC1, 0X8F81, 0X4F40, 0X8D01, 0X4DC0, 0X4C80, 0X8C41,
- 0X4400, 0X84C1, 0X8581, 0X4540, 0X8701, 0X47C0, 0X4680, 0X8641,
- 0X8201, 0X42C0, 0X4380, 0X8341, 0X4100, 0X81C1, 0X8081, 0X4040
- };
- public static byte[] CalculateModBusCrc(this byte[] data)
- {
- if (data == null)
- {
- throw new ArgumentNullException(nameof(data));
- }
- ushort crc = ushort.MaxValue;
- foreach (byte b in data)
- {
- byte tableIndex = (byte)(crc ^ b);
- crc >>= 8;
- crc ^= CrcTable[tableIndex];
- }
- return BitConverter.GetBytes(crc);
- }
- public static byte CalculateLRC(this IEnumerable<byte> bytes)
- {
- int LRC = 0;
- for (int i = 0; i < bytes.Count(); i++)
- {
- LRC ^= bytes.ElementAt(i);
- }
- return (byte)LRC;
- }
- static ExtentionMethod()
- {
- ushort value;
- ushort temp;
- for (ushort i = 0; i < table.Length; ++i)
- {
- value = 0;
- temp = i;
- for (byte j = 0; j < 8; ++j)
- {
- if (((value ^ temp) & 0x0001) != 0)
- {
- value = (ushort)((value >> 1) ^ polynomial);
- }
- else
- {
- value >>= 1;
- }
- temp >>= 1;
- }
- table[i] = value;
- }
- }
- }
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
- }
|