Skip to main content

Decidability of Robot Manipulation Planning: Three Disks in the Plane

  • Chapter
  • First Online:
Algorithmic Foundations of Robotics XI

Part of the book series: Springer Tracts in Advanced Robotics ((STAR,volume 107))

Abstract

This paper considers the problem of planning collision-free motion of three disks in the plane. One of the three disks, the robot, can autonomously translate in the plane, the other two move only when in contact with the robot. This represents the abstract formulation of a manipulation planning problem. Despite the simplicity of the formulation, the decidability of the problem had remained unproven so far. We prove that the problem is decidable, i.e., there exists an exact algorithm that decides whether a solution exists in finite time.

B. Mishra—This work is supported by the EU FP7 ICT-287513 SAPHARI project.

This is a preview of subscription content, log in via an institution to check access.

Access this chapter

Chapter
USD 29.95
Price excludes VAT (USA)
  • Available as PDF
  • Read on any device
  • Instant download
  • Own it forever
eBook
USD 129.00
Price excludes VAT (USA)
  • Available as EPUB and PDF
  • Read on any device
  • Instant download
  • Own it forever
Hardcover Book
USD 169.99
Price excludes VAT (USA)
  • Durable hardcover edition
  • Dispatched in 3 to 5 business days
  • Free shipping worldwide - see info

Tax calculation will be finalised at checkout

Purchases are for personal use only

Institutional subscriptions

Notes

  1. 1.

    In [9] the authors propose a generalization to the case where the object may be further subjected to some placement constraints. The nodes of the manipulation graph are the various connected components of \(\textit{Grasp} \cap \textit{Placement}\) space and the adjacency relation is based on the existence of either transit paths or transfer paths.

  2. 2.

    It should be noted that this extension is not trivial and, to our knowledge, it has never been implemented.

  3. 3.

    This is a point in \(\mathcal{C}_{c_1}\).

References

  1. Wilfong, G.: Motion planning in the presence of movable obstacles. In: Proceedings of the Fourth Annual Symposium on Computational Geometry, SCG ’88, pp. 279–288. ACM, New York (1988)

    Google Scholar 

  2. Wilfong, G.: Motion planning in the presence of movable obstacles. Ann. Math. Artif. Intell. 3(1), 131–150 (1991)

    Article  MATH  MathSciNet  Google Scholar 

  3. Alami, R., Simeon, T., Laumond, J.-P.: A geometrical approach to planning manipulation tasks. The case of discrete placements and grasps. In: The Fifth International Symposium on Robotics Research, Tokyo, JPN (1989)

    Google Scholar 

  4. Latombe, J.-C.: Robot Motion Planning: Edition en anglais. The Springer International Series in Engineering and Computer Science. Springer (1991)

    Google Scholar 

  5. Dacre-Wright, B., Laumond, J., Alami, R.: Motion planning for a robot and a movable object amidst polygonal obstacles. In: 1992 IEEE International Conference on Robotics and Automation, pp. 2475–2480 (1992)

    Google Scholar 

  6. Berg, J., Stilman, M., Kuffner, J., Lin, M., Manocha, D.: Path planning among movable obstacles: a probabilistically complete approach. In: Chirikjian, G., Choset, H., Morales, M., Murphey, T. (eds.) Algorithmic Foundation of Robotics VIII. Springer Tracts in Advanced Robotics, vol. 57, pp. 599–614. Springer, Berlin (2010)

    Google Scholar 

  7. Karagoz, C., Bozma, H., Koditschek, D.: Feedback-based event-driven parts moving. IEEE Trans. Robot. 20, 1012–1018 (2004)

    Article  Google Scholar 

  8. Goodwine, B., Burdick, J.W.: Controllability of kinematic control systems on stratified configuration spaces. IEEE Trans. Autom. Control 46(3), 358–368 (2001)

    Article  MATH  MathSciNet  Google Scholar 

  9. Siméon, T., Laumond, J.-P., Corts, J., Sahbani, A.: Manipulation planning with probabilistic roadmaps. Int. J. Robot. Res. 23(7–8), 729–746 (2004)

    Article  Google Scholar 

  10. Schwartz, J.T., Sharir, M.: On the piano movers’ problem: III. Coordinating the motion of several independent bodies: the special case of circular bodies moving amidst polygonal barriers. Int. J. Robot. Res. 2(3), 46–75 (1983)

    Article  MathSciNet  Google Scholar 

  11. Schwartz, J.T.: On the “piano movers” problem: II. General techniques for computing topological properties of real algebraic manifolds. Adv. Appl. Math. 4(3), 298–351 (1983)

    Article  MATH  Google Scholar 

