Added code to handle Life Safety Operation service.

2009-01-23 00:34:55 +00:00
parent 93826be9e5
commit 89fc2810f3
6 changed files with 380 additions and 7 deletions
@@ -0,0 +1,121 @@
+/**************************************************************************
+*
+* Copyright (C) 2005 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.
+*
+*********************************************************************/
+#include <stddef.h>
+#include <stdint.h>
+#include <stdio.h>
+#include <string.h>
+#include <errno.h>
+#include "config.h"
+#include "txbuf.h"
+#include "bacdef.h"
+#include "bacdcode.h"
+#include "apdu.h"
+#include "npdu.h"
+#include "abort.h"
+#include "lso.h"
+#include "handlers.h"
+
+bool handler_lso(
+    uint8_t * service_request,
+    uint16_t service_len,
+    BACNET_ADDRESS * src,
+    BACNET_CONFIRMED_SERVICE_DATA * service_data)
+{
+    BACNET_LSO_DATA    data;
+    int                len = 0;
+    int                pdu_len = 0;
+    BACNET_NPDU_DATA   npdu_data;
+    int                bytes_sent = 0;
+    BACNET_ADDRESS     my_address;
+
+    /* encode the NPDU portion of the packet */
+    datalink_get_my_address(&my_address);
+    npdu_encode_npdu_data(&npdu_data, false, MESSAGE_PRIORITY_NORMAL);
+    pdu_len =
+        npdu_encode_pdu(&Handler_Transmit_Buffer[0], src, &my_address,
+        &npdu_data);
+    if (service_data->segmented_message) {
+        /* we don't support segmentation - send an abort */
+        len =
+            abort_encode_apdu(&Handler_Transmit_Buffer[pdu_len],
+            service_data->invoke_id, ABORT_REASON_SEGMENTATION_NOT_SUPPORTED,
+            true);
+#if PRINT_ENABLED
+        fprintf(stderr, "LSO: Segmented message.  Sending Abort!\n");
+#endif
+        goto LSO_ABORT;
+    }
+
+    len = lso_decode_service_request(service_request, service_len, &data);
+#if PRINT_ENABLED
+    if (len <= 0)
+        fprintf(stderr, "LSO: Unable to decode Request!\n");
+#endif
+    if (len < 0) {
+        /* bad decoding - send an abort */
+        len =
+            abort_encode_apdu(&Handler_Transmit_Buffer[pdu_len],
+            service_data->invoke_id, ABORT_REASON_OTHER, true);
+#if PRINT_ENABLED
+        fprintf(stderr, "LSO: Bad Encoding.  Sending Abort!\n");
+#endif
+        goto LSO_ABORT;
+    }
+
+	/*
+	** Process Life Safety Operation Here
+	*/
+#if PRINT_ENABLED
+    fprintf(stderr,
+        "Life Safety Operation: Received operation %d from process id %d for object %id\n", 
+			data.operation,
+			data.processId,
+			data.targetObject.instance);
+#endif
+
+    len =
+        encode_simple_ack(&Handler_Transmit_Buffer[pdu_len],
+        service_data->invoke_id,
+        SERVICE_CONFIRMED_LIFE_SAFETY_OPERATION);
+#if PRINT_ENABLED
+    fprintf(stderr,
+        "Life Safety Operation: " "Sending Simple Ack!\n");
+#endif
+
+  LSO_ABORT:
+    pdu_len += len;
+    bytes_sent =
+        datalink_send_pdu(src, &npdu_data, &Handler_Transmit_Buffer[0],
+        pdu_len);
+#if PRINT_ENABLED
+    if (bytes_sent <= 0)
+        fprintf(stderr,
+            "Life Safety Operation: " "Failed to send PDU (%s)!\n",
+            strerror(errno));
+#endif
+
+    return;
+}
+