Fix un-timestampping measurements before sending to vehicle.

Fixed #77.
If any vehicle interfaces return -1 on read, disconnect.