Do two timers. Get an overflow int from TC0 Ch0, and capture on Ch0/1
Use the SerialUSB as console, to free a UART for other things