#include <config.h>

#include <util/delay.h>

#include "debug.h"

#include "power.h"

#include "sysclock.h"

#include "audio.h"

#include "board.h"

#include "adc.h"

#include "nv.h"

#include "dma.h"

#include "backpack.h"

#include "audio_power.h"

#include "core_sensors_def.h"

#include "command.h"

#include <hal.h>

#include <phy.h>

#include <sys.h>

#include <nwk.h>

/* digital communication buses *********************************************/

uart_t serial_port;

i2c_bus_t sensor_i2c_bus;

spi_bus_t sensor_spi_bus;

/* sensors *****************************************************************/

sht21_t sht;

isl_t isl;

bmp180_t bmp;

lt3652_t solar;

analog_generic_t battery_voltage;

/* optional sensors */

analog_generic_t solar_voltage;

vwc_t vwc;

spi_peripheral_t accel_spi;

adxl362_t accel;

bool have_audio = false;

/* sensor configuration structs ********************************************/

const lt3652_config_t solar_config = {

    .chg_port = &PORTB,

    .chg_pin = 1,

    .fault_port = &PORTB,

    .fault_pin = 3

};

const analog_generic_config_t battery_config = {

    .mode = ANALOG_MODE_SINGLEENDED,

    .pos_input = ANALOG_POS_INPUT_BATMON,

    .scale_numerator = 1100,

    .scale_denominator = 2048,

    .fixed_precision = 2,

    .sensor_type = CORE_SENSORS_BATTERY_VOLTAGE

};

/*

const analog_generic_config_t solar_voltage_config = {

    .mode = ANALOG_MODE_DIFFERENTIAL,

    .pos_input = ANALOG_POS_INPUT_EXT4,

    .neg_input = ANALOG_NEG_INPUT_PADGND,

    .scale_numerator = 1500, // 7.5k and 200k resistor divider

    .scale_denominator = 1024,

    .fixed_precision = 2,

    .sensor_type = CORE_SENSORS_SOLAR_VOLTAGE

};

*/

/* board setup *************************************************************/

void board_setup(void) {

    dma_setup();

    /* set up serial port and debugging */

    PORTE.DIRSET = PIN3_bm;

    uart_setup(&serial_port, &SERIAL_PORT, SERIAL_BAUD);

    debug_setup(&serial_port);

    debugf("setup: begin\n");

    /* set up basic functions */

    power_setup();

    power_shutdown_unused();

    sensors_setup();

    adc_setup();

    _delay_ms(100);

    /* configure communication buses */

    i2c_setup(&sensor_i2c_bus, &SENSOR_TWI_BUS);

    spi_setup(&sensor_spi_bus, &SPID, &PORTD);

    /* sensor setup functions */

    sht21_status_t sht_status = sht21_setup(&sht, &sensor_i2c_bus);

    debug_sensor_status("sht21", sht_status);

    bmp180_status_t bmp_status = bmp180_setup(&bmp, &sensor_i2c_bus);

    debug_sensor_status("bmp180", bmp_status);

    isl_status_t isl_status = isl_setup(&isl, &sensor_i2c_bus);

    debug_sensor_status("isl29023", isl_status);

    spi_peripheral_setup(&accel_spi, &sensor_spi_bus, &PORTA, 0, 0,

        SPI_MSB_FIRST, 1000000UL);

    adxl362_status_t accel_status = adxl362_setup(&accel, &accel_spi);

    debug_sensor_status("adxl362", accel_status);

    if(accel_status == ADXL362_SUCCESS)

        accel_status = adxl362_reset(&accel);

    //    accel_status = adxl362_configure_basic(&accel);

    lt3652_setup(&solar, &solar_config);

    analog_generic_setup(&battery_voltage, &battery_config, PSTR("battery"));

    bool audio_power_status = audio_power_setup(&sensor_i2c_bus);

    debug_sensor_status("mppt_pwr", audio_power_status? 0:1);

    /*

    if(nv_has_feature(FEATURE_SOLAR)) {

        analog_generic_setup(&solar_voltage, &solar_voltage_config, PSTR("solar"));

    }

    */

    if(nv_has_feature(FEATURE_DECAGON)) {

        vwc_setup(&vwc, PSTR("decagon"));

    }

    if(nv_has_feature(FEATURE_TX22U_WIND)) {

        tx22u_setup();

    }

    //have_audio = audio_probe();

    //debugf("  audio: %c\n", have_audio? 'Y' : 'N');

    /* radio setup */

    SYS_Init();

    debugf("    addr: 0x%04X\n", nv_get_addr());

    debugf("     pan: 0x%04X\n", nv_get_pan());

    NWK_SetAddr(nv_get_addr());

    NWK_SetPanId(nv_get_pan());

    PHY_SetChannel(11);

    PHY_SetRxState(true);

    PHY_SetTxPower(0);

    sensors_radio_setup();

    /* register the sensors that successfully initialized */

    if(sht_status == SHT21_SUCCESS)

        sensors_register(SENSOR(&sht));

    if(isl_status == ISL_SUCCESS)

        sensors_register(SENSOR(&isl));

    if(bmp_status == BMP180_SUCCESS)

        sensors_register(SENSOR(&bmp));

    //if(accel_status == ADXL362_SUCCESS)

    //    sensors_register(SENSOR(&accel));

    sensors_register(SENSOR(&battery_voltage));

    if(nv_has_feature(FEATURE_SOLAR)) {

        sensors_register(SENSOR(&solar));

        sensors_register(SENSOR(&solar_voltage));

    }

    if(nv_has_feature(FEATURE_VEGETRONIX) || nv_has_feature(FEATURE_DECAGON)) {

        sensors_register(SENSOR(&vwc));

    }

    command_set_i2c_bus(&sensor_i2c_bus);

    sei();

    debugf("setup: end\n");

    _delay_ms(10);

}

/* sleep/wake tasks ********************************************************/

void board_sleep(void) {

    VCC_MODE_PORT.OUTSET = (1<<VCC_MODE_PIN);

    SENSOR_TWI_BUS.MASTER.CTRLA &= ~TWI_MASTER_ENABLE_bm;

    PR.PRPE |= PR_TWI_bm;

    adc_disable();

}

void board_wake(void) {

    VCC_MODE_PORT.OUTCLR = (1<<VCC_MODE_PIN);

    PR.PRPE &= ~PR_TWI_bm;

    i2c_setup(&sensor_i2c_bus, &SENSOR_TWI_BUS);

}

UART_ISR(&serial_port, SERIAL_INTERRUPT);