time measurement between Interupts fixed. Still a little buggy (MSB
sometimes 1 off)