positioning_app/app.c

 
#define DEBUG_LOG_MODULE_NAME "POSAPP"
#ifdef DEBUG_POSLIB_LOG_MAX_LEVEL
#define DEBUG_LOG_MAX_LEVEL DEBUG_POSLIB_LOG_MAX_LEVEL
#else
#define DEBUG_LOG_MAX_LEVEL LVL_NOLOG
#endif
#include "debug_log.h"
#include "api.h"
#include "app_scheduler.h"
#include "poslib.h"
#include "shared_neighbors.h"
#include "stack_state.h"
#include "shared_data.h"
#include "shared_appconfig.h"
#include "shared_offline.h"
#include "shared_beacon.h"
#include "posapp_settings.h"
#include "board.h"
#include "voltage.h"
#ifdef BUTTON_ENABLED
#include "button.h"
#endif
#ifdef CONF_USE_LED_NOTIFICATION
#include "led.h"
#endif
#ifdef MOTION_SUPPORTED
#include "motion.h"
#endif
#ifdef CONF_USE_PERSISTENT_MEMORY
#include "app_persistent.h"
#endif
 
#ifdef BUTTON_ENABLED
#define BUTTON_ID   0
#endif
#ifdef CONF_USE_LED_NOTIFICATION
#define LED_ON true
#define LED_OFF false
 
#define LED_ID 0
#endif
 
static uint8_t m_event_config_change_id = POSLIB_FLAG_EVENT_SUBSCRIBERS_MAX;
static uint8_t m_event_led_on_id = POSLIB_FLAG_EVENT_SUBSCRIBERS_MAX;
static uint8_t m_event_led_off_id = POSLIB_FLAG_EVENT_SUBSCRIBERS_MAX;
 
#ifdef BUTTON_ENABLED
 
static void button_pressed_cb(uint8_t button_id, button_event_e button_event)
{
    LOG(LVL_DEBUG, "Start oneshot. Button event %u button id %u", button_event, button_id);
#ifndef APP_PRINTING
    (void) button_id;
    (void) button_event;
#endif
    PosLib_startOneshot();
}
 
static void enable_button(void)
{
    button_res_e res;
 
    res = Button_register_for_event(BUTTON_ID, BUTTON_PRESSED, button_pressed_cb);
 
    if (res == BUTTON_RES_OK)
    {
        LOG(LVL_INFO, "Oneshot request active on button id %u", BUTTON_ID);
    }
    else
    {
        LOG(LVL_ERROR, "Registration for button id: %u failed.", BUTTON_ID)
    }
}
#else
static void enable_button(void) {}
#endif
 
#ifdef CONF_USE_PERSISTENT_MEMORY
static uint32_t App_persistent_data_write(void)
{
    poslib_settings_t settings;
 
    PosLib_getConfig(&settings);
    PosApp_Settings_store(&settings);
    return APP_SCHEDULER_STOP_TASK;
}
#endif
 
#ifdef MOTION_SUPPORTED
static void motion_cb(poslib_motion_mode_e mode)
{
    LOG(LVL_DEBUG, "Motion state: %u", mode);
    PosLib_motion(mode);
}
 
bool update_motion(poslib_motion_mon_settings_t * motion)
{
    if (motion->enabled)
    {
        posapp_motion_ret_e res_mon;
        posapp_motion_mon_settings_t motion_cfg = {
            .threshold_mg = motion->threshold_mg,
            .duration_ms = motion->duration_ms,
            .cb = motion_cb
        };
 
        res_mon = PosAppMotion_startMonitoring(&motion_cfg);
 
        if (res_mon != POSAPP_MOTION_RET_OK)
        {
            LOG(LVL_ERROR, "Cannot activate motion monitoring! res: %u", res_mon);
            return false;
        }
    }
    else
    {
        PosAppMotion_stopMonitoring();
    }
 
    return true;
}
#endif
 
