private static void HanleSetRequestWithDataBlock(GXDLMSSettings settings, GXDLMSServer server, GXByteBuffer data, GXDLMSLNParameters p, GXByteBuffer replyData, GXDLMSTranslatorStructure xml)
{
GXDataInfo reply = new GXDataInfo();
p.multipleBlocks = data.GetUInt8() == 0;
UInt32 blockNumber = data.GetUInt32();
if (blockNumber != settings.BlockIndex)
{
Debug.WriteLine("HanleSetRequestWithDataBlock failed. Invalid block number. " + settings.BlockIndex + "/" + blockNumber);
p.status = (byte)ErrorCode.DataBlockNumberInvalid;
}
else
{
int size = GXCommon.GetObjectCount(data);
int realSize = data.Size - data.Position;
if (size != realSize)
{
Debug.WriteLine("HanleSetRequestWithDataBlock failed. Invalid block size.");
p.status = (byte)ErrorCode.DataBlockUnavailable;
}
server.transaction.data.Set(data);
//If all data is received.
if (!p.multipleBlocks)
{
try
{
object value = GXCommon.GetData(settings, server.transaction.data, reply);
if (value is byte[])
{
DataType dt = (server.transaction.targets[0].Target as IGXDLMSBase).GetDataType(server.transaction.targets[0].Index);
if (dt != DataType.None && dt != DataType.OctetString)
{
value = GXDLMSClient.ChangeType((byte[])value, dt, settings.UseUtc2NormalTime);
}
}
server.transaction.targets[0].Value = value;
server.NotifyWrite(server.transaction.targets);
if (!server.transaction.targets[0].Handled && !p.multipleBlocks)
{
(server.transaction.targets[0].Target as IGXDLMSBase).SetValue(settings, server.transaction.targets[0]);
server.NotifyPostWrite(server.transaction.targets);
}
}
catch (Exception)
{
p.status = (byte)ErrorCode.HardwareFault;
}
finally
{
server.transaction = null;
}
settings.ResetBlockIndex();
}
}
p.multipleBlocks = true;
}
///<summary>
/// Handle Event Notification.
///</summary>
internal static void HandleEventNotification(GXDLMSSettings settings, GXReplyData reply, List <KeyValuePair <GXDLMSObject, int> > list)
{
reply.Time = DateTime.MinValue;
int len = reply.Data.GetUInt8();
byte[] tmp = null;
// If date time is given.
if (len != 0)
{
tmp = new byte[len];
reply.Data.Get(tmp);
reply.Time = (GXDateTime)GXDLMSClient.ChangeType(tmp, DataType.DateTime, settings.UseUtc2NormalTime);
}
if (reply.Xml != null)
{
reply.Xml.AppendStartTag(Command.EventNotification);
if (reply.Time != DateTime.MinValue)
{
reply.Xml.AppendComment(Convert.ToString(reply.Time));
reply.Xml.AppendLine(TranslatorTags.Time, null,
GXCommon.ToHex(tmp, false));
}
}
int ci = reply.Data.GetUInt16();
byte[] ln = new byte[6];
reply.Data.Get(ln);
byte index = reply.Data.GetUInt8();
if (reply.Xml != null)
{
AppendAttributeDescriptor(reply.Xml, ci, ln, index);
reply.Xml.AppendStartTag(TranslatorTags.AttributeValue);
}
GXDataInfo di = new GXDataInfo();
di.xml = reply.Xml;
object value = GXCommon.GetData(settings, reply.Data, di);
if (reply.Xml != null)
{
reply.Xml.AppendEndTag(TranslatorTags.AttributeValue);
reply.Xml.AppendEndTag(Command.EventNotification);
}
else
{
GXDLMSObject obj = settings.Objects.FindByLN((ObjectType)ci, GXCommon.ToLogicalName(ln));
if (obj != null)
{
ValueEventArgs v = new ValueEventArgs(obj, index, 0, null);
v.Value = value;
(obj as IGXDLMSBase).SetValue(settings, v);
list.Add(new KeyValuePair <GXDLMSObject, int>(obj, index));
}
}
}
///<summary>
/// Handle action request.
///</summary>
///<param name="Reply">
/// Received data from the client.
///</param>
///<returns>
///Reply.
///</returns>
private byte[][] HandleMethodRequest()
{
GXByteBuffer data = Reply.Data;
GXByteBuffer bb = new GXByteBuffer();
// Get type.
data.GetUInt8();
// Get invoke ID and priority.
data.GetUInt8();
// CI
ObjectType ci = (ObjectType)data.GetUInt16();
byte[] ln = new byte[6];
data.Get(ln);
// Attribute Id
int id = data.GetUInt8();
// Get parameters.
object parameters = null;
if (data.GetUInt8() != 0)
{
GXDataInfo info = new GXDataInfo();
parameters = GXCommon.GetData(data, info);
}
GXDLMSObject obj = Settings.Objects.FindByLN(ci, GXDLMSObject.ToLogicalName(ln));
if (obj == null)
{
obj = FindObject(ci, 0, GXDLMSObject.ToLogicalName(ln));
}
if (obj == null)
{
// Device reports a undefined object.
addError(ErrorCode.UndefinedObject, bb);
Debug.WriteLine("Undefined object.");
}
else
{
ValueEventArgs e = new ValueEventArgs(obj, id, 0, parameters);
Action(e);
if (e.Handled)
{
bb.Add((obj as IGXDLMSBase).Invoke(Settings, id, parameters));
}
else
{
bb.Add((obj as IGXDLMSBase).Invoke(Settings, id, parameters));
}
}
return(GXDLMS.SplitPdu(Settings, Command.MethodResponse, 1, bb, ErrorCode.Ok, DateTime.MinValue)[0]);
}
///<summary>
///Handle set request.
///</summary>
///<returns>
///Reply to the client.
///</returns>
private byte[][] HandleSetRequest()
{
ErrorCode error = ErrorCode.Ok;
GXByteBuffer data = Reply.Data;
GXDataInfo info = new GXDataInfo();
GXByteBuffer bb = new GXByteBuffer();
// Get type.
short type = data.GetUInt8();
// Get invoke ID and priority.
data.GetUInt8();
// SetRequest normal
if (type == 1)
{
Settings.ResetBlockIndex();
ServerReply.Index = 0;
// CI
ObjectType ci = (ObjectType)data.GetUInt16();
byte[] ln = new byte[6];
data.Get(ln);
// Attribute index.
int index = data.GetUInt8();
// Get Access Selection.
data.GetUInt8();
object value = GXCommon.GetData(data, info);
GXDLMSObject obj = Settings.Objects.FindByLN(ci, GXDLMSObject.ToLogicalName(ln));
if (obj == null)
{
obj = FindObject(ci, 0, GXDLMSObject.ToLogicalName(ln));
}
// If target is unknown.
if (obj == null)
{
Debug.WriteLine("Undefined object.");
// Device reports a undefined object.
error = ErrorCode.UndefinedObject;
}
else
{
AccessMode am = obj.GetAccess(index);
// If write is denied.
if (am != AccessMode.Write && am != AccessMode.ReadWrite)
{
Debug.WriteLine("Read Write denied.");
error = ErrorCode.ReadWriteDenied;
}
else
{
try
{
if (value is byte[])
{
DataType dt = (obj as IGXDLMSBase).GetDataType(index);
if (dt != DataType.None)
{
value = GXDLMSClient.ChangeType((byte[])value, dt);
}
}
ValueEventArgs e = new ValueEventArgs(obj, index, 0, null);
Write(e);
if (!e.Handled)
{
(obj as IGXDLMSBase).SetValue(Settings, index, value);
}
}
catch (Exception e)
{
Debug.WriteLine(e.Message);
error = ErrorCode.HardwareFault;
}
}
}
}
else
{
Debug.WriteLine("handleSetRequest failed. Unknown command.");
Settings.ResetBlockIndex();
error = ErrorCode.HardwareFault;
}
return(GXDLMS.SplitPdu(Settings, Command.SetResponse, 1, bb, error, DateTime.MinValue)[0]);
}
private byte[][] HandleGetRequest()
{
ErrorCode error = ErrorCode.Ok;
GXByteBuffer data = Reply.Data;
GXByteBuffer bb = new GXByteBuffer();
short type;
int index = 0;
object parameters = null;
// Get type.
type = data.GetUInt8();
// Get invoke ID and priority.
data.GetUInt8();
// GetRequest normal
if (type == 1)
{
Settings.ResetBlockIndex();
ServerReply.Index = 0;
parameters = null;
// CI
ObjectType ci = (ObjectType)data.GetUInt16();
byte[] ln = new byte[6];
data.Get(ln);
// Attribute Id
int attributeIndex = data.GetUInt8();
GXDLMSObject obj = Settings.Objects.FindByLN(ci, GXDLMSObject.ToLogicalName(ln));
if (obj == null)
{
obj = FindObject(ci, 0, GXDLMSObject.ToLogicalName(ln));
}
if (obj == null)
{
// "Access Error : Device reports a undefined object."
error = ErrorCode.UndefinedObject;
}
else
{
// AccessSelection
int selection = data.GetUInt8();
int selector = 0;
if (selection != 0)
{
selector = data.GetUInt8();
GXDataInfo info = new GXDataInfo();
parameters = GXCommon.GetData(data, info);
}
ValueEventArgs e = new ValueEventArgs(obj, attributeIndex, 0, parameters);
Read(e);
object value;
if (e.Handled)
{
value = e.Value;
}
else
{
value = (obj as IGXDLMSBase).GetValue(Settings, attributeIndex, selector, parameters);
}
GXDLMS.AppedData(obj, attributeIndex, bb, value);
}
ServerReply.ReplyMessages = GXDLMS.SplitPdu(Settings, Command.GetResponse, 1, bb, error, DateTime.MinValue);
}
else if (type == 2)
{
// Get request for next data block
// Get block index.
index = (int)data.GetUInt32();
if (index != Settings.BlockIndex + 1)
{
Debug.WriteLine("handleGetRequest failed. Invalid block number. " + Settings.BlockIndex + "/" + index);
ServerReply.ReplyMessages = GXDLMS.SplitPdu(Settings, Command.GetResponse, 1, bb,
ErrorCode.DataBlockNumberInvalid, DateTime.MinValue);
index = 0;
ServerReply.Index = index;
}
else
{
Settings.IncreaseBlockIndex();
index = ServerReply.Index + 1;
ServerReply.Index = index;
}
}
else if (type == 3)
{
// Get request with a list.
int cnt = GXCommon.GetObjectCount(data);
GXCommon.SetObjectCount(cnt, bb);
for (int pos = 0; pos != cnt; ++pos)
{
ObjectType ci = (ObjectType)data.GetUInt16();
byte[] ln = new byte[6];
data.Get(ln);
short attributeIndex = data.GetUInt8();
GXDLMSObject obj = Settings.Objects.FindByLN(ci, GXDLMSObject.ToLogicalName(ln));
if (obj == null)
{
obj = FindObject(ci, 0, GXDLMSObject.ToLogicalName(ln));
}
if (obj == null)
{
// "Access Error : Device reports a undefined object."
error = ErrorCode.UndefinedObject;
}
else
{
// AccessSelection
int selection = data.GetUInt8();
int selector = 0;
if (selection != 0)
{
selector = data.GetUInt8();
GXDataInfo info = new GXDataInfo();
parameters = GXCommon.GetData(data, info);
}
try
{
ValueEventArgs e = new ValueEventArgs(obj, attributeIndex, 0, parameters);
Read(e);
object value;
if (e.Handled)
{
value = e.Value;
}
else
{
value = (obj as IGXDLMSBase).GetValue(Settings, attributeIndex, selector, parameters);
}
bb.SetUInt8(ErrorCode.Ok);
GXDLMS.AppedData(obj, attributeIndex, bb, value);
}
catch (Exception)
{
bb.SetUInt8(1);
bb.SetUInt8(ErrorCode.HardwareFault);
}
}
}
ServerReply.ReplyMessages = GXDLMS.SplitPdu(Settings, Command.GetResponse, 3, bb, error, DateTime.MinValue);
}
else
{
Debug.WriteLine("handleGetRequest failed. Invalid command type.");
Settings.ResetBlockIndex();
// Access Error : Device reports a hardware fault.
ServerReply.ReplyMessages = GXDLMS.SplitPdu(Settings, Command.GetResponse, 1, bb, ErrorCode.HardwareFault, DateTime.MinValue);
}
ServerReply.Index = index;
return(ServerReply.ReplyMessages[index]);
}
private static void HanleSetRequestWithList(GXDLMSSettings settings, byte invokeID, GXDLMSServer server, GXByteBuffer data, GXDLMSLNParameters p, GXByteBuffer replyData, GXDLMSTranslatorStructure xml)
{
ValueEventArgs e;
int cnt = GXCommon.GetObjectCount(data);
List <ValueEventArgs> list = new List <ValueEventArgs>();
if (xml != null)
{
xml.AppendStartTag(TranslatorTags.AttributeDescriptorList, "Qty", xml.IntegerToHex(cnt, 2));
}
try
{
for (int pos = 0; pos != cnt; ++pos)
{
ObjectType ci = (ObjectType)data.GetUInt16();
byte[] ln = new byte[6];
data.Get(ln);
short attributeIndex = data.GetUInt8();
// AccessSelection
int selection = data.GetUInt8();
int selector = 0;
object parameters = null;
if (selection != 0)
{
selector = data.GetUInt8();
GXDataInfo info = new GXDataInfo();
parameters = GXCommon.GetData(settings, data, info);
}
if (xml != null)
{
xml.AppendStartTag(TranslatorTags.AttributeDescriptorWithSelection);
xml.AppendStartTag(TranslatorTags.AttributeDescriptor);
xml.AppendComment(ci.ToString());
xml.AppendLine(TranslatorTags.ClassId, "Value", xml.IntegerToHex((int)ci, 4));
xml.AppendComment(GXCommon.ToLogicalName(ln));
xml.AppendLine(TranslatorTags.InstanceId, "Value", GXCommon.ToHex(ln, false));
xml.AppendLine(TranslatorTags.AttributeId, "Value", xml.IntegerToHex(attributeIndex, 2));
xml.AppendEndTag(TranslatorTags.AttributeDescriptor);
xml.AppendEndTag(TranslatorTags.AttributeDescriptorWithSelection);
}
else
{
GXDLMSObject obj = settings.Objects.FindByLN(ci, GXCommon.ToLogicalName(ln));
if (obj == null)
{
obj = server.NotifyFindObject(ci, 0, GXCommon.ToLogicalName(ln));
}
if (obj == null)
{
// "Access Error : Device reports a undefined object."
e = new ValueEventArgs(server, obj, attributeIndex, 0, 0);
e.Error = ErrorCode.UndefinedObject;
list.Add(e);
}
else
{
ValueEventArgs arg = new ValueEventArgs(server, obj, attributeIndex, selector, parameters);
arg.InvokeId = invokeID;
if (server.NotifyGetAttributeAccess(arg) == AccessMode.NoAccess)
{
//Read Write denied.
arg.Error = ErrorCode.ReadWriteDenied;
list.Add(arg);
}
else
{
list.Add(arg);
}
}
}
}
cnt = GXCommon.GetObjectCount(data);
if (xml != null)
{
xml.AppendEndTag(TranslatorTags.AttributeDescriptorList);
xml.AppendStartTag(TranslatorTags.ValueList, "Qty", xml.IntegerToHex(cnt, 2));
}
for (int pos = 0; pos != cnt; ++pos)
{
GXDataInfo di = new GXDataInfo();
di.xml = xml;
if (xml != null && xml.OutputType == TranslatorOutputType.StandardXml)
{
xml.AppendStartTag(Command.WriteRequest, SingleReadResponse.Data);
}
object value = GXCommon.GetData(settings, data, di);
if (!di.Complete)
{
value = GXCommon.ToHex(data.Data, false, data.Position, data.Size - data.Position);
}
else if (value is byte[])
{
value = GXCommon.ToHex((byte[])value, false);
}
if (xml != null && xml
.OutputType == TranslatorOutputType.StandardXml)
{
xml.AppendEndTag(Command.WriteRequest, SingleReadResponse.Data);
}
}
if (xml != null)
{
xml.AppendEndTag(TranslatorTags.ValueList);
}
}
catch (Exception ex)
{
if (xml == null)
{
throw ex;
}
}
}
private static void HandleRead(GXDLMSSettings settings, GXDLMSServer server, byte type, GXByteBuffer data,
List<ValueEventArgs> list, List<ValueEventArgs> reads, List<ValueEventArgs> actions,
GXByteBuffer replyData, GXDLMSTranslatorStructure xml)
{
int sn = data.GetInt16();
if (xml != null)
{
if (xml.OutputType == TranslatorOutputType.StandardXml)
{
xml.AppendStartTag(
TranslatorTags.VariableAccessSpecification);
}
else
{
sn &= 0xFFFF;
}
if (type == (byte)VariableAccessSpecification.ParameterisedAccess)
{
xml.AppendStartTag(Command.ReadRequest,
VariableAccessSpecification.ParameterisedAccess);
xml.AppendLine(
(int)Command.ReadRequest << 8
| (int)VariableAccessSpecification.VariableName,
"Value", xml.IntegerToHex(sn, 4));
xml.AppendLine(TranslatorTags.Selector, "Value",
xml.IntegerToHex(data.GetUInt8(), 2));
GXDataInfo di = new GXDataInfo();
di.xml = xml;
xml.AppendStartTag(TranslatorTags.Parameter);
GXCommon.GetData(settings, data, di);
xml.AppendEndTag(TranslatorTags.Parameter);
xml.AppendEndTag(Command.ReadRequest,
VariableAccessSpecification.ParameterisedAccess);
}
else
{
xml.AppendLine(
(int)Command.ReadRequest << 8
| (int)VariableAccessSpecification.VariableName,
"Value", xml.IntegerToHex(sn, 4));
}
if (xml.OutputType == TranslatorOutputType.StandardXml)
{
xml.AppendEndTag(TranslatorTags.VariableAccessSpecification);
}
return;
}
GXSNInfo info = FindSNObject(server, sn & 0xFFFF);
ValueEventArgs e = new ValueEventArgs(settings, info.Item, info.Index, 0, null);
e.action = info.IsAction;
if (type == (byte)VariableAccessSpecification.ParameterisedAccess)
{
e.Selector = data.GetUInt8();
GXDataInfo di = new GXDataInfo();
e.Parameters = GXCommon.GetData(settings, data, di);
}
//Return error if connection is not established.
if (!settings.Connected && (!e.action || e.Target.ShortName != 0xFA00 || e.Index != 8))
{
replyData.Add(GXDLMSServer.GenerateConfirmedServiceError(ConfirmedServiceError.InitiateError,
ServiceError.Service, (byte)Service.Unsupported));
return;
}
list.Add(e);
if (!e.action && info.Item.GetAccess(info.Index) == AccessMode.NoAccess)
{
e.Error = ErrorCode.ReadWriteDenied;
}
else if (e.action && info.Item.GetMethodAccess(info.Index) == MethodAccessMode.NoAccess)
{
e.Error = ErrorCode.ReadWriteDenied;
}
else
{
if (e.action)
{
actions.Add(e);
}
else
{
reads.Add(e);
}
}
}
private static void HandleRead(GXDLMSSettings settings, GXDLMSServer server, byte type, GXByteBuffer data,
List <ValueEventArgs> list, List <ValueEventArgs> reads, List <ValueEventArgs> actions,
GXByteBuffer replyData, GXDLMSTranslatorStructure xml)
{
int sn = data.GetInt16();
if (xml != null)
{
if (xml.OutputType == TranslatorOutputType.StandardXml)
{
xml.AppendStartTag(
TranslatorTags.VariableAccessSpecification);
}
else
{
sn &= 0xFFFF;
}
if (type == (byte)VariableAccessSpecification.ParameterisedAccess)
{
xml.AppendStartTag(Command.ReadRequest,
VariableAccessSpecification.ParameterisedAccess);
xml.AppendLine(
(int)Command.ReadRequest << 8
| (int)VariableAccessSpecification.VariableName,
"Value", xml.IntegerToHex(sn, 4));
xml.AppendLine(TranslatorTags.Selector, "Value",
xml.IntegerToHex(data.GetUInt8(), 2));
GXDataInfo di = new GXDataInfo();
di.xml = xml;
xml.AppendStartTag(TranslatorTags.Parameter);
GXCommon.GetData(settings, data, di);
xml.AppendEndTag(TranslatorTags.Parameter);
xml.AppendEndTag(Command.ReadRequest,
VariableAccessSpecification.ParameterisedAccess);
}
else
{
xml.AppendLine(
(int)Command.ReadRequest << 8
| (int)VariableAccessSpecification.VariableName,
"Value", xml.IntegerToHex(sn, 4));
}
if (xml.OutputType == TranslatorOutputType.StandardXml)
{
xml.AppendEndTag(TranslatorTags.VariableAccessSpecification);
}
return;
}
GXSNInfo info = FindSNObject(server, sn & 0xFFFF);
ValueEventArgs e = new ValueEventArgs(server, info.Item, info.Index, 0, null);
e.action = info.IsAction;
if (type == (byte)VariableAccessSpecification.ParameterisedAccess)
{
e.Selector = data.GetUInt8();
GXDataInfo di = new GXDataInfo();
e.Parameters = GXCommon.GetData(settings, data, di);
}
//Return error if connection is not established.
if (!settings.Connected && (!e.action || e.Target.ShortName != 0xFA00 || e.Index != 8))
{
replyData.Add(GXDLMSServer.GenerateConfirmedServiceError(ConfirmedServiceError.InitiateError,
ServiceError.Service, (byte)Service.Unsupported));
return;
}
if (e.Target is GXDLMSProfileGeneric && info.Index == 2)
{
e.RowToPdu = GXDLMS.RowsToPdu(settings, (GXDLMSProfileGeneric)e.Target);
}
list.Add(e);
if (!e.action && server.NotifyGetAttributeAccess(e) == AccessMode.NoAccess)
{
e.Error = ErrorCode.ReadWriteDenied;
}
else if (e.action && server.NotifyGetMethodAccess(e) == MethodAccessMode.NoAccess)
{
e.Error = ErrorCode.ReadWriteDenied;
}
else
{
if (e.action)
{
actions.Add(e);
}
else
{
reads.Add(e);
}
}
}
/// <summary>
/// Handle get response and get data from block and/or update error status.
/// </summary>
/// <param name="settings">DLMS settings.</param>
/// <param name="reply">Received data from the client.</param>
/// <param name="index">Block index number.</param>
static bool HandleGetResponse(GXDLMSSettings settings,
GXReplyData reply, int index)
{
bool ret = true;
long number;
short ch = 0;
GXByteBuffer data = reply.Data;
// Get type.
GetCommandType type = (GetCommandType)data.GetUInt8();
// Get invoke ID and priority.
ch = data.GetUInt8();
if (reply.Xml != null)
{
reply.Xml.AppendStartTag(Command.GetResponse);
reply.Xml.AppendStartTag(Command.GetResponse, type);
//InvokeIdAndPriority
reply.Xml.AppendLine(TranslatorTags.InvokeId, "Value", reply.Xml.IntegerToHex(ch, 2));
}
// Response normal
if (type == GetCommandType.Normal)
{
// Result
ch = data.GetUInt8();
if (ch != 0)
{
reply.Error = data.GetUInt8();
}
if (reply.Xml != null)
{
// Result start tag.
reply.Xml.AppendStartTag(TranslatorTags.Result);
if (reply.Error != 0)
{
reply.Xml.AppendLine(TranslatorTags.DataAccessError,
"Value",
GXDLMSTranslator.ErrorCodeToString(
reply.Xml.OutputType, (ErrorCode)reply.Error));
}
else
{
reply.Xml.AppendStartTag(TranslatorTags.Data);
GXDataInfo di = new GXDataInfo();
di.xml = reply.Xml;
GXCommon.GetData(settings, reply.Data, di);
reply.Xml.AppendEndTag(TranslatorTags.Data);
}
}
else
{
GetDataFromBlock(data, 0);
}
}
else if (type == GetCommandType.NextDataBlock)
{
// Is Last block.
ch = data.GetUInt8();
if (reply.Xml != null)
{
//Result start tag.
reply.Xml.AppendStartTag(TranslatorTags.Result);
//LastBlock
reply.Xml.AppendLine(TranslatorTags.LastBlock, "Value", reply.Xml.IntegerToHex(ch, 2));
}
if (ch == 0)
{
reply.MoreData = (RequestTypes)(reply.MoreData | RequestTypes.DataBlock);
}
else
{
reply.MoreData = (RequestTypes)(reply.MoreData & ~RequestTypes.DataBlock);
}
// Get Block number.
number = data.GetUInt32();
if (reply.Xml != null)
{
//BlockNumber
reply.Xml.AppendLine(TranslatorTags.BlockNumber, "Value", reply.Xml.IntegerToHex(number, 8));
}
else
{
//If meter's block index is zero based.
if (number != 1 && settings.BlockIndex == 1)
{
settings.BlockIndex = (uint)number;
}
if (number != settings.BlockIndex)
{
throw new ArgumentException(
"Invalid Block number. It is " + number
+ " and it should be " + settings.BlockIndex + ".");
}
}
// Get status.
ch = data.GetUInt8();
if (ch != 0)
{
reply.Error = data.GetUInt8();
}
if (reply.Xml != null)
{
// Get data size.
int blockLength = GXCommon.GetObjectCount(data);
// if whole block is read.
if ((reply.MoreData & RequestTypes.Frame) == 0)
{
// Check Block length.
if (blockLength > data.Size - data.Position)
{
throw new OutOfMemoryException();
}
}
//Result
reply.Xml.AppendStartTag(TranslatorTags.Result);
reply.Xml.AppendLine(TranslatorTags.RawData, "Value",
GXCommon.ToHex(reply.Data.Data, false, data.Position, reply.Data.Size - data.Position));
reply.Xml.AppendEndTag(TranslatorTags.Result);
}
else if (data.Position != data.Size)
{
// Get data size.
int blockLength = GXCommon.GetObjectCount(data);
// if whole block is read.
if ((reply.MoreData & RequestTypes.Frame) == 0)
{
// Check Block length.
if (blockLength > data.Size - data.Position)
{
throw new OutOfMemoryException();
}
reply.Command = Command.None;
}
GetDataFromBlock(data, index);
// If last packet and data is not try to peek.
if (reply.MoreData == RequestTypes.None)
{
if (!reply.Peek)
{
data.Position = 0;
}
settings.ResetBlockIndex();
}
}
}
else if (type == GetCommandType.WithList)
{
//Get object count.
int cnt = GXCommon.GetObjectCount(data);
object[] values = new object[cnt];
if (reply.Xml != null)
{
//Result start tag.
reply.Xml.AppendStartTag(TranslatorTags.Result, "Qty", reply.Xml.IntegerToHex(cnt, 2));
}
for (int pos = 0; pos != cnt; ++pos)
{
// Result
ch = data.GetUInt8();
if (ch != 0)
{
reply.Error = data.GetUInt8();
}
else
{
if (reply.Xml != null)
{
GXDataInfo di = new GXDataInfo();
di.xml = reply.Xml;
//Data.
reply.Xml.AppendStartTag(Command.ReadResponse, SingleReadResponse.Data);
GXCommon.GetData(settings, reply.Data, di);
reply.Xml.AppendEndTag(Command.ReadResponse, SingleReadResponse.Data);
}
else
{
reply.ReadPosition = reply.Data.Position;
GetValueFromData(settings, reply);
reply.Data.Position = reply.ReadPosition;
if (values != null)
{
values[pos] = reply.Value;
}
reply.Value = null;
}
}
}
reply.Value = values;
ret = false;
}
else
{
throw new ArgumentException("Invalid Get response.");
}
if (reply.Xml != null)
{
reply.Xml.AppendEndTag(TranslatorTags.Result);
reply.Xml.AppendEndTag(Command.GetResponse, type);
reply.Xml.AppendEndTag(Command.GetResponse);
}
return ret;
}
/// <summary>
/// Handle get request with list command.
/// </summary>
/// <param name="data">Received data.</param>
private static void GetRequestWithList(GXDLMSSettings settings, GXDLMSServer server, GXByteBuffer data, GXByteBuffer replyData, GXDLMSTranslatorStructure xml)
{
ValueEventArgs e;
GXByteBuffer bb = new GXByteBuffer();
int pos;
int cnt = GXCommon.GetObjectCount(data);
GXCommon.SetObjectCount(cnt, bb);
List<ValueEventArgs> list = new List<ValueEventArgs>();
if (xml != null)
{
xml.AppendStartTag(TranslatorTags.AttributeDescriptorList, "Qty", xml.IntegerToHex(cnt, 2));
}
try
{
for (pos = 0; pos != cnt; ++pos)
{
ObjectType ci = (ObjectType)data.GetUInt16();
byte[] ln = new byte[6];
data.Get(ln);
short attributeIndex = data.GetUInt8();
// AccessSelection
int selection = data.GetUInt8();
int selector = 0;
object parameters = null;
if (selection != 0)
{
selector = data.GetUInt8();
GXDataInfo info = new GXDataInfo();
parameters = GXCommon.GetData(settings, data, info);
}
if (xml != null)
{
xml.AppendStartTag(TranslatorTags.AttributeDescriptorWithSelection);
xml.AppendStartTag(TranslatorTags.AttributeDescriptor);
xml.AppendLine(TranslatorTags.ClassId, "Value", xml.IntegerToHex((int)ci, 4));
xml.AppendLine(TranslatorTags.InstanceId, "Value", GXCommon.ToHex(ln, false));
xml.AppendLine(TranslatorTags.AttributeId, "Value", xml.IntegerToHex(attributeIndex, 2));
xml.AppendEndTag(TranslatorTags.AttributeDescriptor);
xml.AppendEndTag(TranslatorTags.AttributeDescriptorWithSelection);
}
else
{
GXDLMSObject obj = settings.Objects.FindByLN(ci, GXDLMSObject.ToLogicalName(ln));
if (obj == null)
{
obj = server.NotifyFindObject(ci, 0, GXDLMSObject.ToLogicalName(ln));
}
if (obj == null)
{
// "Access Error : Device reports a undefined object."
e = new ValueEventArgs(settings, obj, attributeIndex, 0, 0);
e.Error = ErrorCode.UndefinedObject;
list.Add(e);
}
else
{
if (obj.GetAccess(attributeIndex) == AccessMode.NoAccess)
{
//Read Write denied.
ValueEventArgs arg = new ValueEventArgs(settings, obj, attributeIndex, 0, null);
arg.Error = ErrorCode.ReadWriteDenied;
list.Add(arg);
}
else
{
ValueEventArgs arg = new ValueEventArgs(settings, obj, attributeIndex, selector, parameters);
list.Add(arg);
}
}
}
}
}
catch (Exception ex)
{
if (xml == null)
{
throw ex;
}
}
if (xml != null)
{
xml.AppendEndTag(TranslatorTags.AttributeDescriptorList);
return;
}
server.NotifyRead(list.ToArray());
object value;
pos = 0;
foreach (ValueEventArgs it in list)
{
try
{
if (it.Handled)
{
value = it.Value;
}
else
{
value = (it.Target as IGXDLMSBase).GetValue(settings, it);
}
bb.SetUInt8(it.Error);
GXDLMS.AppendData(settings, it.Target, it.Index, bb, value);
}
catch (Exception)
{
bb.SetUInt8((byte)ErrorCode.HardwareFault);
}
if (settings.Index != settings.Count)
{
server.transaction = new GXDLMSLongTransaction(list.ToArray(), Command.GetRequest, null);
}
++pos;
}
GXDLMSLNParameters p = new GXDLMSLNParameters(settings, Command.GetResponse, 3, null, bb, 0xFF);
GXDLMS.GetLNPdu(p, replyData);
}
/// <summary>
/// Handle Information Report.
/// </summary>
/// <param name="settings">DLMS settings.</param>
/// <param name="reply"></param>
/// <returns></returns>
public static void HandleInformationReport(GXDLMSSettings settings, GXReplyData reply, List <KeyValuePair <GXDLMSObject, int> > list)
{
reply.Time = DateTime.MinValue;
int len = reply.Data.GetUInt8();
byte[] tmp = null;
// If date time is given.
if (len != 0)
{
tmp = new byte[len];
reply.Data.Get(tmp);
reply.Time = (GXDateTime)GXDLMSClient.ChangeType(tmp, DataType.DateTime, settings.UseUtc2NormalTime);
}
byte type;
int count = GXCommon.GetObjectCount(reply.Data);
if (reply.Xml != null)
{
reply.Xml.AppendStartTag(Command.InformationReport);
if (reply.Time != DateTime.MinValue)
{
reply.Xml.AppendComment(Convert.ToString(reply.Time));
if (reply.Xml.OutputType == TranslatorOutputType.SimpleXml)
{
reply.Xml.AppendLine(TranslatorTags.CurrentTime, null, GXCommon.ToHex(tmp, false));
}
else
{
reply.Xml.AppendLine(TranslatorTags.CurrentTime, null,
GXCommon.GeneralizedTime(reply.Time));
}
}
reply.Xml.AppendStartTag(TranslatorTags.ListOfVariableAccessSpecification, "Qty", reply.Xml.IntegerToHex(count, 2));
}
for (int pos = 0; pos != count; ++pos)
{
type = reply.Data.GetUInt8();
if (type == (byte)VariableAccessSpecification.VariableName)
{
int sn = reply.Data.GetUInt16();
if (reply.Xml != null)
{
reply.Xml.AppendLine(
(int)Command.WriteRequest << 8
| (int)VariableAccessSpecification.VariableName,
"Value", reply.Xml.IntegerToHex(sn, 4));
}
else
{
GXSNInfo info = FindSNObject(settings.Objects, sn);
if (info.Item != null)
{
list.Add(new KeyValuePair <GXDLMSObject, int>(info.Item, info.Index));
}
else
{
System.Diagnostics.Debug.WriteLine(string.Format("Unknown object : {0}.", sn));
}
}
}
}
if (reply.Xml != null)
{
reply.Xml.AppendEndTag(TranslatorTags.ListOfVariableAccessSpecification);
reply.Xml.AppendStartTag(TranslatorTags.ListOfData, "Qty", reply.Xml.IntegerToHex(count, 2));
}
//Get values.
count = GXCommon.GetObjectCount(reply.Data);
GXDataInfo di = new GXDataInfo();
di.xml = reply.Xml;
for (int pos = 0; pos != count; ++pos)
{
di.Clear();
if (reply.Xml != null)
{
GXCommon.GetData(settings, reply.Data, di);
}
else
{
ValueEventArgs v = new ValueEventArgs(list[pos].Key, list[pos].Value, 0, null);
v.Value = GXCommon.GetData(settings, reply.Data, di);
(list[pos].Key as IGXDLMSBase).SetValue(settings, v);
}
}
if (reply.Xml != null)
{
reply.Xml.AppendEndTag(TranslatorTags.ListOfData);
reply.Xml.AppendEndTag(Command.InformationReport);
}
}
///<summary>
/// Handle action request.
///</summary>
///<param name="Reply">
/// Received data from the client.
///</param>
///<returns>
///Reply.
///</returns>
public static void HandleMethodRequest(GXDLMSSettings settings, GXDLMSServer server, GXByteBuffer data, GXDLMSConnectionEventArgs connectionInfo, GXByteBuffer replyData, GXDLMSTranslatorStructure xml)
{
ErrorCode error = ErrorCode.Ok;
GXByteBuffer bb = new GXByteBuffer();
// Get type.
ActionRequestType type = (ActionRequestType)data.GetUInt8();
// Get invoke ID and priority.
byte invokeId = data.GetUInt8();
// CI
ObjectType ci = (ObjectType)data.GetUInt16();
byte[] ln = new byte[6];
data.Get(ln);
// Attribute Id
byte id = data.GetUInt8();
// Get parameters.
object parameters = null;
byte selection = data.GetUInt8();
if (xml != null)
{
xml.AppendStartTag(Command.MethodRequest);
if (type == ActionRequestType.Normal)
{
xml.AppendStartTag(Command.MethodRequest, ActionRequestType.Normal);
xml.AppendLine(TranslatorTags.InvokeId, "Value", xml.IntegerToHex(invokeId, 2));
AppendMethodDescriptor(xml, (int)ci, ln, id);
if (selection != 0)
{
//MethodInvocationParameters
xml.AppendStartTag(TranslatorTags.MethodInvocationParameters);
GXDataInfo di = new GXDataInfo();
di.xml = xml;
GXCommon.GetData(settings, data, di);
xml.AppendEndTag(TranslatorTags.MethodInvocationParameters);
}
xml.AppendEndTag(Command.MethodRequest, ActionRequestType.Normal);
}
xml.AppendEndTag(Command.MethodRequest);
return;
}
if (selection != 0)
{
GXDataInfo info = new GXDataInfo();
parameters = GXCommon.GetData(settings, data, info);
}
GXDLMSObject obj = settings.Objects.FindByLN(ci, GXDLMSObject.ToLogicalName(ln));
if (!settings.Connected && (ci != ObjectType.AssociationLogicalName || id != 1))
{
replyData.Set(GXDLMSServer.GenerateConfirmedServiceError(ConfirmedServiceError.InitiateError,
ServiceError.Service, (byte)Service.Unsupported));
return;
}
if (obj == null)
{
obj = server.NotifyFindObject(ci, 0, GXDLMSObject.ToLogicalName(ln));
}
if (obj == null)
{
// Device reports a undefined object.
error = ErrorCode.UndefinedObject;
}
else
{
if (obj.GetMethodAccess(id) == MethodAccessMode.NoAccess)
{
error = ErrorCode.ReadWriteDenied;
}
else
{
ValueEventArgs e = new ValueEventArgs(settings, obj, id, 0, parameters);
server.NotifyAction(new ValueEventArgs[] { e });
byte[] actionReply;
if (e.Handled)
{
actionReply = (byte[])e.Value;
}
else
{
actionReply = (obj as IGXDLMSBase).Invoke(settings, e);
}
//Set default action reply if not given.
if (actionReply != null && e.Error == 0)
{
//Add return parameters
bb.SetUInt8(1);
//Add parameters error code.
bb.SetUInt8(0);
GXCommon.SetData(settings, bb, GXCommon.GetValueType(actionReply), actionReply);
}
else
{
error = e.Error;
//Add return parameters
bb.SetUInt8(0);
}
}
}
GXDLMSLNParameters p = new GXDLMSLNParameters(settings, Command.MethodResponse, 1, null, bb, (byte)error);
GXDLMS.GetLNPdu(p, replyData);
//If High level authentication fails.
if (!settings.Connected && obj is GXDLMSAssociationLogicalName && id == 1)
{
server.NotifyInvalidConnection(connectionInfo);
}
}
/// <summary>
/// Handle get request normal command.
/// </summary>
/// <param name="data">Received data.</param>
private static void GetRequestNormal(GXDLMSSettings settings, GXDLMSServer server, GXByteBuffer data, GXByteBuffer replyData, GXDLMSTranslatorStructure xml)
{
ValueEventArgs e = null;
GXByteBuffer bb = new GXByteBuffer();
// Get type.
ErrorCode status = ErrorCode.Ok;
settings.Count = settings.Index = 0;
settings.ResetBlockIndex();
// CI
ObjectType ci = (ObjectType)data.GetUInt16();
byte[] ln = new byte[6];
data.Get(ln);
// Attribute Id
byte attributeIndex = data.GetUInt8();
// AccessSelection
byte selection = data.GetUInt8();
byte selector = 0;
object parameters = null;
GXDataInfo info = new GXDataInfo();
if (selection != 0)
{
selector = data.GetUInt8();
}
if (xml != null)
{
AppendAttributeDescriptor(xml, (int)ci, ln, attributeIndex);
if (selection != 0)
{
info.xml = xml;
xml.AppendStartTag(TranslatorTags.AccessSelection);
xml.AppendLine(TranslatorTags.AccessSelector, "Value", xml.IntegerToHex(selector, 2));
xml.AppendStartTag(TranslatorTags.AccessParameters);
GXCommon.GetData(settings, data, info);
xml.AppendEndTag(TranslatorTags.AccessParameters);
xml.AppendEndTag(TranslatorTags.AccessSelection);
}
return;
}
if (selection != 0)
{
parameters = GXCommon.GetData(settings, data, info);
}
GXDLMSObject obj = settings.Objects.FindByLN(ci, GXDLMSObject.ToLogicalName(ln));
if (obj == null)
{
obj = server.NotifyFindObject(ci, 0, GXDLMSObject.ToLogicalName(ln));
}
if (obj == null)
{
// "Access Error : Device reports a undefined object."
status = ErrorCode.UndefinedObject;
}
else
{
if (obj.GetAccess(attributeIndex) == AccessMode.NoAccess)
{
//Read Write denied.
status = ErrorCode.ReadWriteDenied;
}
else
{
e = new ValueEventArgs(settings, obj, attributeIndex, selector, parameters);
server.NotifyRead(new ValueEventArgs[] { e });
object value;
if (e.Handled)
{
value = e.Value;
}
else
{
value = (obj as IGXDLMSBase).GetValue(settings, e);
}
GXDLMS.AppendData(settings, obj, attributeIndex, bb, value);
status = e.Error;
}
}
GXDLMS.GetLNPdu(new GXDLMSLNParameters(settings, Command.GetResponse, 1, null, bb, (byte)status), replyData);
if (settings.Count != settings.Index || bb.Size != bb.Position)
{
server.transaction = new GXDLMSLongTransaction(new ValueEventArgs[] { e }, Command.GetRequest, bb);
}
}
/// <summary>
/// Get value from the data.
/// </summary>
/// <param name="settings">DLMS settings.</param>
/// <param name="reply"> Received data.</param>
internal static void GetValueFromData(GXDLMSSettings settings, GXReplyData reply)
{
GXByteBuffer data = reply.Data;
GXDataInfo info = new GXDataInfo();
if (reply.Value is Object[])
{
info.Type = DataType.Array;
info.Count = reply.TotalCount;
info.Index = reply.Count;
}
int index = data.Position;
data.Position = reply.ReadPosition;
try
{
Object value = GXCommon.GetData(settings, data, info);
if (value != null)
{
lock (reply)
{
// If new data.
if (!(value is Object[]))
{
reply.DataType = info.Type;
reply.Value = value;
reply.TotalCount = 0;
reply.ReadPosition = data.Position;
}
else
{
if (((Object[])value).Length != 0)
{
if (reply.Value == null)
{
reply.Value = value;
}
else
{
// Add items to collection.
List<Object> list = new List<Object>();
list.AddRange((Object[])reply.Value);
list.AddRange((Object[])value);
reply.Value = list.ToArray();
}
}
reply.ReadPosition = data.Position;
// Element count.
reply.TotalCount = info.Count;
}
}
}
else if (info.Complete
&& reply.Command == Command.DataNotification)
{
// If last item is null. This is a special case.
reply.ReadPosition = data.Position;
}
}
finally
{
data.Position = index;
}
// If last data frame of the data block is read.
if (reply.Command != Command.DataNotification
&& info.Complete && reply.MoreData == RequestTypes.None)
{
// If all blocks are read.
settings.ResetBlockIndex();
data.Position = 0;
}
}
private static void HandleDataNotification(GXDLMSSettings settings, GXReplyData reply)
{
int start = reply.Data.Position - 1;
//Get invoke id.
UInt32 invokeId = reply.Data.GetUInt32();
reply.Time = DateTime.MinValue;
int len = reply.Data.GetUInt8();
byte[] tmp = null;
// If date time is given.
if (len != 0)
{
tmp = new byte[len];
reply.Data.Get(tmp);
if (reply.Xml != null)
{
reply.Xml.AppendLine(TranslatorTags.DateTime, "Value", GXCommon.ToHex(tmp, false));
}
reply.Time = (GXDateTime)GXDLMSClient.ChangeType(tmp, DataType.DateTime);
}
if (reply.Xml != null)
{
reply.Xml.AppendStartTag(Command.DataNotification);
reply.Xml.AppendLine(TranslatorTags.LongInvokeId, null,
reply.Xml.IntegerToHex(invokeId, 8));
reply.Xml.AppendLine(TranslatorTags.DateTime, null,
GXCommon.ToHex(tmp, false));
reply.Xml.AppendStartTag(TranslatorTags.NotificationBody);
reply.Xml.AppendStartTag(TranslatorTags.DataValue);
GXDataInfo di = new GXDataInfo();
di.xml = reply.Xml;
GXCommon.GetData(settings, reply.Data, di);
reply.Xml.AppendEndTag(TranslatorTags.DataValue);
reply.Xml.AppendEndTag(TranslatorTags.NotificationBody);
reply.Xml.AppendEndTag(Command.DataNotification);
}
else
{
GetDataFromBlock(reply.Data, start);
GetValueFromData(settings, reply);
}
}
private static void HandleAccessResponse(GXDLMSSettings settings, GXReplyData reply)
{
int start = reply.Data.Position - 1;
//Get invoke id.
UInt32 invokeId = reply.Data.GetUInt32();
reply.Time = DateTime.MinValue;
int len = reply.Data.GetUInt8();
byte[] tmp = null;
// If date time is given.
if (len != 0)
{
tmp = new byte[len];
reply.Data.Get(tmp);
reply.Time = (GXDateTime)GXDLMSClient.ChangeType(tmp, DataType.DateTime);
}
if (reply.Xml != null)
{
reply.Xml.AppendStartTag(Command.AccessResponse);
reply.Xml.AppendLine(TranslatorTags.LongInvokeId, "Value", reply.Xml.IntegerToHex(invokeId, 8));
reply.Xml.AppendLine(TranslatorTags.DateTime, "Value", GXCommon.ToHex(tmp, false));
//access-request-specification OPTIONAL
reply.Data.GetUInt8();
len = GXCommon.GetObjectCount(reply.Data);
reply.Xml.AppendStartTag(TranslatorTags.AccessResponseBody);
reply.Xml.AppendStartTag(
TranslatorTags.AccessResponseListOfData, "Qty",
reply.Xml.IntegerToHex(len, 2));
for (int pos = 0; pos != len; ++pos)
{
if (reply.Xml.OutputType == TranslatorOutputType.StandardXml)
{
reply.Xml.AppendStartTag(Command.WriteRequest,
SingleReadResponse.Data);
}
GXDataInfo di = new GXDataInfo();
di.xml = reply.Xml;
GXCommon.GetData(settings, reply.Data, di);
if (reply.Xml.OutputType == TranslatorOutputType.StandardXml)
{
reply.Xml.AppendEndTag(Command.WriteRequest,
SingleReadResponse.Data);
}
}
reply.Xml.AppendEndTag(TranslatorTags.AccessResponseListOfData);
//access-response-specification
int err;
len = GXCommon.GetObjectCount(reply.Data);
reply.Xml.AppendStartTag(TranslatorTags.ListOfAccessResponseSpecification, "Qty", reply.Xml.IntegerToHex(len, 2));
for (int pos = 0; pos != len; ++pos)
{
AccessServiceCommandType type = (AccessServiceCommandType)reply.Data.GetUInt8();
err = reply.Data.GetUInt8();
if (err != 0)
{
err = reply.Data.GetUInt8();
}
reply.Xml.AppendStartTag(
TranslatorTags.AccessResponseSpecification);
reply.Xml.AppendStartTag(Command.AccessResponse, type);
reply.Xml.AppendLine(TranslatorTags.Result, null,
GXDLMSTranslator.ErrorCodeToString(reply.Xml.OutputType,
(ErrorCode)err));
reply.Xml.AppendEndTag(Command.AccessResponse, type);
reply.Xml.AppendEndTag(
TranslatorTags.AccessResponseSpecification);
}
reply.Xml.AppendEndTag(
TranslatorTags.ListOfAccessResponseSpecification);
reply.Xml.AppendEndTag(TranslatorTags.AccessResponseBody);
reply.Xml.AppendEndTag(Command.AccessResponse);
}
else
{
//Skip access-request-specification
reply.Data.GetUInt8();
}
}
///
///<summary>Handle read request.
/// </summary>
///<returns> Reply to the client. </returns>
///
private byte[][] HandleReadRequest()
{
GXByteBuffer data = Reply.Data;
short type;
object value = null;
GXByteBuffer bb = new GXByteBuffer();
int cnt = GXCommon.GetObjectCount(data);
GXCommon.SetObjectCount(cnt, bb);
GXSNInfo info;
for (int pos = 0; pos != cnt; ++pos)
{
type = data.GetUInt8();
// GetRequest normal
if (type == 2)
{
int sn = data.GetUInt16();
info = FindSNObject(sn);
if (!info.IsAction)
{
ValueEventArgs e = new ValueEventArgs(info.Item, info.Index, 0, null);
Read(e);
if (e.Handled)
{
value = e.Value;
}
else
{
value = (info.Item as IGXDLMSBase).GetValue(Settings, info.Index, 0, null);
}
// Set status.
bb.SetUInt8(0);
GXDLMS.AppedData(info.Item, info.Index, bb, value);
}
else
{
ValueEventArgs e = new ValueEventArgs(info.Item, info.Index, 0, null);
Action(e);
if (e.Handled)
{
value = e.Value;
}
else
{
value = ((IGXDLMSBase)info.Item).Invoke(Settings, info.Index, null);
}
// Set status.
bb.SetUInt8(0);
// Add value
bb.SetUInt8(GXCommon.GetValueType(value));
bb.Add(value);
}
}
else if (type == 2)
{
// Get request for next data block
throw new System.ArgumentException("TODO: Invalid Command.");
}
else if (type == 4)
{
// Parameterised access.
int sn = data.GetUInt16();
int selector = data.GetUInt8();
GXDataInfo di = new GXDataInfo();
object parameters = GXCommon.GetData(data, di);
info = FindSNObject(sn);
if (!info.IsAction)
{
ValueEventArgs e = new ValueEventArgs(info.Item, info.Index, 0, parameters);
Read(e);
if (e.Handled)
{
value = e.Value;
}
else
{
value = (info.Item as IGXDLMSBase).GetValue(Settings, info.Index, selector, parameters);
}
// Set status.
bb.SetUInt8(0);
GXDLMS.AppedData(info.Item, info.Index, bb, value);
}
else
{
ValueEventArgs e = new ValueEventArgs(info.Item, info.Index, 0, parameters);
e.Value = parameters;
Action(e);
if (e.Handled)
{
value = e.Value;
}
else
{
value = ((IGXDLMSBase)info.Item).Invoke(Settings, info.Index, parameters);
}
// Add value
bb.Add(value);
}
}
else
{
throw new System.ArgumentException("Invalid Command.");
}
}
return(GXDLMS.SplitPdu(Settings, Command.ReadResponse, 1, bb,
ErrorCode.Ok, DateTime.MinValue)[0]);
}
private static void HandleSetRequestNormal(GXDLMSSettings settings, GXDLMSServer server, GXByteBuffer data, byte type, GXDLMSLNParameters p, GXByteBuffer replyData, GXDLMSTranslatorStructure xml)
{
object value = null;
GXDataInfo reply = new GXDataInfo();
// CI
ObjectType ci = (ObjectType)data.GetUInt16();
byte[] ln = new byte[6];
data.Get(ln);
// Attribute index.
byte index = data.GetUInt8();
// Get Access Selection.
data.GetUInt8();
if (xml != null)
{
AppendAttributeDescriptor(xml, (int)ci, ln, index);
xml.AppendStartTag(TranslatorTags.Value);
GXDataInfo di = new GXDataInfo();
di.xml = xml;
value = GXCommon.GetData(settings, data, di);
if (!di.Complete)
{
value = GXCommon.ToHex(data.Data, false, data.Position, data.Size - data.Position);
}
else if (value is byte[])
{
value = GXCommon.ToHex((byte[])value, false);
}
xml.AppendEndTag(TranslatorTags.Value);
return;
}
if (type == 2)
{
p.multipleBlocks = data.GetUInt8() == 0;
UInt32 blockNumber = data.GetUInt32();
if (blockNumber != settings.BlockIndex)
{
Debug.WriteLine("HandleSetRequest failed. Invalid block number. " + settings.BlockIndex + "/" + blockNumber);
p.status = (byte)ErrorCode.DataBlockNumberInvalid;
return;
}
settings.IncreaseBlockIndex();
int size = GXCommon.GetObjectCount(data);
int realSize = data.Size - data.Position;
if (size != realSize)
{
Debug.WriteLine("HandleSetRequest failed. Invalid block size.");
p.status = (byte)ErrorCode.DataBlockUnavailable;
return;
}
}
if (!p.multipleBlocks)
{
settings.ResetBlockIndex();
value = GXCommon.GetData(settings, data, reply);
}
GXDLMSObject obj = settings.Objects.FindByLN(ci, GXDLMSObject.ToLogicalName(ln));
if (obj == null)
{
obj = server.NotifyFindObject(ci, 0, GXDLMSObject.ToLogicalName(ln));
}
// If target is unknown.
if (obj == null)
{
// Device reports a undefined object.
p.status = (byte)ErrorCode.UndefinedObject;
}
else
{
AccessMode am = obj.GetAccess(index);
// If write is denied.
if (am != AccessMode.Write && am != AccessMode.ReadWrite)
{
//Read Write denied.
p.status = (byte)ErrorCode.ReadWriteDenied;
}
else
{
try
{
if (value is byte[])
{
DataType dt = (obj as IGXDLMSBase).GetDataType(index);
if (dt != DataType.None && dt != DataType.OctetString)
{
value = GXDLMSClient.ChangeType((byte[])value, dt);
}
}
ValueEventArgs e = new ValueEventArgs(settings, obj, index, 0, null);
e.Value = value;
ValueEventArgs[] list = new ValueEventArgs[] { e };
if (p.multipleBlocks)
{
server.transaction = new GXDLMSLongTransaction(list, Command.GetRequest, data);
}
server.NotifyWrite(list);
if (e.Error != 0)
{
p.status = (byte)e.Error;
}
else if (!e.Handled && !p.multipleBlocks)
{
(obj as IGXDLMSBase).SetValue(settings, e);
}
}
catch (Exception)
{
p.status = (byte)ErrorCode.HardwareFault;
}
}
}
}
/// <summary>
/// Handle read response and get data from block and/or update error status.
/// </summary>
/// <param name="reply">Received data from the client.</param>
static bool HandleReadResponse(GXDLMSSettings settings, GXReplyData reply, int index)
{
int cnt = GXCommon.GetObjectCount(reply.Data);
//Set total count if not set yet.
if (reply.TotalCount == 0)
{
reply.TotalCount = cnt;
}
SingleReadResponse type = SingleReadResponse.Data;
List<object> values = null;
if (cnt != 1)
{
values = new List<object>();
}
if (reply.Xml != null)
{
reply.Xml.AppendStartTag(Command.ReadResponse, "Qty", reply.Xml.IntegerToHex(cnt, 2));
}
for (int pos = 0; pos != cnt; ++pos)
{
//Some meters are returning wrong count.
if (reply.Xml != null && reply.Data.Position == reply.Data.Size)
{
}
else
{
// Get status code.
if (reply.Data.Position == reply.ReadPosition)
{
reply.TotalCount = 0;
reply.Data.Position = index;
GetDataFromBlock(reply.Data, 0);
reply.Value = null;
//Ask that data is parsed after last block is received.
reply.CommandType = (byte)SingleReadResponse.DataBlockResult;
return false;
}
reply.CommandType = reply.Data.GetUInt8();
type = (SingleReadResponse)reply.CommandType;
}
switch (type)
{
case SingleReadResponse.Data:
reply.Error = 0;
if (reply.Xml != null)
{
if (reply.Xml.OutputType == TranslatorOutputType.StandardXml)
{
reply.Xml.AppendStartTag(TranslatorTags.Choice);
}
reply.Xml.AppendStartTag(Command.ReadResponse, SingleReadResponse.Data);
GXDataInfo di = new GXDataInfo();
di.xml = reply.Xml;
GXCommon.GetData(settings, reply.Data, di);
reply.Xml.AppendEndTag(Command.ReadResponse, SingleReadResponse.Data);
if (reply.Xml.OutputType == TranslatorOutputType.StandardXml)
{
reply.Xml.AppendEndTag(TranslatorTags.Choice);
}
}
else if (cnt == 1)
{
GetDataFromBlock(reply.Data, 0);
}
else
{
reply.ReadPosition = reply.Data.Position;
GetValueFromData(settings, reply);
if (reply.Data.Position == reply.ReadPosition)
{
//If multiple values remove command.
if (cnt != 1 && reply.TotalCount == 0)
{
++index;
}
reply.TotalCount = 0;
reply.Data.Position = index;
GetDataFromBlock(reply.Data, 0);
reply.Value = null;
//Ask that data is parsed after last block is received.
reply.CommandType = (byte)SingleReadResponse.DataBlockResult;
return false;
}
reply.Data.Position = reply.ReadPosition;
values.Add(reply.Value);
reply.Value = null;
}
break;
case SingleReadResponse.DataAccessError:
// Get error code.
reply.Error = reply.Data.GetUInt8();
if (reply.Xml != null)
{
if (reply.Xml.OutputType == TranslatorOutputType.StandardXml)
{
reply.Xml.AppendStartTag(TranslatorTags.Choice);
}
reply.Xml.AppendLine(
(int)Command.ReadResponse << 8
| (int)SingleReadResponse.DataAccessError,
null,
GXDLMSTranslator.ErrorCodeToString(
reply.Xml.OutputType,
(ErrorCode)reply.Error));
if (reply.Xml.OutputType == TranslatorOutputType.StandardXml)
{
reply.Xml.AppendEndTag(TranslatorTags.Choice);
}
//reply.Xml.AppendLine("<" + SingleReadResponse.DataAccessError.ToString() + " Value=\"" + ((ErrorCode)reply.Error).ToString() + "\" />");
}
break;
case SingleReadResponse.DataBlockResult:
if (!ReadResponseDataBlockResult(settings, reply, index))
{
//If xml only received bytes are shown. Data is not try to parse.
if (reply.Xml != null)
{
reply.Xml.AppendEndTag(Command.ReadResponse);
}
return false;
}
break;
case SingleReadResponse.BlockNumber:
// Get Block number.
UInt32 number = reply.Data.GetUInt16();
if (number != settings.BlockIndex)
{
throw new ArgumentException(
"Invalid Block number. It is " + number
+ " and it should be " + settings.BlockIndex + ".");
}
settings.IncreaseBlockIndex();
reply.MoreData = (RequestTypes)(reply.MoreData | RequestTypes.DataBlock);
break;
default:
throw new GXDLMSException("HandleReadResponse failed. Invalid tag.");
}
}
if (reply.Xml != null)
{
reply.Xml.AppendEndTag(Command.ReadResponse);
return true;
}
if (values != null)
{
reply.Value = values.ToArray();
}
return cnt == 1;
}
///<summary>
/// Handle action request.
///</summary>
public static void HandleMethodRequest(GXDLMSSettings settings, GXDLMSServer server, GXByteBuffer data, GXDLMSConnectionEventArgs connectionInfo, GXByteBuffer replyData, GXDLMSTranslatorStructure xml)
{
ErrorCode error = ErrorCode.Ok;
GXByteBuffer bb = new GXByteBuffer();
// Get type.
ActionRequestType type = (ActionRequestType)data.GetUInt8();
// Get invoke ID and priority.
byte invokeId = data.GetUInt8();
settings.UpdateInvokeId(invokeId);
// CI
ObjectType ci = (ObjectType)data.GetUInt16();
byte[] ln = new byte[6];
data.Get(ln);
// Attribute Id
byte id = data.GetUInt8();
// Get parameters.
object parameters = null;
byte selection = data.GetUInt8();
if (xml != null)
{
xml.AppendStartTag(Command.MethodRequest);
if (type == ActionRequestType.Normal)
{
xml.AppendStartTag(Command.MethodRequest, ActionRequestType.Normal);
xml.AppendLine(TranslatorTags.InvokeId, "Value", xml.IntegerToHex(invokeId, 2));
AppendMethodDescriptor(xml, (int)ci, ln, id);
if (selection != 0)
{
//MethodInvocationParameters
xml.AppendStartTag(TranslatorTags.MethodInvocationParameters);
GXDataInfo di = new GXDataInfo();
di.xml = xml;
GXCommon.GetData(settings, data, di);
xml.AppendEndTag(TranslatorTags.MethodInvocationParameters);
}
xml.AppendEndTag(Command.MethodRequest, ActionRequestType.Normal);
}
xml.AppendEndTag(Command.MethodRequest);
return;
}
if (selection != 0)
{
GXDataInfo info = new GXDataInfo();
parameters = GXCommon.GetData(settings, data, info);
}
GXDLMSObject obj = settings.Objects.FindByLN(ci, GXCommon.ToLogicalName(ln));
if (settings.Connected == ConnectionState.None && !settings.CanAccess() && (ci != ObjectType.AssociationLogicalName || id != 1))
{
replyData.Set(GXDLMSServer.GenerateConfirmedServiceError(ConfirmedServiceError.InitiateError,
ServiceError.Service, (byte)Service.Unsupported));
return;
}
if (obj == null)
{
obj = server.NotifyFindObject(ci, 0, GXCommon.ToLogicalName(ln));
}
if (obj == null)
{
// Device reports a undefined object.
error = ErrorCode.UndefinedObject;
}
else
{
ValueEventArgs e = new ValueEventArgs(server, obj, id, 0, parameters);
e.InvokeId = invokeId;
if (server.NotifyGetMethodAccess(e) == MethodAccessMode.NoAccess)
{
error = ErrorCode.ReadWriteDenied;
}
else
{
server.NotifyAction(new ValueEventArgs[] { e });
byte[] actionReply;
if (e.Handled)
{
actionReply = (byte[])e.Value;
}
else
{
actionReply = (obj as IGXDLMSBase).Invoke(settings, e);
server.NotifyPostAction(new ValueEventArgs[] { e });
}
//Set default action reply if not given.
if (actionReply != null && e.Error == 0)
{
//Add return parameters
bb.SetUInt8(1);
//Add parameters error code.
bb.SetUInt8(0);
GXCommon.SetData(settings, bb, GXDLMSConverter.GetDLMSDataType(actionReply), actionReply);
}
else
{
error = e.Error;
//Add return parameters
bb.SetUInt8(0);
}
}
invokeId = (byte)e.InvokeId;
}
GXDLMSLNParameters p = new GXDLMSLNParameters(null, settings, invokeId, Command.MethodResponse, 1, null, bb, (byte)error);
GXDLMS.GetLNPdu(p, replyData);
//If High level authentication fails.
if (obj is GXDLMSAssociationLogicalName && id == 1)
{
if ((obj as GXDLMSAssociationLogicalName).AssociationStatus == Objects.Enums.AssociationStatus.Associated)
{
server.NotifyConnected(connectionInfo);
settings.Connected |= ConnectionState.Dlms;
}
else
{
server.NotifyInvalidConnection(connectionInfo);
settings.Connected &= ~ConnectionState.Dlms;
}
}
}
///<summary>
/// Handle write request.
///</summary>
public static void HandleWriteRequest(GXDLMSSettings settings, GXDLMSServer server, GXByteBuffer data,
GXByteBuffer replyData, GXDLMSTranslatorStructure xml)
{
//Return error if connection is not established.
if (xml == null && !settings.Connected)
{
replyData.Add(GXDLMSServer.GenerateConfirmedServiceError(ConfirmedServiceError.InitiateError,
ServiceError.Service, (byte)Service.Unsupported));
return;
}
short type;
object value;
// Get object count.
List <GXSNInfo> targets = new List <GXSNInfo>();
int cnt = GXCommon.GetObjectCount(data);
if (xml != null)
{
xml.AppendStartTag(Command.WriteRequest);
xml.AppendStartTag(
TranslatorTags.ListOfVariableAccessSpecification, "Qty",
xml.IntegerToHex(cnt, 2));
if (xml.OutputType == TranslatorOutputType.StandardXml)
{
xml.AppendStartTag(
TranslatorTags.VariableAccessSpecification);
}
}
GXByteBuffer results = new GXByteBuffer((ushort)cnt);
for (int pos = 0; pos != cnt; ++pos)
{
type = data.GetUInt8();
if (type == (byte)VariableAccessSpecification.VariableName)
{
int sn = data.GetUInt16();
if (xml != null)
{
xml.AppendLine(
(int)Command.WriteRequest << 8
| (int)VariableAccessSpecification.VariableName,
"Value", xml.IntegerToHex(sn, 4));
}
else
{
GXSNInfo info = FindSNObject(server, sn);
targets.Add(info);
// If target is unknown.
if (info == null)
{
// Device reports a undefined object.
results.SetUInt8(ErrorCode.UndefinedObject);
}
else
{
results.SetUInt8(ErrorCode.Ok);
}
}
}
else if (type == (byte)VariableAccessSpecification.WriteDataBlockAccess)
{
HandleReadDataBlockAccess(settings, server, Command.WriteResponse, data, cnt, replyData, xml);
if (xml == null)
{
return;
}
}
else
{
// Device reports a HW error.
results.SetUInt8(ErrorCode.HardwareFault);
}
}
if (xml != null)
{
if (xml.OutputType == TranslatorOutputType.StandardXml)
{
xml.AppendEndTag(TranslatorTags.VariableAccessSpecification);
}
xml.AppendEndTag(
TranslatorTags.ListOfVariableAccessSpecification);
}
// Get data count.
cnt = GXCommon.GetObjectCount(data);
GXDataInfo di = new GXDataInfo();
di.xml = xml;
if (xml != null)
{
xml.AppendStartTag(TranslatorTags.ListOfData, "Qty", xml.IntegerToHex(cnt, 2));
}
for (int pos = 0; pos != cnt; ++pos)
{
di.Clear();
if (xml != null)
{
if (xml.OutputType == TranslatorOutputType.StandardXml)
{
xml.AppendStartTag(Command.WriteRequest,
SingleReadResponse.Data);
}
value = GXCommon.GetData(settings, data, di);
if (!di.Complete)
{
value = GXCommon.ToHex(data.Data, false,
data.Position, data.Size - data.Position);
xml.AppendLine(
GXDLMS.DATA_TYPE_OFFSET + (int)di.Type,
"Value", value.ToString());
}
if (xml.OutputType == TranslatorOutputType.StandardXml)
{
xml.AppendEndTag(Command.WriteRequest, SingleReadResponse.Data);
}
GXCommon.GetData(settings, data, di);
}
else if (results.GetUInt8(pos) == 0)
{
// If object has found.
GXSNInfo target = targets[pos];
value = GXCommon.GetData(settings, data, di);
if (value is byte[])
{
DataType dt = target.Item.GetDataType(target.Index);
if (dt != DataType.None && dt != DataType.OctetString)
{
value = GXDLMSClient.ChangeType((byte[])value, dt, settings.UseUtc2NormalTime);
}
}
ValueEventArgs e = new ValueEventArgs(server, target.Item, target.Index, 0, null);
AccessMode am = server.NotifyGetAttributeAccess(e);
// If write is denied.
if (am != AccessMode.Write && am != AccessMode.ReadWrite)
{
results.SetUInt8((byte)pos, (byte)ErrorCode.ReadWriteDenied);
}
else
{
e.Value = value;
server.NotifyWrite(new ValueEventArgs[] { e });
if (e.Error != 0)
{
results.SetUInt8((byte)pos, (byte)e.Error);
}
else if (!e.Handled)
{
(target.Item as IGXDLMSBase).SetValue(settings, e);
server.NotifyPostWrite(new ValueEventArgs[] { e });
}
}
}
}
if (xml != null)
{
xml.AppendEndTag(TranslatorTags.ListOfData);
xml.AppendEndTag(Command.WriteRequest);
return;
}
GenerateWriteResponse(settings, results, replyData);
}
/// <summary>
/// Handle get request with list command.
/// </summary>
/// <param name="data">Received data.</param>
private static void GetRequestWithList(GXDLMSSettings settings, byte invokeID, GXDLMSServer server, GXByteBuffer data, GXByteBuffer replyData, GXDLMSTranslatorStructure xml)
{
ValueEventArgs e;
GXByteBuffer bb = new GXByteBuffer();
int pos;
int cnt = GXCommon.GetObjectCount(data);
GXCommon.SetObjectCount(cnt, bb);
List <ValueEventArgs> list = new List <ValueEventArgs>();
if (xml != null)
{
xml.AppendStartTag(TranslatorTags.AttributeDescriptorList, "Qty", xml.IntegerToHex(cnt, 2));
}
try
{
for (pos = 0; pos != cnt; ++pos)
{
ObjectType ci = (ObjectType)data.GetUInt16();
byte[] ln = new byte[6];
data.Get(ln);
short attributeIndex = data.GetUInt8();
// AccessSelection
int selection = data.GetUInt8();
int selector = 0;
object parameters = null;
if (selection != 0)
{
selector = data.GetUInt8();
GXDataInfo info = new GXDataInfo();
parameters = GXCommon.GetData(settings, data, info);
}
if (xml != null)
{
xml.AppendStartTag(TranslatorTags.AttributeDescriptorWithSelection);
xml.AppendStartTag(TranslatorTags.AttributeDescriptor);
xml.AppendComment(ci.ToString());
xml.AppendLine(TranslatorTags.ClassId, "Value", xml.IntegerToHex((int)ci, 4));
xml.AppendComment(GXCommon.ToLogicalName(ln));
xml.AppendLine(TranslatorTags.InstanceId, "Value", GXCommon.ToHex(ln, false));
xml.AppendLine(TranslatorTags.AttributeId, "Value", xml.IntegerToHex(attributeIndex, 2));
xml.AppendEndTag(TranslatorTags.AttributeDescriptor);
xml.AppendEndTag(TranslatorTags.AttributeDescriptorWithSelection);
}
else
{
GXDLMSObject obj = settings.Objects.FindByLN(ci, GXCommon.ToLogicalName(ln));
if (obj == null)
{
obj = server.NotifyFindObject(ci, 0, GXCommon.ToLogicalName(ln));
}
if (obj == null)
{
// "Access Error : Device reports a undefined object."
e = new ValueEventArgs(server, obj, attributeIndex, 0, 0);
e.Error = ErrorCode.UndefinedObject;
list.Add(e);
}
else
{
ValueEventArgs arg = new ValueEventArgs(server, obj, attributeIndex, selector, parameters);
arg.InvokeId = invokeID;
if (server.NotifyGetAttributeAccess(arg) == AccessMode.NoAccess)
{
//Read Write denied.
arg.Error = ErrorCode.ReadWriteDenied;
list.Add(arg);
}
else
{
list.Add(arg);
}
}
}
}
}
catch (Exception ex)
{
if (xml == null)
{
throw ex;
}
}
if (xml != null)
{
xml.AppendEndTag(TranslatorTags.AttributeDescriptorList);
return;
}
server.NotifyRead(list.ToArray());
object value;
pos = 0;
foreach (ValueEventArgs it in list)
{
try
{
if (it.Handled)
{
value = it.Value;
}
else
{
value = (it.Target as IGXDLMSBase).GetValue(settings, it);
}
bb.SetUInt8(it.Error);
if (it.ByteArray)
{
bb.Set((byte[])value);
}
else
{
GXDLMS.AppendData(settings, it.Target, it.Index, bb, value);
}
invokeID = (byte)it.InvokeId;
}
catch (Exception)
{
bb.SetUInt8((byte)ErrorCode.HardwareFault);
}
if (settings.Index != settings.Count)
{
server.transaction = new GXDLMSLongTransaction(list.ToArray(), Command.GetRequest, null);
}
++pos;
}
server.NotifyPostRead(list.ToArray());
GXDLMSLNParameters p = new GXDLMSLNParameters(null, settings, invokeID, Command.GetResponse, 3, null, bb, 0xFF);
GXDLMS.GetLNPdu(p, replyData);
}
private static void HanleSetRequestWithDataBlock(GXDLMSSettings settings, GXDLMSServer server, GXByteBuffer data, GXDLMSLNParameters p, GXByteBuffer replyData, GXDLMSTranslatorStructure xml)
{
GXDataInfo reply = new GXDataInfo();
p.multipleBlocks = data.GetUInt8() == 0;
UInt32 blockNumber = data.GetUInt32();
if (blockNumber != settings.BlockIndex)
{
Debug.WriteLine("HanleSetRequestWithDataBlock failed. Invalid block number. " + settings.BlockIndex + "/" + blockNumber);
p.status = (byte)ErrorCode.DataBlockNumberInvalid;
}
else
{
int size = GXCommon.GetObjectCount(data);
int realSize = data.Size - data.Position;
if (size != realSize)
{
Debug.WriteLine("HanleSetRequestWithDataBlock failed. Invalid block size.");
p.status = (byte)ErrorCode.DataBlockUnavailable;
}
server.transaction.data.Set(data);
//If all data is received.
if (!p.multipleBlocks)
{
try
{
object value = GXCommon.GetData(settings, server.transaction.data, reply);
if (value is byte[])
{
DataType dt = (server.transaction.targets[0].Target as IGXDLMSBase).GetDataType(server.transaction.targets[0].Index);
if (dt != DataType.None && dt != DataType.OctetString)
{
value = GXDLMSClient.ChangeType((byte[])value, dt);
}
}
server.transaction.targets[0].Value = value;
server.NotifyWrite(server.transaction.targets);
if (!server.transaction.targets[0].Handled && !p.multipleBlocks)
{
(server.transaction.targets[0].Target as IGXDLMSBase).SetValue(settings, server.transaction.targets[0]);
}
}
catch (Exception)
{
p.status = (byte)ErrorCode.HardwareFault;
}
finally
{
server.transaction = null;
}
settings.ResetBlockIndex();
}
}
p.multipleBlocks = true;
}
private static void HandleActionResponseNormal(GXDLMSSettings settings, GXReplyData data)
{
//Get Action-Result
byte ret = data.Data.GetUInt8();
if (data.Xml != null)
{
if (data.Xml
.OutputType == TranslatorOutputType.StandardXml)
{
data.Xml
.AppendStartTag(TranslatorTags.SingleResponse);
}
data.Xml.AppendLine(TranslatorTags.Result, null,
GXDLMSTranslator.ErrorCodeToString(
data.Xml.OutputType,
(ErrorCode)data.Error));
}
if (ret != 0)
{
data.Error = ret;
}
// Response normal. Get data if exists. Some meters do not return here anything.
if (data.Data.Position < data.Data.Size)
{
//Get-Data-Result
ret = data.Data.GetUInt8();
//If data.
if (ret == 0)
{
GetDataFromBlock(data.Data, 0);
}
else if (ret == 1) //Data-Access-Result
{
//Get Data-Access-Result
ret = data.Data.GetUInt8();
if (ret != 0)
{
data.Error = data.Data.GetUInt8();
//Handle Texas Instrument missing byte here.
if (ret == 9 && data.Error == 16)
{
data.Data.Position -= 2;
GetDataFromBlock(data.Data, 0);
data.Error = 0;
ret = 0;
}
}
else
{
GetDataFromBlock(data.Data, 0);
}
}
else
{
throw new GXDLMSException("parseApplicationAssociationResponse failed. Invalid tag.");
}
if (data.Xml != null)
{
data.Xml.AppendStartTag(TranslatorTags.ReturnParameters);
if (ret != 0)
{
data.Xml.AppendLine(
TranslatorTags.DataAccessError, null,
GXDLMSTranslator.ErrorCodeToString(
data.Xml.OutputType, (ErrorCode)
data.Error));
}
else
{
if (data.Error != 0)
{
data.Xml.AppendLine(TranslatorTags.Result,
null,
GXDLMSTranslator.ErrorCodeToString(
data.Xml.OutputType,
(ErrorCode)data.Error));
}
else
{
data.Xml.AppendStartTag(Command.ReadResponse,
SingleReadResponse.Data);
GXDataInfo di = new GXDataInfo();
di.xml = data.Xml;
GXCommon.GetData(settings, data.Data, di);
data.Xml.AppendEndTag(Command.ReadResponse,
SingleReadResponse.Data);
}
}
data.Xml.AppendEndTag(TranslatorTags.ReturnParameters);
if (data.Xml.OutputType == TranslatorOutputType.StandardXml)
{
data.Xml.AppendEndTag(TranslatorTags.SingleResponse);
}
}
}
}
/// <summary>
/// Handle get request normal command.
/// </summary>
/// <param name="data">Received data.</param>
private static void GetRequestNormal(GXDLMSSettings settings, byte invokeID, GXDLMSServer server, GXByteBuffer data, GXByteBuffer replyData, GXDLMSTranslatorStructure xml)
{
ValueEventArgs e = null;
GXByteBuffer bb = new GXByteBuffer();
// Get type.
ErrorCode status = ErrorCode.Ok;
settings.Count = settings.Index = 0;
settings.ResetBlockIndex();
// CI
ObjectType ci = (ObjectType)data.GetUInt16();
byte[] ln = new byte[6];
data.Get(ln);
// Attribute Id
byte attributeIndex = data.GetUInt8();
// AccessSelection
byte selection = data.GetUInt8();
byte selector = 0;
object parameters = null;
GXDataInfo info = new GXDataInfo();
if (selection != 0)
{
selector = data.GetUInt8();
}
if (xml != null)
{
AppendAttributeDescriptor(xml, (int)ci, ln, attributeIndex);
if (selection != 0)
{
info.xml = xml;
xml.AppendStartTag(TranslatorTags.AccessSelection);
xml.AppendLine(TranslatorTags.AccessSelector, "Value", xml.IntegerToHex(selector, 2));
xml.AppendStartTag(TranslatorTags.AccessParameters);
GXCommon.GetData(settings, data, info);
xml.AppendEndTag(TranslatorTags.AccessParameters);
xml.AppendEndTag(TranslatorTags.AccessSelection);
}
return;
}
if (selection != 0)
{
parameters = GXCommon.GetData(settings, data, info);
}
GXDLMSObject obj = settings.Objects.FindByLN(ci, GXCommon.ToLogicalName(ln));
if (obj == null)
{
obj = server.NotifyFindObject(ci, 0, GXCommon.ToLogicalName(ln));
}
e = new ValueEventArgs(server, obj, attributeIndex, selector, parameters);
e.InvokeId = invokeID;
if (obj == null)
{
// "Access Error : Device reports a undefined object."
status = ErrorCode.UndefinedObject;
}
else
{
if (server.NotifyGetAttributeAccess(e) == AccessMode.NoAccess)
{
//Read Write denied.
status = ErrorCode.ReadWriteDenied;
}
else
{
if (e.Target is GXDLMSProfileGeneric && attributeIndex == 2)
{
e.RowToPdu = GXDLMS.RowsToPdu(settings, (GXDLMSProfileGeneric)e.Target);
}
object value;
server.NotifyRead(new ValueEventArgs[] { e });
if (e.Handled)
{
value = e.Value;
}
else
{
settings.Count = e.RowEndIndex - e.RowBeginIndex;
value = (obj as IGXDLMSBase).GetValue(settings, e);
}
if (e.ByteArray)
{
bb.Set((byte[])value);
}
else
{
GXDLMS.AppendData(settings, obj, attributeIndex, bb, value);
}
server.NotifyPostRead(new ValueEventArgs[] { e });
status = e.Error;
}
}
GXDLMSLNParameters p = new GXDLMSLNParameters(null, settings, e.InvokeId, Command.GetResponse, 1, null, bb, (byte)status);
GXDLMS.GetLNPdu(p, replyData);
if (settings.Count != settings.Index || bb.Size != bb.Position)
{
server.transaction = new GXDLMSLongTransaction(new ValueEventArgs[] { e }, Command.GetRequest, bb);
}
}
///<summary>
/// Handle Access request.
///</summary>
///<param name="Reply">
/// Received data from the client.
/// </param>
///<returns>
/// Reply.
///</returns>
public static void HandleAccessRequest(GXDLMSSettings settings, GXDLMSServer server, GXByteBuffer data,
GXByteBuffer reply, GXDLMSTranslatorStructure xml)
{
//Return error if connection is not established.
if (xml == null && !settings.Connected)
{
reply.Set(GXDLMSServer.GenerateConfirmedServiceError(ConfirmedServiceError.InitiateError,
ServiceError.Service, (byte)Service.Unsupported));
return;
}
//Get long invoke id and priority.
UInt32 invokeId = data.GetUInt32();
int len = GXCommon.GetObjectCount(data);
byte[] tmp = null;
// If date time is given.
if (len != 0)
{
tmp = new byte[len];
data.Get(tmp);
if (xml == null)
{
DataType dt = DataType.DateTime;
if (len == 4)
{
dt = DataType.Time;
}
else if (len == 5)
{
dt = DataType.Date;
}
GXDataInfo info = new GXDataInfo();
info.Type = dt;
GXCommon.GetData(settings, new GXByteBuffer(tmp), info);
}
}
// Get object count.
int cnt = GXCommon.GetObjectCount(data);
if (xml != null)
{
xml.AppendStartTag(Command.AccessRequest);
xml.AppendLine(TranslatorTags.LongInvokeId, "Value", xml.IntegerToHex(invokeId, 2));
xml.AppendLine(TranslatorTags.DateTime, "Value", GXCommon.ToHex(tmp, false));
xml.AppendStartTag(TranslatorTags.AccessRequestBody);
xml.AppendStartTag(TranslatorTags.ListOfAccessRequestSpecification, "Qty",
xml.IntegerToHex(cnt, 2));
}
AccessServiceCommandType type;
for (int pos = 0; pos != cnt; ++pos)
{
type = (AccessServiceCommandType)data.GetUInt8();
if (!(type == AccessServiceCommandType.Get ||
type == AccessServiceCommandType.Set ||
type == AccessServiceCommandType.Action))
{
throw new ArgumentException("Invalid access service command type.");
}
// CI
ObjectType ci = (ObjectType)data.GetUInt16();
byte[] ln = new byte[6];
data.Get(ln);
// Attribute Id
byte attributeIndex = data.GetUInt8();
if (xml != null)
{
xml.AppendStartTag(TranslatorTags.AccessRequestSpecification);
xml.AppendStartTag(Command.AccessRequest, type);
AppendAttributeDescriptor(xml, (int)ci, ln, attributeIndex);
xml.AppendEndTag(Command.AccessRequest, type);
xml.AppendEndTag(TranslatorTags.AccessRequestSpecification);
}
}
if (xml != null)
{
xml.AppendEndTag(TranslatorTags.ListOfAccessRequestSpecification);
xml.AppendStartTag(TranslatorTags.AccessRequestListOfData, "Qty", xml.IntegerToHex(cnt, 2));
}
// Get data count.
cnt = GXCommon.GetObjectCount(data);
for (int pos = 0; pos != cnt; ++pos)
{
GXDataInfo di = new GXDataInfo();
di.xml = xml;
if (xml != null && xml.OutputType == TranslatorOutputType.StandardXml)
{
xml.AppendStartTag(Command.WriteRequest, SingleReadResponse.Data);
}
object value = GXCommon.GetData(settings, data, di);
if (!di.Complete)
{
value = GXCommon.ToHex(data.Data, false, data.Position, data.Size - data.Position);
}
else if (value is byte[])
{
value = GXCommon.ToHex((byte[])value, false);
}
if (xml != null && xml
.OutputType == TranslatorOutputType.StandardXml)
{
xml.AppendEndTag(Command.WriteRequest, SingleReadResponse.Data);
}
}
if (xml != null)
{
xml.AppendEndTag(TranslatorTags.AccessRequestListOfData);
xml.AppendEndTag(TranslatorTags.AccessRequestBody);
xml.AppendEndTag(Command.AccessRequest);
}
}
private static void HandleSetRequestNormal(GXDLMSSettings settings, GXDLMSServer server, GXByteBuffer data, byte type, GXDLMSLNParameters p, GXByteBuffer replyData, GXDLMSTranslatorStructure xml)
{
object value = null;
GXDataInfo reply = new GXDataInfo();
// CI
ObjectType ci = (ObjectType)data.GetUInt16();
byte[] ln = new byte[6];
data.Get(ln);
// Attribute index.
byte index = data.GetUInt8();
// Get Access Selection.
data.GetUInt8();
if (type == 2)
{
byte lastBlock = data.GetUInt8();
p.multipleBlocks = lastBlock == 0;
UInt32 blockNumber = data.GetUInt32();
if (blockNumber != settings.BlockIndex)
{
Debug.WriteLine("HandleSetRequest failed. Invalid block number. " + settings.BlockIndex + "/" + blockNumber);
p.status = (byte)ErrorCode.DataBlockNumberInvalid;
return;
}
settings.IncreaseBlockIndex();
int size = GXCommon.GetObjectCount(data);
int realSize = data.Size - data.Position;
if (size != realSize)
{
Debug.WriteLine("HandleSetRequest failed. Invalid block size.");
p.status = (byte)ErrorCode.DataBlockUnavailable;
return;
}
if (xml != null)
{
AppendAttributeDescriptor(xml, (int)ci, ln, index);
xml.AppendStartTag(TranslatorTags.DataBlock);
xml.AppendLine(TranslatorTags.LastBlock, "Value", xml.IntegerToHex(lastBlock, 2));
xml.AppendLine(TranslatorTags.BlockNumber, "Value", xml.IntegerToHex(blockNumber, 8));
xml.AppendLine(TranslatorTags.RawData, "Value", data.RemainingHexString(false));
xml.AppendEndTag(TranslatorTags.DataBlock);
}
return;
}
if (xml != null)
{
AppendAttributeDescriptor(xml, (int)ci, ln, index);
xml.AppendStartTag(TranslatorTags.Value);
GXDataInfo di = new GXDataInfo();
di.xml = xml;
value = GXCommon.GetData(settings, data, di);
if (!di.Complete)
{
value = GXCommon.ToHex(data.Data, false, data.Position, data.Size - data.Position);
}
else if (value is byte[])
{
value = GXCommon.ToHex((byte[])value, false);
}
xml.AppendEndTag(TranslatorTags.Value);
return;
}
if (!p.multipleBlocks)
{
settings.ResetBlockIndex();
value = GXCommon.GetData(settings, data, reply);
}
GXDLMSObject obj = settings.Objects.FindByLN(ci, GXCommon.ToLogicalName(ln));
if (obj == null)
{
obj = server.NotifyFindObject(ci, 0, GXCommon.ToLogicalName(ln));
}
// If target is unknown.
if (obj == null)
{
// Device reports a undefined object.
p.status = (byte)ErrorCode.UndefinedObject;
}
else
{
ValueEventArgs e = new ValueEventArgs(server, obj, index, 0, null);
e.InvokeId = p.InvokeId;
AccessMode am = server.NotifyGetAttributeAccess(e);
// If write is denied.
if (am != AccessMode.Write && am != AccessMode.ReadWrite)
{
//Read Write denied.
p.status = (byte)ErrorCode.ReadWriteDenied;
}
else
{
try
{
if (value is byte[])
{
DataType dt = (obj as IGXDLMSBase).GetDataType(index);
if (dt != DataType.None && dt != DataType.OctetString && dt != DataType.Structure)
{
value = GXDLMSClient.ChangeType((byte[])value, dt, settings.UseUtc2NormalTime);
}
}
e.Value = value;
ValueEventArgs[] list = new ValueEventArgs[] { e };
if (p.multipleBlocks)
{
server.transaction = new GXDLMSLongTransaction(list, Command.GetRequest, data);
}
server.NotifyWrite(list);
if (e.Error != 0)
{
p.status = (byte)e.Error;
}
else if (!e.Handled && !p.multipleBlocks)
{
(obj as IGXDLMSBase).SetValue(settings, e);
server.NotifyPostWrite(list);
if (e.Error != 0)
{
p.status = (byte)e.Error;
}
}
p.InvokeId = e.InvokeId;
}
catch (Exception)
{
p.status = (byte)ErrorCode.HardwareFault;
}
}
}
}
///<summary>
/// Handle write request.
///</summary>
///<param name="Reply">
/// Received data from the client.
/// </param>
///<returns>
/// Reply.
///</returns>
private byte[][] HandleWriteRequest()
{
GXByteBuffer data = Reply.Data;
short type;
object value;
// Get object count.
IList <GXSNInfo> targets = new List <GXSNInfo>();
int cnt = GXCommon.GetObjectCount(data);
GXByteBuffer results = new GXByteBuffer((ushort)cnt);
for (int pos = 0; pos != cnt; ++pos)
{
type = data.GetUInt8();
if (type == 2)
{
int sn = data.GetUInt16();
GXSNInfo info = FindSNObject(sn);
targets.Add(info);
// If target is unknown.
if (info == null)
{
// Device reports a undefined object.
results.SetUInt8(ErrorCode.UndefinedObject);
}
else
{
results.SetUInt8(ErrorCode.Ok);
}
}
else
{
// Device reports a HW error.
results.SetUInt8(ErrorCode.HardwareFault);
}
}
// Get data count.
cnt = GXCommon.GetObjectCount(data);
GXDataInfo di = new GXDataInfo();
for (int pos = 0; pos != cnt; ++pos)
{
if (results.GetUInt8(pos) == 0)
{
// If object has found.
GXSNInfo target = targets[pos];
value = GXCommon.GetData(data, di);
if (value is byte[])
{
DataType dt = target.Item.GetDataType(target.Index);
if (dt != DataType.None && dt != DataType.OctetString)
{
value = GXDLMSClient.ChangeType((byte[])value, dt);
}
}
di.Clear();
AccessMode am = target.Item.GetAccess(target.Index);
// If write is denied.
if (am != AccessMode.Write && am != AccessMode.ReadWrite)
{
results.SetUInt8((byte)pos, (byte)ErrorCode.ReadWriteDenied);
}
else
{
ValueEventArgs e = new ValueEventArgs(target.Item, target.Index, 0, null);
e.Value = value;
Write(e);
if (!e.Handled)
{
(target.Item as IGXDLMSBase).SetValue(Settings, target.Index, value);
}
}
}
}
GXByteBuffer bb = new GXByteBuffer((UInt16)(2 * cnt + 2));
GXCommon.SetObjectCount(cnt, bb);
byte ret;
for (int pos = 0; pos != cnt; ++pos)
{
ret = results.GetUInt8(pos);
// If meter returns error.
if (ret != 0)
{
bb.SetUInt8(1);
}
bb.SetUInt8(ret);
}
return(GXDLMS.SplitPdu(Settings, Command.WriteResponse, 1, bb, ErrorCode.Ok, DateTime.MinValue)[0]);
}
///<summary>
/// Handle Access request.
///</summary>
public static void HandleAccessRequest(GXDLMSSettings settings, GXDLMSServer server, GXByteBuffer data,
GXByteBuffer reply, GXDLMSTranslatorStructure xml)
{
//Return error if connection is not established.
if (xml == null && settings.Connected == ConnectionState.None && !settings.CanAccess())
{
reply.Set(GXDLMSServer.GenerateConfirmedServiceError(ConfirmedServiceError.InitiateError,
ServiceError.Service, (byte)Service.Unsupported));
return;
}
//Get long invoke id and priority.
UInt32 invokeId = data.GetUInt32();
settings.longInvokeID = invokeId;
int len = GXCommon.GetObjectCount(data);
byte[] tmp = null;
// If date time is given.
if (len != 0)
{
tmp = new byte[len];
data.Get(tmp);
if (xml == null)
{
DataType dt = DataType.DateTime;
if (len == 4)
{
dt = DataType.Time;
}
else if (len == 5)
{
dt = DataType.Date;
}
GXDataInfo info = new GXDataInfo();
info.Type = dt;
GXCommon.GetData(settings, new GXByteBuffer(tmp), info);
}
}
// Get object count.
int cnt = GXCommon.GetObjectCount(data);
if (xml != null)
{
xml.AppendStartTag(Command.AccessRequest);
xml.AppendLine(TranslatorTags.LongInvokeId, "Value", xml.IntegerToHex(invokeId, 2));
xml.AppendLine(TranslatorTags.DateTime, "Value", GXCommon.ToHex(tmp, false));
xml.AppendStartTag(TranslatorTags.AccessRequestBody);
xml.AppendStartTag(TranslatorTags.ListOfAccessRequestSpecification, "Qty",
xml.IntegerToHex(cnt, 2));
}
AccessServiceCommandType type;
for (int pos = 0; pos != cnt; ++pos)
{
type = (AccessServiceCommandType)data.GetUInt8();
if (!(type == AccessServiceCommandType.Get ||
type == AccessServiceCommandType.Set ||
type == AccessServiceCommandType.Action))
{
throw new ArgumentException("Invalid access service command type.");
}
// CI
ObjectType ci = (ObjectType)data.GetUInt16();
byte[] ln = new byte[6];
data.Get(ln);
// Attribute Id
byte attributeIndex = data.GetUInt8();
if (xml != null)
{
xml.AppendStartTag(TranslatorTags.AccessRequestSpecification);
xml.AppendStartTag(Command.AccessRequest, type);
AppendAttributeDescriptor(xml, (int)ci, ln, attributeIndex);
xml.AppendEndTag(Command.AccessRequest, type);
xml.AppendEndTag(TranslatorTags.AccessRequestSpecification);
}
}
if (xml != null)
{
xml.AppendEndTag(TranslatorTags.ListOfAccessRequestSpecification);
xml.AppendStartTag(TranslatorTags.AccessRequestListOfData, "Qty", xml.IntegerToHex(cnt, 2));
}
// Get data count.
cnt = GXCommon.GetObjectCount(data);
for (int pos = 0; pos != cnt; ++pos)
{
GXDataInfo di = new GXDataInfo();
di.xml = xml;
if (xml != null && xml.OutputType == TranslatorOutputType.StandardXml)
{
xml.AppendStartTag(Command.WriteRequest, SingleReadResponse.Data);
}
object value = GXCommon.GetData(settings, data, di);
if (!di.Complete)
{
value = GXCommon.ToHex(data.Data, false, data.Position, data.Size - data.Position);
}
else if (value is byte[])
{
value = GXCommon.ToHex((byte[])value, false);
}
if (xml != null && xml
.OutputType == TranslatorOutputType.StandardXml)
{
xml.AppendEndTag(Command.WriteRequest, SingleReadResponse.Data);
}
}
if (xml != null)
{
xml.AppendEndTag(TranslatorTags.AccessRequestListOfData);
xml.AppendEndTag(TranslatorTags.AccessRequestBody);
xml.AppendEndTag(Command.AccessRequest);
}
}
///<summary>
/// Handle write request.
///</summary>
///<param name="Reply">
/// Received data from the client.
/// </param>
///<returns>
/// Reply.
///</returns>
public static void HandleWriteRequest(GXDLMSSettings settings, GXDLMSServer server, GXByteBuffer data,
GXByteBuffer replyData, GXDLMSTranslatorStructure xml)
{
//Return error if connection is not established.
if (xml == null && !settings.Connected)
{
replyData.Add(GXDLMSServer.GenerateConfirmedServiceError(ConfirmedServiceError.InitiateError,
ServiceError.Service, (byte)Service.Unsupported));
return;
}
short type;
object value;
// Get object count.
List<GXSNInfo> targets = new List<GXSNInfo>();
int cnt = GXCommon.GetObjectCount(data);
if (xml != null)
{
xml.AppendStartTag(Command.WriteRequest);
xml.AppendStartTag(
TranslatorTags.ListOfVariableAccessSpecification, "Qty",
xml.IntegerToHex(cnt, 2));
if (xml.OutputType == TranslatorOutputType.StandardXml)
{
xml.AppendStartTag(
TranslatorTags.VariableAccessSpecification);
}
}
GXByteBuffer results = new GXByteBuffer((ushort)cnt);
for (int pos = 0; pos != cnt; ++pos)
{
type = data.GetUInt8();
if (type == (byte)VariableAccessSpecification.VariableName)
{
int sn = data.GetUInt16();
if (xml != null)
{
xml.AppendLine(
(int)Command.WriteRequest << 8
| (int)VariableAccessSpecification.VariableName,
"Value", xml.IntegerToHex(sn, 4));
}
else
{
GXSNInfo info = FindSNObject(server, sn);
targets.Add(info);
// If target is unknown.
if (info == null)
{
// Device reports a undefined object.
results.SetUInt8(ErrorCode.UndefinedObject);
}
else
{
results.SetUInt8(ErrorCode.Ok);
}
}
}
else if (type == (byte)VariableAccessSpecification.WriteDataBlockAccess)
{
HandleReadDataBlockAccess(settings, server, Command.WriteResponse, data, cnt, replyData, xml);
if (xml == null)
{
return;
}
}
else
{
// Device reports a HW error.
results.SetUInt8(ErrorCode.HardwareFault);
}
}
if (xml != null)
{
if (xml.OutputType == TranslatorOutputType.StandardXml)
{
xml.AppendEndTag(TranslatorTags.VariableAccessSpecification);
}
xml.AppendEndTag(
TranslatorTags.ListOfVariableAccessSpecification);
}
// Get data count.
cnt = GXCommon.GetObjectCount(data);
GXDataInfo di = new GXDataInfo();
di.xml = xml;
if (xml != null)
{
xml.AppendStartTag(TranslatorTags.ListOfData, "Qty", xml.IntegerToHex(cnt, 2));
}
for (int pos = 0; pos != cnt; ++pos)
{
di.Clear();
if (xml != null)
{
if (xml.OutputType == TranslatorOutputType.StandardXml)
{
xml.AppendStartTag(Command.WriteRequest,
SingleReadResponse.Data);
}
value = GXCommon.GetData(settings, data, di);
if (!di.Complete)
{
value = GXCommon.ToHex(data.Data, false,
data.Position, data.Size - data.Position);
xml.AppendLine(
GXDLMS.DATA_TYPE_OFFSET + (int)di.Type,
"Value", value.ToString());
}
if (xml.OutputType == TranslatorOutputType.StandardXml)
{
xml.AppendEndTag(Command.WriteRequest, SingleReadResponse.Data);
}
GXCommon.GetData(settings, data, di);
}
else if (results.GetUInt8(pos) == 0)
{
// If object has found.
GXSNInfo target = targets[pos];
value = GXCommon.GetData(settings, data, di);
if (value is byte[])
{
DataType dt = target.Item.GetDataType(target.Index);
if (dt != DataType.None && dt != DataType.OctetString)
{
value = GXDLMSClient.ChangeType((byte[])value, dt);
}
}
AccessMode am = target.Item.GetAccess(target.Index);
// If write is denied.
if (am != AccessMode.Write && am != AccessMode.ReadWrite)
{
results.SetUInt8((byte)pos, (byte)ErrorCode.ReadWriteDenied);
}
else
{
ValueEventArgs e = new ValueEventArgs(settings, target.Item, target.Index, 0, null);
e.Value = value;
server.NotifyWrite(new ValueEventArgs[] { e });
if (e.Error != 0)
{
results.SetUInt8((byte)pos, (byte)e.Error);
}
else if (!e.Handled)
{
(target.Item as IGXDLMSBase).SetValue(settings, e);
}
}
}
}
if (xml != null)
{
xml.AppendEndTag(TranslatorTags.ListOfData);
xml.AppendEndTag(Command.WriteRequest);
return;
}
GenerateWriteResponse(settings, results, replyData);
}
