#include <stdint.h>
#include <msp430.h>

#define interrupt(x) void __attribute__((interrupt (x)))

#define delay_us(n) __delay_cycles((n) * 16)

void delay_ms(uint16_t ms) {
    while (ms--)
        __delay_cycles(16000);
}

void wait_for_button() {
    while (!(P1IN & 0x08)) ;
    delay_ms(20);
    while (P1IN & 0x08) ;
    delay_ms(20);
}

uint8_t debug[8];

int main() {
    WDTCTL = WDTPW | WDTHOLD;

    BCSCTL1 = CALBC1_16MHZ;
    DCOCTL = CALDCO_16MHZ;

    // Led
    P1DIR |= 0x01;
    
    P2SEL = 0x00;
    P2SEL2 = 0x00;
    P2OUT = 0x00;
    P2DIR = 0x03;

    delay_ms(500);

    while (1) {
        P2OUT = 0x00;
        delay_us(4);
        P2OUT = 0x01;
        delay_us(8);

        delay_us(25);
        P2OUT = 0x03;
        delay_us(2);
        P2OUT = 0x01;
        delay_us(25);

        P2OUT = 0x00;
        delay_us(2);
    }

    return 0;
}