/**
 * @file
 * @brief Functions that extend the Device object to support routing.
 * @author Tom Brennan <tbrennan3@users.sourceforge.net>
 * @author Peter Mc Shane <petermcs@users.sourceforge.net>
 * @author Piotr Grudzinski <bacpack@users.sourceforge.net>
 * @date October 2010
 * @copyright SPDX-License-Identifier: MIT
 */
#include <stdbool.h>
#include <stdint.h>
#include <string.h>
/* BACnet Stack defines - first */
//#include "bacnet/bacdef.h"
#include "../../../../bacnet/bacdef.h"
/* BACnet Stack API */
//#include "bacnet/bacdcode.h"
#include "../../../../bacnet/bacdcode.h"
//#include "bacnet/bacapp.h"
#include "../../../../bacnet/bacapp.h"
//#include "bacnet/datetime.h"
#include "../../../../bacnet/datetime.h"
//#include "bacnet/apdu.h"
#include "../../../../bacnet/apdu.h"
//#include "bacnet/wp.h"
#include "../../../../bacnet/wp.h" /* write property handling */
//#include "bacnet/rp.h"
#include "../../../../bacnet/rp.h" /* read property handling */
//#include "bacnet/reject.h"
#include "../../../../bacnet/reject.h"
//#include "bacnet/version.h"
#include "../../../../bacnet/version.h"
//#include "bacnet/basic/services.h"
#include "../../../../bacnet/basic/services.h"
//#include "bacnet/datalink/datalink.h"
#include "../../../../bacnet/datalink/datalink.h"
//#include "bacnet/basic/binding/address.h"
#include "../../../../bacnet/basic/binding/address.h"
/* include the objects */
//#include "bacnet/basic/object/device.h"
#include "../../../../bacnet/basic/object/device.h" /* me */
//#include "bacnet/basic/object/ai.h"
#include "../../../../bacnet/basic/object/ai.h"
//#include "bacnet/basic/object/ao.h"
#include "../../../../bacnet/basic/object/ao.h"
//#include "bacnet/basic/object/av.h"
#include "../../../../bacnet/basic/object/av.h"
//#include "bacnet/basic/object/bi.h"
#include "../../../../bacnet/basic/object/bi.h"
//#include "bacnet/basic/object/bo.h"
#include "../../../../bacnet/basic/object/bo.h"
//#include "bacnet/basic/object/bv.h"
#include "../../../../bacnet/basic/object/bv.h"
//#include "bacnet/basic/object/lc.h"
#include "../../../../bacnet/basic/object/lc.h"
//#include "bacnet/basic/object/lsp.h"
#include "../../../../bacnet/basic/object/lsp.h"
//#include "bacnet/basic/object/mso.h"
#include "../../../../bacnet/basic/object/mso.h"
//#include "bacnet/basic/object/ms-input.h"
#include "../../../../bacnet/basic/object/ms-input.h"
//#include "bacnet/basic/object/trendlog.h"
#include "../../../../bacnet/basic/object/trendlog.h"
#if defined(BACFILE)
//#include "bacnet/basic/object/bacfile.h"
#include "../../../../bacnet/basic/object/bacfile.h" /* object list dependency */
#endif
/* os specific includes */
//#include "bacnet/basic/sys/mstimer.h"
#include "../../../../bacnet/basic/sys/mstimer.h"

/* forward prototypes */
int Routed_Device_Read_Property_Local(BACNET_READ_PROPERTY_DATA *rpdata);
bool Routed_Device_Write_Property_Local(BACNET_WRITE_PROPERTY_DATA *wp_data);

#if !defined(BAC_ROUTING)
#ifdef _MSC_VER
#pragma message This file should not be included in the build unless \
    BAC_ROUTING is enabled.
#else
#warning This file should not be included in the build unless BAC_ROUTING is enabled.
#endif
#endif

/****************************************************************************
 ************* BACnet Routing Functionality (Optional) **********************
 ****************************************************************************
 * It would be correct to view the routing functionality here as inheriting
 * and extending the regular Device Object functionality.
 ****************************************************************************/

