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 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); }