Added a PRINT_ENABLED define to allow small embedded devices without print capability to use some functions in this module.
This commit is contained in:
@@ -38,6 +38,7 @@
|
|||||||
#include "reject.h"
|
#include "reject.h"
|
||||||
#include "rd.h"
|
#include "rd.h"
|
||||||
|
|
||||||
|
static char *Password = "Jesus";
|
||||||
static BACNET_CHARACTER_STRING My_Password;
|
static BACNET_CHARACTER_STRING My_Password;
|
||||||
|
|
||||||
void handler_reinitialize_device(uint8_t * service_request,
|
void handler_reinitialize_device(uint8_t * service_request,
|
||||||
@@ -45,7 +46,7 @@ void handler_reinitialize_device(uint8_t * service_request,
|
|||||||
BACNET_ADDRESS * src, BACNET_CONFIRMED_SERVICE_DATA * service_data)
|
BACNET_ADDRESS * src, BACNET_CONFIRMED_SERVICE_DATA * service_data)
|
||||||
{
|
{
|
||||||
BACNET_REINITIALIZED_STATE state;
|
BACNET_REINITIALIZED_STATE state;
|
||||||
BACNET_CHARACTER_STRING password;
|
BACNET_CHARACTER_STRING their_password;
|
||||||
int len = 0;
|
int len = 0;
|
||||||
int pdu_len = 0;
|
int pdu_len = 0;
|
||||||
BACNET_ADDRESS my_address;
|
BACNET_ADDRESS my_address;
|
||||||
@@ -53,13 +54,15 @@ void handler_reinitialize_device(uint8_t * service_request,
|
|||||||
|
|
||||||
/* decode the service request only */
|
/* decode the service request only */
|
||||||
len = rd_decode_service_request(service_request,
|
len = rd_decode_service_request(service_request,
|
||||||
service_len, &state, &password);
|
service_len, &state, &their_password);
|
||||||
|
#if PRINT_ENABLED
|
||||||
fprintf(stderr, "ReinitializeDevice!\n");
|
fprintf(stderr, "ReinitializeDevice!\n");
|
||||||
if (len > 0)
|
if (len > 0)
|
||||||
fprintf(stderr, "ReinitializeDevice: state=%u password=%s\n",
|
fprintf(stderr, "ReinitializeDevice: state=%u password=%s\n",
|
||||||
(unsigned) state, characterstring_value(&password));
|
(unsigned) state, characterstring_value(&their_password));
|
||||||
else
|
else
|
||||||
fprintf(stderr, "ReinitializeDevice: Unable to decode request!\n");
|
fprintf(stderr, "ReinitializeDevice: Unable to decode request!\n");
|
||||||
|
#endif
|
||||||
/* prepare a reply */
|
/* prepare a reply */
|
||||||
datalink_get_my_address(&my_address);
|
datalink_get_my_address(&my_address);
|
||||||
/* encode the NPDU portion of the packet */
|
/* encode the NPDU portion of the packet */
|
||||||
@@ -69,26 +72,34 @@ void handler_reinitialize_device(uint8_t * service_request,
|
|||||||
if (len == -1) {
|
if (len == -1) {
|
||||||
pdu_len += abort_encode_apdu(&Handler_Transmit_Buffer[pdu_len],
|
pdu_len += abort_encode_apdu(&Handler_Transmit_Buffer[pdu_len],
|
||||||
service_data->invoke_id, ABORT_REASON_OTHER);
|
service_data->invoke_id, ABORT_REASON_OTHER);
|
||||||
|
#if PRINT_ENABLED
|
||||||
fprintf(stderr,
|
fprintf(stderr,
|
||||||
"ReinitializeDevice: Sending Abort - could not decode.\n");
|
"ReinitializeDevice: Sending Abort - could not decode.\n");
|
||||||
|
#endif
|
||||||
} else if (service_data->segmented_message) {
|
} else if (service_data->segmented_message) {
|
||||||
pdu_len += abort_encode_apdu(&Handler_Transmit_Buffer[pdu_len],
|
pdu_len += abort_encode_apdu(&Handler_Transmit_Buffer[pdu_len],
|
||||||
service_data->invoke_id,
|
service_data->invoke_id,
|
||||||
ABORT_REASON_SEGMENTATION_NOT_SUPPORTED);
|
ABORT_REASON_SEGMENTATION_NOT_SUPPORTED);
|
||||||
|
#if PRINT_ENABLED
|
||||||
fprintf(stderr,
|
fprintf(stderr,
|
||||||
"ReinitializeDevice: Sending Abort - segmented message.\n");
|
"ReinitializeDevice: Sending Abort - segmented message.\n");
|
||||||
|
#endif
|
||||||
} else if (state >= MAX_BACNET_REINITIALIZED_STATE) {
|
} else if (state >= MAX_BACNET_REINITIALIZED_STATE) {
|
||||||
pdu_len += reject_encode_apdu(&Handler_Transmit_Buffer[pdu_len],
|
pdu_len += reject_encode_apdu(&Handler_Transmit_Buffer[pdu_len],
|
||||||
service_data->invoke_id, REJECT_REASON_UNDEFINED_ENUMERATION);
|
service_data->invoke_id, REJECT_REASON_UNDEFINED_ENUMERATION);
|
||||||
|
#if PRINT_ENABLED
|
||||||
fprintf(stderr,
|
fprintf(stderr,
|
||||||
"ReinitializeDevice: Sending Reject - undefined enumeration\n");
|
"ReinitializeDevice: Sending Reject - undefined enumeration\n");
|
||||||
|
#endif
|
||||||
} else {
|
} else {
|
||||||
characterstring_init_ansi(&My_Password, "Jesus");
|
characterstring_init_ansi(&My_Password, Password);
|
||||||
if (characterstring_same(&password, &My_Password)) {
|
if (characterstring_same(&their_password, &My_Password)) {
|
||||||
pdu_len += encode_simple_ack(&Handler_Transmit_Buffer[pdu_len],
|
pdu_len += encode_simple_ack(&Handler_Transmit_Buffer[pdu_len],
|
||||||
service_data->invoke_id,
|
service_data->invoke_id,
|
||||||
SERVICE_CONFIRMED_REINITIALIZE_DEVICE);
|
SERVICE_CONFIRMED_REINITIALIZE_DEVICE);
|
||||||
|
#if PRINT_ENABLED
|
||||||
fprintf(stderr, "ReinitializeDevice: Sending Simple Ack!\n");
|
fprintf(stderr, "ReinitializeDevice: Sending Simple Ack!\n");
|
||||||
|
#endif
|
||||||
/* FIXME: now you can reboot, restart, quit, or something clever */
|
/* FIXME: now you can reboot, restart, quit, or something clever */
|
||||||
/* Note: you can use a mix of state and password to do specific stuff */
|
/* Note: you can use a mix of state and password to do specific stuff */
|
||||||
/* Note: if you don't do something clever like actually restart,
|
/* Note: if you don't do something clever like actually restart,
|
||||||
@@ -99,15 +110,19 @@ void handler_reinitialize_device(uint8_t * service_request,
|
|||||||
service_data->invoke_id,
|
service_data->invoke_id,
|
||||||
SERVICE_CONFIRMED_REINITIALIZE_DEVICE,
|
SERVICE_CONFIRMED_REINITIALIZE_DEVICE,
|
||||||
ERROR_CLASS_SERVICES, ERROR_CODE_PASSWORD_FAILURE);
|
ERROR_CLASS_SERVICES, ERROR_CODE_PASSWORD_FAILURE);
|
||||||
|
#if PRINT_ENABLED
|
||||||
fprintf(stderr,
|
fprintf(stderr,
|
||||||
"ReinitializeDevice: Sending Error - password failure.\n");
|
"ReinitializeDevice: Sending Error - password failure.\n");
|
||||||
|
#endif
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
bytes_sent = datalink_send_pdu(src, /* destination address */
|
bytes_sent = datalink_send_pdu(src, /* destination address */
|
||||||
&Handler_Transmit_Buffer[0], pdu_len); /* number of bytes of data */
|
&Handler_Transmit_Buffer[0], pdu_len); /* number of bytes of data */
|
||||||
|
#if PRINT_ENABLED
|
||||||
if (bytes_sent <= 0)
|
if (bytes_sent <= 0)
|
||||||
fprintf(stderr, "ReinitializeDevice: Failed to send PDU (%s)!\n",
|
fprintf(stderr, "ReinitializeDevice: Failed to send PDU (%s)!\n",
|
||||||
strerror(errno));
|
strerror(errno));
|
||||||
|
#endif
|
||||||
|
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|||||||
Reference in New Issue
Block a user