Updated the who-is-router-to-network demo.

bacnet-stack/demo/handler/s_router.c

@@ -43,7 +43,7 @@
 
 static void npdu_encode_npdu_network(
     BACNET_NPDU_DATA * npdu_data,
-    BACNET_NETWORK_MESSAGE_TYPE network_message_type,
+    BACNET_NETWORK_MESSAGE_TYPE network_message_type,
     bool data_expecting_reply,
     BACNET_MESSAGE_PRIORITY priority)
 {
@@ -69,8 +69,8 @@ void Send_Who_Is_Router_To_Network(
     BACNET_NPDU_DATA npdu_data;
 
     npdu_encode_npdu_network(&npdu_data,
-        NETWORK_MESSAGE_WHO_IS_ROUTER_TO_NETWORK,
+        NETWORK_MESSAGE_WHO_IS_ROUTER_TO_NETWORK,
-        false,
+        false,
         MESSAGE_PRIORITY_NORMAL);
     /* fixme: should dnet/dlen/dadr be set in NPDU?  */
     pdu_len =
@@ -98,7 +98,7 @@ void Send_Who_Is_Router_To_Network(
 #endif
 }
 
-/* pDNET_list: list of networks for which I am a router, 
+/* pDNET_list: list of networks for which I am a router,
    terminated with -1 */
 void Send_I_Am_Router_To_Network(
     const int DNET_list[])
@@ -112,8 +112,8 @@ void Send_I_Am_Router_To_Network(
     unsigned index = 0;
 
     npdu_encode_npdu_network(&npdu_data,
-        NETWORK_MESSAGE_I_AM_ROUTER_TO_NETWORK, 
+        NETWORK_MESSAGE_I_AM_ROUTER_TO_NETWORK,
-        false,
+        false,
         MESSAGE_PRIORITY_NORMAL);
     pdu_len =
         npdu_encode_pdu(&Handler_Transmit_Buffer[0], NULL, NULL, &npdu_data);
@@ -130,7 +130,7 @@ void Send_I_Am_Router_To_Network(
         fprintf(stderr, "%u\n", dnet);
 #endif
     }
-    /* I-Am-Router-To-Network shall always be transmitted with 
+    /* I-Am-Router-To-Network shall always be transmitted with
        a broadcast MAC address. */
     datalink_get_broadcast_address(&dest);
     bytes_sent =
@@ -157,8 +157,8 @@ void Send_Initialize_Routing_Table(
     BACNET_ROUTER_PORT *router_port;
     unsigned i = 0;     /* counter */
 
-    npdu_encode_npdu_network(&npdu_data, 
+    npdu_encode_npdu_network(&npdu_data,
-        NETWORK_MESSAGE_INIT_RT_TABLE,
+        NETWORK_MESSAGE_INIT_RT_TABLE,
         true,
         MESSAGE_PRIORITY_NORMAL);
     pdu_len =
@@ -208,8 +208,8 @@ void Send_Initialize_Routing_Table_Ack(
     int bytes_sent = 0;
     BACNET_NPDU_DATA npdu_data;
 
-    npdu_encode_npdu_network(&npdu_data, 
+    npdu_encode_npdu_network(&npdu_data,
-        NETWORK_MESSAGE_INIT_RT_TABLE_ACK,
+        NETWORK_MESSAGE_INIT_RT_TABLE_ACK,
         false,
         MESSAGE_PRIORITY_NORMAL);
     pdu_len =

bacnet-stack/demo/whois/main.c

@@ -117,7 +117,7 @@ static void print_address_cache(
     for (i = 0; i < MAX_ADDRESS_CACHE; i++) {
         if (address_get_by_index(i, &device_id, &max_apdu, &address)) {
             printf("%7u ", device_id);
-            for (j = 0; j < 7; j++) {
+            for (j = 0; j < MAX_MAC_LEN; j++) {
                 if (j < address.mac_len) {
                     printf("%02X", address.mac[j]);
                 } else {
@@ -127,7 +127,7 @@ static void print_address_cache(
             printf(" %4hu ", max_apdu);
             printf("%5hu ", address.net);
             if (address.net) {
-                for (j = 0; j < 7; j++) {
+                for (j = 0; j < MAX_MAC_LEN; j++) {
                     if (j < address.len) {
                         printf("%02X", address.adr[j]);
                     } else {

bacnet-stack/demo/whoisrouter/Makefile

@@ -21,7 +21,7 @@ BACNET_LIB_DIR = ../../lib
 BACNET_LIB_NAME = bacnet
 BACNET_LIB_TARGET = $(BACNET_LIB_DIR)/lib$(BACNET_LIB_NAME).a
 # Compiler Setup
-INCLUDES = -I$(BACNET_INCLUDE) -I$(BACNET_PORT_DIR) 
+INCLUDES = -I$(BACNET_INCLUDE) -I$(BACNET_PORT_DIR)
 ifeq (${BACNET_PORT},linux)
 PFLAGS = -pthread
 TARGET_BIN = ${TARGET}
@@ -38,7 +38,7 @@ OPTIMIZATION = -O0
 CFLAGS = -Wall $(DEBUGGING) $(OPTIMIZATION) $(INCLUDES) $(DEFINES)
 LFLAGS = -Wl,-Map=$(TARGET).map,$(LIBRARIES)
 
-SRCS = main.c
+SRCS = main.c npdu.c
 
 OBJS = ${SRCS:.c=.o}
 

bacnet-stack/demo/whoisrouter/main.c

@@ -40,6 +40,7 @@
 #include "device.h"
 #include "datalink.h"
 /* some demo stuff needed */
+#include "debug.h"
 #include "filename.h"
 #include "handlers.h"
 #include "client.h"
@@ -83,6 +84,51 @@ void MyRejectHandler(
     Error_Detected = true;
 }
 
+void router_handler(
+    BACNET_ADDRESS *src,
+    BACNET_NPDU_DATA *npdu_data,
+    uint8_t * npdu,      /* PDU data */
+    uint16_t npdu_len)
+{
+    uint16_t npdu_offset = 0;
+    uint16_t dnet = 0;
+    uint16_t len = 0;
+    uint16_t j = 0;
+
+    switch (npdu_data->network_message_type) {
+        case NETWORK_MESSAGE_WHO_IS_ROUTER_TO_NETWORK:
+            break;
+        case NETWORK_MESSAGE_I_AM_ROUTER_TO_NETWORK:
+            printf("I-Am Router to Network from ");
+            for (j = 0; j < MAX_MAC_LEN; j++) {
+                if (j < src->mac_len) {
+                    printf("%02X", src->mac[j]);
+                }
+            }
+            printf("\nNetworks: ");
+            while (npdu_len) {
+                len = decode_unsigned16(&npdu[npdu_offset], &dnet);
+                printf("%hu",dnet);
+                npdu_len -= len;
+                if (npdu_len) {
+                    printf(", ");
+                }
+            }
+            printf("\n");
+            break;
+        case NETWORK_MESSAGE_I_COULD_BE_ROUTER_TO_NETWORK:
+        case NETWORK_MESSAGE_REJECT_MESSAGE_TO_NETWORK:
+        case NETWORK_MESSAGE_ROUTER_BUSY_TO_NETWORK:
+        case NETWORK_MESSAGE_ROUTER_AVAILABLE_TO_NETWORK:
+        case NETWORK_MESSAGE_INIT_RT_TABLE:
+        case NETWORK_MESSAGE_INIT_RT_TABLE_ACK:
+        case NETWORK_MESSAGE_ESTABLISH_CONNECTION_TO_NETWORK:
+        case NETWORK_MESSAGE_DISCONNECT_CONNECTION_TO_NETWORK:
+        default:
+            break;
+    }
+}
+
 static void Init_Service_Handlers(
     void)
 {

bacnet-stack/demo/whoisrouter/npdu.c

@@ -0,0 +1,580 @@
+/*####COPYRIGHTBEGIN####
+ -------------------------------------------
+ Copyright (C) 2005 Steve Karg
+
+ This program is free software; you can redistribute it and/or
+ modify it under the terms of the GNU General Public License
+ as published by the Free Software Foundation; either version 2
+ of the License, or (at your option) any later version.
+
+ This program is distributed in the hope that it will be useful,
+ but WITHOUT ANY WARRANTY; without even the implied warranty of
+ MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ GNU General Public License for more details.
+
+ You should have received a copy of the GNU General Public License
+ along with this program; if not, write to:
+ The Free Software Foundation, Inc.
+ 59 Temple Place - Suite 330
+ Boston, MA  02111-1307, USA.
+
+ As a special exception, if other files instantiate templates or
+ use macros or inline functions from this file, or you compile
+ this file and link it with other works to produce a work based
+ on this file, this file does not by itself cause the resulting
+ work to be covered by the GNU General Public License. However
+ the source code for this file must still be made available in
+ accordance with section (3) of the GNU General Public License.
+
+ This exception does not invalidate any other reasons why a work
+ based on this file might be covered by the GNU General Public
+ License.
+ -------------------------------------------
+####COPYRIGHTEND####*/
+#include <stdbool.h>
+#include <stdint.h>
+#include "bacdef.h"
+#include "bacdcode.h"
+#include "bacint.h"
+#include "bacenum.h"
+#include "bits.h"
+#include "npdu.h"
+#include "apdu.h"
+#define DEBUG_ENABLED 0
+#include "debug.h"
+
+#if PRINT_ENABLED
+#include <stdio.h>
+#endif
+
+void npdu_copy_data(
+    BACNET_NPDU_DATA * dest,
+    BACNET_NPDU_DATA * src)
+{
+    if (dest && src) {
+        dest->protocol_version = src->protocol_version;
+        dest->data_expecting_reply = src->data_expecting_reply;
+        dest->network_layer_message = src->network_layer_message;
+        dest->priority = src->priority;
+        dest->network_message_type = src->network_message_type;
+        dest->vendor_id = src->vendor_id;
+        dest->hop_count = src->hop_count;
+    }
+
+    return;
+}
+
+/*
+
+The following ICI parameters are exchanged with the
+various service primitives across an API:
+
+'destination_address' (DA): the address of the device(s)
+intended to receive the service primitive. Its format (device name,
+network address, etc.) is a local matter. This address
+may also be a multicast, local broadcast or global broadcast type.
+
+'source_address' (SA): the address of the device from which
+the service primitive was received. Its format (device name,
+network address, etc.) is a local matter.
+
+'network_priority' (NP): a four-level network priority parameter
+described in 6.2.2.
+
+'data_expecting_reply' (DER): a Boolean parameter that indicates
+whether (TRUE) or not (FALSE) a reply service primitive
+is expected for the service being issued.
+
+
+Table 5-1. Applicability of ICI parameters for abstract service primitives
+     Service Primitive         DA           SA         NP        DER
+CONF_SERV.request              Yes          No         Yes       Yes
+CONF_SERV.indication           Yes         Yes         Yes       Yes
+CONF_SERV.response             Yes          No         Yes       Yes
+CONF_SERV.confirm              Yes         Yes         Yes        No
+UNCONF_SERV.request            Yes          No         Yes        No
+UNCONF_SERV.indication         Yes         Yes         Yes        No
+REJECT.request                 Yes          No         Yes        No
+REJECT.indication              Yes         Yes         Yes        No
+SEGMENT_ACK.request            Yes          No         Yes        No
+SEGMENT_ACK.indication         Yes         Yes         Yes        No
+ABORT.request                  Yes          No         Yes        No
+ABORT.indication               Yes         Yes         Yes        No
+*/
+
+int npdu_encode_pdu(
+    uint8_t * npdu,
+    BACNET_ADDRESS * dest,
+    BACNET_ADDRESS * src,
+    BACNET_NPDU_DATA * npdu_data)
+{
+    int len = 0;        /* return value - number of octets loaded in this function */
+    int i = 0;  /* counter  */
+
+
+    if (npdu && npdu_data) {
+        /* protocol version */
+        npdu[0] = npdu_data->protocol_version;
+        /* initialize the control octet */
+        npdu[1] = 0;
+        /* Bit 7: 1 indicates that the NSDU conveys a network layer message. */
+        /*          Message Type field is present. */
+        /*        0 indicates that the NSDU contains a BACnet APDU. */
+        /*          Message Type field is absent. */
+        if (npdu_data->network_layer_message)
+            npdu[1] |= BIT7;
+        /*Bit 6: Reserved. Shall be zero. */
+        /*Bit 5: Destination specifier where: */
+        /* 0 = DNET, DLEN, DADR, and Hop Count absent */
+        /* 1 = DNET, DLEN, and Hop Count present */
+        /* DLEN = 0 denotes broadcast MAC DADR and DADR field is absent */
+        /* DLEN > 0 specifies length of DADR field */
+        if (dest && dest->net)
+            npdu[1] |= BIT5;
+        /* Bit 4: Reserved. Shall be zero. */
+        /* Bit 3: Source specifier where: */
+        /* 0 =  SNET, SLEN, and SADR absent */
+        /* 1 =  SNET, SLEN, and SADR present */
+        /* SLEN = 0 Invalid */
+        /* SLEN > 0 specifies length of SADR field */
+        if (src && src->net)
+            npdu[1] |= BIT3;
+        /* Bit 2: The value of this bit corresponds to the */
+        /* data_expecting_reply parameter in the N-UNITDATA primitives. */
+        /* 1 indicates that a BACnet-Confirmed-Request-PDU, */
+        /* a segment of a BACnet-ComplexACK-PDU, */
+        /* or a network layer message expecting a reply is present. */
+        /* 0 indicates that other than a BACnet-Confirmed-Request-PDU, */
+        /* a segment of a BACnet-ComplexACK-PDU, */
+        /* or a network layer message expecting a reply is present. */
+        if (npdu_data->data_expecting_reply)
+            npdu[1] |= BIT2;
+        /* Bits 1,0: Network priority where: */
+        /* B'11' = Life Safety message */
+        /* B'10' = Critical Equipment message */
+        /* B'01' = Urgent message */
+        /* B'00' = Normal message */
+        npdu[1] |= (npdu_data->priority & 0x03);
+        len = 2;
+        if (dest && dest->net) {
+            len += encode_unsigned16(&npdu[len], dest->net);
+            npdu[len++] = dest->len;
+            /* DLEN = 0 denotes broadcast MAC DADR and DADR field is absent */
+            /* DLEN > 0 specifies length of DADR field */
+            if (dest->len) {
+                for (i = 0; i < dest->len; i++) {
+                    npdu[len++] = dest->adr[i];
+                }
+            }
+        }
+        if (src && src->net) {
+            len += encode_unsigned16(&npdu[len], src->net);
+            npdu[len++] = src->len;
+            /* SLEN = 0 denotes broadcast MAC SADR and SADR field is absent */
+            /* SLEN > 0 specifies length of SADR field */
+            if (src->len) {
+                for (i = 0; i < src->len; i++) {
+                    npdu[len++] = src->adr[i];
+                }
+            }
+        }
+        /* The Hop Count field shall be present only if the message is */
+        /* destined for a remote network, i.e., if DNET is present. */
+        /* This is a one-octet field that is initialized to a value of 0xff. */
+        if (dest && dest->net) {
+            npdu[len] = npdu_data->hop_count;
+            len++;
+        }
+        if (npdu_data->network_layer_message) {
+            npdu[len] = npdu_data->network_message_type;
+            len++;
+            /* Message Type field contains a value in the range 0x80 - 0xFF, */
+            /* then a Vendor ID field shall be present */
+            if (npdu_data->network_message_type >= 0x80)
+                len += encode_unsigned16(&npdu[len], npdu_data->vendor_id);
+        }
+    }
+
+    return len;
+}
+
+/* Configure the NPDU portion of the packet for an APDU */
+/* This function does not handle the network messages, just APDUs. */
+/* From BACnet 5.1:
+Applicability of ICI parameters for abstract service primitives
+Service Primitive      DA  SA  NP  DER
+-----------------      --- --- --- ---
+CONF_SERV.request      Yes No  Yes Yes
+CONF_SERV.indication   Yes Yes Yes Yes
+CONF_SERV.response     Yes No  Yes Yes
+CONF_SERV.confirm      Yes Yes Yes No
+UNCONF_SERV.request    Yes No  Yes No
+UNCONF_SERV.indication Yes Yes Yes No
+REJECT.request         Yes No  Yes No
+REJECT.indication      Yes Yes Yes No
+SEGMENT_ACK.request    Yes No  Yes No
+SEGMENT_ACK.indication Yes Yes Yes No
+ABORT.request          Yes No  Yes No
+ABORT.indication       Yes Yes Yes No
+
+Where:
+'destination_address' (DA): the address of the device(s) intended
+to receive the service primitive. Its format (device name,
+network address, etc.) is a local matter. This address may
+also be a multicast, local broadcast or global broadcast type.
+'source_address' (SA): the address of the device from which
+the service primitive was received. Its format (device name,
+network address, etc.) is a local matter.
+'network_priority' (NP): a four-level network priority parameter
+described in 6.2.2.
+'data_expecting_reply' (DER): a Boolean parameter that indicates
+whether (TRUE) or not (FALSE) a reply service primitive
+is expected for the service being issued.
+*/
+void npdu_encode_npdu_data(
+    BACNET_NPDU_DATA * npdu_data,
+    bool data_expecting_reply,
+    BACNET_MESSAGE_PRIORITY priority)
+{
+    if (npdu_data) {
+        npdu_data->data_expecting_reply = data_expecting_reply;
+        npdu_data->protocol_version = BACNET_PROTOCOL_VERSION;
+        npdu_data->network_layer_message = false;       /* false if APDU */
+        npdu_data->network_message_type = NETWORK_MESSAGE_INVALID;      /* optional */
+        npdu_data->vendor_id = 0;       /* optional, if net message type is > 0x80 */
+        npdu_data->priority = priority;
+        npdu_data->hop_count = 255;
+    }
+}
+
+int npdu_decode(
+    uint8_t * npdu,
+    BACNET_ADDRESS * dest,
+    BACNET_ADDRESS * src,
+    BACNET_NPDU_DATA * npdu_data)
+{
+    int len = 0;        /* return value - number of octets loaded in this function */
+    int i = 0;  /* counter */
+    uint16_t src_net = 0;
+    uint16_t dest_net = 0;
+    uint8_t address_len = 0;
+    uint8_t mac_octet = 0;
+
+    if (npdu && npdu_data) {
+        /* Protocol Version */
+        npdu_data->protocol_version = npdu[0];
+        /* control octet */
+        /* Bit 7: 1 indicates that the NSDU conveys a network layer message. */
+        /*          Message Type field is present. */
+        /*        0 indicates that the NSDU contains a BACnet APDU. */
+        /*          Message Type field is absent. */
+        npdu_data->network_layer_message = (npdu[1] & BIT7) ? true : false;
+        /*Bit 6: Reserved. Shall be zero. */
+        /* Bit 4: Reserved. Shall be zero. */
+        /* Bit 2: The value of this bit corresponds to data expecting reply */
+        /* parameter in the N-UNITDATA primitives. */
+        /* 1 indicates that a BACnet-Confirmed-Request-PDU, */
+        /* a segment of a BACnet-ComplexACK-PDU, */
+        /* or a network layer message expecting a reply is present. */
+        /* 0 indicates that other than a BACnet-Confirmed-Request-PDU, */
+        /* a segment of a BACnet-ComplexACK-PDU, */
+        /* or a network layer message expecting a reply is present. */
+        npdu_data->data_expecting_reply = (npdu[1] & BIT2) ? true : false;
+        /* Bits 1,0: Network priority where: */
+        /* B'11' = Life Safety message */
+        /* B'10' = Critical Equipment message */
+        /* B'01' = Urgent message */
+        /* B'00' = Normal message */
+        npdu_data->priority = (BACNET_MESSAGE_PRIORITY) (npdu[1] & 0x03);
+        /* set the offset to where the optional stuff starts */
+        len = 2;
+        /*Bit 5: Destination specifier where: */
+        /* 0 = DNET, DLEN, DADR, and Hop Count absent */
+        /* 1 = DNET, DLEN, and Hop Count present */
+        /* DLEN = 0 denotes broadcast MAC DADR and DADR field is absent */
+        /* DLEN > 0 specifies length of DADR field */
+        if (npdu[1] & BIT5) {
+            len += decode_unsigned16(&npdu[len], &dest_net);
+            /* DLEN = 0 denotes broadcast MAC DADR and DADR field is absent */
+            /* DLEN > 0 specifies length of DADR field */
+            address_len = npdu[len++];
+            if (dest) {
+                dest->net = dest_net;
+                dest->len = address_len;
+            }
+            if (address_len) {
+                for (i = 0; i < address_len; i++) {
+                    mac_octet = npdu[len++];
+                    if (dest)
+                        dest->adr[i] = mac_octet;
+                }
+            }
+        }
+        /* zero out the destination address */
+        else if (dest) {
+            dest->net = 0;
+            dest->len = 0;
+            for (i = 0; i < MAX_MAC_LEN; i++) {
+                dest->adr[i] = 0;
+            }
+        }
+        /* Bit 3: Source specifier where: */
+        /* 0 =  SNET, SLEN, and SADR absent */
+        /* 1 =  SNET, SLEN, and SADR present */
+        /* SLEN = 0 Invalid */
+        /* SLEN > 0 specifies length of SADR field */
+        if (npdu[1] & BIT3) {
+            len += decode_unsigned16(&npdu[len], &src_net);
+            /* SLEN = 0 denotes broadcast MAC SADR and SADR field is absent */
+            /* SLEN > 0 specifies length of SADR field */
+            address_len = npdu[len++];
+            if (src) {
+                src->net = src_net;
+                src->len = address_len;
+            }
+            if (address_len) {
+                for (i = 0; i < address_len; i++) {
+                    mac_octet = npdu[len++];
+                    if (src)
+                        src->adr[i] = mac_octet;
+                }
+            }
+        } else if (src) {
+            src->net = 0;
+            src->len = 0;
+            for (i = 0; i < MAX_MAC_LEN; i++) {
+                src->adr[i] = 0;
+            }
+        }
+        /* The Hop Count field shall be present only if the message is */
+        /* destined for a remote network, i.e., if DNET is present. */
+        /* This is a one-octet field that is initialized to a value of 0xff. */
+        if (dest_net) {
+            npdu_data->hop_count = npdu[len++];
+        } else {
+            npdu_data->hop_count = 0;
+        }
+        /* Indicates that the NSDU conveys a network layer message. */
+        /* Message Type field is present. */
+        if (npdu_data->network_layer_message) {
+            npdu_data->network_message_type =
+                (BACNET_NETWORK_MESSAGE_TYPE) npdu[len++];
+            /* Message Type field contains a value in the range 0x80 - 0xFF, */
+            /* then a Vendor ID field shall be present */
+            if (npdu_data->network_message_type >= 0x80)
+                len += decode_unsigned16(&npdu[len], &npdu_data->vendor_id);
+        } else {
+            /* FIXME: another value for this? */
+            npdu_data->network_message_type = NETWORK_MESSAGE_INVALID;
+        }
+    }
+
+    return len;
+}
+
+extern void router_handler(
+    BACNET_ADDRESS *src,
+    BACNET_NPDU_DATA *npdu_data,
+    uint8_t * npdu,      /* PDU data */
+    uint16_t npdu_len);
+
+void npdu_handler(
+    BACNET_ADDRESS * src,       /* source address */
+    uint8_t * pdu,      /* PDU data */
+    uint16_t pdu_len)
+{       /* length PDU  */
+    int apdu_offset = 0;
+    BACNET_ADDRESS dest = { 0 };
+    BACNET_NPDU_DATA npdu_data = { 0 };
+
+    apdu_offset = npdu_decode(&pdu[0], &dest, src, &npdu_data);
+    if (npdu_data.network_layer_message) {
+        router_handler(src,&npdu_data,&pdu[apdu_offset],
+            (uint16_t) (pdu_len - apdu_offset));
+    } else if ((apdu_offset > 0) && (apdu_offset <= pdu_len)) {
+        if ((npdu_data.protocol_version == BACNET_PROTOCOL_VERSION) &&
+            ((dest.net == 0) || (dest.net == BACNET_BROADCAST_NETWORK))) {
+            /* only handle the version that we know how to handle */
+            /* and we are not a router, so ignore messages with
+               routing information cause they are not for us */
+            apdu_handler(src, &pdu[apdu_offset],
+                (uint16_t) (pdu_len - apdu_offset));
+        } else {
+            if (dest.net) {
+                debug_printf("NPDU: DNET=%d.  Discarded!\n", dest.net);
+            } else {
+                debug_printf("NPDU: BACnet Protocol Version=%d.  Discarded!\n",
+                    npdu_data.protocol_version);
+            }
+        }
+    }
+
+    return;
+}
+
+#ifdef TEST
+#include <assert.h>
+#include <string.h>
+#include "ctest.h"
+
+void testNPDU2(
+    Test * pTest)
+{
+    uint8_t pdu[480] = { 0 };
+    BACNET_ADDRESS dest = { 0 };
+    BACNET_ADDRESS src = { 0 };
+    BACNET_ADDRESS npdu_dest = { 0 };
+    BACNET_ADDRESS npdu_src = { 0 };
+    int len = 0;
+    bool data_expecting_reply = true;
+    BACNET_MESSAGE_PRIORITY priority = MESSAGE_PRIORITY_NORMAL;
+    BACNET_NPDU_DATA npdu_data = { 0 };
+    int i = 0;  /* counter */
+    int npdu_len = 0;
+    bool network_layer_message = false; /* false if APDU */
+    BACNET_NETWORK_MESSAGE_TYPE network_message_type = 0;       /* optional */
+    uint16_t vendor_id = 0;     /* optional, if net message type is > 0x80 */
+
+    dest.mac_len = 6;
+    for (i = 0; i < dest.mac_len; i++) {
+        dest.mac[i] = i;
+    }
+    /* DNET,DLEN,DADR */
+    dest.net = 1;
+    dest.len = 6;
+    for (i = 0; i < dest.len; i++) {
+        dest.adr[i] = i * 10;
+    }
+    src.mac_len = 1;
+    for (i = 0; i < src.mac_len; i++) {
+        src.mac[i] = 0x80;
+    }
+    /* SNET,SLEN,SADR */
+    src.net = 2;
+    src.len = 1;
+    for (i = 0; i < src.len; i++) {
+        src.adr[i] = 0x40;
+    }
+    npdu_encode_npdu_data(&npdu_data, true, priority);
+    len = npdu_encode_pdu(&pdu[0], &dest, &src, &npdu_data);
+    ct_test(pTest, len != 0);
+    /* can we get the info back? */
+    npdu_len = npdu_decode(&pdu[0], &npdu_dest, &npdu_src, &npdu_data);
+    ct_test(pTest, npdu_len != 0);
+    ct_test(pTest, npdu_data.data_expecting_reply == data_expecting_reply);
+    ct_test(pTest, npdu_data.network_layer_message == network_layer_message);
+    if (npdu_data.network_layer_message) {
+        ct_test(pTest, npdu_data.network_message_type == network_message_type);
+    }
+    ct_test(pTest, npdu_data.vendor_id == vendor_id);
+    ct_test(pTest, npdu_data.priority == priority);
+    /* DNET,DLEN,DADR */
+    ct_test(pTest, npdu_dest.net == dest.net);
+    ct_test(pTest, npdu_dest.len == dest.len);
+    for (i = 0; i < dest.len; i++) {
+        ct_test(pTest, npdu_dest.adr[i] == dest.adr[i]);
+    }
+    /* SNET,SLEN,SADR */
+    ct_test(pTest, npdu_src.net == src.net);
+    ct_test(pTest, npdu_src.len == src.len);
+    for (i = 0; i < src.len; i++) {
+        ct_test(pTest, npdu_src.adr[i] == src.adr[i]);
+    }
+}
+
+void testNPDU1(
+    Test * pTest)
+{
+    uint8_t pdu[480] = { 0 };
+    BACNET_ADDRESS dest = { 0 };
+    BACNET_ADDRESS src = { 0 };
+    BACNET_ADDRESS npdu_dest = { 0 };
+    BACNET_ADDRESS npdu_src = { 0 };
+    int len = 0;
+    bool data_expecting_reply = false;
+    BACNET_MESSAGE_PRIORITY priority = MESSAGE_PRIORITY_NORMAL;
+    BACNET_NPDU_DATA npdu_data = { 0 };
+    int i = 0;  /* counter */
+    int npdu_len = 0;
+    bool network_layer_message = false; /* false if APDU */
+    BACNET_NETWORK_MESSAGE_TYPE network_message_type = 0;       /* optional */
+    uint16_t vendor_id = 0;     /* optional, if net message type is > 0x80 */
+
+    /* mac_len = 0 if global address */
+    dest.mac_len = 0;
+    for (i = 0; i < MAX_MAC_LEN; i++) {
+        dest.mac[i] = 0;
+    }
+    /* DNET,DLEN,DADR */
+    dest.net = 0;
+    dest.len = 0;
+    for (i = 0; i < MAX_MAC_LEN; i++) {
+        dest.adr[i] = 0;
+    }
+    src.mac_len = 0;
+    for (i = 0; i < MAX_MAC_LEN; i++) {
+        src.mac[i] = 0;
+    }
+    /* SNET,SLEN,SADR */
+    src.net = 0;
+    src.len = 0;
+    for (i = 0; i < MAX_MAC_LEN; i++) {
+        src.adr[i] = 0;
+    }
+    npdu_encode_npdu_data(&npdu_data, false, priority);
+    len = npdu_encode_pdu(&pdu[0], &dest, &src, &npdu_data);
+    ct_test(pTest, len != 0);
+    /* can we get the info back? */
+    npdu_len = npdu_decode(&pdu[0], &npdu_dest, &npdu_src, &npdu_data);
+    ct_test(pTest, npdu_len != 0);
+    ct_test(pTest, npdu_data.data_expecting_reply == data_expecting_reply);
+    ct_test(pTest, npdu_data.network_layer_message == network_layer_message);
+    if (npdu_data.network_layer_message) {
+        ct_test(pTest, npdu_data.network_message_type == network_message_type);
+    }
+    ct_test(pTest, npdu_data.vendor_id == vendor_id);
+    ct_test(pTest, npdu_data.priority == priority);
+    ct_test(pTest, npdu_dest.mac_len == src.mac_len);
+    ct_test(pTest, npdu_src.mac_len == dest.mac_len);
+}
+
+#ifdef TEST_NPDU
+/* dummy stub for testing */
+void tsm_free_invoke_id(
+    uint8_t invokeID)
+{
+    (void) invokeID;
+}
+
+void iam_handler(
+    uint8_t * service_request,
+    uint16_t service_len,
+    BACNET_ADDRESS * src)
+{
+    (void) service_request;
+    (void) service_len;
+    (void) src;
+}
+
+int main(
+    void)
+{
+    Test *pTest;
+    bool rc;
+
+    pTest = ct_create("BACnet NPDU", NULL);
+    /* individual tests */
+    rc = ct_addTestFunction(pTest, testNPDU1);
+    assert(rc);
+    rc = ct_addTestFunction(pTest, testNPDU2);
+    assert(rc);
+
+    ct_setStream(pTest, stdout);
+    ct_run(pTest);
+    (void) ct_report(pTest);
+    ct_destroy(pTest);
+
+    return 0;
+}
+#endif /* TEST_NPDU */
+#endif /* TEST */

bacnet-stack/test/mstp.mak

@@ -16,19 +16,19 @@ SRCS = $(SRC_DIR)/mstp.c \
 TARGET = mstp
 
 all: ${TARGET}
- 
+
 OBJS = ${SRCS:.c=.o}
 
 ${TARGET}: ${OBJS}
-	${CC} -o $@ ${OBJS} 
+	${CC} -o $@ ${OBJS}
 
 .c.o:
 	${CC} -c ${CFLAGS} $*.c -o $@
-	
+
 depend:
 	rm -f .depend
 	${CC} -MM ${CFLAGS} *.c >> .depend
-	
+
 clean:
 	rm -rf core ${TARGET} $(OBJS)