Planning for quasi-static manipulation tasks via an intrinsic haptic metric

Lin Yang,Sri Harsha Turlapati,Chen Lv,Domenico Campolo

2024-11-07

Abstract:Contact-rich manipulation often requires strategic interactions with objects, such as pushing to accomplish specific tasks. We propose a novel scenario where a robot inserts a book into a crowded shelf by pushing aside neighboring books to create space before slotting the new book into place. Classical planning algorithms fail in this context due to limited space and their tendency to avoid contact. Additionally, they do not handle indirectly manipulable objects or consider force interactions. Our key contributions are: i) re-framing quasi-static manipulation as a planning problem on an implicit manifold derived from equilibrium conditions; ii) utilizing an intrinsic haptic metric instead of ad-hoc cost functions; and iii) proposing an adaptive algorithm that simultaneously updates robot states, object positions, contact points, and haptic distances. We evaluate our method on such crowded bookshelf insertion task but it is a general formulation to rigid bodies manipulation tasks. We propose proxies to capture contact point and force, with superellipse to represent objects. This simplified model guarantee the differentiablity. Our framework autonomously discovers strategic wedging-in policies while our simplified contact model achieves behavior similar to real world scenarios. We also vary the stiffness and initial positions to analysis our framework comprehensively. The video can be found at <a class="link-external link-https" href="https://youtu.be/eab8umZ3AQ0" rel="external noopener nofollow">this https URL</a>.

Robotics

What problem does this paper attempt to address?

This paper attempts to solve the problem of the failure of traditional planning algorithms when performing contact - rich manipulation tasks in a narrow space. Specifically, the paper focuses on the problem of a robot inserting a book into a fully - stuffed bookshelf. In this process, the robot needs to make room by pushing adjacent books and then insert the new book. Traditional planning algorithms perform poorly in this situation because they tend to avoid contact and lack the ability to handle indirectly manipulable objects.

### Main contributions of the paper:
1. **Redefine quasi - static manipulation as a planning problem**: The author proposes a new scenario, that is, redefining quasi - static manipulation as a planning problem on an implicit manifold derived from equilibrium conditions.
2. **Use the intrinsic haptic metric instead of custom cost functions**: The intrinsic haptic metric is introduced instead of using traditional custom cost functions to evaluate the interactions during the manipulation process.
3. **Propose an adaptive algorithm**: An adaptive algorithm is developed that can simultaneously update the state of the robot, the position of the object, the contact points, and the haptic distance.

### Specific application scenarios:
- **The task of inserting a book into a crowded bookshelf**: The paper takes the example of inserting a book into a crowded bookshelf to verify the effectiveness of the proposed method. By simplifying the model to capture contact points and forces and representing the object with super - ellipses, the differentiability of the model is ensured. The experimental results show that this framework can autonomously discover effective insertion strategies, and the simplified contact model can be close to the real - life scenario in terms of behavior.

### Summary of mathematical formulas:
- **Intrinsic haptic metric**:
\[
S[u]=\int_{0}^{1}\sqrt{\dot{u}^{T}G_{m}(z^{*}(u), u)\dot{u}}\,dt
\]
where \(G_{m}\) is the control Hessian matrix:
\[
G_{m}(z^{*}(u), u):=\partial_{uu}W-\partial_{uz}W(\partial_{zz}W)^{-1}\partial_{zu}W
\]

- **Super - ellipse equation**:
\[
\left(\frac{x}{a_{1}}\right)^{2 /\epsilon}+\left(\frac{y}{a_{2}}\right)^{2 /\epsilon}=1
\]
The inner and outer function \(F(x, y)\) is defined as:
\[
F(x, y)=\left(\frac{x}{a_{1}}\right)^{2 /\epsilon}+\left(\frac{y}{a_{2}}\right)^{2 /\epsilon}-1
\]

### Conclusion:
By introducing the intrinsic haptic metric and the adaptive algorithm, this paper overcomes the limitations of traditional planning algorithms in contact - rich tasks, especially in manipulation tasks in a narrow space. The experimental results show that this method performs well in the task of inserting a book into a crowded bookshelf and can autonomously discover effective insertion strategies.