#define os_log(format, ...)  custom_log("OTA", format, ##__VA_ARGS__)
#include "TimeUtils.h"

#include "mico.h"
#include "main.h"
#include "user_udp.h"
#include "user_mqtt_client.h"
#include "user_function.h"
#include "user_power.h"

mico_timer_t power_timer;

PowerRecord power_record = { 0, { 50,55,60,65,70,75,80,85,90,95,90,85,80,75,70,65,60,65,70,75,80,85,90,95,90,85,80,75,70,65,60,65,70,75,80,85,90,95,90,85,80,75,70,65,60 } };

static uint32_t clock_count_last = 0;
static uint32_t clock_count = 0;
static uint32_t timer_count = 0;
static uint32_t timer_irq_count = 0;

char power_record_str[1101] = { 0 };

void SetPowerRecord(PowerRecord* pr, uint32_t pw)
{
    if (pr->idx >= PW_NUM)
    {
        pr->idx = 0;
    }
    pr->powers[pr->idx++] = pw;
}

char* GetPowerRecord()
{
    int i = 0;
    char* tmp = power_record_str;
    for (; i < PW_NUM; i++)
    {
        sprintf(tmp, "%d,", power_record.powers[i]);
        tmp += strlen(tmp);
    }
    *(--tmp) = 0;
    return power_record_str;
}

static void PowerTimerHandler(void* arg)
{
    uint32_t timer = 0;

    if (timer_irq_count > 1)
    {
        timer = (clock_count - clock_count_last);

        if (timer_count > 3)
        {
            timer /= 1000;
            timer += 4294967; //0xffffffff/1000;
        }
        else if (clock_count < clock_count_last)
        {
            timer += 0xffffffff;
            timer /= 1000;
        }
        else
        {
            timer /= 1000;
        }
        power = 17100000 * (timer_irq_count - 1) / timer;
        timer_count = 0;
        timer_irq_count = 0;
    }
    else
    {
        timer_count++;
    }
}

static void PowerIrqHandler(void* arg)
{
    clock_count = mico_nanosecond_clock_value();
    if (timer_irq_count == 0) clock_count_last = clock_count;
    timer_irq_count++;
}

void PowerInit(void)
{
    os_log("user_power_init");

    MicoGpioInitialize(POWER, INPUT_PULL_UP);
    mico_rtos_init_timer(&power_timer, 1000, PowerTimerHandler, NULL);
    mico_rtos_start_timer(&power_timer);

    MicoGpioEnableIRQ(POWER, IRQ_TRIGGER_FALLING_EDGE, PowerIrqHandler, NULL);
}