static void App_posLib_event(POSLIB_FLAG_EVENT_info_t * msg)
{
    LOG(LVL_INFO, "PosLib event: %u, time: %u", msg->event_id, msg->time_hp)
 
    if (msg->event_id & POSLIB_FLAG_EVENT_CONFIG_CHANGE)
    {
        poslib_settings_t settings;
        PosLib_getConfig(&settings);
 
#ifdef MOTION_SUPPORTED
    update_motion(&settings.motion);
#endif
 
#ifdef CONF_USE_PERSISTENT_MEMORY
 
    App_Scheduler_addTask_execTime(App_persistent_data_write, APP_SCHEDULER_SCHEDULE_ASAP, 500);
#endif
    }
}
 
 
static void App_posLib_led_on_event(POSLIB_FLAG_EVENT_info_t * msg)
{
    (void) msg;
 
    LOG(LVL_INFO, "PosLib led on public event. Id: %u, time: %u", msg->event_id, msg->time_hp)
#ifdef CONF_USE_LED_NOTIFICATION
    led_res_e res = Led_set(LED_ID, LED_ON);
 
    if (res != LED_RES_OK)
    {
        LOG(LVL_ERROR, "Led set failed with led_id:  %d", LED_ID)
    }
#endif
}
 
static void App_posLib_led_off_event(POSLIB_FLAG_EVENT_info_t * msg)
{
    (void) msg;
 
    LOG(LVL_INFO, "PosLib led off public event. Id: %u, time: %u", msg->event_id, msg->time_hp)
#ifdef CONF_USE_LED_NOTIFICATION
    led_res_e res = Led_set(LED_ID, LED_OFF);
 
    if (res != LED_RES_OK)
    {
        LOG(LVL_ERROR, "Led set failed with led_id:  %d", LED_ID)
    }
#endif
}
 
static poslib_ret_e App_start_positioning(void)
{
    poslib_settings_t settings;
    poslib_ret_e res;
 
    /* Retrieve the default | persistent settings */
 
    PosApp_Settings_get(&settings);
 
    res = PosLib_setConfig(&settings);
 
    if (res != POS_RET_OK)
    {
        LOG(LVL_ERROR, "PosLib configuration fail. res: %d", res);
        return res;
    }
 
    poslib_events_e event = POSLIB_FLAG_EVENT_CONFIG_CHANGE;
    res = PosLib_eventRegister(event, App_posLib_event, &m_event_config_change_id);
 
    if (res != POS_RET_OK)
    {
        LOG(LVL_ERROR, "PosLib cannot register event %u failed. res: %d", event, res);
        return res;
    }
 
    poslib_events_e event_led_on = POSLIB_FLAG_EVENT_LED_ON;
    res = PosLib_eventRegister(event_led_on, App_posLib_led_on_event, &m_event_led_on_id);
    if (res != POS_RET_OK)
    {
        LOG(LVL_ERROR, "PosLib cannot register event %u failed. res: %d", event, res);
        return res;
    }
    poslib_events_e event_led_off = POSLIB_FLAG_EVENT_LED_OFF;
    res = PosLib_eventRegister(event_led_off, App_posLib_led_off_event, &m_event_led_off_id);
    if (res != POS_RET_OK)
    {
        LOG(LVL_ERROR, "PosLib cannot register event %u failed. res: %d", event, res);
        return res;
    }
 
#ifdef MOTION_SUPPORTED
    update_motion(&settings.motion);
#endif
 
    res = PosLib_startPeriodic();
 
    if (res !=POS_RET_OK)
    {
        LOG(LVL_ERROR, "PosLib start periodic failed. res: %d", res);
    }
 
    return res;
}
 
void App_init(const app_global_functions_t* functions)
{
    (void) functions;
 
    LOG_INIT();
    PosApp_Settings_configureNode();
 
    enable_button();
 
    /* Initialize motion sensor if enabled */
    #ifdef MOTION_SUPPORTED
    PosAppMotion_init();
    #endif
 
    #ifdef CONF_VOLTAGE_REPORT
    /* Initialize voltage measurement. */
    Mcu_voltageInit();
    #endif
 
    // start the stack
    lib_state->startStack();
 
    //Start positioning
    App_start_positioning();
 
}