diff --git a/bacnet-stack/demo/handler/h_wpm.c b/bacnet-stack/demo/handler/h_wpm.c new file mode 100644 index 00000000..9495efe2 --- /dev/null +++ b/bacnet-stack/demo/handler/h_wpm.c @@ -0,0 +1,187 @@ +/************************************************************************** +* +* Copyright (C) 2011 Krzysztof Malorny +* +* 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 +#include +#include +#include +#include +#include "config.h" +#include "txbuf.h" +#include "bacdef.h" +#include "bacdcode.h" +#include "bacerror.h" +#include "apdu.h" +#include "npdu.h" +#include "abort.h" +#include "wp.h" +#include "wpm.h" +/* device object has the handling for all objects */ +#include "device.h" +#include "handlers.h" + +/** @file h_wpm.c Handles Write Property Multiple requests. */ + + +/** Handler for a WriteProperty Service request. + * @ingroup DSWP + * This handler will be invoked by apdu_handler() if it has been enabled + * by a call to apdu_set_confirmed_handler(). + * This handler builds a response packet, which is + * - an Abort if + * - the message is segmented + * - if decoding fails + * - an ACK if Device_Write_Property_Multiple() succeeds + * - an Error if Device_Write_PropertyMultiple() encounters an error + * + * @param service_request [in] The contents of the service request. + * @param service_len [in] The length of the service_request. + * @param src [in] BACNET_ADDRESS of the source of the message + * @param service_data [in] The BACNET_CONFIRMED_SERVICE_DATA information + * decoded from the APDU header of this message. + */ + + + +void handler_write_property_multiple( + uint8_t * service_request, + uint16_t service_len, + BACNET_ADDRESS * src, + BACNET_CONFIRMED_SERVICE_DATA * service_data) +{ + int len = 0; + int apdu_len = 0; + int npdu_len = 0; + int pdu_len = 0; + int decode_len = 0; + bool error = false; + BACNET_WRITE_PROPERTY_DATA wp_data; + BACNET_NPDU_DATA npdu_data; + BACNET_ADDRESS my_address; + int bytes_sent = 0; + + + + if (service_data->segmented_message) { + len = abort_encode_apdu(&Handler_Transmit_Buffer[npdu_len], + service_data->invoke_id, + ABORT_REASON_SEGMENTATION_NOT_SUPPORTED, true); +#if PRINT_ENABLED + fprintf(stderr, "WPM: Segmented message. Sending Abort!\n"); +#endif + goto WPM_ABORT; + } + + /* decode service request */ + decode_len = 0; + do + { + // decode Object Identifier + len = wpm_decode_object_id(&service_request[decode_len], + service_len - decode_len, &wp_data); + if (len > 0) + { + uint8_t tag_number = 0; + + decode_len += len; + // Opening tag 1 - List of Properties + if (decode_is_opening_tag_number(&service_request[decode_len++], 1)) + { + do + { + // decode a 'Property Identifier'; (3) an optional 'Property Array Index'; + // (4) a 'Property Value'; and (5) an optional 'Priority'. + len = wpm_decode_object_property(&service_request[decode_len], + service_len - decode_len, &wp_data); + if (len > 0) + { + decode_len += len; + if (Device_Write_Property(&wp_data) == false) + { + error = true; + break; // do while (decoding List of Properties) + } + } + else + { +#if PRINT_ENABLED + fprintf(stderr, "Bad Encoding!\n"); +#endif + wp_data.error_class = ERROR_CLASS_PROPERTY; + wp_data.error_code = ERROR_CODE_OTHER; + error = true; + break; // do while (decoding List of Properties) + } + + // Closing tag 1 - List of Properties + if (decode_is_closing_tag_number(&service_request[decode_len], 1)) + { + tag_number = 1; + decode_len++; + } + else + tag_number = 0; // it was not tag 1, decode next Property Identifier ... + + } + while(tag_number != 1); // end decoding List of Properties for "that" object + + if (error) + break; //do while (decode service request) + } + } + else + { +#if PRINT_ENABLED + fprintf(stderr, "Bad Encoding!\n"); +#endif + wp_data.error_class = ERROR_CLASS_OBJECT; + wp_data.error_code = ERROR_CODE_OTHER; + error = true; + break; //do while (decode service request) + } + } + while(decode_len < service_len); + + + /* encode the NPDU portion of the packet */ + datalink_get_my_address(&my_address); + npdu_encode_npdu_data(&npdu_data, false, MESSAGE_PRIORITY_NORMAL); + npdu_len = npdu_encode_pdu(&Handler_Transmit_Buffer[0], src, &my_address, + &npdu_data); + + apdu_len = 0; + + if (error == false) + apdu_len = wpm_ack_encode_apdu_init(&Handler_Transmit_Buffer[npdu_len], + service_data->invoke_id); + else + apdu_len = wpm_error_ack_encode_apdu(&Handler_Transmit_Buffer[npdu_len], + service_data->invoke_id, &wp_data); + +WPM_ABORT: + + pdu_len = npdu_len + apdu_len; + bytes_sent = datalink_send_pdu(src, &npdu_data, &Handler_Transmit_Buffer[0], + pdu_len); +}