/** Model the gateway as the main Device, with (two) remote
 * Devices that are reached via its routing capabilities.
 */
DEVICE_OBJECT_DATA Devices[MAX_NUM_DEVICES];
/** Keep track of the number of managed devices, including the gateway */
uint16_t Num_Managed_Devices = 0;
/** Which Device entry are we currently managing.
 * Since we are not using actual class objects here, the best we can do is
 * keep this local variable which notes which of the Devices the current
 * request is addressing.  Should default to 0, the main gateway Device.
 */
uint16_t iCurrent_Device_Idx = 0;

/* void Routing_Device_Init(uint32_t first_object_instance) is
 * found in device.c
 */

/** Add a Device to our table of Devices[].
 * The first entry must be the gateway device.
 * @param Object_Instance [in] Set the new Device to this instance number.
 * @param sObject_Name [in] Use this Object Name for the Device.
 * @param sDescription [in] Set this Description for the Device.
 * @return The index of this instance in the Devices[] array, or UINT16_MAX if
 *         there isn't enough room to add this Device.
 */
uint16_t Add_Routed_Device(
    uint32_t Object_Instance,
    const BACNET_CHARACTER_STRING *sObject_Name,
    const char *sDescription)
{
    int i = Num_Managed_Devices;
    if (i < MAX_NUM_DEVICES) {
        DEVICE_OBJECT_DATA *pDev = &Devices[i];
        Num_Managed_Devices++;
        iCurrent_Device_Idx = i;
        pDev->bacObj.mObject_Type = OBJECT_DEVICE;
        pDev->bacObj.Object_Instance_Number = Object_Instance;
        if (sObject_Name != NULL) {
            Routed_Device_Set_Object_Name(
                sObject_Name->encoding, sObject_Name->value,
                sObject_Name->length);
        } else {
            Routed_Device_Set_Object_Name(
                CHARACTER_UTF8, "No Name", strlen("No Name"));
        }
        if (sDescription != NULL) {
            Routed_Device_Set_Description(sDescription, strlen(sDescription));
        } else {
            Routed_Device_Set_Description("No Descr", strlen("No Descr"));
        }
        pDev->Database_Revision = 0; /* Reset/Initialize now */
        return i;
    } else {
        return UINT16_MAX;
    }
}

/** Return the Device Object descriptive data for the indicated entry.
 * @param idx [in] Index into Devices[] array being requested.
 *                 0 is for the main, gateway Device entry.
 *                 -1 is a special case meaning "whichever iCurrent_Device_Idx
 *                 is currently set to"
 *                 If valid idx, will set iCurrent_Device_Idx with the idx
 * @return Pointer to the requested Device Object data, or NULL if the idx
 *         is for an invalid row entry (eg, after the last good Device).
 */
DEVICE_OBJECT_DATA *Get_Routed_Device_Object(int idx)
{
    if (idx == -1) {
        return &Devices[iCurrent_Device_Idx];
    } else if (
        (idx >= 0) && (idx < min(MAX_NUM_DEVICES, Num_Managed_Devices))) {
        iCurrent_Device_Idx = idx;
        return &Devices[idx];
    } else {
        return NULL;
    }
}

/** Return the BACnet address for the indicated entry.
 * @param idx [in] Index into Devices[] array being requested.
 *                 0 is for the main, gateway Device entry.
 *                 -1 is a special case meaning "whichever iCurrent_Device_Idx
 *                 is currently set to"
 *                 If valid idx, will set iCurrent_Device_Idx with the idx
 * @return Pointer to the requested Device Object BACnet address, or NULL if the
 * idx is for an invalid row entry (eg, after the last good Device).
 */
BACNET_ADDRESS *Get_Routed_Device_Address(int idx)
{
    if (idx == -1) {
        return &Devices[iCurrent_Device_Idx].bacDevAddr;
    } else if (
        (idx >= 0) && (idx < min(MAX_NUM_DEVICES, Num_Managed_Devices))) {
        iCurrent_Device_Idx = idx;
        return &Devices[idx].bacDevAddr;
    } else {
        return NULL;
    }
}

