added pose reset on negative time change, changed tf lookup time to match incoming sensor data