private byte[] ReportError(Command cmd, ErrorCode error)
{
switch (cmd)
{
case Command.ReadRequest:
cmd = Command.ReadResponse;
break;
case Command.WriteRequest:
cmd = Command.WriteResponse;
break;
case Command.GetRequest:
cmd = Command.GetResponse;
break;
case Command.SetRequest:
cmd = Command.SetResponse;
break;
case Command.MethodRequest:
cmd = Command.MethodResponse;
break;
default:
//Return HW error and close connection..
break;
}
if (Settings.UseLogicalNameReferencing)
{
GXDLMS.GetLNPdu(new GXDLMSLNParameters(Settings, 0, cmd, 1, null, null, (byte)error), replyData);
}
else
{
GXByteBuffer bb = new GXByteBuffer();
bb.SetUInt8(error);
GXDLMSSNParameters p = new GXDLMSSNParameters(Settings, cmd, 1, (byte)error, null, bb);
GXDLMS.GetSNPdu(p, replyData);
}
if (this.InterfaceType == Enums.InterfaceType.WRAPPER)
{
return(GXDLMS.GetWrapperFrame(Settings, replyData));
}
else
{
return(GXDLMS.GetHdlcFrame(Settings, 0, replyData));
}
}
///<summary>
///Handle set request.
///</summary>
///<returns>
///Reply to the client.
///</returns>
public static void HandleSetRequest(GXDLMSSettings settings, GXDLMSServer server, GXByteBuffer data, GXByteBuffer replyData, GXDLMSTranslatorStructure xml)
{
//Return error if connection is not established.
if (xml == null && !settings.Connected)
{
replyData.Set(GXDLMSServer.GenerateConfirmedServiceError(ConfirmedServiceError.InitiateError,
ServiceError.Service, (byte)Service.Unsupported));
return;
}
// Get type.
SetRequestType type = (SetRequestType)data.GetUInt8();
// Get invoke ID and priority.
byte invoke = data.GetUInt8();
// SetRequest normal or Set Request With First Data Block
GXDLMSLNParameters p = new GXDLMSLNParameters(settings, invoke, Command.SetResponse, (byte)type, null, null, 0);
if (xml != null)
{
xml.AppendStartTag(Command.SetRequest);
xml.AppendStartTag(Command.SetRequest, type);
//InvokeIdAndPriority
xml.AppendLine(TranslatorTags.InvokeId, "Value", xml.IntegerToHex(invoke, 2));
}
switch (type)
{
case SetRequestType.Normal:
case SetRequestType.FirstDataBlock:
HandleSetRequestNormal(settings, server, data, (byte)type, p, replyData, xml);
break;
case SetRequestType.WithDataBlock:
HanleSetRequestWithDataBlock(settings, server, data, p, replyData, xml);
break;
default:
System.Diagnostics.Debug.WriteLine("HandleSetRequest failed. Unknown command.");
settings.ResetBlockIndex();
p.status = (byte)ErrorCode.HardwareFault;
break;
}
if (xml != null)
{
xml.AppendEndTag(Command.SetRequest, type);
xml.AppendEndTag(Command.SetRequest);
return;
}
GXDLMS.GetLNPdu(p, 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);
}
/// <summary>
/// Handle get request next data block command.
/// </summary>
/// <param name="data">Received data.</param>
internal static void GetRequestNextDataBlock(GXDLMSSettings settings, byte invokeID, GXDLMSServer server, GXByteBuffer data, GXByteBuffer replyData, GXDLMSTranslatorStructure xml, bool streaming)
{
GXByteBuffer bb = new GXByteBuffer();
if (!streaming)
{
UInt32 index;
// Get block index.
index = data.GetUInt32();
if (xml != null)
{
xml.AppendLine(TranslatorTags.BlockNumber, null, xml.IntegerToHex(index, 8));
return;
}
if (index != settings.BlockIndex)
{
Debug.WriteLine("handleGetRequest failed. Invalid block number. " + settings.BlockIndex + "/" + index);
GXDLMS.GetLNPdu(new GXDLMSLNParameters(null, settings, 0, Command.GetResponse, 2, null, bb, (byte)ErrorCode.DataBlockNumberInvalid), replyData);
return;
}
}
settings.IncreaseBlockIndex();
GXDLMSLNParameters p = new GXDLMSLNParameters(null, settings, invokeID, streaming ? Command.GeneralBlockTransfer : Command.GetResponse, 2, null, bb, (byte)ErrorCode.Ok);
p.Streaming = streaming;
p.WindowSize = settings.WindowSize;
//If transaction is not in progress.
if (server.transaction == null)
{
p.status = (byte)ErrorCode.NoLongGetOrReadInProgress;
}
else
{
bb.Set(server.transaction.data);
bool moreData = settings.Index != settings.Count;
if (moreData)
{
//If there is multiple blocks on the buffer.
//This might happen when Max PDU size is very small.
if (bb.Size < settings.MaxPduSize)
{
foreach (ValueEventArgs arg in server.transaction.targets)
{
object value;
server.NotifyRead(new ValueEventArgs[] { arg });
if (arg.Handled)
{
value = arg.Value;
}
else
{
value = (arg.Target as IGXDLMSBase).GetValue(settings, arg);
}
//Add data.
if (arg.ByteArray)
{
bb.Set((byte[])value);
}
else
{
GXDLMS.AppendData(settings, arg.Target, arg.Index, bb, value);
}
}
moreData = settings.Index != settings.Count;
}
}
p.multipleBlocks = true;
GXDLMS.GetLNPdu(p, replyData);
if (moreData || bb.Size - bb.Position != 0)
{
server.transaction.data = bb;
}
else
{
server.transaction = null;
settings.ResetBlockIndex();
}
}
}
/// <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 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;
}
}
}
