Small comment clarification
Made timing calculation more general and introduced integral calculation for pose
Fixed a bug that would prevent CTRL+C'ing out of the program when no dongle is connected