/** Get the currently active BACnet address.
 * This is an implementation of the datalink_get_my_address() template for
 * devices with routing.
 *
 * @param my_address [out] Points to the currently active Device Object's
 *                         BACnet address.
 */
void routed_get_my_address(BACNET_ADDRESS *my_address)
{
    if (my_address) {
        memcpy(
            my_address, &Devices[iCurrent_Device_Idx].bacDevAddr,
            sizeof(BACNET_ADDRESS));
    }
}

/** See if the Gateway or Routed Device at the given idx matches
 * the given MAC address.
 * Has the desirable side-effect of setting iCurrent_Device_Idx to the
 * given idx if a match is found, for use in the subsequent routing handling
 * functions here.
 *
 * @param idx [in] Index into Devices[] array being requested.
 *                 0 is for the main, gateway Device entry.
 * @param address_len [in] Length of the mac_adress[] field.
 *         If 0, then this is a MAC broadcast.  Otherwise, size is determined
 *         by the DLL type (eg, 6 for BIP and 2 for MSTP).
 * @param mac_adress [in] The desired MAC address of a Device;
 *
 * @return True if the MAC addresses match (or the address_len is 0,
 *         meaning MAC broadcast, so it's an automatic match).
 *         Else False if no match or invalid idx is given.
 */
bool Routed_Device_Address_Lookup(int idx, uint8_t dlen, const uint8_t *dadr)
{
    bool result = false;
    DEVICE_OBJECT_DATA *pDev;
    int i;

    if ((idx >= 0) && (idx < min(MAX_NUM_DEVICES, Num_Managed_Devices))) {
        pDev = &Devices[idx];
        if (dlen == 0) {
            /* Automatic match */
            iCurrent_Device_Idx = idx;
            result = true;
        } else if (dadr != NULL) {
            for (i = 0; i < dlen; i++) {
                if (pDev->bacDevAddr.adr[i] != dadr[i]) {
                    break;
                }
            }
            if (i == dlen) { /* Success! */
                iCurrent_Device_Idx = idx;
                result = true;
            }
        }
    }

    return result;
}

/** Find the next Gateway or Routed Device at the given MAC address,
 * starting the search at the "cursor".
 * Has the desirable side-effect of setting internal iCurrent_Device_Idx
 * if a match is found, for use in the subsequent routing handling
 * functions.
 *
 * @param dest [in] The BACNET_ADDRESS of the message's destination.
 *         If the Length of the mac_adress[] field is 0, then this is a
 * MAC broadcast.  Otherwise, size is determined by the DLL type (eg, 6 for BIP
 * and 2 for MSTP).
 * @param DNET_list [in] List of our reachable downstream BACnet Network
 * numbers. Normally just one valid entry; terminated with a -1 value.
 * @param cursor [in,out] The concept of the cursor is that it is a starting
 *         "hint" for the search; on return, it is updated to provide
 * the cursor value to use with a subsequent GetNext call, or it equals -1 if
 * there are no further matches. Set it to 0 on entry to access the main,
 * gateway Device entry, or to start looping through the routed devices.
 *         Otherwise, its returned value is implementation-dependent and the
 *         calling function should not alter or interpret it.
 *
 * @return True if the MAC addresses match (or if BACNET_BROADCAST_NETWORK and
 *         the dest->len is 0, meaning MAC bcast, so it's an automatic
 * match). Else False if no match or invalid idx is given; the cursor will be
 * returned as -1 in these cases.
 */
