#include <tos_compiler.h>
#include <tos_ktypes.h>

#define ECLIC_ADDR_BASE         0xD2000000
#define CLIC_INT_TMR            0x07

#define ECLIC_CFG_OFFSET        0x00
#define ECLIC_INFO_OFFSET       0x04
#define ECLIC_MTH_OFFSET        0x0B


#define ECLIC_INT_IP_OFFSET     0x1000
#define ECLIC_INT_IE_OFFSET     0x1001
#define ECLIC_INT_ATTR_OFFSET   0x1002
#define ECLIC_INT_CTRL_OFFSET   0x1003


#define ECLIC_CFG_NLBITS_MASK   0x1E
#define ECLIC_CFG_NLBITS_LSB    1


static uint8_t eclic_get_clic_int_ctl_bits() {
    uint32_t bits = *(volatile uint32_t*)(ECLIC_ADDR_BASE+ECLIC_INFO_OFFSET);
    bits >>= 21;
    return (uint8_t) bits;
}


static uint8_t eclic_get_nlbits() {
    uint8_t nlbits = *(volatile uint8_t*)(ECLIC_ADDR_BASE+ECLIC_CFG_OFFSET);
    nlbits = (nlbits & ECLIC_CFG_NLBITS_MASK) >> ECLIC_CFG_NLBITS_LSB;

    uint8_t cicbits = eclic_get_clic_int_ctl_bits();
    if(nlbits > cicbits) {
        nlbits = cicbits;
    }

    return nlbits;
}

static uint8_t eclic_get_intctrl(uint32_t source) {
    return *(volatile uint8_t*)(ECLIC_ADDR_BASE+ECLIC_INT_CTRL_OFFSET+source*4);
}

static void    eclic_set_intctrl(uint32_t source, uint8_t v) {
    *(volatile uint8_t*)(ECLIC_ADDR_BASE+ECLIC_INT_CTRL_OFFSET+source*4) = v;
}


static void eclic_enable_interrupt(uint32_t source) {
    *(volatile uint8_t*)(ECLIC_ADDR_BASE+ECLIC_INT_IE_OFFSET+source*4) = 1;
}

static void eclic_set_irq_level(uint32_t source, uint8_t level) {
    uint8_t nlbits = eclic_get_nlbits();

    if (nlbits == 0) {
        return ;
    }

    uint8_t intctrl_val = eclic_get_intctrl(CLIC_INT_TMR);

    intctrl_val <<= nlbits;
    intctrl_val >>= nlbits;
    intctrl_val  |= (level << (8- nlbits));

    eclic_set_intctrl(CLIC_INT_TMR, intctrl_val);
}

static void eclic_set_irq_priority(uint32_t source, uint8_t priority) {
    uint8_t nlbits = eclic_get_nlbits();
    uint8_t cicbits= eclic_get_clic_int_ctl_bits();

    if (nlbits >= cicbits) {
        return ;
    }


    uint8_t pad   = ~0;
    pad         <<= cicbits;
    pad         >>= cicbits;


    uint8_t intctrl_val = eclic_get_intctrl(CLIC_INT_TMR);

    intctrl_val >>= (8 - nlbits);
    intctrl_val <<= (8 - nlbits);
    intctrl_val  |= (priority << (8 - cicbits));
    intctrl_val  |= pad;

    eclic_set_intctrl(CLIC_INT_TMR, intctrl_val);
}

__PORT__ void port_cpu_init() {

    eclic_enable_interrupt(CLIC_INT_TMR);

    eclic_set_irq_level(CLIC_INT_TMR, 0);

}

__PORT__ void port_systick_priority_set(uint32_t priority) {
    eclic_set_irq_priority(CLIC_INT_TMR, priority);
}