Download references

Author information

Authors and Affiliations

Authors

Corresponding author

Correspondence to Marilena Vendittelli .

Editor information

Editors and Affiliations

Appendix

Appendix

In this section we propose a constructive geometric proof of the reduction property for paths in configuration space constrained by contact between the robot and both objects. Preliminary to this proof is the conceptual illustration of the contact manifolds.

1.1 Single-Contact Manifold

Paths corresponding to motion in contact with only one object lie in a 5-dimensional manifold immersed in that foliates with the position of the obstacle that is not in contact. On each leaf the reduction property in [5] can be applied to transform any path in contact into a sequence of transfer and transit paths. In principle, there exist two identical spaces of this kind, one for each object, and they are transversal to each other. We call these spaces \(\mathcal{C}_{c_1}\) and \(\mathcal{C}_{c_2}\). Figure 5 provides a conceptual illustration of \(\mathcal{C}_{c_1}\) and the paths in \(\mathcal{C}_{c_1}\) and \(\mathcal{C}_{c_1} \cap \mathcal{C}_{c_2}\) represented in \(\mathcal{C}_{c_1}\).

Fig. 6
figure 6

Illustration of the “reduction property” to be proven: is the dashed green path equivalent to the sequence of dotted and blue (continous) path?

1.2 Double-Contact Manifold

Paths of the robot in contact with both objects belong to the 4-dimensional manifold \(\mathcal{C}_{c_1,c_2} = \mathcal{C}_{c_1} \cap \mathcal{C}_{c_2}\) at the intersection between \(\mathcal{C}_{c_1}\) and \(\mathcal{C}_{c_2}\). A path in contact with both objects is represented by the green dashed path in Fig. 6 as a path “across” the foliation of one of the single-contact manifolds.

We start with the following claim: Because of the foliations of \(\mathcal{C}_{c_1}\) and \(\mathcal{C}_{c_2}\), any path in this manifold should be equivalent to a sequence of transfer paths with two contacts and paths in either \(\mathcal{C}_{c_1}\) or \(\mathcal{C}_{c_2}\). Figure 6 shows an example of such a decomposition: the green dashed path in contact with both objects can be reduced to the sequence composed by the black dotted path and the blue continuous path. Along the black dotted path both objects are in contact and the contact points do not change along the path. The path terminates where one of the object has reached the desired position. The blue path is a single-contact path lying on a leaf of one of the single contact manifolds. We know that the reduction property applies to paths in contact lying on either of these two manifolds, therefore, we only need to show that the green dashed path is equivalent to the sequence of black and blue paths. Figure 7 illustrates the property through an example: given the initial and the final configurations, respectively \({{\varvec{q}}}_s\) and \({{\varvec{q}}}_g\), any path in the double-contact manifold is admissible. Figure 8 shows how to reduce it to a sequence of transfer and transit paths. A formal proof to this Generalized Reduction Property follows.

Fig. 7
figure 7

Any path in the double-contact manifold is admissible to go from \({{\varvec{q}}}_s\) to \({{\varvec{q}}}_g\) but not any path is a manipulation path

Fig. 8
figure 8

Can any path in the double-contact manifold be “reduced” to a sequence of transfer and transit paths as in the figure?

1.3 Generalized Reduction Property

Generalized Reduction Property: Any two configurations belonging to the same connected component of the double-contact manifold can be connected by a manipulation path.

Proof

It is a direct generalization of the reduction property proof in [5]. Let \({{\varvec{q}}}_a\) and \({{\varvec{q}}}_b\) be two configurations in the double-contact manifold connected by a collision-free path in \(\mathcal{C}_{c_1,c_2}\). Note that, since the robot is not allowed to move in contact with static obstacles, this path is actually contained in the subset \(\tilde{\mathcal{C}}_{c_1,c_2}\) of \(\mathcal{C}_{c_1,c_2}\) of all configurations such that the robot is not in contact with any static obstacle. This is an open set in \(\mathcal{C}_R\) but might not be in \(\mathcal C\).

