hector_imu_tools: Prevent race conditions in slam, formatting