No Arabic abstract
We present an algorithm to characterize the space of identifiable inertial parameters in system identification of an articulated robot. The algorithm can be applied to general open-chain kinematic trees ranging from industrial manipulators to legged robots. It is the first solution for this case that is provably correct and does not rely on symbolic techniques. The high-level operation of the algorithm is based on a key observation: Undetectable changes in inertial parameters can be interpreted as sequences of inertial transfers across the joints. Drawing on the exponential parameterization of rigid-body kinematics, undetectable inertial transfers are analyzed in terms of linear observability. This analysis can be applied recursively, and lends an overall complexity of $O(N)$ to characterize parameter identifiability for a system of N bodies. Matlab source code for the new algorithm is provided.
State estimation for robots navigating in GPS-denied and perceptually-degraded environments, such as underground tunnels, mines and planetary subsurface voids, remains challenging in robotics. Towards this goal, we present LION (Lidar-Inertial Observability-Aware Navigator), which is part of the state estimation framework developed by the team CoSTAR for the DARPA Subterranean Challenge, where the team achieved second and first places in the Tunnel and Urban circuits in August 2019 and February 2020, respectively. LION provides high-rate odometry estimates by fusing high-frequency inertial data from an IMU and low-rate relative pose estimates from a lidar via a fixed-lag sliding window smoother. LION does not require knowledge of relative positioning between lidar and IMU, as the extrinsic calibration is estimated online. In addition, LION is able to self-assess its performance using an observability metric that evaluates whether the pose estimate is geometrically ill-constrained. Odometry and confidence estimates are used by HeRO, a supervisory algorithm that provides robust estimates by switching between different odometry sources. In this paper we benchmark the performance of LION in perceptually-degraded subterranean environments, demonstrating its high technology readiness level for deployment in the field.
We formulate for the first time visual-inertial initialization as an optimal estimation problem, in the sense of maximum-a-posteriori (MAP) estimation. This allows us to properly take into account IMU measurement uncertainty, which was neglected in previous methods that either solved sets of algebraic equations, or minimized ad-hoc cost functions using least squares. Our exhaustive initialization tests on EuRoC dataset show that our proposal largely outperforms the best methods in the literature, being able to initialize in less than 4 seconds in almost any point of the trajectory, with a scale error of 5.3% on average. This initialization has been integrated into ORB-SLAM Visual-Inertial boosting its robustness and efficiency while maintaining its excellent accuracy.
Designing an exoskeleton to reduce the risk of low-back injury during lifting is challenging. Computational models of the human-robot system coupled with predictive movement simulations can help to simplify this design process. Here, we present a study that models the interaction between a human model actuated by muscles and a lower-back exoskeleton. We provide a computational framework for identifying the spring parameters of the exoskeleton using an optimal control approach and forward-dynamics simulations. This is applied to generate dynamically consistent bending and lifting movements in the sagittal plane. Our computations are able to predict motions and forces of the human and exoskeleton that are within the torque limits of a subject. The identified exoskeleton could also yield a considerable reduction of the peak lower-back torques as well as the cumulative lower-back load during the movements. This work is relevant to the research communities working on human-robot interaction, and can be used as a basis for a better human-centered design process.
Visual Localization is an essential component in autonomous navigation. Existing approaches are either based on the visual structure from SLAM/SfM or the geometric structure from dense mapping. To take the advantages of both, in this work, we present a complete visual inertial localization system based on a hybrid map representation to reduce the computational cost and increase the positioning accuracy. Specially, we propose two modules for data association and batch optimization, respectively. To this end, we develop an efficient data association module to associate map components with local features, which takes only $2$ms to generate temporal landmarks. For batch optimization, instead of using visual factors, we develop a module to estimate a pose prior from the instant localization results to constrain poses. The experimental results on the EuRoC MAV dataset demonstrate a competitive performance compared to the state of the arts. Specially, our system achieves an average position error in 1.7 cm with 100% recall. The timings show that the proposed modules reduce the computational cost by 20-30%. We will make our implementation open source at http://github.com/hyhuang1995/gmmloc.
This paper proposes to use a newly-derived transformed inertial navigation system (INS) mechanization to fuse INS with other complementary navigation systems. Through formulating the attitude, velocity and position as one group state of group of double direct spatial isometries SE2(3), the transformed INS mechanization has proven to be group affine, which means that the corresponding vector error state model will be trajectory-independent. In order to make use of the transformed INS mechanization in inertial based integration, both the right and left vector error state models are derived. The INS/GPS and INS/Odometer integration are investigated as two representatives of inertial based integration. Some application aspects of the derived error state models in the two applications are presented, which include how to select the error state model, initialization of the SE2(3) based error state covariance and feedback correction corresponding to the error state definitions. Extensive Monte Carlo simulations and land vehicle experiments are conducted to evaluate the performance of the derived error state models. It is shown that the most striking superiority of using the derived error state models is their ability to handle the large initial attitude misalignments, which is just the result of log-linearity property of the derived error state models. Therefore, the derived error state models can be used in the so-called attitude alignment for the two applications. Moreover, the derived right error state-space model is also very preferred for long-endurance INS/Odometer integration due to the filtering consistency caused by its less dependence on the global state estimate.