#include "mbed.h"

Serial pc(USBTX, USBRX);

InterruptIn fsk_in(p21);
DigitalOut myled(LED1);
Timer tim;

void key_up(){
    myled = 1;
    tim.stop();
    int t = tim.read_us();
    tim.reset();
    tim.start();
    pc.printf( "%d\r\n", t );
}

void key_down(){
    myled = 0;
    tim.stop();
    int t = tim.read_us();
    tim.reset();
    tim.start();
    pc.printf( "%d\r\n", t );
}
        
int main() {
    pc.baud(921600);
    tim.reset();
    //fsk_in.mode(PullUp);
    fsk_in.rise(&key_up);
    fsk_in.fall(&key_down);
    
    while(1) {
    }
}