Denoted the collision-free path as \({{\varvec{p}}}: [0,1] \rightarrow \tilde{\mathcal{C}}_{c_1,c_2}\), with \({{\varvec{p}}}(0)={{\varvec{q}}}_a\) and \({{\varvec{p}}}(1)={{\varvec{q}}}_b\), some preliminary definitions are in order:

  • \({{\varvec{p}}}_R\): projection of \({{\varvec{p}}}\) on \(\mathcal{C}_R\);

  • \({{\varvec{p}}}_{O_1}\): projection of \({{\varvec{p}}}\) on \(\mathcal{C}_{O_1}\);

  • \({{\varvec{p}}}_{O_2}\): projection of \({{\varvec{p}}}\) on \(\mathcal{C}_{O_2}\);

  • \({{\varvec{p}}}_{R - {O_1}}\): contact configuration relative to object \(O_1\) on \({{\varvec{p}}}\);

  • \({{\varvec{p}}}_{R - {O_2}}\): contact configuration relative to object \(O_2\) on \({{\varvec{p}}}\).

Assume that the objects can neither be in contact with obstacles nor in contact between themselves (quite unrealistic, to be removed later) and let \({{\varvec{q}}}={{\varvec{p}}}(s)\), \(s \in [0,1]\), be a configuration on the path. Due to the non-contact hypothesis, it is always possible to define an open ball \(B_{1}\) in the collision-free single-contact configuration space , centered on the contact configuration \({{\varvec{p}}}_{R - {O_1}}(s)\) Footnote 3 and without considering \(O_2\). Its projection \(D_{\epsilon _1}\) in \(\mathcal{C}_R\) is homeomorphic to a disk of radius \(\epsilon _1~>~0\). The object \(O_1\) will not collide with obstacles as long as it is in contact with \(R \in D_{\epsilon _1}\). In the same way there exists a ball \(B_{2}\) in the collision-free single-contact configuration space , centered on the contact configuration \({{\varvec{p}}}_{R - {O_2}}(s)\). Its projection \(D_{\epsilon _2}\) in \(\mathcal{C}_R\) is a disk of radius \(\epsilon _2~>~0\).

Denote by \(\epsilon =\min \{\epsilon _1, \epsilon _2\}\). Due to the continuity of \({{\varvec{p}}}\), there exists an \(\eta _R >0\) such that

$$ {\forall \tau \in ]s-\eta _R, s+\eta _R[, \, {{\varvec{p}}}_R(\tau ) \in D_{\epsilon /2}}, $$

an \(\eta _1 >0\) such that

$$ \scriptstyle {\forall \tau \in ]s-\eta _1, s+\eta _1[, ||({{\varvec{p}}}_R(\tau ) - {{\varvec{p}}}_{O_1}(\tau )) -({{\varvec{p}}}_R(s) - {{\varvec{p}}}_{O_1}(s))|| < \epsilon /4}, $$

and an \(\eta _2 >0\) such that

$$ \scriptstyle {\forall \tau \in ]s-\eta _2, s+\eta _2[, ||({{\varvec{p}}}_R(\tau ) - {{\varvec{p}}}_{O_2}(\tau )) -({{\varvec{p}}}_R(s) - {{\varvec{p}}}_{O_2}(s))|| < \epsilon /4}. $$

Denote by \(\eta _3=\min \{\eta _1, \eta _2 \}\), and conclude that

$$ \scriptstyle {\forall \tau \in ]s-\eta _3, s+\eta _3[, ||({{\varvec{p}}}_{O_2}(\tau ) - {{\varvec{p}}}_{O_1}(\tau )) -({{\varvec{p}}}_{O_2}(s)- {{\varvec{p}}}_{O_1}(s))|| < \epsilon /2}. $$

Consider now \(\eta =\min \{\eta _R ,\eta _3 \}\) and two configurations along the path: \({{\varvec{q}}}_1={{\varvec{p}}}(\tau _1)\) and \({{\varvec{q}}}_2={{\varvec{p}}}(\tau _2)\), with \(\tau _1 < \tau _2\) and both in the interval \(]s-\eta ,s+\eta [\).

The path \({{\varvec{p}}}(\tau )=({{\varvec{p}}}_R(\tau ), {{\varvec{p}}}_{O_1}(\tau ), {{\varvec{p}}}_{O_2}(\tau )), \tau \in [\tau _1, \tau _2]\) that transfers of \(O_1\) in double-contact can be written as

