Abstract
We believe that the future of robot motion planning will look very different than how it looks today: instead of complex collision avoidance trajectories with a brittle dependence on sensing and estimation of the environment, motion plans should consist of smooth, simple trajectories and be executed by robots that are not afraid of making contact. Here we present a "contact-aware" controller which continues to execute a given trajectory despite unexpected collisions while keeping the contact force stable and small. We introduce a quadratic programming (QP) formulation, which minimizes a trajectory-tracking error subject to quasistatic dynamics and contact-force constraints. Compared with the classical null-space projection technique, the inequality constraint on contact forces in the proposed QP controller allows for more gentle release when the robot comes out of contact. In the quasistatic dynamics model, control actions consist only of commanded joint positions, allowing the QP controller to run on stiffness-controlled robots which do not have a straightforward torque-control interface nor accurate dynamic models. The effectiveness of the proposed QP controller is demonstrated on a KUKA iiwa arm.
Introduction
In traditional robotics, contact is often treated as a failure state. Engineers spend massive amounts of computational effort on "collision-free planning"—using complex algorithms to ensure a robot never touches anything it didn't intend to. However, this approach is brittle. It relies on perfect environment models and high-fidelity sensors. If a depth camera misses a transparent glass tray or a thin wire, the robot will likely collide with it, potentially generating large, damaging forces because the controller is blindly trying to reach its next waypoint.
This research argues that instead of being "afraid" of contact, robots should be equipped to handle it gracefully, allowing for simpler plans that can survive the uncertainties of the real world.
Methods: Contact-Aware Control via Quasistatic QP
The proposed solution is a QP-based controller that utilizes a quasistatic dynamics model. Unlike standard second-order dynamics, a quasistatic model predicts the steady-state equilibrium of a robot, which is particularly useful for "stiffness-controlled" robots like the KUKA iiwa.
The controller solves an optimization problem at every time step, minimizing the error between the robot's current position and a reference trajectory subject to several key constraints:
- Force Constraints: Ensuring contact forces stay below a safe, user-defined limit (e.g., 15N).
- Quasistatic Constraints: Ensuring the commanded positions are physically consistent with the robot's stiffness and the environment's geometry.
A key advantage of this QP approach over classical "null-space projection" methods is the use of inequality constraints. While null-space methods often require an abrupt, manual "switch" to break contact, the QP formulation allows the robot to naturally and gently slide away from an obstacle as the reference trajectory moves. Additionally, to mitigate friction without complex real-time estimation, a "damping" term is added to the objective function to penalize large changes in commanded positions when model predictions diverge from reality.
Experimental Evaluation
The proposed controller was evaluated on a KUKA iiwa arm through physical experiments:
- Mug Placement Task: The robot must place a mug on a cart while its wrist unexpectedly collides with a table edge. The contact-aware controller successfully kept contact forces near the 15N limit, whereas baseline controllers produced much higher spikes.
- Mug Moving Task: The robot moves a mug along a straight line, requiring it to slide along a table surface and then break contact. The QP controller avoided the joint velocity spikes seen in null-space projection methods, with contact force dropping to zero gradually.
Discussion and Future Work
By treating contact forces as inequality constraints, the robot can "feel" its way around obstacles. However, limitations remain. The current system estimates contact using proprioception, which is difficult for multiple simultaneous contacts. Future improvements could involve integrating tactile "skins." Furthermore, the quasistatic assumption applies primarily to slower manipulation tasks; high-speed dynamic movements would require accounting for inertial effects. Finally, real-time contact geometry estimation remains a challenge for building accurate Jacobian matrices.
Summary updated