#include <stddef.h>
#include <stdint.h>

#include "isr_vector.h"
#include "ch573/gpio.h"

_Static_assert(offsetof(typeof(isr_vector_t), nmi_cb) == 0x8, "Offset wrong");

_Static_assert(
    offsetof(typeof(isr_vector_t), systick_cb) == 0x30, "Offset wrong ");

_Static_assert(
    offsetof(typeof(isr_vector_t), tmr0_cb) == 0x40, "Offset wrong ");

_Static_assert(
    offsetof(typeof(isr_vector_t), tmr1_cb) == 0x60, "Offset wrong ");

_Static_assert(
    offsetof(typeof(isr_vector_t), pwmx_cb) == 0x7c, "Offset wrong ");

_Static_assert(
    offsetof(typeof(isr_vector_t), wdog_bat_cb) == 0x8c, "Offset wrong ");

void on_reset(void);

void __attribute__((weak, interrupt)) default_irq_handler(void)
{
  return;
}

#define WEAK_IRQ(irq) \
  void __attribute__((weak, alias("default_irq_handler"))) irq(void)

WEAK_IRQ(irq_on_nmi);
WEAK_IRQ(irq_on_exc);
WEAK_IRQ(irq_on_systick);
WEAK_IRQ(irq_on_swi);
WEAK_IRQ(irq_on_tmr0);
WEAK_IRQ(irq_on_gpio_a);
WEAK_IRQ(irq_on_gpio_b);
WEAK_IRQ(irq_on_spi0);
WEAK_IRQ(irq_on_blel);
WEAK_IRQ(irq_on_bleb);
WEAK_IRQ(irq_on_usb);
WEAK_IRQ(irq_on_tmr1);
WEAK_IRQ(irq_on_tmr2);
WEAK_IRQ(irq_on_uart0);
WEAK_IRQ(irq_on_uart1);
WEAK_IRQ(irq_on_rtc);
WEAK_IRQ(irq_on_adc);
WEAK_IRQ(irq_on_pwmx);
WEAK_IRQ(irq_on_tmr3);
WEAK_IRQ(irq_on_uart2);
WEAK_IRQ(irq_on_uart3);
WEAK_IRQ(irq_on_wdog_bat);

/** The ISR Vector structure. This is linked to starting at address 0. */
__attribute((__section__(".isr_vector"))) volatile isr_vector_t isr_vectors = {
    .reset_cb = on_reset,
    .nmi_cb = irq_on_nmi,
    .exc_cb = irq_on_exc,
    .systick_cb = irq_on_systick,
    .swi_cb = irq_on_swi,
    .tmr0_cb = irq_on_tmr0,
    .gpio_a_cb = irq_on_gpio_a,
    .gpio_b_cb = irq_on_gpio_b,
    .spi0_cb = irq_on_spi0,
    .blel_cb = irq_on_blel,
    .bleb_cb = irq_on_bleb,
    .usb_cb = irq_on_usb,
    .tmr1_cb = irq_on_tmr1,
    .tmr2_cb = irq_on_tmr2,
    .uart0_cb = irq_on_uart0,
    .uart1_cb = irq_on_uart1,
    .rtc_cb = irq_on_rtc,
    .adc_cb = irq_on_adc,
    .pwmx_cb = irq_on_pwmx,
    .tmr3_cb = irq_on_tmr3,
    .uart2_cb = irq_on_uart2,
    .uart3_cb = irq_on_uart3,
    .wdog_bat_cb = irq_on_wdog_bat,
};

// Memory-mapped address of the data values in flash.
extern uint32_t* DATA_VALUES_IN_FLASH;

// Where the data is located in sram.
extern uint32_t* DATA_SEGMENT_START;
extern uint32_t* DATA_SEGMENT_STOP;

// Where 0-initialized data is in sram.
extern uint32_t* BSS_START;
extern uint32_t* BSS_STOP;

/*
 * Initialize the data segment and the bss segment.
 *
 * This function loads data in the .data section from flash and puts it in
 * memory where it can be edited and initialized the BSS data to 0.
 */
void init_data_segments(void)
{
  uint32_t* src = DATA_VALUES_IN_FLASH;
  uint32_t* dest = DATA_SEGMENT_START;

  while (dest != DATA_SEGMENT_STOP) {
    *(dest++) = *(src++);
  }

  dest = BSS_START;
  while (dest != BSS_STOP) {
    *(dest++) = 0;
  }
}

/*
 *  External reference to the main() function.
 */
extern void main(void);

#define GPIO_PORT_A ch573_gpio__gpio_port_a
#define GPIO_PORT CH573_GPIO__GPIO_PORT_T_INTF
/* Start function. Responsible for initializing the system and jumping to the
 * main function. */
// static void start(void)
// {
//   // init_data_segments();
//   GPIO_PORT.dir.set(GPIO_PORT_A, DIR_OUT, 8);
//   GPIO_PORT.pd_drv.set(GPIO_PORT_A, PD_DRV_OPEN_DRAIN, 8);
//   GPIO_PORT.out.set(GPIO_PORT_A, OFF, 8);
// 
//   main();
// }

/*
 * The reset callback.This has to be a naked function because the stack pointer
 * may not be initialized!!.
 */

/*
 * The reset callback.This has to be a naked function because the stack pointer
 * may not be initialized!!.
 */