bool Routed_Device_GetNext(
    const BACNET_ADDRESS *dest, const int *DNET_list, int *cursor)
{
    int dnet = DNET_list[0]; /* Get the DNET of our virtual network */
    int idx = *cursor;
    bool bSuccess = false;

    if ((idx < 0) || (idx >= min(MAX_NUM_DEVICES, Num_Managed_Devices))) {
        /* The next index will be out of range.
           Eg, last call to GetNext may have been the last successful one.*/
        idx = -1;
    } else if (dest->net == BACNET_BROADCAST_NETWORK) {
        /* For BACnet broadcasts, all Devices get a chance at it. */
        /* Just take the entry indexed by the cursor */
        bSuccess = Routed_Device_Address_Lookup(idx++, dest->len, dest->adr);
    } else if (dest->net == 0) {
        /* See if it's for the main Gateway Device,
           because there's no routing info. */
        /* Handle like a normal, non-routed access of the Gateway Device.
           But first, make sure our internal access is pointing at
           that Device in our table by telling it "no routing info" : */
        bSuccess = Routed_Device_Address_Lookup(0, dest->len, dest->adr);
        /* Next step: no more matches: */
        idx = -1;
    } else if (dest->net == dnet) {
        /* Or if is our virtual DNET, check
           against each of our virtually routed Devices.
           If we get a match, have it handle the APDU.
           For broadcasts, all Devices get a chance at it.*/
        if (idx == 0) {
            /* Step over this case (starting point) */
            idx = 1;
        }
        while (idx < min(MAX_NUM_DEVICES, Num_Managed_Devices)) {
            bSuccess =
                Routed_Device_Address_Lookup(idx++, dest->len, dest->adr);
            if (bSuccess) {
                /* We don't need to keep looking */
                break;
            }
        }
    }
    if (!bSuccess) {
        *cursor = -1;
    } else if (idx == min(MAX_NUM_DEVICES, Num_Managed_Devices)) {
        /* No more to GetNext */
        *cursor = -1;
    } else {
        *cursor = idx;
    }
    return bSuccess;
}

/** Check if the destination network is reachable - is it our virtual network,
 *  or local or else broadcast.
 *
 * @param dest_net [in] The BACnet network number of a message's destination.
 *         Success if it is our virtual network number, or 0 (local for
 * the gateway, or 0xFFFF for a broadcast network number.
 * @param DNET_list [in] List of our reachable downstream BACnet Network
 * numbers. Normally just one valid entry; terminated with a -1 value.
 * @return True if matches our virtual network, or is for the local network
 *          Device (the gateway), or is BACNET_BROADCAST_NETWORK,
 * which is an automatic match. Else False if not a reachable network.
 */
bool Routed_Device_Is_Valid_Network(uint16_t dest_net, const int *DNET_list)
{
    int dnet = DNET_list[0]; /* Get the DNET of our virtual network */
    bool bSuccess = false;

    /* First, see if it's a BACnet broadcast (automatic pass). */
    if (dest_net == BACNET_BROADCAST_NETWORK) {
        bSuccess = true;
        /* Or see if it's for the main Gateway Device, because
         * there's no routing info.
         */
    } else if (dest_net == 0) {
        bSuccess = true;
        /* Or see if matches our virtual DNET */
    } else if (dest_net == dnet) {
        bSuccess = true;
    }

    return bSuccess;
}

/* methods to override the normal Device objection functions */

uint32_t Routed_Device_Index_To_Instance(unsigned index)
{
    (void)index;
    return Devices[iCurrent_Device_Idx].bacObj.Object_Instance_Number;
}

/**
 * For a given object instance-number, determines a 1..N-1 index
 * of Device objects where N is MAX_NUM_DEVICES
 *
 * @param  object_instance - object-instance number of the object
 * @return  index for the given instance-number, or 0 if not valid.
 */
static uint32_t Routed_Device_Instance_To_Index(uint32_t Instance_Number)
{
    int i;

    for (i = 0; i < min(MAX_NUM_DEVICES, Num_Managed_Devices); i++) {
        if (Devices[i].bacObj.Object_Instance_Number == Instance_Number) {
            /* Found Instance, so return the Device Index Number */
            return i;
        }
    }

    /* We did not find instance... so simply return an Index of 0
       All gateways will have at least a single root Device Object */
    return 0;
}

/**
 * Determines if a given Device instance is valid
 *
 * @param  object_id - object-instance number of the object
 * @return  true if the instance is valid, and false if not
 */
