13 January 2021 in IEEE Transactions on Robotics
This article presents a novel representation-free model predictive control (RF-MPC) framework for controlling various dynamic motions of a quadrupedal robot in three-dimensional (3-D) space. Our formulation directly represents the rotational dynamics using the rotation matrix, which liberates us from the issues associated with the use of Euler angles and quaternion as the orientation representations. With a variation-based linearization scheme and a carefully constructed cost function, the MPC control law is transcribed to the standard quadratic program form. The MPC controller can operate at real-time rates of 250 Hz on a quadruped robot. Experimental results including periodic quadrupedal gaits and a controlled backflip validate that our control strategy could stabilize dynamic motions that involve singularity in 3-D maneuvers.
21 December 2022 in Science Robotics
A climbing robot that can rapidly move on diverse surfaces such as floors, walls, and ceilings will have an enlarged operational workspace compared with other terrestrial robots. However, the climbing skill of robots in such environments has been limited to low speeds or simple locomotion tasks. Here, we present an untethered quadrupedal climbing robot called MARVEL (magnetically adhesive robot for versatile and expeditious locomotion), capable of agile and versatile climbing locomotion in ferromagnetic environments. MARVEL excels over prior climbing robots in terms of climbing speed and ability to execute various motions. It demonstrates the fastest vertical and inverted walking speed, whereas its versatile locomotion ability enables the highest number of gaits and locomotion tasks. The key innovations are an integrated foot design using electropermanent magnets and magnetorheological elastomers that provide large adhesion and traction forces, torque control actuators, and a model predictive control framework adapted for stable climbing. In experiments, the robot achieved locomotion on ceilings and vertical walls up to 0.5 meter (1.51 body lengths) per second and 0.7 meter (2.12 body lengths) per second, respectively. Furthermore, the robot exhibited complex behaviors such as stepping over 10-centimeter-wide gaps; overcoming 5-centimeter-high obstacles; and making transitions between floors, walls, and ceilings. We also show that MARVEL could climb on a curved surface of a storage tank covered with up to 0.3-millimeter-thick paint with rust and dust.
3 July 2019 in IEEE Robotics and Automation Letters
In this paper we present iSWIFT, a real-time Quadratic Program (QP) solver. Motivated by the need for a robust embedded QP solver in robotic applications, iSWIFT employs standard Primal-Dual Interior-Point Method (PD-IPM), along with Mehrotra predictor-corrector steps and Nesterov- Todd scaling. The sparse structure of the resulting KKT linear system in the QP formulation is exploited, and sparse direct methods are utilized to solve the linear system of equations. To further accelerate the factorization process, we only modify the corresponding rows of the matrix factors that change during iterations and cache the nonzero Cholesky pattern. iSWIFT is library free, written in ANSI-C and its performance is benchmarked through standard problems that could be cast as QP. Numerical results show that iSWIFT outperforms state-of-the-art solvers for small scale problems. To evaluate the performance of the solver, a real-time implementation of the solver in the MPC framework through experiments on a quadrupedal robot are presented.
30 June 2021 in IEEE Robotics and Automation Letters
This letter presents a state estimation algorithm for the legged robot by defining the problem as a Maximum A Posteriori (MAP) estimation problem and solving the problem with the Gauss-Newton algorithm. Moreover, marginalization by the Schur Complement method is adopted to make a fixed size problem. Each component of the cost function and its Jacobian are derived utilizing the SO(3) manifold structure, while we reparameterize the state with nominal state and variation to make linear algebra and vector calculus applied properly. Furthermore, a slip rejection method is proposed to reduce the erroneous effect of fault modeling of kinematics models. The proposed algorithm is verified by comparison with the Invariant Extended Kalman Filter (IEKF) in real robot experiments on various environments.
1 October 2024 in The International Journal of Robotics Research
This paper presents a contact-implicit model predictive control (MPC) framework for the real-time discovery of multi-contact motions, without predefined contact mode sequences or foothold positions. This approach utilizes the contact-implicit differential dynamic programming (DDP) framework, merging the hard contact model with a linear complementarity constraint. We propose the analytical gradient of the contact impulse based on relaxed complementarity constraints to further the exploration of a variety of contact modes. By leveraging a hard contact model-based simulation and computation of search direction through a smooth gradient, our methodology identifies dynamically feasible state trajectories, control inputs, and contact forces while simultaneously unveiling new contact mode sequences. However, the broadened scope of contact modes does not always ensure real-world applicability. Recognizing this, we implemented differentiable cost terms to guide foot trajectories and make gait patterns. Furthermore, to address the challenge of unstable initial roll-outs in an MPC setting, we employ the multiple shooting variant of DDP. The efficacy of the proposed framework is validated through simulations and real-world demonstrations using a 45 kg HOUND quadruped robot, performing various tasks in simulation and showcasing actual experiments involving a forward trot and a front-leg rearing motion.
14 February 2022 in IEEE Robotics and Automation Letters
Wepropose a novel state estimator for legged robots, STEP, achieved through a novel preintegrated foot velocity factor. In the preintegrated foot velocity factor, the usual non-slip assumption is not adopted. Instead, the end effector velocity becomes observable by exploiting the body speed obtained from a stereo camera. In other words, the preintegrated end effector’s pose can be estimated. Another advantage of our approach is that it eliminates the necessity for a contact detection step, unlike the typical approaches. The proposed method has also been validated in harsh-environment simulations and real-world experiments containing uneven or slippery terrains.