pinebuds/services/ble_profiles/prox/proxr/src/proxr.c

/**
 ****************************************************************************************
 * @addtogroup PROXR
 * @{
 ****************************************************************************************
 */

/*
 * INCLUDE FILES
 ****************************************************************************************
 */

#include "rwip_config.h"

#if (BLE_PROX_REPORTER)

#include "proxr.h"
#include "proxr_task.h"
#include "attm.h"
#include "gap.h"

#include "ke_mem.h"

/*
 * PROXIMITY PROFILE ATTRIBUTES DEFINITION
 ****************************************************************************************
 */

/// Full LLS Database Description - Used to add attributes into the database
const struct attm_desc proxr_lls_att_db[LLS_IDX_NB] =
{
    // Link Loss Service Declaration
    [LLS_IDX_SVC]                   =   {ATT_DECL_PRIMARY_SERVICE, PERM(RD, ENABLE), 0, 0},
    // Alert Level Characteristic Declaration
    [LLS_IDX_ALERT_LVL_CHAR]        =   {ATT_DECL_CHARACTERISTIC, PERM(RD, ENABLE), 0, 0},
    // Alert Level Characteristic Value
    [LLS_IDX_ALERT_LVL_VAL]         =   {ATT_CHAR_ALERT_LEVEL, PERM(RD, ENABLE) | PERM(WRITE_REQ, ENABLE), PERM(RI, ENABLE), sizeof(uint8_t)},
};

/// Full IAS Database Description - Used to add attributes into the database
const struct attm_desc proxr_ias_att_db[IAS_IDX_NB] =
{
    // Immediate Alert Service Declaration
    [IAS_IDX_SVC]                   =   {ATT_DECL_PRIMARY_SERVICE, PERM(RD, ENABLE),0, 0},
    // Alert Level Characteristic Declaration
    [IAS_IDX_ALERT_LVL_CHAR]        =   {ATT_DECL_CHARACTERISTIC, PERM(RD, ENABLE), 0, 0},
    // Alert Level Characteristic Value
    [IAS_IDX_ALERT_LVL_VAL]         =   {ATT_CHAR_ALERT_LEVEL, PERM(WRITE_COMMAND, ENABLE), PERM(RI, ENABLE), sizeof(uint8_t)},
};

/// Full TXPS Database Description - Used to add attributes into the database
const struct attm_desc proxr_txps_att_db[TXPS_IDX_NB] =
{
    // TX Power Service Declaration
    [TXPS_IDX_SVC]                  =   {ATT_DECL_PRIMARY_SERVICE, PERM(RD, ENABLE), 0, 0},
    // TX Power Level Characteristic Declaration
    [TXPS_IDX_TX_POWER_LVL_CHAR]       =   {ATT_DECL_CHARACTERISTIC, PERM(RD, ENABLE), 0, 0},
    // TX Power Level Characteristic Value
    [TXPS_IDX_TX_POWER_LVL_VAL]     =   {ATT_CHAR_TX_POWER_LEVEL, PERM(RD, ENABLE), PERM(RI, ENABLE), sizeof(uint8_t)},
};
/*
 * LOCAL FUNCTION DEFINITIONS
 ****************************************************************************************
 */

