maier_st/Sharp7
1
0
Fork 0
mirror of https://github.com/fbarresi/Sharp7.git synced 2026-02-04 08:42:51 +00:00
Code Issues Actions Packages Projects Releases Wiki Activity

Added S7 to extension methods and fixed parameter names

Browse Source
This commit is contained in:
Federico Barresi
2019-11-28 10:01:58 +01:00
parent 5b8baf3c78
commit 590af4b245
1 changed files with 505 additions and 505 deletions
Download Patch File Download Diff File Expand all files Collapse all files

490
Sharp7/S7.cs
View File

@@ -15,21 +15,21 @@ namespace Sharp7
return ((B >> 4) * 10) + (B & 0x0F);
}
private static byte ByteToBCD(int Value)
private static byte ByteToBCD(int value)
{
return (byte)(((Value / 10) << 4) | (Value % 10));
return (byte)(((value / 10) << 4) | (value % 10));
}
private static byte[] CopyFrom(byte[] Buffer, int Pos, int Size)
private static byte[] CopyFrom(byte[] buffer, int pos, int size)
{
byte[] Result=new byte[Size];
Array.Copy(Buffer, Pos, Result, 0, Size);
return Result;
byte[] result = new byte[size];
Array.Copy(buffer, pos, result, 0, size);
return result;
}
public static int DataSizeByte(int WordLength)
public static int DataSizeByte(this int wordLength)
{
switch (WordLength)
switch (wordLength)
{
case S7Consts.S7WLBit: return 1; // S7 sends 1 byte per bit
case S7Consts.S7WLByte: return 1;
@@ -46,269 +46,269 @@ namespace Sharp7
}
#region Get/Set the bit at Pos.Bit
public static bool GetBitAt(byte[] Buffer, int Pos, int Bit)
public static bool GetBitAt(this byte[] buffer, int pos, int bit)
{
byte[] Mask = { 0x01, 0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80 };
if (Bit < 0) Bit = 0;
if (Bit > 7) Bit = 7;
return (Buffer[Pos] & Mask[Bit]) != 0;
if (bit < 0) bit = 0;
if (bit > 7) bit = 7;
return (buffer[pos] & Mask[bit]) != 0;
}
public static void SetBitAt(ref byte[] Buffer, int Pos, int Bit, bool Value)
public static void SetBitAt(ref byte[] buffer, int pos, int bit, bool value)
{
byte[] Mask = { 0x01, 0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80 };
if (Bit < 0) Bit = 0;
if (Bit > 7) Bit = 7;
if (bit < 0) bit = 0;
if (bit > 7) bit = 7;
if (Value)
Buffer[Pos] = (byte)(Buffer[Pos] | Mask[Bit]);
if (value)
buffer[pos] = (byte)(buffer[pos] | Mask[bit]);
else
Buffer[Pos] = (byte)(Buffer[Pos] & ~Mask[Bit]);
buffer[pos] = (byte)(buffer[pos] & ~Mask[bit]);
}
#endregion
#region Get/Set 8 bit signed value (S7 SInt) -128..127
public static int GetSIntAt(byte[] Buffer, int Pos)
public static int GetSIntAt(this byte[] buffer, int pos)
{
int Value = Buffer[Pos];
if (Value < 128)
return Value;
int value = buffer[pos];
if (value < 128)
return value;
else
return (int) (Value - 256);
return (int)(value - 256);
}
public static void SetSIntAt(byte[] Buffer, int Pos, int Value)
public static void SetSIntAt(this byte[] buffer, int pos, int value)
{
if (Value < -128) Value = -128;
if (Value > 127) Value = 127;
Buffer[Pos] = (byte)Value;
if (value < -128) value = -128;
if (value > 127) value = 127;
buffer[pos] = (byte)value;
}
#endregion
#region Get/Set 16 bit signed value (S7 int) -32768..32767
public static int GetIntAt(byte[] Buffer, int Pos)
public static int GetIntAt(this byte[] buffer, int pos)
{
return (short)((Buffer[Pos] << 8) | Buffer[Pos + 1]);
return (short)((buffer[pos] << 8) | buffer[pos + 1]);
}
public static void SetIntAt(byte[] Buffer, int Pos, Int16 Value)
public static void SetIntAt(this byte[] buffer, int pos, Int16 value)
{
Buffer[Pos] = (byte)(Value >> 8);
Buffer[Pos + 1] = (byte)(Value & 0x00FF);
buffer[pos] = (byte)(value >> 8);
buffer[pos + 1] = (byte)(value & 0x00FF);
}
#endregion
#region Get/Set 32 bit signed value (S7 DInt) -2147483648..2147483647
public static int GetDIntAt(byte[] Buffer, int Pos)
public static int GetDIntAt(this byte[] buffer, int pos)
{
int Result;
Result = Buffer[Pos]; Result <<= 8;
Result += Buffer[Pos + 1]; Result <<= 8;
Result += Buffer[Pos + 2]; Result <<= 8;
Result += Buffer[Pos + 3];
return Result;
int result;
result = buffer[pos]; result <<= 8;
result += buffer[pos + 1]; result <<= 8;
result += buffer[pos + 2]; result <<= 8;
result += buffer[pos + 3];
return result;
}
public static void SetDIntAt(byte[] Buffer, int Pos, int Value)
public static void SetDIntAt(this byte[] buffer, int pos, int value)
{
Buffer[Pos + 3] = (byte)(Value & 0xFF);
Buffer[Pos + 2] = (byte)((Value >> 8) & 0xFF);
Buffer[Pos + 1] = (byte)((Value >> 16) & 0xFF);
Buffer[Pos] = (byte)((Value >> 24) & 0xFF);
buffer[pos + 3] = (byte)(value & 0xFF);
buffer[pos + 2] = (byte)((value >> 8) & 0xFF);
buffer[pos + 1] = (byte)((value >> 16) & 0xFF);
buffer[pos] = (byte)((value >> 24) & 0xFF);
}
#endregion
#region Get/Set 64 bit signed value (S7 LInt) -9223372036854775808..9223372036854775807
public static Int64 GetLIntAt(byte[] Buffer, int Pos)
public static Int64 GetLIntAt(this byte[] buffer, int pos)
{
Int64 Result;
Result = Buffer[Pos]; Result <<= 8;
Result += Buffer[Pos + 1]; Result <<= 8;
Result += Buffer[Pos + 2]; Result <<= 8;
Result += Buffer[Pos + 3]; Result <<= 8;
Result += Buffer[Pos + 4]; Result <<= 8;
Result += Buffer[Pos + 5]; Result <<= 8;
Result += Buffer[Pos + 6]; Result <<= 8;
Result += Buffer[Pos + 7];
return Result;
Int64 result;
result = buffer[pos]; result <<= 8;
result += buffer[pos + 1]; result <<= 8;
result += buffer[pos + 2]; result <<= 8;
result += buffer[pos + 3]; result <<= 8;
result += buffer[pos + 4]; result <<= 8;
result += buffer[pos + 5]; result <<= 8;
result += buffer[pos + 6]; result <<= 8;
result += buffer[pos + 7];
return result;
}
public static void SetLIntAt(byte[] Buffer, int Pos, Int64 Value)
public static void SetLIntAt(this byte[] buffer, int pos, Int64 value)
{
Buffer[Pos + 7] = (byte)(Value & 0xFF);
Buffer[Pos + 6] = (byte)((Value >> 8) & 0xFF);
Buffer[Pos + 5] = (byte)((Value >> 16) & 0xFF);
Buffer[Pos + 4] = (byte)((Value >> 24) & 0xFF);
Buffer[Pos + 3] = (byte)((Value >> 32) & 0xFF);
Buffer[Pos + 2] = (byte)((Value >> 40) & 0xFF);
Buffer[Pos + 1] = (byte)((Value >> 48) & 0xFF);
Buffer[Pos] = (byte)((Value >> 56) & 0xFF);
buffer[pos + 7] = (byte)(value & 0xFF);
buffer[pos + 6] = (byte)((value >> 8) & 0xFF);
buffer[pos + 5] = (byte)((value >> 16) & 0xFF);
buffer[pos + 4] = (byte)((value >> 24) & 0xFF);
buffer[pos + 3] = (byte)((value >> 32) & 0xFF);
buffer[pos + 2] = (byte)((value >> 40) & 0xFF);
buffer[pos + 1] = (byte)((value >> 48) & 0xFF);
buffer[pos] = (byte)((value >> 56) & 0xFF);
}
#endregion
#region Get/Set 8 bit unsigned value (S7 USInt) 0..255
public static byte GetUSIntAt(byte[] Buffer, int Pos)
public static byte GetUSIntAt(this byte[] buffer, int pos)
{
return Buffer[Pos];
return buffer[pos];
}
public static void SetUSIntAt(byte[] Buffer, int Pos, byte Value)
public static void SetUSIntAt(this byte[] buffer, int pos, byte value)
{
Buffer[Pos] = Value;
buffer[pos] = value;
}
#endregion
#region Get/Set 16 bit unsigned value (S7 UInt) 0..65535
public static UInt16 GetUIntAt(byte[] Buffer, int Pos)
public static UInt16 GetUIntAt(this byte[] buffer, int pos)
{
return (UInt16)((Buffer[Pos] << 8) | Buffer[Pos + 1]);
return (UInt16)((buffer[pos] << 8) | buffer[pos + 1]);
}
public static void SetUIntAt(byte[] Buffer, int Pos, UInt16 Value)
public static void SetUIntAt(this byte[] buffer, int pos, UInt16 value)
{
Buffer[Pos] = (byte)(Value >> 8);
Buffer[Pos + 1] = (byte)(Value & 0x00FF);
buffer[pos] = (byte)(value >> 8);
buffer[pos + 1] = (byte)(value & 0x00FF);
}
#endregion
#region Get/Set 32 bit unsigned value (S7 UDInt) 0..4294967296
public static UInt32 GetUDIntAt(byte[] Buffer, int Pos)
public static UInt32 GetUDIntAt(this byte[] buffer, int pos)
{
UInt32 Result;
Result = Buffer[Pos]; Result <<= 8;
Result |= Buffer[Pos + 1]; Result <<= 8;
Result |= Buffer[Pos + 2]; Result <<= 8;
Result |= Buffer[Pos + 3];
return Result;
UInt32 result;
result = buffer[pos]; result <<= 8;
result |= buffer[pos + 1]; result <<= 8;
result |= buffer[pos + 2]; result <<= 8;
result |= buffer[pos + 3];
return result;
}
public static void SetUDIntAt(byte[] Buffer, int Pos, UInt32 Value)
public static void SetUDIntAt(this byte[] buffer, int pos, UInt32 value)
{
Buffer[Pos + 3] = (byte)(Value & 0xFF);
Buffer[Pos + 2] = (byte)((Value >> 8) & 0xFF);
Buffer[Pos + 1] = (byte)((Value >> 16) & 0xFF);
Buffer[Pos] = (byte)((Value >> 24) & 0xFF);
buffer[pos + 3] = (byte)(value & 0xFF);
buffer[pos + 2] = (byte)((value >> 8) & 0xFF);
buffer[pos + 1] = (byte)((value >> 16) & 0xFF);
buffer[pos] = (byte)((value >> 24) & 0xFF);
}
#endregion
#region Get/Set 64 bit unsigned value (S7 ULint) 0..18446744073709551616
public static UInt64 GetULIntAt(byte[] Buffer, int Pos)
public static UInt64 GetULIntAt(this byte[] buffer, int pos)
{
UInt64 Result;
Result = Buffer[Pos]; Result <<= 8;
Result |= Buffer[Pos + 1]; Result <<= 8;
Result |= Buffer[Pos + 2]; Result <<= 8;
Result |= Buffer[Pos + 3]; Result <<= 8;
Result |= Buffer[Pos + 4]; Result <<= 8;
Result |= Buffer[Pos + 5]; Result <<= 8;
Result |= Buffer[Pos + 6]; Result <<= 8;
Result |= Buffer[Pos + 7];
return Result;
UInt64 result;
result = buffer[pos]; result <<= 8;
result |= buffer[pos + 1]; result <<= 8;
result |= buffer[pos + 2]; result <<= 8;
result |= buffer[pos + 3]; result <<= 8;
result |= buffer[pos + 4]; result <<= 8;
result |= buffer[pos + 5]; result <<= 8;
result |= buffer[pos + 6]; result <<= 8;
result |= buffer[pos + 7];
return result;
}
public static void SetULintAt(byte[] Buffer, int Pos, UInt64 Value)
public static void SetULintAt(this byte[] buffer, int pos, UInt64 value)
{
Buffer[Pos + 7] = (byte)(Value & 0xFF);
Buffer[Pos + 6] = (byte)((Value >> 8) & 0xFF);
Buffer[Pos + 5] = (byte)((Value >> 16) & 0xFF);
Buffer[Pos + 4] = (byte)((Value >> 24) & 0xFF);
Buffer[Pos + 3] = (byte)((Value >> 32) & 0xFF);
Buffer[Pos + 2] = (byte)((Value >> 40) & 0xFF);
Buffer[Pos + 1] = (byte)((Value >> 48) & 0xFF);
Buffer[Pos] = (byte)((Value >> 56) & 0xFF);
buffer[pos + 7] = (byte)(value & 0xFF);
buffer[pos + 6] = (byte)((value >> 8) & 0xFF);
buffer[pos + 5] = (byte)((value >> 16) & 0xFF);
buffer[pos + 4] = (byte)((value >> 24) & 0xFF);
buffer[pos + 3] = (byte)((value >> 32) & 0xFF);
buffer[pos + 2] = (byte)((value >> 40) & 0xFF);
buffer[pos + 1] = (byte)((value >> 48) & 0xFF);
buffer[pos] = (byte)((value >> 56) & 0xFF);
}
#endregion
#region Get/Set 8 bit word (S7 Byte) 16#00..16#FF
public static byte GetByteAt(byte[] Buffer, int Pos)
public static byte GetByteAt(this byte[] buffer, int pos)
{
return Buffer[Pos];
return buffer[pos];
}
public static void SetByteAt(byte[] Buffer, int Pos, byte Value)
public static void SetByteAt(this byte[] buffer, int pos, byte value)
{
Buffer[Pos] = Value;
buffer[pos] = value;
}
#endregion
#region Get/Set 16 bit word (S7 Word) 16#0000..16#FFFF
public static UInt16 GetWordAt(byte[] Buffer, int Pos)
public static UInt16 GetWordAt(this byte[] buffer, int pos)
{
return GetUIntAt(Buffer,Pos);
return GetUIntAt(buffer, pos);
}
public static void SetWordAt(byte[] Buffer, int Pos, UInt16 Value)
public static void SetWordAt(this byte[] buffer, int pos, UInt16 value)
{
SetUIntAt(Buffer, Pos, Value);
SetUIntAt(buffer, pos, value);
}
#endregion
#region Get/Set 32 bit word (S7 DWord) 16#00000000..16#FFFFFFFF
public static UInt32 GetDWordAt(byte[] Buffer, int Pos)
public static UInt32 GetDWordAt(this byte[] buffer, int pos)
{
return GetUDIntAt(Buffer, Pos);
return GetUDIntAt(buffer, pos);
}
public static void SetDWordAt(byte[] Buffer, int Pos, UInt32 Value)
public static void SetDWordAt(this byte[] buffer, int pos, UInt32 value)
{
SetUDIntAt(Buffer, Pos, Value);
SetUDIntAt(buffer, pos, value);
}
#endregion
#region Get/Set 64 bit word (S7 LWord) 16#0000000000000000..16#FFFFFFFFFFFFFFFF
public static UInt64 GetLWordAt(byte[] Buffer, int Pos)
public static UInt64 GetLWordAt(this byte[] buffer, int pos)
{
return GetULIntAt(Buffer, Pos);
return GetULIntAt(buffer, pos);
}
public static void SetLWordAt(byte[] Buffer, int Pos, UInt64 Value)
public static void SetLWordAt(this byte[] buffer, int pos, UInt64 value)
{
SetULintAt(Buffer, Pos, Value);
SetULintAt(buffer, pos, value);
}
#endregion
#region Get/Set 32 bit floating point number (S7 Real) (Range of Single)
public static Single GetRealAt(byte[] Buffer, int Pos)
public static Single GetRealAt(this byte[] buffer, int pos)
{
UInt32 Value = GetUDIntAt(Buffer, Pos);
byte[] bytes = BitConverter.GetBytes(Value);
UInt32 value = GetUDIntAt(buffer, pos);
byte[] bytes = BitConverter.GetBytes(value);
return BitConverter.ToSingle(bytes, 0);
}
public static void SetRealAt(byte[] Buffer, int Pos, Single Value)
public static void SetRealAt(this byte[] buffer, int pos, Single value)
{
byte[] FloatArray = BitConverter.GetBytes(Value);
Buffer[Pos] = FloatArray[3];
Buffer[Pos + 1] = FloatArray[2];
Buffer[Pos + 2] = FloatArray[1];
Buffer[Pos + 3] = FloatArray[0];
byte[] FloatArray = BitConverter.GetBytes(value);
buffer[pos] = FloatArray[3];
buffer[pos + 1] = FloatArray[2];
buffer[pos + 2] = FloatArray[1];
buffer[pos + 3] = FloatArray[0];
}
#endregion
#region Get/Set 64 bit floating point number (S7 LReal) (Range of Double)
public static Double GetLRealAt(byte[] Buffer, int Pos)
public static Double GetLRealAt(this byte[] buffer, int pos)
{
UInt64 Value = GetULIntAt(Buffer, Pos);
byte[] bytes = BitConverter.GetBytes(Value);
UInt64 value = GetULIntAt(buffer, pos);
byte[] bytes = BitConverter.GetBytes(value);
return BitConverter.ToDouble(bytes, 0);
}
public static void SetLRealAt(byte[] Buffer, int Pos, Double Value)
public static void SetLRealAt(this byte[] buffer, int pos, Double value)
{
byte[] FloatArray = BitConverter.GetBytes(Value);
Buffer[Pos] = FloatArray[7];
Buffer[Pos + 1] = FloatArray[6];
Buffer[Pos + 2] = FloatArray[5];
Buffer[Pos + 3] = FloatArray[4];
Buffer[Pos + 4] = FloatArray[3];
Buffer[Pos + 5] = FloatArray[2];
Buffer[Pos + 6] = FloatArray[1];
Buffer[Pos + 7] = FloatArray[0];
byte[] FloatArray = BitConverter.GetBytes(value);
buffer[pos] = FloatArray[7];
buffer[pos + 1] = FloatArray[6];
buffer[pos + 2] = FloatArray[5];
buffer[pos + 3] = FloatArray[4];
buffer[pos + 4] = FloatArray[3];
buffer[pos + 5] = FloatArray[2];
buffer[pos + 6] = FloatArray[1];
buffer[pos + 7] = FloatArray[0];
}
#endregion
#region Get/Set DateTime (S7 DATE_AND_TIME)
public static DateTime GetDateTimeAt(byte[] Buffer, int Pos)
public static DateTime GetDateTimeAt(this byte[] buffer, int pos)
{
int Year, Month, Day, Hour, Min, Sec, MSec;
Year = BCDtoByte(Buffer[Pos]);
Year = BCDtoByte(buffer[pos]);
if (Year < 90)
Year += 2000;
else
Year += 1900;
Month = BCDtoByte(Buffer[Pos + 1]);
Day = BCDtoByte(Buffer[Pos + 2]);
Hour = BCDtoByte(Buffer[Pos + 3]);
Min = BCDtoByte(Buffer[Pos + 4]);
Sec = BCDtoByte(Buffer[Pos + 5]);
MSec = (BCDtoByte(Buffer[Pos + 6]) * 10) + (BCDtoByte(Buffer[Pos + 7]) / 10);
Month = BCDtoByte(buffer[pos + 1]);
Day = BCDtoByte(buffer[pos + 2]);
Hour = BCDtoByte(buffer[pos + 3]);
Min = BCDtoByte(buffer[pos + 4]);
Sec = BCDtoByte(buffer[pos + 5]);
MSec = (BCDtoByte(buffer[pos + 6]) * 10) + (BCDtoByte(buffer[pos + 7]) / 10);
try
{
return new DateTime(Year, Month, Day, Hour, Min, Sec, MSec);
@@ -318,122 +318,122 @@ namespace Sharp7
return new DateTime(0);
}
}
public static void SetDateTimeAt(byte[] Buffer, int Pos, DateTime Value)
public static void SetDateTimeAt(this byte[] buffer, int pos, DateTime value)
{
int Year = Value.Year;
int Month = Value.Month;
int Day = Value.Day;
int Hour = Value.Hour;
int Min = Value.Minute;
int Sec = Value.Second;
int Dow = (int)Value.DayOfWeek + 1;
int Year = value.Year;
int Month = value.Month;
int Day = value.Day;
int Hour = value.Hour;
int Min = value.Minute;
int Sec = value.Second;
int Dow = (int)value.DayOfWeek + 1;
// MSecH = First two digits of miliseconds
int MsecH = Value.Millisecond / 10;
int MsecH = value.Millisecond / 10;
// MSecL = Last digit of miliseconds
int MsecL = Value.Millisecond % 10;
int MsecL = value.Millisecond % 10;
if (Year > 1999)
Year -= 2000;
Buffer[Pos] = ByteToBCD(Year);
Buffer[Pos + 1] = ByteToBCD(Month);
Buffer[Pos + 2] = ByteToBCD(Day);
Buffer[Pos + 3] = ByteToBCD(Hour);
Buffer[Pos + 4] = ByteToBCD(Min);
Buffer[Pos + 5] = ByteToBCD(Sec);
Buffer[Pos + 6] = ByteToBCD(MsecH);
Buffer[Pos + 7] = ByteToBCD(MsecL * 10 + Dow);
buffer[pos] = ByteToBCD(Year);
buffer[pos + 1] = ByteToBCD(Month);
buffer[pos + 2] = ByteToBCD(Day);
buffer[pos + 3] = ByteToBCD(Hour);
buffer[pos + 4] = ByteToBCD(Min);
buffer[pos + 5] = ByteToBCD(Sec);
buffer[pos + 6] = ByteToBCD(MsecH);
buffer[pos + 7] = ByteToBCD(MsecL * 10 + Dow);
}
#endregion
#region Get/Set DATE (S7 DATE)
public static DateTime GetDateAt(byte[] Buffer, int Pos)
public static DateTime GetDateAt(this byte[] buffer, int pos)
{
try
{
return new DateTime(1990, 1, 1).AddDays(GetIntAt(Buffer, Pos));
return new DateTime(1990, 1, 1).AddDays(GetIntAt(buffer, pos));
}
catch (System.ArgumentOutOfRangeException)
{
return new DateTime(0);
}
}
public static void SetDateAt(byte[] Buffer, int Pos, DateTime Value)
public static void SetDateAt(this byte[] buffer, int pos, DateTime value)
{
SetIntAt(Buffer, Pos, (Int16)(Value - new DateTime(1990, 1, 1)).Days);
SetIntAt(buffer, pos, (Int16)(value - new DateTime(1990, 1, 1)).Days);
}
#endregion
#region Get/Set TOD (S7 TIME_OF_DAY)
public static DateTime GetTODAt(byte[] Buffer, int Pos)
public static DateTime GetTODAt(this byte[] buffer, int pos)
{
try
{
return new DateTime(0).AddMilliseconds(S7.GetDIntAt(Buffer, Pos));
return new DateTime(0).AddMilliseconds(S7.GetDIntAt(buffer, pos));
}
catch (System.ArgumentOutOfRangeException)
{
return new DateTime(0);
}
}
public static void SetTODAt(byte[] Buffer, int Pos, DateTime Value)
public static void SetTODAt(this byte[] buffer, int pos, DateTime value)
{
TimeSpan Time = Value.TimeOfDay;
SetDIntAt(Buffer, Pos, (Int32)Math.Round(Time.TotalMilliseconds));
TimeSpan Time = value.TimeOfDay;
SetDIntAt(buffer, pos, (Int32)Math.Round(Time.TotalMilliseconds));
}
#endregion
#region Get/Set LTOD (S7 1500 LONG TIME_OF_DAY)
public static DateTime GetLTODAt(byte[] Buffer, int Pos)
public static DateTime GetLTODAt(this byte[] buffer, int pos)
{
// .NET Tick = 100 ns, S71500 Tick = 1 ns
try
{
return new DateTime(Math.Abs(GetLIntAt(Buffer,Pos)/100));
return new DateTime(Math.Abs(GetLIntAt(buffer, pos) / 100));
}
catch (System.ArgumentOutOfRangeException)
{
return new DateTime(0);
}
}
public static void SetLTODAt(byte[] Buffer, int Pos, DateTime Value)
public static void SetLTODAt(this byte[] buffer, int pos, DateTime value)
{
TimeSpan Time = Value.TimeOfDay;
SetLIntAt(Buffer, Pos, (Int64)Time.Ticks * 100);
TimeSpan Time = value.TimeOfDay;
SetLIntAt(buffer, pos, (Int64)Time.Ticks * 100);
}
#endregion
#region GET/SET LDT (S7 1500 Long Date and Time)
public static DateTime GetLDTAt(byte[] Buffer, int Pos)
public static DateTime GetLDTAt(this byte[] buffer, int pos)
{
try
{
return new DateTime((GetLIntAt(Buffer, Pos) / 100) + bias);
return new DateTime((GetLIntAt(buffer, pos) / 100) + bias);
}
catch (System.ArgumentOutOfRangeException)
{
return new DateTime(0);
}
}
public static void SetLDTAt(byte[] Buffer, int Pos, DateTime Value)
public static void SetLDTAt(this byte[] buffer, int pos, DateTime value)
{
SetLIntAt(Buffer, Pos, (Value.Ticks-bias) * 100);
SetLIntAt(buffer, pos, (value.Ticks - bias) * 100);
}
#endregion
#region Get/Set DTL (S71200/1500 Date and Time)
// Thanks to Johan Cardoen for GetDTLAt
public static DateTime GetDTLAt(byte[] Buffer, int Pos)
public static DateTime GetDTLAt(this byte[] buffer, int pos)
{
int Year, Month, Day, Hour, Min, Sec, MSec;
Year = Buffer[Pos] * 256 + Buffer[Pos + 1];
Month = Buffer[Pos + 2];
Day = Buffer[Pos + 3];
Hour = Buffer[Pos + 5];
Min = Buffer[Pos + 6];
Sec = Buffer[Pos + 7];
MSec = (int)GetUDIntAt(Buffer, Pos + 8)/1000000;
Year = buffer[pos] * 256 + buffer[pos + 1];
Month = buffer[pos + 2];
Day = buffer[pos + 3];
Hour = buffer[pos + 5];
Min = buffer[pos + 6];
Sec = buffer[pos + 7];
MSec = (int)GetUDIntAt(buffer, pos + 8) / 1000000;
try
{
@@ -444,109 +444,109 @@ namespace Sharp7
return new DateTime(0);
}
}
public static void SetDTLAt(byte[] Buffer, int Pos, DateTime Value)
public static void SetDTLAt(this byte[] buffer, int pos, DateTime value)
{
short Year = (short)Value.Year;
byte Month = (byte)Value.Month;
byte Day = (byte)Value.Day;
byte Hour = (byte)Value.Hour;
byte Min = (byte)Value.Minute;
byte Sec = (byte)Value.Second;
byte Dow = (byte)(Value.DayOfWeek + 1);
short Year = (short)value.Year;
byte Month = (byte)value.Month;
byte Day = (byte)value.Day;
byte Hour = (byte)value.Hour;
byte Min = (byte)value.Minute;
byte Sec = (byte)value.Second;
byte Dow = (byte)(value.DayOfWeek + 1);
Int32 NanoSecs = Value.Millisecond * 1000000;
Int32 NanoSecs = value.Millisecond * 1000000;
var bytes_short = BitConverter.GetBytes(Year);
Buffer[Pos] = bytes_short[1];
Buffer[Pos + 1] = bytes_short[0];
Buffer[Pos + 2] = Month;
Buffer[Pos + 3] = Day;
Buffer[Pos + 4] = Dow;
Buffer[Pos + 5] = Hour;
Buffer[Pos + 6] = Min;
Buffer[Pos + 7] = Sec;
SetDIntAt(Buffer, Pos + 8, NanoSecs);
buffer[pos] = bytes_short[1];
buffer[pos + 1] = bytes_short[0];
buffer[pos + 2] = Month;
buffer[pos + 3] = Day;
buffer[pos + 4] = Dow;
buffer[pos + 5] = Hour;
buffer[pos + 6] = Min;
buffer[pos + 7] = Sec;
SetDIntAt(buffer, pos + 8, NanoSecs);
}
#endregion
#region Get/Set String (S7 String)
// Thanks to Pablo Agirre
public static string GetStringAt(byte[] Buffer, int Pos)
public static string GetStringAt(this byte[] buffer, int pos)
{
int size = (int)Buffer[Pos + 1];
return Encoding.UTF8.GetString(Buffer, Pos + 2, size);
int size = (int)buffer[pos + 1];
return Encoding.UTF8.GetString(buffer, pos + 2, size);
}
public static void SetStringAt(byte[] Buffer, int Pos, int MaxLen, string Value)
public static void SetStringAt(this byte[] buffer, int pos, int MaxLen, string value)
{
int size = Value.Length;
Buffer[Pos] = (byte)MaxLen;
Buffer[Pos + 1] = (byte)size;
Encoding.UTF8.GetBytes(Value, 0, size, Buffer, Pos + 2);
int size = value.Length;
buffer[pos] = (byte)MaxLen;
buffer[pos + 1] = (byte)size;
Encoding.UTF8.GetBytes(value, 0, size, buffer, pos + 2);
}
#endregion
#region Get/Set Array of char (S7 ARRAY OF CHARS)
public static string GetCharsAt(byte[] Buffer, int Pos, int Size)
public static string GetCharsAt(this byte[] buffer, int pos, int Size)
{
return Encoding.UTF8.GetString(Buffer, Pos , Size);
return Encoding.UTF8.GetString(buffer, pos, Size);
}
public static void SetCharsAt(byte[] Buffer, int Pos, string Value)
public static void SetCharsAt(this byte[] buffer, int pos, string value)
{
int MaxLen = Buffer.Length - Pos;
int MaxLen = buffer.Length - pos;
// Truncs the string if there's no room enough
if (MaxLen > Value.Length) MaxLen = Value.Length;
Encoding.UTF8.GetBytes(Value, 0, MaxLen, Buffer, Pos);
if (MaxLen > value.Length) MaxLen = value.Length;
Encoding.UTF8.GetBytes(value, 0, MaxLen, buffer, pos);
}
#endregion
#region Get/Set Counter
public static int GetCounter(ushort Value)
public static int GetCounter(this ushort value)
{
return BCDtoByte((byte)Value) * 100 + BCDtoByte((byte)(Value >> 8));
return BCDtoByte((byte)value) * 100 + BCDtoByte((byte)(value >> 8));
}
public static int GetCounterAt(ushort[] Buffer, int Index)
public static int GetCounterAt(this ushort[] buffer, int Index)
{
return GetCounter(Buffer[Index]);
return GetCounter(buffer[Index]);
}
public static ushort ToCounter(int Value)
public static ushort ToCounter(this int value)
{
return (ushort)(ByteToBCD(Value / 100) + (ByteToBCD(Value % 100) << 8));
return (ushort)(ByteToBCD(value / 100) + (ByteToBCD(value % 100) << 8));
}
public static void SetCounterAt(ushort[] Buffer, int Pos, int Value)
public static void SetCounterAt(this ushort[] buffer, int pos, int value)
{
Buffer[Pos] = ToCounter(Value);
buffer[pos] = ToCounter(value);
}
#endregion
#region Get/Set Timer
public static S7Timer GetS7TimerAt(byte[] Buffer, int Pos)
public static S7Timer GetS7TimerAt(this byte[] buffer, int pos)
{
return new S7Timer(new List<byte>(Buffer).GetRange(Pos, 12).ToArray());
return new S7Timer(new List<byte>(buffer).GetRange(pos, 12).ToArray());
}
public static void SetS7TimespanAt(byte[] Buffer, int Pos, TimeSpan Value)
public static void SetS7TimespanAt(this byte[] buffer, int pos, TimeSpan value)
{
SetDIntAt(Buffer, Pos, (Int32)Value.TotalMilliseconds);
SetDIntAt(buffer, pos, (Int32)value.TotalMilliseconds);
}
public static TimeSpan GetS7TimespanAt(byte[] Buffer, int pos)
public static TimeSpan GetS7TimespanAt(this byte[] buffer, int pos)
{
if (Buffer.Length < pos + 4)
if (buffer.Length < pos + 4)
{
return new TimeSpan();
}
Int32 a;
a = Buffer[pos + 0]; a <<= 8;
a += Buffer[pos + 1]; a <<= 8;
a += Buffer[pos + 2]; a <<= 8;
a += Buffer[pos + 3];
a = buffer[pos + 0]; a <<= 8;
a += buffer[pos + 1]; a <<= 8;
a += buffer[pos + 2]; a <<= 8;
a += buffer[pos + 3];
TimeSpan sp = new TimeSpan(0, 0, 0, 0, a);
return sp;