#include "sl_bluetooth.h"
#include "sl_app_assert.h"
#include "gatt_db.h"
#include "app.h"
#include "sl_i2cspm_instances.h"
#include "TMP112.h"
#include "LIS2DW12.h"

#define TIMER_ID_DYN    0
#define TIMER_ID_SEN    1
#define TIMER_ID_INIT   2
#define ACC_THRESH     50           // UP/DN threschold
#define MEASURE_PERIOD 15           // sensor period is seconds

typedef struct {
   uint8_t flags_len;                 // Length of the Flags field.
   uint8_t flags_type;                // Type of the Flags field.
   uint8_t flags;                     // Flags field.
   uint8_t field_len;                 // Length of device name.
   uint8_t field_type;                // Device name (9).
   char    beacon_data[8];
} beacon_adv_data_t;

static void bcn_setup_adv_beaconing(void);

// The advertising set handle allocated from Bluetooth stack.
static uint8_t advertising_set_handle = 0xff;
int8_t zOut;
static beacon_adv_data_t beacon_adv_data;

SL_WEAK void app_init(void)
{
   TMP112_init();
   LIS2DW12_init();
}

SL_WEAK void app_process_action(void)
{
}

void sl_bt_on_event(sl_bt_msg_t *evt)
{
   switch (SL_BT_MSG_ID(evt->header)) {
      case sl_bt_evt_system_boot_id:
         // Initialize iBeacon ADV data.
         bcn_setup_adv_beaconing();
         sl_bt_system_set_soft_timer(32768*MEASURE_PERIOD,TIMER_ID_DYN,0);  // start software timer
         sl_bt_system_set_soft_timer(32768,TIMER_ID_INIT,1);
         break;

      case sl_bt_evt_system_soft_timer_id:
         switch (evt->data.evt_system_soft_timer.handle) {
            case TIMER_ID_DYN:
               sl_bt_system_set_soft_timer(3276,TIMER_ID_SEN,1);
               TMP112_startConversion();
               LIS2DW12_startMeas();
            break;

            case TIMER_ID_SEN:
               TMP112_getTemp();
               LIS2DW12_getData();
               zOut = (ACC_data[6]<<4) + (ACC_data[5]>>4);

               if (-ACC_THRESH <= zOut && zOut <= ACC_THRESH) {
                  beacon_adv_data.beacon_data[0] = 'D';
                  beacon_adv_data.beacon_data[1] = 'N';
               }
               else {
                  beacon_adv_data.beacon_data[0] = 'U';
                  beacon_adv_data.beacon_data[1] = 'P';
               }

               beacon_adv_data.beacon_data[3] = '+';
               if (temp < 0) {
                  temp = -temp;
                  beacon_adv_data.beacon_data[3] = '-';
               }
               beacon_adv_data.beacon_data[4] = (temp / 10) + '0';
               beacon_adv_data.beacon_data[5] = (temp % 10) + '0';
               sl_bt_advertiser_set_data(advertising_set_handle, 0, sizeof(beacon_adv_data), (uint8_t *)(&beacon_adv_data));
               break;

            case TIMER_ID_INIT:
               TMP112_init();
               LIS2DW12_init();
            break;

            default:
            break;
         }
         break;

         default:
         break;
   }
}

static void bcn_setup_adv_beaconing(void)
{
   int16_t ret_min, ret_max;
   beacon_adv_data.flags_len = 2;        // Field length
   beacon_adv_data.flags_type = 0x01;    // Field type
   beacon_adv_data.flags = 0x04 | 0x02;  // General Discoverable Mode, BR/EDR is disabled
   beacon_adv_data.field_len = 9;
   beacon_adv_data.field_type = 9;       // Full device name
   strncpy(beacon_adv_data.beacon_data, "DN +25*C", 8);

   sl_bt_system_set_tx_power(0, 0, &ret_min, &ret_max);

   // Create an advertising set.
   sl_bt_advertiser_create_set(&advertising_set_handle);

   // Set custom advertising data.
   sl_bt_advertiser_set_data(advertising_set_handle, 0, sizeof(beacon_adv_data), (uint8_t *)(&beacon_adv_data));

   // Set advertising parameters. 1000ms advertisement interval.
   sl_bt_advertiser_set_timing(advertising_set_handle, 1600, 1600, 0, 0);

   // Start advertising in user mode and disable connections.
   sl_bt_advertiser_start(advertising_set_handle, advertiser_user_data, advertiser_non_connectable);
}