bool Routed_Device_Valid_Object_Instance_Number(uint32_t object_id)
{
    bool valid = false;
    DEVICE_OBJECT_DATA *pDev = NULL;

    iCurrent_Device_Idx = Routed_Device_Instance_To_Index(object_id);
    pDev = &Devices[iCurrent_Device_Idx];
    if (pDev->bacObj.Object_Instance_Number == object_id) {
        valid = true;
    }

    return valid;
}

bool Routed_Device_Name(
    uint32_t object_instance, BACNET_CHARACTER_STRING *object_name)
{
    DEVICE_OBJECT_DATA *pDev = &Devices[iCurrent_Device_Idx];
    if (object_instance == pDev->bacObj.Object_Instance_Number) {
        return characterstring_init_ansi(object_name, pDev->bacObj.Object_Name);
    }

    return false;
}

/** Manages ReadProperty service for fields which are different for routed
 * Devices, or hands off to the default Device RP function for the rest.
 * @param rpdata [in] Structure which describes the property to be read.
 * @return The length of the apdu encoded, or BACNET_STATUS_ERROR for error or
 * BACNET_STATUS_ABORT for abort message.
 */
int Routed_Device_Read_Property_Local(BACNET_READ_PROPERTY_DATA *rpdata)
{
    int apdu_len = 0; /* return value */
    BACNET_CHARACTER_STRING char_string;
    uint8_t *apdu = NULL;
    DEVICE_OBJECT_DATA *pDev = &Devices[iCurrent_Device_Idx];

    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_DEVICE, pDev->bacObj.Object_Instance_Number);
            break;
        case PROP_OBJECT_NAME:
            characterstring_init_ansi(&char_string, pDev->bacObj.Object_Name);
            apdu_len =
                encode_application_character_string(&apdu[0], &char_string);
            break;
        case PROP_DESCRIPTION:
            characterstring_init_ansi(&char_string, pDev->Description);
            apdu_len =
                encode_application_character_string(&apdu[0], &char_string);
            break;
        case PROP_DATABASE_REVISION:
            apdu_len =
                encode_application_unsigned(&apdu[0], pDev->Database_Revision);
            break;
        default:
            apdu_len = Device_Read_Property_Local(rpdata);
            break;
    }

    return (apdu_len);
}

bool Routed_Device_Write_Property_Local(BACNET_WRITE_PROPERTY_DATA *wp_data)
{
    bool status = false; /* return value */
    int len = 0;
    BACNET_APPLICATION_DATA_VALUE value = { 0 };

    /* decode the some of the request */
    len = bacapp_decode_application_data(
        wp_data->application_data, wp_data->application_data_len, &value);
    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;
    }
    /* FIXME: len < application_data_len: more data? */
    switch (wp_data->object_property) {
        case PROP_OBJECT_IDENTIFIER:
            status = write_property_type_valid(
                wp_data, &value, BACNET_APPLICATION_TAG_OBJECT_ID);
            if (status) {
                if ((value.type.Object_Id.type == OBJECT_DEVICE) &&
                    (Routed_Device_Set_Object_Instance_Number(
                        value.type.Object_Id.instance))) {
                    /* FIXME: we could send an I-Am broadcast to let the world
                     * know */
                } else {
                    status = false;
                    wp_data->error_class = ERROR_CLASS_PROPERTY;
                    wp_data->error_code = ERROR_CODE_VALUE_OUT_OF_RANGE;
                }
            }
            break;
        case PROP_OBJECT_NAME:
            status =
                write_property_string_valid(wp_data, &value, MAX_DEV_NAME_LEN);
            if (status) {
                Routed_Device_Set_Object_Name(
                    characterstring_encoding(&value.type.Character_String),
                    characterstring_value(&value.type.Character_String),
                    characterstring_length(&value.type.Character_String));
            }
            break;
        default:
            status = Device_Write_Property_Local(wp_data);
            break;
    }
    return status;
}

/* methods to manipulate the data */

/** Return the Object Instance number for the currently active Device Object.
 * This is an overload of the important, widely used
 * Device_Object_Instance_Number() function.
 *
 * @return The Instance number of the currently active Device.
 */
