#include "scheduler.h"

#include "report.h"

#include "audio_power_def.h"

#include "audio_power.h"

i2c_bus_t *power_bus;

sched_task_t *audio_power_task;

/* static definitions */

static void audio_power_task_fn(void);

bool audio_power_setup(i2c_bus_t *b) {

    power_bus = b;

    if(!audio_power_probe())

        return false;

    audio_power_task = sched_task_create(audio_power_task_fn, 30, 0, 

        SCHED_ENABLED);

    return true;

}

bool audio_power_probe(void) {

    uint8_t data;

    i2c_error_t status = i2c_read_generic(power_bus, AUDIO_POWER_DEVICE, 0x00,

        &data, 1);

    if(status != I2C_SUCCESS)

        return false;

    if(data != AUDIO_POWER_SIG)

        return false;

    return true;

}

static void audio_power_task_fn(void) {

    audio_power_lipo_data_t lipo;

    audio_power_mppt_data_t mppt;

    report_t report;

    if(!report_start(&report, AUDIO_POWER_NAMESPACE))

        return;

    /* read lipo status */

    i2c_error_t status = i2c_read_generic(power_bus, AUDIO_POWER_DEVICE,

        AUDIO_POWER_LIPO_REG, &lipo, sizeof(lipo));

    if(status == I2C_SUCCESS) {

        report_add_payload(&report, 

            AUDIO_POWER_LIPO_CHARGE_CAPACITY | SENSOR_SIZE_16BIT | SENSOR_SIGNED,

            &lipo.charge_capacity);

        report_add_payload(&report, 

            AUDIO_POWER_LIPO_CHARGE | SENSOR_SIZE_16BIT | SENSOR_SIGNED,

            &lipo.charge);

        report_add_payload(&report, 

            AUDIO_POWER_LIPO_CURRENT | SENSOR_SIZE_16BIT | SENSOR_SIGNED,

            &lipo.current);

        report_add_payload(&report, 

            AUDIO_POWER_LIPO_VOLTAGE | SENSOR_SIZE_16BIT | SENSOR_SIGNED,

            &lipo.voltage);

        report_add_payload(&report, 

            AUDIO_POWER_LIPO_STATE | SENSOR_SIZE_8BIT,

            &lipo.state);

    }

    /* check mppt validity, read status */

    uint8_t mppt_status;

    status = i2c_read_generic(power_bus, AUDIO_POWER_DEVICE,

        AUDIO_POWER_MPPT_STATUS_REG, &mppt_status, 1);

    if(status == I2C_SUCCESS && mppt_status == 0) {

        status = i2c_read_generic(power_bus, AUDIO_POWER_DEVICE,

            AUDIO_POWER_MPPT_REG, &mppt, sizeof(mppt));

        if(status == I2C_SUCCESS) {

            report_add_payload(&report,

                AUDIO_POWER_SLA_VOLTAGE | SENSOR_SIZE_16BIT,

                &mppt.sla_voltage);

            report_add_payload(&report,

                AUDIO_POWER_PV_VOLTAGE | SENSOR_SIZE_16BIT,

                &mppt.pv_voltage);

            report_add_payload(&report,

                AUDIO_POWER_SLA_LOAD_CURRENT | SENSOR_SIZE_16BIT,

                &mppt.load_current);

            report_add_payload(&report,

                AUDIO_POWER_SLA_OVERDISCHARGE_VOLTAGE | SENSOR_SIZE_16BIT,

                &mppt.overdischarge_voltage);

            report_add_payload(&report,

                AUDIO_POWER_SLA_FULL_VOLTAGE | SENSOR_SIZE_16BIT,

                &mppt.full_voltage);

            report_add_payload(&report,

                AUDIO_POWER_SLA_FLAGS | SENSOR_SIZE_8BIT,

                &mppt.flags);

            report_add_payload(&report,

                AUDIO_POWER_SLA_TEMPERATURE | SENSOR_SIZE_8BIT,

                &mppt.temperature);

            report_add_payload(&report,

                AUDIO_POWER_SLA_CHARGE_CURRENT | SENSOR_SIZE_16BIT,

                &mppt.charge_current);

            report_add_payload(&report,

                AUDIO_POWER_SLA_CHARGE | SENSOR_SIZE_16BIT | SENSOR_SIGNED,

                &mppt.charge);

        }

    }

    report_send(&report);

}