#include <stdio.h>
#include <string.h>
#include <stdlib.h>
#include <math.h>
#include "watch.h"
#include "lis2dw.h"

static void cb_light_pressed(void) {
}

static void cb_mode_pressed(void) {
}

static void cb_alarm_pressed(void) {
}

uint8_t interrupts = 0;
uint8_t last_interrupts = 0;
uint8_t ticks = 0;
char buf[13] = {0};

static void cb_tick(void) {
    watch_clear_indicator(WATCH_INDICATOR_SIGNAL);
    if (!lis2dw_have_new_data()) return;

    watch_set_indicator(WATCH_INDICATOR_SIGNAL);
    lis2dw_reading raw_reading;
    lis2dw_acceleration_measurement measurement = lis2dw_get_acceleration_measurement(&raw_reading);
    printf("%f, %f, %f\n", measurement.x, measurement.y, measurement.z);
    char buf[128];
    sprintf(buf, "%f, %f, %f\n", measurement.x, measurement.y, measurement.z);
    watch_debug_puts(buf);
}

void app_init(void) {
    watch_enable_debug_uart(460800); // this is glitchy now, but this enables a baud rate of 115200 when USB is disabled.

    watch_enable_display();
    watch_display_string("AC  Strean", 0);

    watch_enable_external_interrupts();
    watch_register_interrupt_callback(BTN_MODE, cb_mode_pressed, INTERRUPT_TRIGGER_RISING);
    watch_register_interrupt_callback(BTN_LIGHT, cb_light_pressed, INTERRUPT_TRIGGER_RISING);
    watch_register_interrupt_callback(BTN_ALARM, cb_alarm_pressed, INTERRUPT_TRIGGER_RISING);

    watch_enable_i2c();
    lis2dw_begin();
    lis2dw_set_data_rate(LIS2DW_DATA_RATE_25_HZ); // is this enough for training?
    lis2dw_set_low_noise_mode(true); // consumes a little more power
    lis2dw_set_low_power_mode(LIS2DW_LP_MODE_2); // lowest power 14-bit mode, 25 Hz is 3.5 µA @ 1.8V w/ low noise, 3µA without
    lis2dw_set_range(LIS2DW_CTRL6_VAL_RANGE_4G);

    watch_rtc_register_periodic_callback(cb_tick, 64);
}

void app_wake_from_backup(void) {
}

void app_setup(void) {
}

void app_prepare_for_standby(void) {
}

void app_wake_from_standby(void) {
}

bool app_loop(void) {
    // TODO: interrupt configuration for LIS2DW
    watch_display_string(buf, 0);

    return true;
}