added yaw dead reckoning and position dead reckoning code