$$\begin{aligned} {{\varvec{p}}}_R(\tau )= & {} {{\varvec{p}}}_{O_1}(\tau )+( {{\varvec{p}}}_R(\tau _1)-{{\varvec{p}}}_{O_1}(\tau _1))\\ {{\varvec{p}}}_{O_1}(\tau )= & {} {{\varvec{p}}}_{O_1}(\tau )\\ {{\varvec{p}}}_{O_2}(\tau )= & {} {{\varvec{p}}}_{O_1}(\tau ) + ({{\varvec{p}}}_{O_2}(\tau _1)- {{\varvec{p}}}_{O_1}(\tau _1)), \end{aligned}$$

and the transfer path \({{\varvec{p}}}(\tau )=({{\varvec{p}}}_R(\tau ), {{\varvec{p}}}_{O_1}(\tau ), {{\varvec{p}}}_{O_2}(\tau )), \tau \in [\tau _1, \tau _2]\) of \(O_2\) in single-contact to its goal position

$$\begin{aligned} {{\varvec{p}}}_R(\tau )= & {} {{\varvec{p}}}_{O_1}(\tau _2)+( {{\varvec{p}}}_{O_2}(\tau )-{{\varvec{p}}}_{O_1}(\tau )) + ( {{\varvec{p}}}_R(\tau _1)-{{\varvec{p}}}_{O_2}(\tau _1))\\ {{\varvec{p}}}_{O_1}(\tau )= & {} {{\varvec{p}}}_{O_1}(\tau _2)\\ {{\varvec{p}}}_{O_2}(\tau )= & {} {{\varvec{p}}}_{O_1}(\tau _2) + ( {{\varvec{p}}}_{O_2}(\tau )-{{\varvec{p}}}_{O_1}(\tau )). \end{aligned}$$

Finally, transit path \({{\varvec{p}}}(\tau )=({{\varvec{p}}}_R(\tau ), {{\varvec{p}}}_{O_1}(\tau ), {{\varvec{p}}}_{O_2}(\tau )), \tau \in [\tau _1, \tau _2]\) of \(R\) to its goal:

$$\begin{aligned} {{\varvec{p}}}_R(\tau )= & {} {{\varvec{p}}}_{O_2}(\tau _2)+( {{\varvec{p}}}_R(\tau )-{{\varvec{p}}}_{O_2}(\tau ))\\ {{\varvec{p}}}_{O_1}(\tau )= & {} {{\varvec{p}}}_{O_1}(\tau _2)\\ {{\varvec{p}}}_{O_2}(\tau )= & {} {{\varvec{p}}}_{O_2}(\tau _2). \end{aligned}$$

As a result of the choice of \(\eta \) these paths should all be feasible, i.e., collision-free. A symmetric argument can be provided if \(O_2\) is transferred first to its goal position.\(\diamond \)

This proof could be completed by considering the case of objects-obstacles and object-objects contacts, but omitted due to lack of space. The critical point in this case is that double-contact motion could not be allowed because it would not be possible to define an open disk in either of the two one-contact manifolds. It is then necessary to prove that a motion in double contact can be reduced to a sequence of motions in single contact. To achieve this reduction it is sufficient to break both contacts and move back to one of the two single-contact manifolds where the reduction property holds. It is, in fact, possible to show that there always exists a set of “escape” directions allowing the robot to un-grasp both obstacles.

Rights and permissions

Reprints and permissions

Copyright information

© 2015 Springer International Publishing Switzerland

About this chapter

Cite this chapter

Vendittelli, M., Laumond, JP., Mishra, B. (2015). Decidability of Robot Manipulation Planning: Three Disks in the Plane. In: Akin, H., Amato, N., Isler, V., van der Stappen, A. (eds) Algorithmic Foundations of Robotics XI. Springer Tracts in Advanced Robotics, vol 107. Springer, Cham. https://doi.org/10.1007/978-3-319-16595-0_37

Download citation

  • DOI: https://doi.org/10.1007/978-3-319-16595-0_37

  • Published:

  • Publisher Name: Springer, Cham

  • Print ISBN: 978-3-319-16594-3

  • Online ISBN: 978-3-319-16595-0

  • eBook Packages: EngineeringEngineering (R0)

Publish with us

Policies and ethics