mirror of
https://github.com/stargieg/bacnet-stack
synced 2025-10-26 23:35:52 +08:00
349 lines
12 KiB
C
349 lines
12 KiB
C
/**************************************************************************
|
|
*
|
|
* Copyright (C) 2006 Steve Karg <skarg@users.sourceforge.net>
|
|
*
|
|
* Permission is hereby granted, free of charge, to any person obtaining
|
|
* a copy of this software and associated documentation files (the
|
|
* "Software"), to deal in the Software without restriction, including
|
|
* without limitation the rights to use, copy, modify, merge, publish,
|
|
* distribute, sublicense, and/or sell copies of the Software, and to
|
|
* permit persons to whom the Software is furnished to do so, subject to
|
|
* the following conditions:
|
|
*
|
|
* The above copyright notice and this permission notice shall be included
|
|
* in all copies or substantial portions of the Software.
|
|
*
|
|
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
|
|
* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
|
|
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.
|
|
* IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY
|
|
* CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT,
|
|
* TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE
|
|
* SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
|
|
*
|
|
*********************************************************************/
|
|
/**
|
|
* Code for this project began with code from the demo/server project and
|
|
* Paul Chapman's vmac project.
|
|
*/
|
|
|
|
#include <stddef.h>
|
|
#include <stdint.h>
|
|
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <signal.h>
|
|
#include <time.h>
|
|
#include "config.h"
|
|
#include "gateway.h"
|
|
#include "address.h"
|
|
#include "bacdef.h"
|
|
#include "handlers.h"
|
|
#include "client.h"
|
|
#include "dlenv.h"
|
|
#include "bacdcode.h"
|
|
#include "npdu.h"
|
|
#include "apdu.h"
|
|
#include "iam.h"
|
|
#include "tsm.h"
|
|
#include "device.h"
|
|
#include "bacfile.h"
|
|
#include "datalink.h"
|
|
#include "dcc.h"
|
|
#include "net.h"
|
|
#include "txbuf.h"
|
|
#include "lc.h"
|
|
#include "debug.h"
|
|
#include "version.h"
|
|
/* include the device object */
|
|
#include "device.h"
|
|
#ifdef BACNET_TEST_VMAC
|
|
#include "vmac.h"
|
|
#endif
|
|
|
|
/** @file gateway/main.c Example virtual gateway application using the BACnet Stack. */
|
|
|
|
/* Prototypes */
|
|
|
|
/* (Doxygen note: The next two lines pull all the following Javadoc
|
|
* into the GatewayDemo module.) */
|
|
/** @addtogroup GatewayDemo */
|
|
/*@{*/
|
|
|
|
/** Buffer used for receiving */
|
|
static uint8_t Rx_Buf[MAX_MPDU] = { 0 };
|
|
|
|
/** The list of DNETs that our router can reach.
|
|
* Only one entry since we don't support downstream routers.
|
|
*/
|
|
int DNET_list[2] = {
|
|
VIRTUAL_DNET, -1 /* Need -1 terminator */
|
|
};
|
|
|
|
|
|
|
|
/** Initialize the Device Objects and each of the child Object instances.
|
|
* @param first_object_instance Set the first (gateway) Device to this
|
|
instance number, and subsequent devices to incremented values.
|
|
*/
|
|
static void Devices_Init(
|
|
uint32_t first_object_instance)
|
|
{
|
|
int i;
|
|
char nameText[MAX_DEV_NAME_LEN];
|
|
char descText[MAX_DEV_DESC_LEN];
|
|
BACNET_CHARACTER_STRING name_string;
|
|
|
|
/* Gateway Device has already been initialized.
|
|
* But give it a better Description. */
|
|
Routed_Device_Set_Description(DEV_DESCR_GATEWAY,
|
|
strlen(DEV_DESCR_GATEWAY));
|
|
|
|
/* Now initialize the remote Device objects. */
|
|
for (i = 1; i < MAX_NUM_DEVICES; i++) {
|
|
#ifdef _MSC_VER
|
|
_snprintf(nameText, MAX_DEV_NAME_LEN, "%s %d", DEV_NAME_BASE, i + 1);
|
|
_snprintf(descText, MAX_DEV_DESC_LEN, "%s %d", DEV_DESCR_REMOTE, i);
|
|
#else
|
|
snprintf(nameText, MAX_DEV_NAME_LEN, "%s %d", DEV_NAME_BASE, i + 1);
|
|
snprintf(descText, MAX_DEV_DESC_LEN, "%s %d", DEV_DESCR_REMOTE, i);
|
|
#endif
|
|
characterstring_init_ansi(&name_string, nameText);
|
|
|
|
Add_Routed_Device((first_object_instance + i), &name_string, descText);
|
|
}
|
|
|
|
}
|
|
|
|
|
|
/** Initialize the handlers we will utilize.
|
|
* @see Device_Init, apdu_set_unconfirmed_handler, apdu_set_confirmed_handler
|
|
*/
|
|
static void Init_Service_Handlers(
|
|
uint32_t first_object_instance)
|
|
{
|
|
Device_Init(NULL);
|
|
Routing_Device_Init(first_object_instance);
|
|
|
|
/* we need to handle who-is to support dynamic device binding
|
|
* For the gateway, we will use the unicast variety so we can
|
|
* get back through switches to different subnets.
|
|
* Don't need the routed versions, since the npdu handler calls
|
|
* each device in turn.
|
|
*/
|
|
apdu_set_unconfirmed_handler(SERVICE_UNCONFIRMED_WHO_IS,
|
|
handler_who_is_unicast);
|
|
apdu_set_unconfirmed_handler(SERVICE_UNCONFIRMED_WHO_HAS, handler_who_has);
|
|
/* set the handler for all the services we don't implement */
|
|
/* It is required to send the proper reject message... */
|
|
apdu_set_unrecognized_service_handler_handler
|
|
(handler_unrecognized_service);
|
|
/* Set the handlers for any confirmed services that we support. */
|
|
/* We must implement read property - it's required! */
|
|
apdu_set_confirmed_handler(SERVICE_CONFIRMED_READ_PROPERTY,
|
|
handler_read_property);
|
|
apdu_set_confirmed_handler(SERVICE_CONFIRMED_READ_PROP_MULTIPLE,
|
|
handler_read_property_multiple);
|
|
apdu_set_confirmed_handler(SERVICE_CONFIRMED_WRITE_PROPERTY,
|
|
handler_write_property);
|
|
apdu_set_confirmed_handler(SERVICE_CONFIRMED_READ_RANGE,
|
|
handler_read_range);
|
|
#if defined(BACFILE)
|
|
apdu_set_confirmed_handler(SERVICE_CONFIRMED_ATOMIC_READ_FILE,
|
|
handler_atomic_read_file);
|
|
apdu_set_confirmed_handler(SERVICE_CONFIRMED_ATOMIC_WRITE_FILE,
|
|
handler_atomic_write_file);
|
|
#endif
|
|
apdu_set_confirmed_handler(SERVICE_CONFIRMED_REINITIALIZE_DEVICE,
|
|
handler_reinitialize_device);
|
|
apdu_set_unconfirmed_handler(SERVICE_UNCONFIRMED_UTC_TIME_SYNCHRONIZATION,
|
|
handler_timesync_utc);
|
|
apdu_set_unconfirmed_handler(SERVICE_UNCONFIRMED_TIME_SYNCHRONIZATION,
|
|
handler_timesync);
|
|
apdu_set_confirmed_handler(SERVICE_CONFIRMED_SUBSCRIBE_COV,
|
|
handler_cov_subscribe);
|
|
apdu_set_unconfirmed_handler(SERVICE_UNCONFIRMED_COV_NOTIFICATION,
|
|
handler_ucov_notification);
|
|
/* handle communication so we can shutup when asked */
|
|
apdu_set_confirmed_handler(SERVICE_CONFIRMED_DEVICE_COMMUNICATION_CONTROL,
|
|
handler_device_communication_control);
|
|
}
|
|
|
|
/** Initialize the BACnet Device Addresses for each Device object.
|
|
* The gateway has already gotten the normal address (eg, PC's IP for BIP) and
|
|
* the remote devices get
|
|
* - For BIP, the IP address reversed, and 4th byte equal to index.
|
|
* (Eg, 11.22.33.44 for the gateway becomes 44.33.22.01 for the first remote
|
|
* device.) This is sure to be unique! The port number stays the same.
|
|
* - For MS/TP, [Steve inserts a good idea here]
|
|
*/
|
|
static void Initialize_Device_Addresses(
|
|
)
|
|
{
|
|
int i = 0; /* First entry is Gateway Device */
|
|
uint32_t virtual_mac = 0;
|
|
DEVICE_OBJECT_DATA *pDev = NULL;
|
|
/* Setup info for the main gateway device first */
|
|
pDev = Get_Routed_Device_Object(i);
|
|
#if defined(BACDL_BIP)
|
|
uint16_t myPort;
|
|
struct in_addr *netPtr; /* Lets us cast to this type */
|
|
uint8_t *gatewayMac = NULL;
|
|
uint32_t myAddr = bip_get_addr();
|
|
gatewayMac = pDev->bacDevAddr.mac; /* Keep pointer to the main MAC */
|
|
memcpy(pDev->bacDevAddr.mac, &myAddr, 4);
|
|
myPort = bip_get_port();
|
|
memcpy(&pDev->bacDevAddr.mac[4], &myPort, 2);
|
|
pDev->bacDevAddr.mac_len = 6;
|
|
#elif defined(BACDL_MSTP)
|
|
pDev->bacDevAddr.mac_len = 1;
|
|
pDev->bacDevAddr.mac[0] = dlmstp_mac_address();
|
|
#else
|
|
#error "No support for this Data Link Layer type "
|
|
#endif
|
|
/* broadcast an I-Am on startup */
|
|
Send_I_Am(&Handler_Transmit_Buffer[0]);
|
|
|
|
for (i = 1; i < MAX_NUM_DEVICES; i++) {
|
|
pDev = Get_Routed_Device_Object(i);
|
|
if (pDev == NULL)
|
|
continue;
|
|
#if defined(BACDL_BIP)
|
|
virtual_mac = i;
|
|
netPtr = (struct in_addr *) pDev->bacDevAddr.mac;
|
|
#if (MAX_NUM_DEVICES > 0xFFFFFF)
|
|
pDev->bacDevAddr.mac[0] = ((virtual_mac & 0xff000000) >> 24);
|
|
#else
|
|
pDev->bacDevAddr.mac[0] = gatewayMac[3];
|
|
#endif
|
|
#if (MAX_NUM_DEVICES > 0xFFFF)
|
|
pDev->bacDevAddr.mac[1] = ((virtual_mac & 0xff0000) >> 16);
|
|
#else
|
|
pDev->bacDevAddr.mac[1] = gatewayMac[2];
|
|
#endif
|
|
#if (MAX_NUM_DEVICES > 0xFF)
|
|
pDev->bacDevAddr.mac[2] = ((virtual_mac & 0xff00) >> 8);
|
|
#else
|
|
pDev->bacDevAddr.mac[2] = gatewayMac[1];
|
|
#endif
|
|
pDev->bacDevAddr.mac[3] = (virtual_mac & 0xff);
|
|
memcpy(&pDev->bacDevAddr.mac[4], &myPort, 2);
|
|
pDev->bacDevAddr.mac_len = 6;
|
|
pDev->bacDevAddr.net = VIRTUAL_DNET;
|
|
memcpy(&pDev->bacDevAddr.adr[0], &pDev->bacDevAddr.mac[0], 6);
|
|
pDev->bacDevAddr.len = 6;
|
|
printf(" - Routed device [%d] ID %u at %s \n", i,
|
|
pDev->bacObj.Object_Instance_Number, inet_ntoa(*netPtr));
|
|
#elif defined(BACDL_MSTP)
|
|
/* Todo: set MS/TP net and port #s */
|
|
pDev->bacDevAddr.mac_len = 2;
|
|
#endif
|
|
/* broadcast an I-Am for each routed Device now */
|
|
Send_I_Am(&Handler_Transmit_Buffer[0]);
|
|
|
|
}
|
|
}
|
|
|
|
/** Main function of server demo.
|
|
*
|
|
* @see Device_Set_Object_Instance_Number, dlenv_init, Send_I_Am,
|
|
* datalink_receive, npdu_handler,
|
|
* dcc_timer_seconds, bvlc_maintenance_timer,
|
|
* Load_Control_State_Machine_Handler, handler_cov_task,
|
|
* tsm_timer_milliseconds
|
|
*
|
|
* @param argc [in] Arg count.
|
|
* @param argv [in] Takes one argument: the Device Instance #.
|
|
* @return 0 on success.
|
|
*/
|
|
int main(
|
|
int argc,
|
|
char *argv[])
|
|
{
|
|
BACNET_ADDRESS src = {
|
|
0
|
|
}; /* address where message came from */
|
|
uint16_t pdu_len = 0;
|
|
unsigned timeout = 1000; /* milliseconds */
|
|
time_t last_seconds = 0;
|
|
time_t current_seconds = 0;
|
|
uint32_t elapsed_seconds = 0;
|
|
uint32_t elapsed_milliseconds = 0;
|
|
uint32_t first_object_instance = FIRST_DEVICE_NUMBER;
|
|
#ifdef BACNET_TEST_VMAC
|
|
/* Router data */
|
|
BACNET_DEVICE_PROFILE *device;
|
|
BACNET_VMAC_ADDRESS adr;
|
|
#endif
|
|
|
|
/* allow the device ID to be set */
|
|
if (argc > 1) {
|
|
first_object_instance = strtol(argv[1], NULL, 0);
|
|
if ((first_object_instance == 0) ||
|
|
(first_object_instance >= BACNET_MAX_INSTANCE)) {
|
|
printf("Error: Invalid Object Instance %s \n", argv[1]);
|
|
printf("Provide a number from 1 to %ul \n",
|
|
BACNET_MAX_INSTANCE - 1);
|
|
exit(1);
|
|
}
|
|
}
|
|
printf("BACnet Router Demo\n" "BACnet Stack Version %s\n"
|
|
"BACnet Device ID: %u\n" "Max APDU: %d\n", BACnet_Version,
|
|
first_object_instance, MAX_APDU);
|
|
Init_Service_Handlers(first_object_instance);
|
|
dlenv_init();
|
|
atexit(datalink_cleanup);
|
|
Devices_Init(first_object_instance);
|
|
Initialize_Device_Addresses();
|
|
|
|
#ifdef BACNET_TEST_VMAC
|
|
/* initialize vmac table and router device */
|
|
device = vmac_initialize(99, 2001);
|
|
debug_printf(device->name, "ROUTER:%u", vmac_get_subnet());
|
|
#endif
|
|
/* configure the timeout values */
|
|
last_seconds = time(NULL);
|
|
|
|
/* broadcast an I-am-router-to-network on startup */
|
|
printf("Remote Network DNET Number %d \n", DNET_list[0]);
|
|
Send_I_Am_Router_To_Network(DNET_list);
|
|
|
|
/* loop forever */
|
|
for (;;) {
|
|
/* input */
|
|
current_seconds = time(NULL);
|
|
|
|
/* returns 0 bytes on timeout */
|
|
pdu_len = datalink_receive(&src, &Rx_Buf[0], MAX_MPDU, timeout);
|
|
|
|
/* process */
|
|
if (pdu_len) {
|
|
routing_npdu_handler(&src, DNET_list, &Rx_Buf[0], pdu_len);
|
|
}
|
|
/* at least one second has passed */
|
|
elapsed_seconds = current_seconds - last_seconds;
|
|
if (elapsed_seconds) {
|
|
last_seconds = current_seconds;
|
|
dcc_timer_seconds(elapsed_seconds);
|
|
#if defined(BACDL_BIP) && BBMD_ENABLED
|
|
bvlc_maintenance_timer(elapsed_seconds);
|
|
#endif
|
|
dlenv_maintenance_timer(elapsed_seconds);
|
|
#if defined(LC)
|
|
Load_Control_State_Machine_Handler();
|
|
#endif
|
|
elapsed_milliseconds = elapsed_seconds * 1000;
|
|
tsm_timer_milliseconds(elapsed_milliseconds);
|
|
}
|
|
handler_cov_task();
|
|
/* output */
|
|
|
|
/* blink LEDs, Turn on or off outputs, etc */
|
|
}
|
|
/* Dummy return */
|
|
return 0;
|
|
}
|
|
|
|
/* @} */
|
|
|
|
/* End group GatewayDemo */
|