386 lines
14 KiB
C
386 lines
14 KiB
C
/**************************************************************************
|
|
*
|
|
* Copyright (C) 2006 Steve Karg <skarg@users.sourceforge.net>
|
|
*
|
|
* SPDX-License-Identifier: MIT
|
|
*
|
|
*********************************************************************/
|
|
|
|
/* Analog Value Objects - customize for your use */
|
|
|
|
#include <stdbool.h>
|
|
#include <stdint.h>
|
|
#include <stdio.h>
|
|
#include "bacnet/bacdef.h"
|
|
#include "bacnet/bacdcode.h"
|
|
#include "bacnet/bacenum.h"
|
|
#include "bacnet/bacapp.h"
|
|
#include "bacnet/config.h" /* the custom stuff */
|
|
#include "bacnet/wp.h"
|
|
#include "bacnet/rp.h"
|
|
#include "bacnet/basic/object/av.h"
|
|
|
|
#define MAX_ANALOG_VALUES 4
|
|
|
|
/* we choose to have a NULL level in our system represented by */
|
|
/* a particular value. When the priorities are not in use, they */
|
|
/* will be relinquished (i.e. set to the NULL level). */
|
|
#define ANALOG_LEVEL_NULL 255
|
|
/* When all the priorities are level null, the present value returns */
|
|
/* the Relinquish Default value */
|
|
#define ANALOG_RELINQUISH_DEFAULT 0
|
|
/* Here is our Present_Value. They are supposed to be Real, but */
|
|
/* we don't have that kind of memory, so we will use a single byte */
|
|
/* and load a Real for returning the value when asked. */
|
|
static uint8_t Present_Value[MAX_ANALOG_VALUES];
|
|
|
|
/* we need to have our arrays initialized before answering any calls */
|
|
static bool Analog_Value_Initialized = false;
|
|
|
|
void Analog_Value_Init(void)
|
|
{
|
|
unsigned i;
|
|
|
|
if (!Analog_Value_Initialized) {
|
|
Analog_Value_Initialized = true;
|
|
|
|
/* initialize all the analog output priority arrays to NULL */
|
|
for (i = 0; i < MAX_ANALOG_VALUES; i++) {
|
|
Present_Value[i] = ANALOG_LEVEL_NULL;
|
|
}
|
|
}
|
|
|
|
return;
|
|
}
|
|
|
|
/* we simply have 0-n object instances. Yours might be */
|
|
/* more complex, and then you need validate that the */
|
|
/* given instance exists */
|
|
bool Analog_Value_Valid_Instance(uint32_t object_instance)
|
|
{
|
|
Analog_Value_Init();
|
|
if (object_instance < MAX_ANALOG_VALUES)
|
|
return true;
|
|
|
|
return false;
|
|
}
|
|
|
|
/* we simply have 0-n object instances. Yours might be */
|
|
/* more complex, and then count how many you have */
|
|
unsigned Analog_Value_Count(void)
|
|
{
|
|
Analog_Value_Init();
|
|
return MAX_ANALOG_VALUES;
|
|
}
|
|
|
|
/* we simply have 0-n object instances. Yours might be */
|
|
/* more complex, and then you need to return the instance */
|
|
/* that correlates to the correct index */
|
|
uint32_t Analog_Value_Index_To_Instance(unsigned index)
|
|
{
|
|
Analog_Value_Init();
|
|
return index;
|
|
}
|
|
|
|
/* we simply have 0-n object instances. Yours might be */
|
|
/* more complex, and then you need to return the index */
|
|
/* that correlates to the correct instance number */
|
|
unsigned Analog_Value_Instance_To_Index(uint32_t object_instance)
|
|
{
|
|
unsigned index = MAX_ANALOG_VALUES;
|
|
|
|
Analog_Value_Init();
|
|
if (object_instance < MAX_ANALOG_VALUES)
|
|
index = object_instance;
|
|
|
|
return index;
|
|
}
|
|
|
|
float Analog_Value_Present_Value(uint32_t object_instance)
|
|
{
|
|
float value = ANALOG_RELINQUISH_DEFAULT;
|
|
unsigned index = 0;
|
|
unsigned i = 0;
|
|
|
|
Analog_Value_Init();
|
|
index = Analog_Value_Instance_To_Index(object_instance);
|
|
if (index < MAX_ANALOG_VALUES) {
|
|
value = Present_Value[index];
|
|
}
|
|
|
|
return value;
|
|
}
|
|
|
|
/* note: the object name must be unique within this device */
|
|
char *Analog_Value_Name(uint32_t object_instance)
|
|
{
|
|
static char text[32] = ""; /* okay for single thread */
|
|
|
|
if (object_instance < MAX_ANALOG_VALUES) {
|
|
snprintf(text, sizeof(text), "AV-%lu", (unsigned long)object_instance);
|
|
return text;
|
|
}
|
|
|
|
return NULL;
|
|
}
|
|
|
|
/* return apdu len, or -1 on error */
|
|
int Analog_Value_Read_Property(BACNET_READ_PROPERTY_DATA *rpdata)
|
|
{
|
|
int len = 0;
|
|
int apdu_len = 0; /* return value */
|
|
BACNET_BIT_STRING bit_string;
|
|
BACNET_CHARACTER_STRING char_string;
|
|
float real_value = (float)1.414;
|
|
unsigned object_index = 0;
|
|
unsigned i = 0;
|
|
bool state = false;
|
|
uint8_t *apdu = NULL;
|
|
|
|
Analog_Value_Init();
|
|
if ((rpdata == NULL) || (rpdata->application_data == NULL) ||
|
|
(rpdata->application_data_len == 0)) {
|
|
return 0;
|
|
}
|
|
apdu = rpdata->application_data;
|
|
switch (rpdata->object_property) {
|
|
case PROP_OBJECT_IDENTIFIER:
|
|
apdu_len = encode_application_object_id(
|
|
&apdu[0], OBJECT_ANALOG_VALUE, rpdata->object_instance);
|
|
break;
|
|
case PROP_OBJECT_NAME:
|
|
case PROP_DESCRIPTION:
|
|
characterstring_init_ansi(
|
|
&char_string, Analog_Value_Name(rpdata->object_instance));
|
|
apdu_len =
|
|
encode_application_character_string(&apdu[0], &char_string);
|
|
break;
|
|
case PROP_OBJECT_TYPE:
|
|
apdu_len =
|
|
encode_application_enumerated(&apdu[0], OBJECT_ANALOG_VALUE);
|
|
break;
|
|
case PROP_PRESENT_VALUE:
|
|
real_value = Analog_Value_Present_Value(rpdata->object_instance);
|
|
apdu_len = encode_application_real(&apdu[0], real_value);
|
|
break;
|
|
case PROP_STATUS_FLAGS:
|
|
bitstring_init(&bit_string);
|
|
bitstring_set_bit(&bit_string, STATUS_FLAG_IN_ALARM, false);
|
|
bitstring_set_bit(&bit_string, STATUS_FLAG_FAULT, false);
|
|
bitstring_set_bit(&bit_string, STATUS_FLAG_OVERRIDDEN, false);
|
|
bitstring_set_bit(&bit_string, STATUS_FLAG_OUT_OF_SERVICE, false);
|
|
apdu_len = encode_application_bitstring(&apdu[0], &bit_string);
|
|
break;
|
|
case PROP_EVENT_STATE:
|
|
apdu_len =
|
|
encode_application_enumerated(&apdu[0], EVENT_STATE_NORMAL);
|
|
break;
|
|
case PROP_OUT_OF_SERVICE:
|
|
#if 0
|
|
object_index = Analog_Value_Instance_To_Index(object_instance);
|
|
state = Analog_Value_Out_Of_Service[object_index];
|
|
#endif
|
|
apdu_len = encode_application_boolean(&apdu[0], false);
|
|
break;
|
|
case PROP_UNITS:
|
|
apdu_len = encode_application_enumerated(&apdu[0], UNITS_PERCENT);
|
|
break;
|
|
#if 0
|
|
case PROP_PRIORITY_ARRAY:
|
|
/* Array element zero is the number of elements in the array */
|
|
if (array_index == 0)
|
|
apdu_len =
|
|
encode_application_unsigned(&apdu[0], BACNET_MAX_PRIORITY);
|
|
/* if no index was specified, then try to encode the entire list */
|
|
/* into one packet. */
|
|
else if (array_index == BACNET_ARRAY_ALL) {
|
|
object_index = Analog_Value_Instance_To_Index(object_instance);
|
|
for (i = 0; i < BACNET_MAX_PRIORITY; i++) {
|
|
/* FIXME: check if we have room before adding it to APDU */
|
|
if (Present_Value[object_index][i] == ANALOG_LEVEL_NULL)
|
|
len = encode_application_null(&apdu[apdu_len]);
|
|
else {
|
|
real_value = Present_Value[object_index][i];
|
|
len =
|
|
encode_application_real(&apdu[apdu_len],
|
|
real_value);
|
|
}
|
|
/* add it if we have room */
|
|
if ((apdu_len + len) < MAX_APDU)
|
|
apdu_len += len;
|
|
else {
|
|
rpdata->error_code =
|
|
ERROR_CODE_ABORT_SEGMENTATION_NOT_SUPPORTED;
|
|
apdu_len = BACNET_STATUS_ABORT;
|
|
break;
|
|
}
|
|
}
|
|
} else {
|
|
object_index = Analog_Value_Instance_To_Index(object_instance);
|
|
if (array_index <= BACNET_MAX_PRIORITY) {
|
|
if (Present_Value[object_index][array_index - 1] ==
|
|
ANALOG_LEVEL_NULL)
|
|
apdu_len = encode_application_null(&apdu[0]);
|
|
else {
|
|
real_value =
|
|
Present_Value[object_index][array_index - 1];
|
|
apdu_len =
|
|
encode_application_real(&apdu[0], real_value);
|
|
}
|
|
} else {
|
|
*error_class = ERROR_CLASS_PROPERTY;
|
|
*error_code = ERROR_CODE_INVALID_ARRAY_INDEX;
|
|
apdu_len = BACNET_STATUS_ERROR;
|
|
}
|
|
}
|
|
|
|
break;
|
|
case PROP_RELINQUISH_DEFAULT:
|
|
real_value = ANALOG_RELINQUISH_DEFAULT;
|
|
apdu_len = encode_application_real(&apdu[0], real_value);
|
|
break;
|
|
#endif
|
|
default:
|
|
rpdata->error_class = ERROR_CLASS_PROPERTY;
|
|
rpdata->error_code = ERROR_CODE_UNKNOWN_PROPERTY;
|
|
apdu_len = BACNET_STATUS_ERROR;
|
|
break;
|
|
}
|
|
/* only array properties can have array options */
|
|
if ((apdu_len >= 0) &&
|
|
#if 0
|
|
(property != PROP_PRIORITY_ARRAY) &&
|
|
#endif
|
|
(rpdata->array_index != BACNET_ARRAY_ALL)) {
|
|
rpdata->error_class = ERROR_CLASS_PROPERTY;
|
|
rpdata->error_code = ERROR_CODE_PROPERTY_IS_NOT_AN_ARRAY;
|
|
apdu_len = BACNET_STATUS_ERROR;
|
|
}
|
|
|
|
return apdu_len;
|
|
}
|
|
|
|
/* returns true if successful */
|
|
bool Analog_Value_Write_Property(BACNET_WRITE_PROPERTY_DATA *wp_data)
|
|
{
|
|
bool status = false; /* return value */
|
|
unsigned int object_index = 0;
|
|
unsigned int priority = 0;
|
|
uint8_t level = ANALOG_LEVEL_NULL;
|
|
int len = 0;
|
|
BACNET_APPLICATION_DATA_VALUE value = { 0 };
|
|
|
|
Analog_Value_Init();
|
|
if (!Analog_Value_Valid_Instance(wp_data->object_instance)) {
|
|
wp_data->error_class = ERROR_CLASS_OBJECT;
|
|
wp_data->error_code = ERROR_CODE_UNKNOWN_OBJECT;
|
|
return false;
|
|
}
|
|
/* decode the some of the request */
|
|
len = bacapp_decode_application_data(
|
|
wp_data->application_data, wp_data->application_data_len, &value);
|
|
/* FIXME: len < application_data_len: more data? */
|
|
if (len < 0) {
|
|
/* error while decoding - a value larger than we can handle */
|
|
wp_data->error_class = ERROR_CLASS_PROPERTY;
|
|
wp_data->error_code = ERROR_CODE_VALUE_OUT_OF_RANGE;
|
|
return false;
|
|
}
|
|
if ((wp_data->object_property != PROP_PRIORITY_ARRAY) &&
|
|
(wp_data->array_index != BACNET_ARRAY_ALL)) {
|
|
/* only array properties can have array options */
|
|
wp_data->error_class = ERROR_CLASS_PROPERTY;
|
|
wp_data->error_code = ERROR_CODE_PROPERTY_IS_NOT_AN_ARRAY;
|
|
return false;
|
|
}
|
|
switch (wp_data->object_property) {
|
|
case PROP_PRESENT_VALUE:
|
|
if (value.tag == BACNET_APPLICATION_TAG_REAL) {
|
|
priority = wp_data->priority;
|
|
/* Command priority 6 is reserved for use by Minimum On/Off
|
|
algorithm and may not be used for other purposes in any
|
|
object. */
|
|
if (priority && (priority <= BACNET_MAX_PRIORITY) &&
|
|
(priority != 6 /* reserved */) &&
|
|
(value.type.Real >= 0.0) && (value.type.Real <= 100.0)) {
|
|
level = (uint8_t)value.type.Real;
|
|
object_index = Analog_Value_Instance_To_Index(
|
|
wp_data->object_instance);
|
|
priority--;
|
|
Present_Value[object_index] = level;
|
|
/* Note: you could set the physical output here if we
|
|
are the highest priority.
|
|
However, if Out of Service is TRUE, then don't set the
|
|
physical output. This comment may apply to the
|
|
main loop (i.e. check out of service before changing
|
|
output) */
|
|
status = true;
|
|
} else if (priority == 6) {
|
|
/* Command priority 6 is reserved for use by Minimum On/Off
|
|
algorithm and may not be used for other purposes in any
|
|
object. */
|
|
wp_data->error_class = ERROR_CLASS_PROPERTY;
|
|
wp_data->error_code = ERROR_CODE_WRITE_ACCESS_DENIED;
|
|
} else {
|
|
wp_data->error_class = ERROR_CLASS_PROPERTY;
|
|
wp_data->error_code = ERROR_CODE_VALUE_OUT_OF_RANGE;
|
|
}
|
|
#if 0
|
|
} else if (value.tag == BACNET_APPLICATION_TAG_NULL) {
|
|
level = ANALOG_LEVEL_NULL;
|
|
object_index =
|
|
Analog_Value_Instance_To_Index(wp_data->object_instance);
|
|
priority = wp_data->priority;
|
|
if (priority && (priority <= BACNET_MAX_PRIORITY)) {
|
|
priority--;
|
|
Present_Value[object_index][priority] = level;
|
|
/* Note: you could set the physical output here to the next
|
|
highest priority, or to the relinquish default if no
|
|
priorities are set.
|
|
However, if Out of Service is TRUE, then don't set the
|
|
physical output. This comment may apply to the
|
|
main loop (i.e. check out of service before changing output) */
|
|
status = true;
|
|
} else {
|
|
*error_class = ERROR_CLASS_PROPERTY;
|
|
*error_code = ERROR_CODE_VALUE_OUT_OF_RANGE;
|
|
}
|
|
#endif
|
|
} else {
|
|
wp_data->error_class = ERROR_CLASS_PROPERTY;
|
|
wp_data->error_code = ERROR_CODE_INVALID_DATA_TYPE;
|
|
}
|
|
break;
|
|
#if 0
|
|
case PROP_OUT_OF_SERVICE:
|
|
if (value.tag == BACNET_APPLICATION_TAG_BOOLEAN) {
|
|
object_index =
|
|
Analog_Value_Instance_To_Index(wp_data->object_instance);
|
|
Analog_Value_Out_Of_Service[object_index] = value.type.Boolean;
|
|
status = true;
|
|
} else {
|
|
*error_class = ERROR_CLASS_PROPERTY;
|
|
*error_code = ERROR_CODE_INVALID_DATA_TYPE;
|
|
}
|
|
break;
|
|
#endif
|
|
case PROP_OBJECT_IDENTIFIER:
|
|
case PROP_OBJECT_NAME:
|
|
case PROP_OBJECT_TYPE:
|
|
case PROP_STATUS_FLAGS:
|
|
case PROP_EVENT_STATE:
|
|
case PROP_OUT_OF_SERVICE:
|
|
case PROP_DESCRIPTION:
|
|
case PROP_PRIORITY_ARRAY:
|
|
wp_data->error_class = ERROR_CLASS_PROPERTY;
|
|
wp_data->error_code = ERROR_CODE_WRITE_ACCESS_DENIED;
|
|
break;
|
|
default:
|
|
wp_data->error_class = ERROR_CLASS_PROPERTY;
|
|
wp_data->error_code = ERROR_CODE_UNKNOWN_PROPERTY;
|
|
break;
|
|
}
|
|
|
|
return status;
|
|
}
|