Whole-body Control (WBC) has emerged as an important framework in locomotion control for legged robots. However, most of WBC frameworks fail to generalize beyond rigid terrains. Legged locomotion over soft terrain is difficult due to the presence of unmodeled contact dynamics that WBCs do not account for. This introduces uncertainty in locomotion and affects the stability and performance of the system. In this paper, we propose a novel soft terrain adaptation algorithm called STANCE: Soft Terrain Adaptation and Compliance Estimation. STANCE consists of a WBC that exploits the knowledge of the terrain to generate an optimal solution that is contact consistent and an online terrain compliance estimator that provides the WBC with terrain knowledge. We validated STANCE both in simulation and experiment on the Hydraulically actuated Quadruped (HyQ) robot, and we compared it against the state of the art WBC. We demonstrated the capabilities of STANCE with multiple terrains of different compliances, aggressive maneuvers, different forward velocities, and external disturbances. STANCE allowed HyQ to adapt online to terrains with different compliances (rigid and soft) without pre-tuning. HyQ was able to successfully deal with the transition between different terrains and showed the ability to differentiate between compliances under each foot.
For contact compliance estimation, we need to accurately model the contact dynamics and estimate the contact parameters online. In contact modeling, Alves al @cite_13 presented a detailed overview of the types of parametric soft contact models used in the literature. In compliance estimation, Schindeler al @cite_3 used a two stage polynomial identification approach to estimate the parameters of the hc contact model online. Differently, Azad al @cite_11 used a ls -based estimation algorithm and compared multiple contact models (including the kv and the hc models). Other approaches that are not based on soft contact models, use force observers @cite_31 or neural networks @cite_9 . These aforementioned approaches in compliance estimation were designed for robotic manipulation tasks.
@cite_9 @cite_3 @cite_31 @cite_13 @cite_11
2535684174 2793379827 2209762605 2477962321
This paper proposes a method to realize desired contact normal forces between humanoids and their compliant environment. By using contact models, desired contact forces are converted to desired deformations of compliant surfaces. To achieve desired forces, deformations are controlled by controlling the contact point positions. Parameters of contact models are assumed to be known or estimated using the approach described in this paper. The proposed methods for estimating the contact parameters and controlling the contact normal force are implemented on a LWR KUKA IV arm. To verify both methods, experiments are performed with the KUKA arm while its end-effector is in contact with two different soft objects. Online environment dynamic estimates are often used for the control of robots, telerobots, and haptic systems. The nonlinear Hunt–Crossley (HC) model, which is physically consistent with the behavior of soft objects with limited deformation at a single point of contact, is being increasingly used in robotic control systems. The HC model can be identified online using a single-stage log linearization technique; however, the accuracy and applicability of the existing method is limited. We propose a two-stage polynomial identification method, which uses a quadratic approximation in the first stage to generate a linearly parameterized model of the HC dynamics (Quad-Poly). The coefficients of the Quad-Poly model are then used in the second stage to extract the HC parameters using a lookup table and recursive least squares parameter estimation. The proposed method is experimentally assessed against a previous natural logarithm linearization method, and further tested for time-varying environment dynamics and human-generated trajectories and for robustness against uncertainties in the measured data and system parameters. Successful model based control relies heavily on proper system identification and accurate state estimation. We present a framework for solving these problems in the context of robotic control applications. We are particularly interested in robotic manipulation tasks, which are especially hard due to the non-linear nature of contact phenomena. We developed a solution that solves both the problems of estimation and system identification jointly. We show that these two problems are difficult to solve separately in the presence of discontinuous phenomena such as contacts. The problem is posed as a joint optimization across both trajectory and model parameters and solved via Newton's method. We present several challenges we encountered while modeling contacts and performing state estimation and propose solutions within the MuJoCo physics engine. We present experimental results performed on our manipulation system consisting of 3-DOF Phantom Haptic Devices, turned into finger manipulators. Cross-validation between different datasets, as well as leave-one-out cross-validation show that our method is robust and is able to accurately explain sensory data. We present a multi-contact walking pattern generator based on preview-control of the 3D acceleration of the center of mass (COM). A key point in the design of our algorithm is the calculation of contact-stability constraints. Thanks to a mathematical observation on the algebraic nature of the frictional wrench cone, we show that the 3D volume of feasible COM accelerations is always an upward-pointing cone. We reduce its computation to a convex hull of (dual) 2D points, for which optimal C(nlog n) algorithms are readily available. This reformulation brings a significant speedup compared to previous methods, which allows us to compute time-varying contact-stability criteria fast enough for the control loop. Next, we propose a conservative trajectory-wide contact-stability criterion, which can be derived from COM-acceleration volumes at marginal cost and directly applied in a model-predictive controller. We finally implement this pipeline and exemplify it with the HRP-4 humanoid model in multi-contact dynamically walking scenarios.