static uint8_t proxr_init(struct prf_task_env* env, uint16_t* start_hdl, uint16_t app_task,
                            uint8_t sec_lvl, struct proxr_db_cfg* params)
{
    // Service content flag
    uint32_t cfg_flag = PROXR_LLS_MANDATORY_MASK;
    // DB Creation Status
    uint8_t status = ATT_ERR_NO_ERROR;

    //-------------------- allocate memory required for the profile  ---------------------
    struct proxr_env_tag* proxr_env =
            (struct proxr_env_tag* ) ke_malloc(sizeof(struct proxr_env_tag), KE_MEM_ATT_DB);

    // allocate PROXR required environment variable
    env->env = (prf_env_t*) proxr_env;

    status = attm_svc_create_db(start_hdl, ATT_SVC_LINK_LOSS, (uint8_t *)&cfg_flag,
               LLS_IDX_NB, NULL, env->task, &proxr_lls_att_db[0],
              (sec_lvl & (PERM_MASK_SVC_DIS | PERM_MASK_SVC_AUTH | PERM_MASK_SVC_EKS))
              | PERM(SVC_MI, DISABLE) );

    proxr_env->lls_start_hdl     = *start_hdl;
    *start_hdl += LLS_IDX_NB;

    if( (status == ATT_ERR_NO_ERROR) && (params->features == PROXR_IAS_TXPS_SUP) )
    {
        cfg_flag = PROXR_IAS_MANDATORY_MASK;
        status = attm_svc_create_db(start_hdl, ATT_SVC_IMMEDIATE_ALERT, (uint8_t *)&cfg_flag,
                    IAS_IDX_NB, NULL, env->task, &proxr_ias_att_db[0],
                   (sec_lvl & (PERM_MASK_SVC_DIS | PERM_MASK_SVC_AUTH | PERM_MASK_SVC_EKS))
                   | PERM(SVC_MI, DISABLE) );

       proxr_env->ias_start_hdl     = *start_hdl;
       *start_hdl += IAS_IDX_NB;

       if( status == ATT_ERR_NO_ERROR )
       {
           cfg_flag = PROXR_TXP_MANDATORY_MASK;
           status = attm_svc_create_db(start_hdl, ATT_SVC_TX_POWER, (uint8_t *)&cfg_flag,
                      TXPS_IDX_NB, NULL, env->task, &proxr_txps_att_db[0],
                     (sec_lvl & (PERM_MASK_SVC_DIS | PERM_MASK_SVC_AUTH | PERM_MASK_SVC_EKS))
                     | PERM(SVC_MI, DISABLE) );

           proxr_env->txp_start_hdl     = *start_hdl;

           if (status == ATT_ERR_NO_ERROR)
           {
               // set start handle to first allocated service value
               *start_hdl = proxr_env->ias_start_hdl;

               proxr_env->features          = params->features;
               proxr_env->prf_env.app_task  = app_task
                       | (PERM_GET(sec_lvl, SVC_MI) ? PERM(PRF_MI, ENABLE) : PERM(PRF_MI, DISABLE));
               proxr_env->prf_env.prf_task  = env->task | PERM(PRF_MI, DISABLE);

               // initialize environment variable
               env->id                     = TASK_ID_PROXR;
               proxr_task_init(&(env->desc));

               // service is ready, go into an Idle state
               ke_state_set(env->task, PROXR_IDLE);
           }
       }
    }
    return (status);
}

static void proxr_destroy(struct prf_task_env* env)
{
    struct proxr_env_tag* proxr_env = (struct proxr_env_tag*) env->env;

    // free profile environment variables
    env->env = NULL;
    ke_free(proxr_env);
}

/**
 ****************************************************************************************
 * @brief Handles Connection creation
 *
 * @param[in|out]    env        Collector or Service allocated environment data.
 * @param[in]        conidx     Connection index
 ****************************************************************************************
 */
static void proxr_create(struct prf_task_env* env, uint8_t conidx)
{
    struct proxr_env_tag* proxr_env = (struct proxr_env_tag*) env->env;

    proxr_env->lls_alert_lvl[conidx] = PROXR_ALERT_NONE;
}

/**
 ****************************************************************************************
 * @brief Handles Disconnection
 *
 * @param[in|out]    env        Collector or Service allocated environment data.
 * @param[in]        conidx     Connection index
 * @param[in]        reason     Detach reason
 ****************************************************************************************
 */
static void proxr_cleanup(struct prf_task_env* env, uint8_t conidx, uint8_t reason)
{
    struct proxr_env_tag* proxr_env = (struct proxr_env_tag*) env->env;

    if((proxr_env->features == PROXR_IAS_TXPS_SUP) && (reason != LL_ERR_REMOTE_USER_TERM_CON))
    {
        if(proxr_env->lls_alert_lvl[conidx] > PROXR_ALERT_NONE)
        {

            // Allocate the alert value change indication
            struct proxr_alert_ind *ind = KE_MSG_ALLOC(PROXR_ALERT_IND,
                    prf_dst_task_get(&(proxr_env->prf_env), conidx),
                    prf_src_task_get(&(proxr_env->prf_env), conidx), proxr_alert_ind);

            // Fill in the parameter structure
            ind->alert_lvl = proxr_env->lls_alert_lvl[conidx];
            ind->char_code = PROXR_LLS_CHAR;
            ind->conidx = conidx;

            // Send the message
            ke_msg_send(ind);
        }
    }

}


/*
 * GLOBAL VARIABLE DEFINITIONS
 ****************************************************************************************
 */


/// PROXR Task interface required by profile manager
const struct prf_task_cbs proxr_itf =
{
    (prf_init_fnct) proxr_init,
    proxr_destroy,
    proxr_create,
    proxr_cleanup,
};

/*
 * FUNCTION DEFINITIONS
 ****************************************************************************************
 */

const struct prf_task_cbs* proxr_prf_itf_get(void)
{
   return &proxr_itf;
}


#endif //BLE_PROX_REPORTER

/// @} PROXR