fixed transform lookup, changed calibration loop to time-based, stability is now checked for a set duration, calcTwistWithCov now overloaded for needed types