#include "hal/soc/soc.h"
//#include "pwm_pub.h"
//Fixme: implement pwm driver
#define PWM_NUM 5
static pwm_dev_t PWM_OBJ[PWM_NUM];
/*
static PinName PWM_MAP[PWM_NUM] = {
   [0] = PD_0,
   [1] = PD_1,
   [2] = PD_2,
   [3] = PD_3,
   [4] = PB_3,
};
*/
int32_t hal_pwm_init(pwm_dev_t * pwm)
{
    if (pwm->port >= PWM_NUM) {
        return -1;
    }
    if (pwm->config.freq > 1000000 || pwm->config.freq < 200)
        return -1;
    if (pwm->config.duty_cycle > 1 || pwm->config.duty_cycle < 0)
        return -1;

    pwm->priv = &PWM_OBJ[pwm->port];
    //pwmout_init(pwm->priv, PWM_MAP[pwm->port]);

    static int init_clk = 0;
    if (!init_clk) {
        //pwmout_clk_set(pwm->priv, 1, 0);
        init_clk = 1;
    }
    return 0;
}

int32_t hal_pwm_clk(pwm_dev_t * pwm, int src, int div)
{
    if (1 == src) {
        pwm->config.freq = 10000000;
    } else {
        pwm->config.freq = 16384;
    }
    //pwmout_clk_set(pwm->priv, src, div);
    return 0;
}

int32_t hal_pwm_period_us(pwm_dev_t * pwm, int us)
{
    //pwmout_period_us(pwm->priv, us);
    return 0;
}

int32_t hal_pwm_write(pwm_dev_t * pwm, float percent)
{
    pwm->config.duty_cycle = percent;
    //pwmout_write(pwm->priv, percent);
    return 0;
}

int32_t hal_pwm_diff_write(pwm_dev_t * pwm, float percent)
{
    pwm->config.duty_cycle = percent;
    //pwmout_diff_write(pwm->priv, percent);
    return 0;
}

int32_t hal_pwm_sync_write(pwm_dev_t * pwm, float percent, uint8_t duty_sel)
{
    pwm->config.duty_cycle = percent;
    //pwmout_sync_write(pwm->priv, percent, duty_sel);
    return 0;
}

int32_t hal_pwm_start(pwm_dev_t * pwm)
{
    int us = 1000000 / pwm->config.freq;
    //pwmout_period_us(pwm->priv, us);
    //pwmout_write(pwm->priv, pwm->config.duty_cycle);
    //pwmout_start(pwm->priv);
    return 0;
}

int32_t hal_pwm_stop(pwm_dev_t * pwm)
{
    //pwmout_stop(pwm->priv);
    return 0;
}

int32_t hal_pwm_finalize(pwm_dev_t * pwm)
{
    //pwmout_free(pwm->priv);
    return 0;
}