“…where Φ is the pitch angle state of gyro, gyro is the pitch angle measured by gyro, g e is the drift error by gyro, g is the measurement noise of gyro, acce is the pitch angle by accelerometer (Sun et al, 2014), T x is the sampling time period to discretize Kalman filter from continuous space, for T x where x is in ( gyro , g , g e ) , and K is the Kalman gain (Docs.ros.org., 2021); for IMU sensors, we used gazebo IMU noise model in ROS and set sensor update frequency to 1000 Hz, and thus, we set T x = 1ms . Further, we set noise parameter for angular rates (gyro) and linear acceleration ( 8)…”