adding BACnet/IP to the Linux port

bacnet-stack/ports/linux/main.c

@@ -26,26 +26,93 @@
 #include <stddef.h>
 #include <stdint.h>
 #include <stdio.h>
+#include <stdlib.h>
+#include <signal.h>
 #include "config.h"
 #include "bacdef.h"
+#include "handlers.h"
 #include "bacdcode.h"
 #include "npdu.h"
 #include "apdu.h"
 #include "device.h"
-#include "ai.h"
-#include "rp.h"
-#include "wp.h"
-#include "iam.h"
-#include "whois.h"
-#include "reject.h"
-#include "abort.h"
-#include "bacerror.h"
-#include "ethernet.h"
-#include "handlers.h"
+#ifdef BACDL_ETHERNET
+  #include "ethernet.h"
+#endif
+#ifdef BACDL_BIP
+  #include "bip.h"
+#endif
+#include "net.h"
 
 // buffers used for receiving
 static uint8_t Rx_Buf[MAX_MPDU] = {0};
 
+static int get_local_ifr_ioctl(char *ifname, struct ifreq *ifr, int request)
+{
+    int fd;
+    int rv;                     // return value
+
+    strncpy(ifr->ifr_name, ifname, sizeof(ifr->ifr_name));
+    fd = socket(AF_INET, SOCK_DGRAM, IPPROTO_IP);
+    if (fd < 0)
+        rv = fd;
+    else
+        rv = ioctl(fd, request, ifr);
+
+    return rv;
+}
+
+static int get_local_address_ioctl(
+    char *ifname, 
+    struct in_addr *addr,
+    int request)
+{
+    struct ifreq ifr = { {{0}} };
+    struct sockaddr_in *tcpip_address;
+    int rv;                     // return value
+
+    rv = get_local_ifr_ioctl(ifname,&ifr,request);
+    if (rv >= 0) {
+        tcpip_address = (struct sockaddr_in *) &ifr.ifr_addr;
+        memcpy(addr, &tcpip_address->sin_addr, sizeof(struct in_addr));
+    }
+
+    return rv;
+}
+
+static void decode_network_address(struct in_addr *net_address,
+    uint8_t *octet1, uint8_t *octet2, uint8_t *octet3, uint8_t *octet4)
+{
+    union {
+        uint8_t byte[4];
+        uint32_t value;
+    } long_data = {{0}};
+
+    long_data.value = net_address->s_addr;
+
+    *octet1 = long_data.byte[0];
+    *octet2 = long_data.byte[1];
+    *octet3 = long_data.byte[2];
+    *octet4 = long_data.byte[3];
+}
+
+static void Init_Network(char *ifname)
+{
+    struct in_addr local_address;
+    uint8_t octet1; 
+    uint8_t octet2; 
+    uint8_t octet3; 
+    uint8_t octet4;
+
+    /* setup local address */
+    get_local_address_ioctl(ifname, &local_address, SIOCGIFADDR);
+    decode_network_address(&local_address, &octet1, &octet2, &octet3, &octet4);
+    #ifdef BACDL_BIP
+    bip_set_address(octet1, octet2, octet3, octet4);
+    #endif
+    fprintf(stderr,"IP Address: %d.%d.%d.%d\n",
+      (int)octet1, (int)octet2, (int)octet3, (int)octet4);   
+}
+
 static void Init_Device_Parameters(void)
 {
   // configure my initial values
@@ -83,17 +150,42 @@ static void Init_Service_Handlers(void)
     WritePropertyHandler);
 }
 
+static void sig_handler(int signo)
+{
+  #ifdef BACDL_ETHERNET
+  ethernet_cleanup();
+  #endif
+  #ifdef BACDL_BIP
+  bip_cleanup();
+  #endif
+
+  exit(0);
+}
+
 int main(int argc, char *argv[])
 {
   BACNET_ADDRESS src = {0};  // address where message came from
   uint16_t pdu_len = 0;
   unsigned timeout = 100; // milliseconds
 
+  // Linux specials
+  signal(SIGINT, sig_handler);
+  signal(SIGHUP, sig_handler);
+  signal(SIGTERM, sig_handler);
+  // setup this BACnet Server
   Init_Device_Parameters();
   Init_Service_Handlers();
+  #ifdef BACDL_ETHERNET
   // init the physical layer
   if (!ethernet_init("eth0"))
     return 1;
+  #endif
+  #ifdef BACDL_BIP
+  Init_Network("eth0");
+  if (!bip_init())
+    return 1;
+  #endif
+
   
   // loop forever
   for (;;)
@@ -101,11 +193,20 @@ int main(int argc, char *argv[])
     // input
 
     // returns 0 bytes on timeout
+    #ifdef BACDL_ETHERNET
     pdu_len = ethernet_receive(
       &src,
       &Rx_Buf[0],
       MAX_MPDU,
       timeout);
+    #endif
+    #ifdef BACDL_BIP
+    pdu_len = bip_receive(
+      &src,
+      &Rx_Buf[0],
+      MAX_MPDU,
+      timeout);
+    #endif
 
     // process
     if (pdu_len)