#include "SHAL.h"
#include "stm32f0xx.h"


volatile GPIO* blueLED = nullptr;
volatile GPIO* greenLED = nullptr;

extern "C" void EXTI0_1_IRQHandler(void) {
    if (EXTI->PR & (1 << 0)) {   //Check pending flag
        EXTI->PR |= (1 << 0);    //Clear it by writing 1
        greenLED->toggle();
    }
}

void tim2Handler(){
    blueLED->toggle();
}

int main() {
    RCC->AHBENR |= RCC_AHBENR_GPIOBEN;

    Timer timer2 = getTimer(Timer_Key::S_TIM2);

    blueLED = &initGPIO(GPIO_Key::A4, PinMode::OUTPUT_MODE);
    greenLED = &initGPIO(GPIO_Key::A5, PinMode::OUTPUT_MODE);

    timer2.setPrescaler(8000 - 1);
    timer2.setARR(1500 - 1);
    timer2.setCallbackFunc(tim2Handler);
    timer2.start();

    RCC->APB2ENR |= RCC_APB2ENR_SYSCFGCOMPEN; //Enable SYSCFG clock (needed for EXTI)

    SYSCFG->EXTICR[0] &= ~SYSCFG_EXTICR1_EXTI0; //Clear EXTI0 mapping
    SYSCFG->EXTICR[0] |= SYSCFG_EXTICR1_EXTI0_PB; //Map PA0 -> EXTI0

    EXTI->IMR |= (1 << 0);   //Unmask EXTI0
    EXTI->RTSR |= (1 << 0);  //Trigger on rising edge

    NVIC_EnableIRQ(EXTI0_1_IRQn); //EXTI lines 0 and 1 share an IRQ vector

    __enable_irq();

    while (true) {
    	__WFI();
    }
}