#include "LedController.h"
#include <cstring>
#include <iostream>

LedController::LedController() {
    memset(m_channels, 0, sizeof(m_channels));
}

bool LedController::initialize() {
    ledc_timer_config_t ledc_timer;
    memset(&ledc_timer, 0, sizeof(ledc_timer));
    ledc_timer.speed_mode = LEDC_HIGH_SPEED_MODE;
    ledc_timer.duty_resolution = LEDC_TIMER_13_BIT;
    ledc_timer.timer_num = LEDC_TIMER_0;
    ledc_timer.freq_hz = 4000;
    ledc_timer.clk_cfg = LEDC_AUTO_CLK;
    auto status = ledc_timer_config(&ledc_timer);
    if (status != ESP_OK) {
        std::cout << "ledc_timer_config() failed." << std::endl;
    }

    m_channels[0].gpio_num = 18; // gpio18
    m_channels[0].speed_mode = LEDC_HIGH_SPEED_MODE;
    m_channels[0].channel = LEDC_CHANNEL_0;
    m_channels[0].timer_sel = LEDC_TIMER_0;
    m_channels[0].duty = 0;
    m_channels[0].hpoint = 0;
    m_channels[0].flags.output_invert = 0;

    m_channels[1].gpio_num = 19; // gpio19
    m_channels[1].speed_mode = LEDC_HIGH_SPEED_MODE;
    m_channels[1].channel = LEDC_CHANNEL_1;
    m_channels[1].timer_sel = LEDC_TIMER_0;
    m_channels[1].duty = 0;
    m_channels[1].hpoint = 0;
    m_channels[1].flags.output_invert = 0;

    for (int i = 0; i < sizeof(m_channels) / sizeof(m_channels[0]); i++) {
        status = ledc_channel_config(&m_channels[i]);
        if (status != ESP_OK) {
            std::cout << "ledc_timer_config() failed." << std::endl;
        }

        ledc_set_duty(m_channels[i].speed_mode, m_channels[i].channel, 4096);
        ledc_update_duty(m_channels[i].speed_mode, m_channels[i].channel);
    }
    std::cout << "led controller initialize finished." << std::endl;
    return true;
}

void LedController::setDuty(int32_t channel, int32_t duty) {
    duty = static_cast<float>(0x1FFF * duty) / 100;

    if ((channel < 0) || (channel >= sizeof(m_channels) / sizeof(m_channels[0]))) return;
    std::cout<<"set channle "<<channel<<" duty: "<<duty<<std::endl;
    ledc_set_duty(m_channels[channel].speed_mode, m_channels[channel].channel, duty);
    ledc_update_duty(m_channels[channel].speed_mode, m_channels[channel].channel);
}

LedController *LedController::instance() {
    static LedController self;
    return &self;
}