Search papers, labs, and topics across Lattice.
This paper addresses the problem of determining sensor query schedules and sensor noise covariances required to achieve a specific trajectory estimation accuracy for mobile robots. They formulate the problem of estimating these sensor parameters as semidefinite programs (SDPs) that can be solved using off-the-shelf solvers, allowing for the determination of either the required sensor measurement rate for a given covariance or the required covariance for a given rate. The method is validated through simulations and real-world experiments, demonstrating its ability to achieve the desired trajectory estimation accuracy and identify scenarios where the target accuracy is unachievable.
Need to hit a specific trajectory estimation accuracy with your robot? This work reverse-engineers the sensor requirements, telling you the necessary sensor update rate or noise covariance.
Trajectory estimation involves determining the trajectory of a mobile robot by combining prior knowledge about its dynamic model with noisy observations of its state obtained using sensors. The accuracy of such a procedure is dictated by the system model fidelity and the sensor parameters, such as the accuracy of the sensor (as represented by its noise covariance) and the rate at which it can generate observations, referred to as the sensor query schedule. Intuitively, high-rate measurements from accurate sensors lead to accurate trajectory estimation. However, cost and resource constraints limit the sensor accuracy and its measurement rate. Our work's novel contribution is the estimation of sensor schedules and sensor covariances necessary to achieve a specific estimation accuracy. Concretely, we focus on estimating: (i) the rate or schedule with which a sensor of known covariance must generate measurements to achieve specific estimation accuracy, and alternatively, (ii) the sensor covariance necessary to achieve specific estimation accuracy for a given sensor update rate. We formulate the problem of estimating these sensor parameters as semidefinite programs, which can be solved by off-the-shelf solvers. We validate our approach in simulation and real experiments by showing that the sensor schedules and the sensor covariances calculated using our proposed method achieve the desired trajectory estimation accuracy. Our method also identifies scenarios where certain estimation accuracy is unachievable with the given system and sensor characteristics.
