private void ProcessConnectResponse(byte[] dgram)
{
// HEADER
KNXDatagram datagram = new KNXDatagram();
datagram.header_length = (int)dgram[0];
datagram.protocol_version = dgram[1];
datagram.service_type = new byte[] { dgram[2], dgram[3] };
datagram.total_length = (int)dgram[4] + (int)dgram[5];
datagram.channel_id = dgram[6];
datagram.status = dgram[7];
if (datagram.channel_id == 0x00 && datagram.status == 0x24)
{
if (KNXConnection.Debug)
{
Console.WriteLine("KNXReceiverTunneling: Received connect response - No more connections available");
}
}
else
{
this.KNXConnectionTunneling.ChannelId = datagram.channel_id;
this.KNXConnectionTunneling.SequenceNumber = 0x00;
this.KNXConnectionTunneling.Connected();
}
}
private void ProcessDatagramHeaders(byte[] dgram)
{
// HEADER
KNXDatagram datagram = new KNXDatagram();
datagram.header_length = (int)dgram[0];
datagram.protocol_version = dgram[1];
datagram.service_type = new byte[] { dgram[2], dgram[3] };
datagram.total_length = (int)dgram[4] + (int)dgram[5];
byte[] cemi = new byte[dgram.Length - 6];
Array.Copy(dgram, 6, cemi, 0, dgram.Length - 6);
base.ProcessCEMI(datagram, cemi);
}
private void ProcessConnectionStateResponse(byte[] dgram)
{
// HEADER
// 06 10 02 08 00 08 -- 48 21
KNXDatagram datagram = new KNXDatagram();
datagram.header_length = (int)dgram[0];
datagram.protocol_version = dgram[1];
datagram.service_type = new byte[] { dgram[2], dgram[3] };
datagram.total_length = (int)dgram[4] + (int)dgram[5];
datagram.channel_id = dgram[6];
byte response = dgram[7];
if (response == 0x21)
{
if (KNXConnection.Debug)
{
Console.WriteLine("KNXReceiverTunneling: Received connection state response - No active connection with channel ID " + datagram.channel_id);
}
this.KNXConnection.Disconnect();
}
}
private void ProcessDatagramHeaders(byte[] dgram)
{
// HEADER
KNXDatagram datagram = new KNXDatagram();
datagram.header_length = (int)dgram[0];
datagram.protocol_version = dgram[1];
datagram.service_type = new byte[] { dgram[2], dgram[3] };
datagram.total_length = (int)dgram[4] + (int)dgram[5];
byte chID = dgram[7];
if (chID != this.KNXConnectionTunneling.ChannelId)
{
return;
}
byte seqN = dgram[8];
bool process = true;
lock (this.RXSequenceNumberLock)
{
if (seqN <= this.RXSequenceNumber)
{
process = false;
}
this.RXSequenceNumber = seqN;
}
if (process)
{
byte[] cemi = new byte[dgram.Length - 10];
Array.Copy(dgram, 10, cemi, 0, dgram.Length - 10);
base.ProcessCEMI(datagram, cemi);
}
((KNXSenderTunneling)KNXConnectionTunneling.KNXSender).SendTunnelingAck(seqN);
}
internal void ProcessCEMI(KNXDatagram datagram, byte[] cemi)
{
try
{
// CEMI
// +--------+--------+--------+--------+----------------+----------------+--------+----------------+
// | Msg |Add.Info| Ctrl 1 | Ctrl 2 | Source Address | Dest. Address | Data | APDU |
// | Code | Length | | | | | Length | |
// +--------+--------+--------+--------+----------------+----------------+--------+----------------+
// 1 byte 1 byte 1 byte 1 byte 2 bytes 2 bytes 1 byte 2 bytes
//
// Message Code = 0x11 - a L_Data.req primitive
// COMMON EMI MESSAGE CODES FOR DATA LINK LAYER PRIMITIVES
// FROM NETWORK LAYER TO DATA LINK LAYER
// +---------------------------+--------------+-------------------------+---------------------+------------------+
// | Data Link Layer Primitive | Message Code | Data Link Layer Service | Service Description | Common EMI Frame |
// +---------------------------+--------------+-------------------------+---------------------+------------------+
// | L_Raw.req | 0x10 | | | |
// +---------------------------+--------------+-------------------------+---------------------+------------------+
// | | | | Primitive used for | Sample Common |
// | L_Data.req | 0x11 | Data Service | transmitting a data | EMI frame |
// | | | | frame | |
// +---------------------------+--------------+-------------------------+---------------------+------------------+
// | L_Poll_Data.req | 0x13 | Poll Data Service | | |
// +---------------------------+--------------+-------------------------+---------------------+------------------+
// | L_Raw.req | 0x10 | | | |
// +---------------------------+--------------+-------------------------+---------------------+------------------+
// FROM DATA LINK LAYER TO NETWORK LAYER
// +---------------------------+--------------+-------------------------+---------------------+
// | Data Link Layer Primitive | Message Code | Data Link Layer Service | Service Description |
// +---------------------------+--------------+-------------------------+---------------------+
// | L_Poll_Data.con | 0x25 | Poll Data Service | |
// +---------------------------+--------------+-------------------------+---------------------+
// | | | | Primitive used for |
// | L_Data.ind | 0x29 | Data Service | receiving a data |
// | | | | frame |
// +---------------------------+--------------+-------------------------+---------------------+
// | L_Busmon.ind | 0x2B | Bus Monitor Service | |
// +---------------------------+--------------+-------------------------+---------------------+
// | L_Raw.ind | 0x2D | | |
// +---------------------------+--------------+-------------------------+---------------------+
// | | | | Primitive used for |
// | | | | local confirmation |
// | L_Data.con | 0x2E | Data Service | that a frame was |
// | | | | sent (does not mean |
// | | | | successful receive) |
// +---------------------------+--------------+-------------------------+---------------------+
// | L_Raw.con | 0x2F | | |
// +---------------------------+--------------+-------------------------+---------------------+
// Add.Info Length = 0x00 - no additional info
// Control Field 1 = see the bit structure above
// Control Field 2 = see the bit structure above
// Source Address = 0x0000 - filled in by router/gateway with its source address which is
// part of the KNX subnet
// Dest. Address = KNX group or individual address (2 byte)
// Data Length = Number of bytes of data in the APDU excluding the TPCI/APCI bits
// APDU = Application Protocol Data Unit - the actual payload including transport
// protocol control information (TPCI), application protocol control
// information (APCI) and data passed as an argument from higher layers of
// the KNX communication stack
//
datagram.message_code = cemi[0];
datagram.aditional_info_length = (int)cemi[1];
if (datagram.aditional_info_length > 0)
{
datagram.aditional_info = new byte[datagram.aditional_info_length];
for (int i = 0; i < datagram.aditional_info_length; i++)
{
datagram.aditional_info[i] = cemi[2 + i];
}
}
datagram.control_field_1 = cemi[2 + datagram.aditional_info_length];
datagram.control_field_2 = cemi[3 + datagram.aditional_info_length];
datagram.source_address = KNXHelper.GetIndividualAddress(new byte[] { cemi[4 + datagram.aditional_info_length], cemi[5 + datagram.aditional_info_length] });
if (KNXHelper.GetKNXDestinationAddressType(datagram.control_field_2).Equals(KNXHelper.KNXDestinationAddressType.INDIVIDUAL))
{
datagram.destination_address = KNXHelper.GetIndividualAddress(new byte[] { cemi[6 + datagram.aditional_info_length], cemi[7 + datagram.aditional_info_length] });
}
else
{
datagram.destination_address = KNXHelper.GetGroupAddress(new byte[] { cemi[6 + datagram.aditional_info_length], cemi[7 + datagram.aditional_info_length] }, KNXConnection.ThreeLevelGroupAddressing);
}
datagram.data_length = (int)cemi[8 + datagram.aditional_info_length];
datagram.apdu = new byte[datagram.data_length + 1];
for (int i = 0; i < datagram.apdu.Length; i++)
{
datagram.apdu[i] = cemi[9 + i + datagram.aditional_info_length];
}
datagram.data = KNXHelper.GetRawData(datagram.data_length, datagram.apdu);
if (KNXConnection.Debug)
{
Console.WriteLine("-----------------------------------------------------------------------------------------------------");
Console.WriteLine(BitConverter.ToString(cemi));
Console.WriteLine("Event Header Length: " + datagram.header_length);
Console.WriteLine("Event Protocol Version: " + datagram.protocol_version.ToString("x"));
Console.WriteLine("Event Service Type: 0x" + BitConverter.ToString(datagram.service_type).Replace("-", string.Empty));
Console.WriteLine("Event Total Length: " + datagram.total_length);
Console.WriteLine("Event Message Code: " + datagram.message_code.ToString("x"));
Console.WriteLine("Event Aditional Info Length: " + datagram.aditional_info_length);
if (datagram.aditional_info_length > 0)
{
Console.WriteLine("Event Aditional Info: 0x" + BitConverter.ToString(datagram.aditional_info).Replace("-", string.Empty));
}
Console.WriteLine("Event Control Field 1: " + Convert.ToString(datagram.control_field_1, 2));
Console.WriteLine("Event Control Field 2: " + Convert.ToString(datagram.control_field_2, 2));
Console.WriteLine("Event Source Address: " + datagram.source_address);
Console.WriteLine("Event Destination Address: " + datagram.destination_address);
Console.WriteLine("Event Data Length: " + datagram.data_length);
Console.WriteLine("Event APDU: 0x" + BitConverter.ToString(datagram.apdu).Replace("-", string.Empty));
Console.WriteLine("Event Data: " + datagram.data);
Console.WriteLine("-----------------------------------------------------------------------------------------------------");
}
if (datagram.message_code == 0x29)
{
int type = ((int)datagram.apdu[1]) >> 4;
if (type == 8)
{
this.KNXConnection.Event(datagram.source_address, datagram.destination_address, datagram.data);
}
else if (type == 4 || type == 0)
{
this.KNXConnection.Status(datagram.source_address, datagram.destination_address, datagram.data);
}
}
}
catch (Exception)
{
// ignore, missing warning information
}
}
private void ProcessDatagramHeaders(byte[] dgram)
{
// HEADER
KNXDatagram datagram = new KNXDatagram();
datagram.header_length = (int)dgram[0];
datagram.protocol_version = dgram[1];
datagram.service_type = new byte[] { dgram[2], dgram[3] };
datagram.total_length = (int)dgram[4] + (int)dgram[5];
byte[] cemi = new byte[dgram.Length - 6];
Array.Copy(dgram, 6, cemi, 0, dgram.Length - 6);
base.ProcessCEMI(datagram, cemi);
}
private void ProcessConnectResponse(byte[] dgram)
{
// HEADER
KNXDatagram datagram = new KNXDatagram();
datagram.header_length = (int)dgram[0];
datagram.protocol_version = dgram[1];
datagram.service_type = new byte[] { dgram[2], dgram[3] };
datagram.total_length = (int)dgram[4] + (int)dgram[5];
datagram.channel_id = dgram[6];
datagram.status = dgram[7];
if (datagram.channel_id == 0x00 && datagram.status == 0x24)
{
if (KNXConnection.Debug)
{
Console.WriteLine("KNXReceiverTunneling: Received connect response - No more connections available");
}
}
else
{
this.KNXConnectionTunneling.ChannelId = datagram.channel_id;
this.KNXConnectionTunneling.SequenceNumber = 0x00;
this.KNXConnectionTunneling.Connected();
}
}
private void ProcessConnectionStateResponse(byte[] dgram)
{
// HEADER
// 06 10 02 08 00 08 -- 48 21
KNXDatagram datagram = new KNXDatagram();
datagram.header_length = (int)dgram[0];
datagram.protocol_version = dgram[1];
datagram.service_type = new byte[] { dgram[2], dgram[3] };
datagram.total_length = (int)dgram[4] + (int)dgram[5];
datagram.channel_id = dgram[6];
byte response = dgram[7];
if (response == 0x21)
{
if (KNXConnection.Debug)
{
Console.WriteLine("KNXReceiverTunneling: Received connection state response - No active connection with channel ID " + datagram.channel_id);
}
this.KNXConnection.Disconnect();
}
}
private void ProcessDatagramHeaders(byte[] dgram)
{
// HEADER
KNXDatagram datagram = new KNXDatagram();
datagram.header_length = (int)dgram[0];
datagram.protocol_version = dgram[1];
datagram.service_type = new byte[] { dgram[2], dgram[3] };
datagram.total_length = (int)dgram[4] + (int)dgram[5];
byte chID = dgram[7];
if (chID != this.KNXConnectionTunneling.ChannelId)
return;
byte seqN = dgram[8];
bool process = true;
lock (this.RXSequenceNumberLock)
{
if (seqN <= this.RXSequenceNumber)
{
process = false;
}
this.RXSequenceNumber = seqN;
}
if (process)
{
byte[] cemi = new byte[dgram.Length - 10];
Array.Copy(dgram, 10, cemi, 0, dgram.Length - 10);
base.ProcessCEMI(datagram, cemi);
}
((KNXSenderTunneling)KNXConnectionTunneling.KNXSender).SendTunnelingAck(seqN);
}
internal void ProcessCEMI(KNXDatagram datagram, byte[] cemi)
{
try
{
// CEMI
// +--------+--------+--------+--------+----------------+----------------+--------+----------------+
// | Msg |Add.Info| Ctrl 1 | Ctrl 2 | Source Address | Dest. Address | Data | APDU |
// | Code | Length | | | | | Length | |
// +--------+--------+--------+--------+----------------+----------------+--------+----------------+
// 1 byte 1 byte 1 byte 1 byte 2 bytes 2 bytes 1 byte 2 bytes
//
// Message Code = 0x11 - a L_Data.req primitive
// COMMON EMI MESSAGE CODES FOR DATA LINK LAYER PRIMITIVES
// FROM NETWORK LAYER TO DATA LINK LAYER
// +---------------------------+--------------+-------------------------+---------------------+------------------+
// | Data Link Layer Primitive | Message Code | Data Link Layer Service | Service Description | Common EMI Frame |
// +---------------------------+--------------+-------------------------+---------------------+------------------+
// | L_Raw.req | 0x10 | | | |
// +---------------------------+--------------+-------------------------+---------------------+------------------+
// | | | | Primitive used for | Sample Common |
// | L_Data.req | 0x11 | Data Service | transmitting a data | EMI frame |
// | | | | frame | |
// +---------------------------+--------------+-------------------------+---------------------+------------------+
// | L_Poll_Data.req | 0x13 | Poll Data Service | | |
// +---------------------------+--------------+-------------------------+---------------------+------------------+
// | L_Raw.req | 0x10 | | | |
// +---------------------------+--------------+-------------------------+---------------------+------------------+
// FROM DATA LINK LAYER TO NETWORK LAYER
// +---------------------------+--------------+-------------------------+---------------------+
// | Data Link Layer Primitive | Message Code | Data Link Layer Service | Service Description |
// +---------------------------+--------------+-------------------------+---------------------+
// | L_Poll_Data.con | 0x25 | Poll Data Service | |
// +---------------------------+--------------+-------------------------+---------------------+
// | | | | Primitive used for |
// | L_Data.ind | 0x29 | Data Service | receiving a data |
// | | | | frame |
// +---------------------------+--------------+-------------------------+---------------------+
// | L_Busmon.ind | 0x2B | Bus Monitor Service | |
// +---------------------------+--------------+-------------------------+---------------------+
// | L_Raw.ind | 0x2D | | |
// +---------------------------+--------------+-------------------------+---------------------+
// | | | | Primitive used for |
// | | | | local confirmation |
// | L_Data.con | 0x2E | Data Service | that a frame was |
// | | | | sent (does not mean |
// | | | | successful receive) |
// +---------------------------+--------------+-------------------------+---------------------+
// | L_Raw.con | 0x2F | | |
// +---------------------------+--------------+-------------------------+---------------------+
// Add.Info Length = 0x00 - no additional info
// Control Field 1 = see the bit structure above
// Control Field 2 = see the bit structure above
// Source Address = 0x0000 - filled in by router/gateway with its source address which is
// part of the KNX subnet
// Dest. Address = KNX group or individual address (2 byte)
// Data Length = Number of bytes of data in the APDU excluding the TPCI/APCI bits
// APDU = Application Protocol Data Unit - the actual payload including transport
// protocol control information (TPCI), application protocol control
// information (APCI) and data passed as an argument from higher layers of
// the KNX communication stack
//
datagram.message_code = cemi[0];
datagram.aditional_info_length = (int)cemi[1];
if (datagram.aditional_info_length > 0)
{
datagram.aditional_info = new byte[datagram.aditional_info_length];
for (int i = 0; i < datagram.aditional_info_length; i++)
{
datagram.aditional_info[i] = cemi[2 + i];
}
}
datagram.control_field_1 = cemi[2 + datagram.aditional_info_length];
datagram.control_field_2 = cemi[3 + datagram.aditional_info_length];
datagram.source_address = KNXHelper.GetIndividualAddress(new byte[] { cemi[4 + datagram.aditional_info_length], cemi[5 + datagram.aditional_info_length] });
if (KNXHelper.GetKNXDestinationAddressType(datagram.control_field_2).Equals(KNXHelper.KNXDestinationAddressType.INDIVIDUAL))
{
datagram.destination_address = KNXHelper.GetIndividualAddress(new byte[] { cemi[6 + datagram.aditional_info_length], cemi[7 + datagram.aditional_info_length] });
}
else
{
datagram.destination_address = KNXHelper.GetGroupAddress(new byte[] { cemi[6 + datagram.aditional_info_length], cemi[7 + datagram.aditional_info_length] }, KNXConnection.ThreeLevelGroupAddressing);
}
datagram.data_length = (int)cemi[8 + datagram.aditional_info_length];
datagram.apdu = new byte[datagram.data_length + 1];
for (int i = 0; i < datagram.apdu.Length; i++)
{
datagram.apdu[i] = cemi[9 + i + datagram.aditional_info_length];
}
datagram.data = KNXHelper.GetRawData(datagram.data_length, datagram.apdu);
if (KNXConnection.Debug)
{
Console.WriteLine("-----------------------------------------------------------------------------------------------------");
Console.WriteLine(BitConverter.ToString(cemi));
Console.WriteLine("Event Header Length: " + datagram.header_length);
Console.WriteLine("Event Protocol Version: " + datagram.protocol_version.ToString("x"));
Console.WriteLine("Event Service Type: 0x" + BitConverter.ToString(datagram.service_type).Replace("-", string.Empty));
Console.WriteLine("Event Total Length: " + datagram.total_length);
Console.WriteLine("Event Message Code: " + datagram.message_code.ToString("x"));
Console.WriteLine("Event Aditional Info Length: " + datagram.aditional_info_length);
if (datagram.aditional_info_length > 0)
{
Console.WriteLine("Event Aditional Info: 0x" + BitConverter.ToString(datagram.aditional_info).Replace("-", string.Empty));
}
Console.WriteLine("Event Control Field 1: " + Convert.ToString(datagram.control_field_1, 2));
Console.WriteLine("Event Control Field 2: " + Convert.ToString(datagram.control_field_2, 2));
Console.WriteLine("Event Source Address: " + datagram.source_address);
Console.WriteLine("Event Destination Address: " + datagram.destination_address);
Console.WriteLine("Event Data Length: " + datagram.data_length);
Console.WriteLine("Event APDU: 0x" + BitConverter.ToString(datagram.apdu).Replace("-", string.Empty));
Console.WriteLine("Event Data: " + datagram.data);
Console.WriteLine("-----------------------------------------------------------------------------------------------------");
}
if (datagram.message_code == 0x29)
{
int type = ((int)datagram.apdu[1]) >> 4;
if (type == 8)
{
this.KNXConnection.Event(datagram.source_address, datagram.destination_address, datagram.data);
}
else if (type == 4 || type == 0)
{
this.KNXConnection.Status(datagram.source_address, datagram.destination_address, datagram.data);
}
}
}
catch (Exception)
{
// ignore, missing warning information
}
}
