482 lines
13 KiB
C
482 lines
13 KiB
C
|
#include <hal_gpio.h>
|
||
|
#include <hal_dma.h>
|
||
|
#include <hal_clk.h>
|
||
|
#include <hal_reset.h>
|
||
|
#include <hal_cache.h>
|
||
|
#include <sunxi_hal_ledc.h>
|
||
|
|
||
|
#ifdef LEDC_DEBUG
|
||
|
#define ledc_info(fmt, args...) printf("%s()%d - "fmt, __func__, __LINE__, ##args)
|
||
|
#else
|
||
|
#define ledc_info(fmt, args...)
|
||
|
#endif
|
||
|
|
||
|
static unsigned long base_addr = LEDC_BASE;
|
||
|
struct sunxi_dma_chan *dma_chan;
|
||
|
|
||
|
static int ledc_clk_init(void)
|
||
|
{
|
||
|
hal_clk_type_t clk_type = HAL_SUNXI_CCU;
|
||
|
hal_clk_id_t mod_clk_id = CLK_LEDC;
|
||
|
hal_clk_id_t bus_clk_id = CLK_BUS_LEDC;
|
||
|
hal_clk_t mod_clk;
|
||
|
hal_clk_t bus_clk;
|
||
|
|
||
|
hal_reset_type_t reset_type = HAL_SUNXI_RESET;
|
||
|
hal_reset_id_t reset_id = RST_BUS_LEDC;
|
||
|
struct reset_control *reset;
|
||
|
|
||
|
reset = hal_reset_control_get(reset_type, reset_id);
|
||
|
if (hal_reset_control_deassert(reset))
|
||
|
{
|
||
|
ledc_info("ledc reset deassert failed!");
|
||
|
return -1;
|
||
|
}
|
||
|
hal_reset_control_put(reset);
|
||
|
|
||
|
mod_clk = hal_clock_get(clk_type, mod_clk_id);
|
||
|
if (hal_clock_enable(mod_clk))
|
||
|
{
|
||
|
ledc_info("ledc clk enable mclk failed!");
|
||
|
return -1;
|
||
|
}
|
||
|
|
||
|
bus_clk = hal_clock_get(clk_type, bus_clk_id);
|
||
|
if (hal_clock_enable(bus_clk))
|
||
|
{
|
||
|
ledc_info("ledc clk enable mclk failed!");
|
||
|
return -1;
|
||
|
}
|
||
|
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int ledc_pinctrl_init(void)
|
||
|
{
|
||
|
if (hal_gpio_pinmux_set_function(LEDC_PIN, LEDC_PINMUXSEL))
|
||
|
{
|
||
|
ledc_info("ledc pin set default function failed!");
|
||
|
return -1;
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
static void ledc_dump_reg(void)
|
||
|
{
|
||
|
ledc_info("LEDC_CTRL_REG = %0x\n", hal_readl(base_addr + LEDC_CTRL_REG));
|
||
|
ledc_info("LED_T01_TIMING_CTRL_REG = %0x\n", hal_readl(base_addr + LED_T01_TIMING_CTRL_REG));
|
||
|
ledc_info("LEDC_DATA_FINISH_CNT_REG = %0x\n", hal_readl(base_addr + LEDC_DATA_FINISH_CNT_REG));
|
||
|
ledc_info("LED_RST_TIMING_CTRL_REG = %0x\n", hal_readl(base_addr + LED_RST_TIMING_CTRL_REG));
|
||
|
ledc_info("LEDC_WAIT_TIME0_CTRL_REG = %0x\n", hal_readl(base_addr + LEDC_WAIT_TIME0_CTRL_REG));
|
||
|
ledc_info("LEDC_DATA_REG = %0x\n", hal_readl(base_addr + LEDC_DATA_REG));
|
||
|
ledc_info("LEDC_DMA_CTRL_REG = %0x\n", hal_readl(base_addr + LEDC_DMA_CTRL_REG));
|
||
|
ledc_info("LEDC_INTC_REG = %0x\n", hal_readl(base_addr + LEDC_INTC_REG));
|
||
|
ledc_info("LEDC_INTS_REG = %0x\n", hal_readl(base_addr + LEDC_INTS_REG));
|
||
|
ledc_info("LEDC_WAIT_TIME1_CTRL_REG = %0x\n", hal_readl(base_addr + LEDC_WAIT_TIME1_CTRL_REG));
|
||
|
ledc_info("LEDC_FIFO_DATA0_REG = %0x\n", hal_readl(base_addr + LEDC_FIFO_DATA0_REG));
|
||
|
}
|
||
|
|
||
|
static void ledc_set_reset_ns(unsigned int reset_ns)
|
||
|
{
|
||
|
unsigned int n, reg_val;
|
||
|
unsigned int mask = 0x1FFF;
|
||
|
unsigned int min = LEDC_RESET_TIME_MIN_NS;
|
||
|
unsigned int max = LEDC_RESET_TIME_MAX_NS;
|
||
|
|
||
|
if (reset_ns < min || reset_ns > max) {
|
||
|
ledc_info("invalid parameter, reset_ns should be %u-%u!\n", min, max);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
n = (reset_ns - 42) / 42;
|
||
|
reg_val = hal_readl(base_addr + LED_RST_TIMING_CTRL_REG);
|
||
|
reg_val &= ~(mask << 16);
|
||
|
reg_val |= (n << 16);
|
||
|
hal_writel(reg_val, base_addr + LED_RST_TIMING_CTRL_REG);
|
||
|
}
|
||
|
|
||
|
static void ledc_set_t1h_ns(unsigned int t1h_ns)
|
||
|
{
|
||
|
unsigned int n, reg_val;
|
||
|
unsigned int mask = 0x3F;
|
||
|
unsigned int shift = 21;
|
||
|
unsigned int min = LEDC_T1H_MIN_NS;
|
||
|
unsigned int max = LEDC_T1H_MAX_NS;
|
||
|
|
||
|
if (t1h_ns < min || t1h_ns > max) {
|
||
|
ledc_info("invalid parameter, t1h_ns should be %u-%u!\n", min, max);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
n = (t1h_ns - 42) / 42;
|
||
|
reg_val = hal_readl(base_addr + LED_T01_TIMING_CTRL_REG);
|
||
|
reg_val &= ~(mask << shift);
|
||
|
reg_val |= n << shift;
|
||
|
hal_writel(reg_val, base_addr + LED_T01_TIMING_CTRL_REG);
|
||
|
}
|
||
|
|
||
|
static void ledc_set_t1l_ns(unsigned int t1l_ns)
|
||
|
{
|
||
|
unsigned int n, reg_val;
|
||
|
unsigned int mask = 0x1F;
|
||
|
unsigned int shift = 16;
|
||
|
unsigned int min = LEDC_T1L_MIN_NS;
|
||
|
unsigned int max = LEDC_T1L_MAX_NS;
|
||
|
|
||
|
if (t1l_ns < min || t1l_ns > max) {
|
||
|
ledc_info("invalid parameter, t1l_ns should be %u-%u!\n", min, max);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
n = (t1l_ns - 42) / 42;
|
||
|
reg_val = hal_readl(base_addr + LED_T01_TIMING_CTRL_REG);
|
||
|
reg_val &= ~(mask << shift);
|
||
|
reg_val |= n << shift;
|
||
|
hal_writel(reg_val, base_addr + LED_T01_TIMING_CTRL_REG);
|
||
|
}
|
||
|
|
||
|
static void ledc_set_t0h_ns(unsigned int t0h_ns)
|
||
|
{
|
||
|
unsigned int n, reg_val;
|
||
|
unsigned int mask = 0x1F;
|
||
|
unsigned int shift = 6;
|
||
|
unsigned int min = LEDC_T0H_MIN_NS;
|
||
|
unsigned int max = LEDC_T0H_MAX_NS;
|
||
|
|
||
|
if (t0h_ns < min || t0h_ns > max) {
|
||
|
ledc_info("invalid parameter, t0h_ns should be %u-%u!\n", min, max);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
n = (t0h_ns - 42) / 42;
|
||
|
reg_val = hal_readl(base_addr + LED_T01_TIMING_CTRL_REG);
|
||
|
reg_val &= ~(mask << shift);
|
||
|
reg_val |= n << shift;
|
||
|
hal_writel(reg_val, base_addr + LED_T01_TIMING_CTRL_REG);
|
||
|
}
|
||
|
|
||
|
static void ledc_set_t0l_ns(unsigned int t0l_ns)
|
||
|
{
|
||
|
unsigned int n, reg_val;
|
||
|
unsigned int min = LEDC_T0L_MIN_NS;
|
||
|
unsigned int max = LEDC_T0L_MAX_NS;
|
||
|
|
||
|
if (t0l_ns < min || t0l_ns > max) {
|
||
|
ledc_info("invalid parameter, t0l_ns should be %u-%u!\n", min, max);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
n = (t0l_ns - 42) / 42;
|
||
|
reg_val = hal_readl(base_addr + LED_T01_TIMING_CTRL_REG);
|
||
|
reg_val &= ~0x3F;
|
||
|
reg_val |= n;
|
||
|
hal_writel(reg_val, base_addr + LED_T01_TIMING_CTRL_REG);
|
||
|
}
|
||
|
|
||
|
static void ledc_set_wait_time0_ns(unsigned int wait_time0_ns)
|
||
|
{
|
||
|
unsigned int n, reg_val;
|
||
|
unsigned int min = LEDC_WAIT_TIME0_MIN_NS;
|
||
|
unsigned int max = LEDC_WAIT_TIME0_MAX_NS;
|
||
|
|
||
|
if (wait_time0_ns < min || wait_time0_ns > max) {
|
||
|
ledc_info("invalid parameter, wait_time0_ns should be %u-%u!\n", min, max);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
n = (wait_time0_ns - 42) / 42;
|
||
|
reg_val = (1 << 8) | n;
|
||
|
hal_writel(reg_val, base_addr + LEDC_WAIT_TIME0_CTRL_REG);
|
||
|
}
|
||
|
|
||
|
static void ledc_set_wait_time1_ns(unsigned long long wait_time1_ns)
|
||
|
{
|
||
|
unsigned long long tmp, max = LEDC_WAIT_TIME1_MAX_NS;
|
||
|
unsigned int min = LEDC_WAIT_TIME1_MIN_NS;
|
||
|
unsigned int n, reg_val;
|
||
|
|
||
|
if (wait_time1_ns < min || wait_time1_ns > max) {
|
||
|
ledc_info("invalid parameter, wait_time1_ns should be %u-%llu!\n", min, max);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
n = wait_time1_ns / 42;
|
||
|
//tmp = wait_time1_ns;
|
||
|
//n = div_u64(tmp, 42);
|
||
|
n -= 1;
|
||
|
reg_val = (1 << 31) | n;
|
||
|
hal_writel(reg_val, base_addr + LEDC_WAIT_TIME1_CTRL_REG);
|
||
|
}
|
||
|
|
||
|
static void ledc_set_wait_data_time_ns(unsigned int wait_data_time_ns)
|
||
|
{
|
||
|
unsigned int mask = 0x1FFF;
|
||
|
unsigned int shift = 16;
|
||
|
unsigned int reg_val = 0;
|
||
|
unsigned int n, min, max;
|
||
|
|
||
|
min = LEDC_WAIT_DATA_TIME_MIN_NS;
|
||
|
max = LEDC_WAIT_DATA_TIME_MAX_NS_IC;
|
||
|
|
||
|
if (wait_data_time_ns < min || wait_data_time_ns > max) {
|
||
|
ledc_info("invalid parameter, wait_data_time_ns should be %u-%u!\n",
|
||
|
min, max);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
n = (wait_data_time_ns - 42) / 42;
|
||
|
reg_val &= ~(mask << shift);
|
||
|
reg_val |= (n << shift);
|
||
|
hal_writel(reg_val, base_addr + LEDC_DATA_FINISH_CNT_REG);
|
||
|
}
|
||
|
|
||
|
static void ledc_set_length(unsigned int length)
|
||
|
{
|
||
|
unsigned int reg_val;
|
||
|
|
||
|
if (length == 0)
|
||
|
return;
|
||
|
|
||
|
reg_val = hal_readl(base_addr + LEDC_CTRL_REG);
|
||
|
reg_val &= ~(0x1FFF << 16);
|
||
|
reg_val |= length << 16;
|
||
|
hal_writel(reg_val, base_addr + LEDC_CTRL_REG);
|
||
|
|
||
|
reg_val = hal_readl(base_addr + LED_RST_TIMING_CTRL_REG);
|
||
|
reg_val &= ~0x3FF;
|
||
|
reg_val |= length - 1;
|
||
|
hal_writel(reg_val, base_addr + LED_RST_TIMING_CTRL_REG);
|
||
|
}
|
||
|
|
||
|
static void ledc_set_output_mode(const char *str)
|
||
|
{
|
||
|
unsigned int val = 0;
|
||
|
unsigned int mask = 0x7;
|
||
|
unsigned int shift = 6;
|
||
|
unsigned int reg_val ;
|
||
|
if (str != NULL) {
|
||
|
if (!strncmp(str, "GRB", 3))
|
||
|
val = LEDC_OUTPUT_GRB;
|
||
|
else if (!strncmp(str, "GBR", 3))
|
||
|
val = LEDC_OUTPUT_GBR;
|
||
|
else if (!strncmp(str, "RGB", 3))
|
||
|
val = LEDC_OUTPUT_RGB;
|
||
|
else if (!strncmp(str, "RBG", 3))
|
||
|
val = LEDC_OUTPUT_RBG;
|
||
|
else if (!strncmp(str, "BGR", 3))
|
||
|
val = LEDC_OUTPUT_BGR;
|
||
|
else if (!strncmp(str, "BRG", 3))
|
||
|
val = LEDC_OUTPUT_BRG;
|
||
|
else
|
||
|
return;
|
||
|
} else {
|
||
|
}
|
||
|
|
||
|
reg_val = hal_readl(base_addr + LEDC_CTRL_REG);
|
||
|
reg_val &= ~(mask << shift);
|
||
|
reg_val |= val;
|
||
|
hal_writel(reg_val, base_addr + LEDC_CTRL_REG);
|
||
|
}
|
||
|
|
||
|
static void ledc_disable_irq(unsigned int mask)
|
||
|
{
|
||
|
unsigned int reg_val = 0;
|
||
|
|
||
|
reg_val = hal_readl(base_addr + LEDC_INTC_REG);
|
||
|
reg_val &= ~mask;
|
||
|
hal_writel(reg_val, base_addr + LEDC_INTC_REG);
|
||
|
}
|
||
|
|
||
|
static void ledc_enable_irq(unsigned int mask)
|
||
|
{
|
||
|
unsigned int reg_val = 0;
|
||
|
|
||
|
reg_val = hal_readl(base_addr + LEDC_INTC_REG);
|
||
|
reg_val |= mask;
|
||
|
hal_writel(reg_val, base_addr + LEDC_INTC_REG);
|
||
|
}
|
||
|
|
||
|
static void ledc_set_dma_mode(void)
|
||
|
{
|
||
|
unsigned int reg_val = 0;
|
||
|
|
||
|
reg_val |= 1 << 5;
|
||
|
hal_writel(reg_val, base_addr + LEDC_DMA_CTRL_REG);
|
||
|
}
|
||
|
|
||
|
static void ledc_set_cpu_mode(void)
|
||
|
{
|
||
|
unsigned int reg_val = 0;
|
||
|
|
||
|
reg_val &= ~(1 << 5);
|
||
|
hal_writel(reg_val, base_addr + LEDC_DMA_CTRL_REG);
|
||
|
}
|
||
|
|
||
|
static void ledc_clear_all_irq(void)
|
||
|
{
|
||
|
unsigned int reg_val;
|
||
|
|
||
|
reg_val = hal_readl(base_addr + LEDC_INTS_REG);
|
||
|
reg_val |= 0x1F;
|
||
|
hal_writel(reg_val, base_addr + LEDC_INTS_REG);
|
||
|
}
|
||
|
|
||
|
static unsigned int ledc_get_irq_status(void)
|
||
|
{
|
||
|
return hal_readl(base_addr + LEDC_INTS_REG);
|
||
|
}
|
||
|
|
||
|
static void ledc_soft_reset(void)
|
||
|
{
|
||
|
unsigned int reg_val;
|
||
|
|
||
|
reg_val = hal_readl(base_addr + LEDC_CTRL_REG);
|
||
|
reg_val |= 1 << 1;
|
||
|
hal_writel(reg_val, base_addr + LEDC_CTRL_REG);
|
||
|
}
|
||
|
|
||
|
static void ledc_reset_en(void)
|
||
|
{
|
||
|
unsigned int reg_val;
|
||
|
|
||
|
reg_val = hal_readl(base_addr + LEDC_CTRL_REG);
|
||
|
reg_val |= 1 << 10;
|
||
|
hal_writel(reg_val, base_addr + LEDC_CTRL_REG);
|
||
|
}
|
||
|
|
||
|
static void ledc_set_data(unsigned int data)
|
||
|
{
|
||
|
hal_writel(data, base_addr + LEDC_DATA_REG);
|
||
|
}
|
||
|
|
||
|
static void ledc_enable(void)
|
||
|
{
|
||
|
unsigned int reg_val;
|
||
|
|
||
|
reg_val = hal_readl(base_addr + LEDC_CTRL_REG);
|
||
|
reg_val |= 1;
|
||
|
hal_writel(reg_val, base_addr + LEDC_CTRL_REG);
|
||
|
}
|
||
|
|
||
|
static void hal_ledc_set_time(struct ledc_config *ledc)
|
||
|
{
|
||
|
ledc_set_reset_ns(ledc->reset_ns);
|
||
|
ledc_set_t1h_ns(ledc->t1h_ns);
|
||
|
ledc_set_t1l_ns(ledc->t1l_ns);
|
||
|
ledc_set_t0h_ns(ledc->t0h_ns);
|
||
|
ledc_set_t0l_ns(ledc->t0l_ns);
|
||
|
ledc_set_wait_time0_ns(ledc->wait_time0_ns);
|
||
|
ledc_set_wait_time1_ns(ledc->wait_time1_ns);
|
||
|
ledc_set_wait_data_time_ns(ledc->wait_data_time_ns);
|
||
|
}
|
||
|
|
||
|
void hal_ledc_dma_callback(void *para)
|
||
|
{
|
||
|
printf("dma callback\n");
|
||
|
}
|
||
|
|
||
|
void hal_ledc_trans_data(struct ledc_config *ledc)
|
||
|
{
|
||
|
int i;
|
||
|
unsigned long int size;
|
||
|
unsigned int mask = 0;
|
||
|
struct dma_slave_config slave_config;
|
||
|
|
||
|
mask = LEDC_TRANS_FINISH_INT_EN | LEDC_WAITDATA_TIMEOUT_INT_EN
|
||
|
| LEDC_FIFO_OVERFLOW_INT_EN | LEDC_GLOBAL_INT_EN;
|
||
|
if (ledc->length <= SUNXI_LEDC_FIFO_DEPTH) {
|
||
|
ledc_info("trans data by CPU mode\n");
|
||
|
mask |= LEDC_FIFO_CPUREQ_INT_EN;
|
||
|
ledc_reset_en();
|
||
|
hal_ledc_set_time(ledc);
|
||
|
ledc_set_output_mode(ledc->output_mode);
|
||
|
ledc_set_cpu_mode();
|
||
|
ledc_set_length(ledc->length);
|
||
|
ledc_enable_irq(mask);
|
||
|
|
||
|
for(i = 0; i < ledc->length; i++)
|
||
|
ledc_set_data(ledc->data[i]);
|
||
|
|
||
|
ledc_enable();
|
||
|
} else {
|
||
|
ledc_info("trans data by DMA mode\n");
|
||
|
mask &= ~LEDC_FIFO_CPUREQ_INT_EN;
|
||
|
|
||
|
ledc_reset_en();
|
||
|
size = ledc->length * 4;
|
||
|
|
||
|
hal_dcache_clean((unsigned long)ledc->data, sizeof(ledc->data));
|
||
|
|
||
|
slave_config.direction = DMA_MEM_TO_DEV;
|
||
|
slave_config.src_addr = (unsigned long)(ledc->data);
|
||
|
slave_config.dst_addr = (uint32_t)(base_addr + LEDC_DATA_REG);
|
||
|
slave_config.src_addr_width = DMA_SLAVE_BUSWIDTH_4_BYTES;
|
||
|
slave_config.dst_addr_width = DMA_SLAVE_BUSWIDTH_4_BYTES;
|
||
|
slave_config.src_maxburst = DMA_SLAVE_BURST_16;
|
||
|
slave_config.dst_maxburst = DMA_SLAVE_BURST_16;
|
||
|
slave_config.slave_id = sunxi_slave_id(DRQDST_LEDC, DRQSRC_SDRAM);
|
||
|
hal_dma_slave_config(dma_chan, &slave_config);
|
||
|
|
||
|
hal_dma_prep_device(dma_chan, slave_config.dst_addr, slave_config.src_addr, size, DMA_MEM_TO_DEV);
|
||
|
|
||
|
//dma_chan->callback = ledc_dma_callback;
|
||
|
hal_dma_start(dma_chan);
|
||
|
|
||
|
hal_ledc_set_time(ledc);
|
||
|
ledc_set_output_mode(ledc->output_mode);
|
||
|
ledc_set_length(ledc->length);
|
||
|
ledc_set_dma_mode();
|
||
|
ledc_enable_irq(mask);
|
||
|
ledc_enable();
|
||
|
}
|
||
|
}
|
||
|
|
||
|
void hal_ledc_clear_all_irq(void)
|
||
|
{
|
||
|
ledc_clear_all_irq();
|
||
|
}
|
||
|
|
||
|
unsigned int hal_ledc_get_irq_status(void)
|
||
|
{
|
||
|
return ledc_get_irq_status();
|
||
|
}
|
||
|
|
||
|
void hal_ledc_reset(void)
|
||
|
{
|
||
|
ledc_disable_irq(LEDC_TRANS_FINISH_INT_EN | LEDC_WAITDATA_TIMEOUT_INT_EN
|
||
|
| LEDC_FIFO_OVERFLOW_INT_EN | LEDC_GLOBAL_INT_EN | LEDC_GLOBAL_INT_EN);
|
||
|
|
||
|
if (dma_chan)
|
||
|
{
|
||
|
hal_dma_stop(dma_chan);
|
||
|
}
|
||
|
ledc_soft_reset();
|
||
|
}
|
||
|
|
||
|
void hal_ledc_deinit(void)
|
||
|
{
|
||
|
hal_dma_chan_free(dma_chan);
|
||
|
hal_gpio_pinmux_set_function(GPIOE(2), 2);
|
||
|
//clk_deinit
|
||
|
}
|
||
|
|
||
|
void hal_ledc_init(void)
|
||
|
{
|
||
|
int i;
|
||
|
unsigned int reg_val = 0;
|
||
|
|
||
|
if (ledc_clk_init())
|
||
|
{
|
||
|
ledc_info("ledc clk init failed \n");
|
||
|
}
|
||
|
|
||
|
if (ledc_pinctrl_init())
|
||
|
{
|
||
|
ledc_info("ledc pinctrl init failed \n");
|
||
|
}
|
||
|
|
||
|
hal_dma_chan_request(&dma_chan);
|
||
|
}
|
||
|
|