uint32_t Routed_Device_Object_Instance_Number(void)
{
    return Devices[iCurrent_Device_Idx].bacObj.Object_Instance_Number;
}

bool Routed_Device_Set_Object_Instance_Number(uint32_t object_id)
{
    bool status = true; /* return value */

    if (object_id <= BACNET_MAX_INSTANCE) {
        /* Make the change and update the database revision */
        Devices[iCurrent_Device_Idx].bacObj.Object_Instance_Number = object_id;
        Routed_Device_Inc_Database_Revision();
    } else {
        status = false;
    }

    return status;
}

/** Sets the Object Name for a routed Device (or the gateway).
 * Uses local variable iCurrent_Device_Idx to know which Device
 * is to be updated.
 * @param object_name [in] Character String for the new Object Name.
 * @return True if succeed in updating Object Name, else False.
 */
bool Routed_Device_Set_Object_Name(
    uint8_t encoding, const char *value, size_t length)
{
    bool status = false; /*return value */
    DEVICE_OBJECT_DATA *pDev = &Devices[iCurrent_Device_Idx];

    if ((encoding == CHARACTER_UTF8) && (length < MAX_DEV_NAME_LEN)) {
        /* Make the change and update the database revision */
        memmove(pDev->bacObj.Object_Name, value, length);
        pDev->bacObj.Object_Name[length] = 0;
        Routed_Device_Inc_Database_Revision();
        status = true;
    }

    return status;
}

bool Routed_Device_Set_Description(const char *name, size_t length)
{
    bool status = false; /*return value */
    DEVICE_OBJECT_DATA *pDev = &Devices[iCurrent_Device_Idx];

    if (length < MAX_DEV_DESC_LEN) {
        memmove(pDev->Description, name, length);
        pDev->Description[length] = 0;
        status = true;
    }

    return status;
}

/*
 * Shortcut for incrementing database revision as this is potentially
 * the most common operation if changing object names and ids is
 * implemented.
 */
void Routed_Device_Inc_Database_Revision(void)
{
    DEVICE_OBJECT_DATA *pDev = &Devices[iCurrent_Device_Idx];
    pDev->Database_Revision++;
}

/** Check to see if the current Device supports this service.
 * Presently checks for RD and DCC and only allows them if the current
 * device is the gateway device.
 *
 * @param service [in] The service being requested.
 * @param service_argument [in] An optional argument (eg, service type).
 * @param apdu_buff [in,out] The buffer where we will encode a Reject message.
 *                              May be NULL if don't want an encoded response.
 * @param invoke_id [in] The invoke_id of the service request.
 * @return Length of bytes encoded in apdu_buff[] for a Reject message,
 *          just 1 if no apdu_buff was supplied and service is not supported,
 *          else 0 if service is approved for the current device.
 */
int Routed_Device_Service_Approval(
    BACNET_SERVICES_SUPPORTED service,
    int service_argument,
    uint8_t *apdu_buff,
    uint8_t invoke_id)
{
    int len = 0;

    (void)service_argument;
    switch (service) {
        case SERVICE_SUPPORTED_REINITIALIZE_DEVICE:
            /* If not the gateway device, we don't support RD */
            if (iCurrent_Device_Idx > 0) {
                if (apdu_buff != NULL) {
                    len = reject_encode_apdu(
                        apdu_buff, invoke_id,
                        REJECT_REASON_UNRECOGNIZED_SERVICE);
                } else {
                    len = 1; /* Non-zero return */
                }
            }
            break;
        case SERVICE_SUPPORTED_DEVICE_COMMUNICATION_CONTROL:
            /* If not the gateway device, we don't support DCC */
            if (iCurrent_Device_Idx > 0) {
                if (apdu_buff != NULL) {
                    len = reject_encode_apdu(
                        apdu_buff, invoke_id,
                        REJECT_REASON_UNRECOGNIZED_SERVICE);
                } else {
                    len = 1; /* Non-zero return */
                }
            }
            break;
        default:
            /* Everything else is a pass, at this time. */
            break;
    }

    return len;
}
