arXiv:1701.02246v1 [math.MG] 6 Jan 2017 MATHEMATICS IN CAGING OF ROBOTICS HIROYASU HAMADA, SATOSHI MAKITA, SHIGEKI MATSUTANI Abstract. It is a crucial problem in robotics field to cage an object using robots like multifingered hand. However the problem what is the caging for general geometrical objects and robots has not been well-described in mathematics though there were many rigorous studies on the methods how to cage an object by certain robots. In this article, we investigate the caging problem more mathematically and describe the problem in terms of recursion of the simple euclidean moves. Using the description, we show that the caging has the degree of difficulty which is closely related to a combinatorial problem and a wire puzzle. It implies that in order to capture an object by caging, from a practical viewpoint the difficulty plays an important role. keywords caging, euclidean move, wire puzzle, robotics AMS: 51M04, 57N15, 57N35, 70B15, 70E60, 1. Introduction In robotics fields, caging is a type of grasping where robots capture an object by sur- rounding or hooking it. Thus the caging problem based on the shape of the robots and the object is addressed on geometrical representation. Its mathematical description has been partially studied with focusing on methodology how to cage an object by certain robots. Though it is rigorous, it is not for arbitrary target objects and robots. In this article, we propose an essential of caging to describe arbitrary target objects and robots from a mathematical viewpoint, and then it naturally leads us to a degree of difficulty of escaping and caging. It is a novel concept of the caging which is connected with practical approaches. Caging or holding an object has been discussed in mathematics field such as [C, Z], and has been applied to robotic manipulation in parallel. Rimon and Blake raised a caging by two circular robots driven by one parameter in two dimensional planar space [RB], and formulated its conditions. Wang and Kumar proposed caging by multi-robot cooperation with mathematical abstract formulas [WK]. More than three dimensional caging problem is formulated by [PS], although only circular and spherical robots are referred. There studies discuss existence of object’s free movable space closed by the robots. Hence path connectivity of the free space for the captured object [RMF] is an important matter to in- vestigate whether the object is caged or able to escape. As mentioned above, confinement of caging formation is studied by previous works such as [RB, PS, RMF], particularly for problems of two dimensional caging. Additionally although path connectivity can 1 2 HIROYASU HAMADA, SATOSHI MAKITA, SHIGEKI MATSUTANI be examined by using probabilistic search algorithm [DS, MP], the difficulty of caging constraint is not quantitatively qualified. Therefore this paper aims to describe caging problem in robotics in the following view- point: to apply the formulation to arbitrary robots and objects; to reveal difficulty of caging constraint mathematically. From a mathematical viewpoint, we recall the fundamental fact that a compact con- nected n -dimensional topological manifold M in n -dimensional euclidean space E n could be wrapped by the ( n − 1)-dimensional sphere S n − 1 , which corresponds to holding in the real world. This fact is described well by the homotopy group π n − 1 . It is based on the mathematical fact that S n − 1 in E n divides E n into its inner side and outer side. The subspace M has the configuration space [ M ] by the euclidean moves ψ , i.e., [ M ] = { ψ ( M ) } . Let us fix the sphere S n − 1 and then it divides [ M ] to the part [ M ] in of the inner side of S n − 1 , that of the outer side, [ M ] out , and the intersection part [ M ] int , i.e., [ M ] = [ M ] in ∐ [ M ] out ∐ [ M ] int and [ M ] int := { M ′ ∈ [ M ] | M ′ ∩ S n − 1 6 = ∅} . If [ M ] in is not empty, it means that S n − 1 holds M ∈ [ M ] in . On the other hand, caging is to divide the configurations space [ M ] using an ( n − 2) dimensional topological manifold K . Then there arises a problem how K with 2- codimension can divide the configuration space [ M ] mathematically. This is a fundamental problem on caging. There are many mathematical studies on this problem to cage some proper geometrical objects using special K as mentioned above. Further Fruchard and Zamfirescu [F, Z] geometrically studied the geometrical conditions whether a circle holds a convex object [ M ]. Rodriguez, Mason and Ferry investigated geometrical and topological properties the multifinger cages rigorously [RMF]. However there was no investigation on the above fundamental problem for general M and K . Though the path connectivity of an object M in E n \ K studied well in [DS, MP, RMF] is an essential property of caging, it is not sufficient. For example if we regard a wire puzzle constituting two pieces as a pair of a robot K and a target object M , M is not caged by K because there is a path between M “in” of K and that of the outer side of K . However a wire puzzle should be considered as an example of caging and holding from a practical viewpoint. It is related to the probabilistic treatment of the path connectivity [DS, MP]. However the path space is very complicate in general [BT] and it is very difficult to assign a probabilistic measure in the path space. In order to introduce a degree of escaping mathematically, in this article, we describe the fundamental problem more mathematically, and then we show that caging is represented in terms of recursion of the simple euclidean moves, i.e., the piecewise euclidean move defined in Definitions 2.8 and [ ? ]. The move means that caging is classified countably and naturally leads us to the degree of difficulty of escaping of [ M ] from K . It is closely related to a combinatorial explosion and the wire puzzle. It means that there might be a difference between practical caging and complete caging. When we capture a complicate object by caging, we propose that the difficulty should be proactively considered from a MATHEMATICS IN CAGING OF ROBOTICS 3 practical viewpoint. Further if we treat the euclidean moves probabilistically, we could assign a natural measure on the moves. 2. Mathematical Preliminary Let us consider the n -dimensional real euclidean space E n and the n -dimensional eu- clidean group SE( n ) := R n ⋊ SO( n ). The element g of SE( n ) acts on each point x of E n by Φ g ( x ) ∈ E n such that for g, g ′ ∈ SE( n ), Φ g ′ g ( x ) = Φ g ′ Φ g ( x ) and for the identity element e ∈ SE( n ), Φ e ( x ) = id ( x ) = x [AM, G]. The action Φ g of g ∈ SE( n ) on E n has the matrix representation: for g , there are element u ∈ R n and A ∈ SO( n ) such that for x ∈ E n , Φ g ( x ) = ( 1 0 u A ) ( 1 x ) = ( 1 Ax + u ) . In this article, let us refer a ℓ -dimensional topological manifold in E n , ℓ -subspace . We say that the ℓ -subspaces M and M ′ of E n are congruent if there is an element g of SE( n ) such that Φ g ( M ) = M ′ . We denote it by M ≃ M ′ . Let [ M ] be the configuration space of M ; [ M ] := { Φ g ( M ) | g ∈ SE( n ) } . The quotient space of the set of the n -subspaces divided by SE( n ) is denoted by M , which classifies the shape of subspace in E n . We call M moduli of the shapes ; [ M ] ∈ M . We consider a continuous map ψ : [0 , 1] → SE( n ), i.e., ψ ∈ C 0 ([0 , 1] , SE( n )) with a fixing point ψ (0) = id , where C 0 ( N, F ) means the set of F -valued continuous functions over N . For given ψ ∈ C 0 ([0 , 1] , SE( n )), the action Φ ψ on E n parameterized by t ∈ [0 , 1] is called orbit by ψ . Lemma 2.1. For an n -subspace M ⊂ E n , the action Φ ψ ( t ) ( M ) induces a congruent family { Φ ψ ( t ) ( M ) } t ∈ [0 , 1] For the Lie group SE( n ), there is its Lie algebra se ( n ) whose element g satisfies exp( g ) ∈ SE( n ); for the economy of notations, we use the same notation g for its matrix representation. Lemma 2.2. For g = ( 0 0 ξ ω ) ∈ se ( n ) , where ω ∈ so ( n ) and ξ ∈ R n , exp( g ) = e g = ( 1 0 v ( ω ) ξ e ω ) , where v ( ω ) := ∞ ∑ k =0 1 ( k + 1)! ω k = ∫ 1 0 e sω ds , ωv ( ω ) = e ω − I n , where I n is the n × n unit matrix. If ω is regular, v ( ω ) = (e ω − I n ) ω − 1 . 4 HIROYASU HAMADA, SATOSHI MAKITA, SHIGEKI MATSUTANI Proof. The straightforward computation leads g k = ( 0 0 ω k − 1 ξ ω k ) and thus we have the result.  Here we recall the properties of so ( n ) [Kn]: Lemma 2.3. (1) dim R so ( n ) = n ( n − 1) 2 , (2) the matrix representation of an element ω of so ( n ) is given by ( ω ij ) such that t ω = − ω , i.e., ω ij = − ω ji ( i, j = 1 , 2 , . . . , n ), (3) the maximal rank of the matrix representation of so ( n ) is ( n − 1) if n = odd and n otherwise, and (4) for the matrix representation ω ∈ so ( n ) , we have the natural decomposition, R n = ω ( R n ) ⊕ ker ω by considering ω : R n → R n , i.e. the cokernel coker ω agrees with the kernel of ω . Proof. 1, 2, and 3 are obvious as in [Kn, p.63]. Using the euclidean inner product, let us show ω ( R n ) ⊥ = ker ω which is equivalent with 4. Let us consider an element x of ω ( R n ) ⊥ = (img ω ) ⊥ , which means ( x, ωy ) = 0 for every y ∈ R n , and equivalently ( t ωx, y ) vanishes. The element x must belongs to ker t ω or ker ω because of t ω = − ω .  Since for g ∈ se ( n ) and t ∈ [0 , 1], t g belongs to se ( n ), by using this relation between SE( n ) and se ( n ), we consider a euclidean move ψ ( t ) = exp( t g ), which we call the simple euclidean move . Lemma 2.4. For t ∈ [0 , 1] and g = ( 0 0 ξ ω ) ∈ se ( n ) , exp( t g ) = ( 1 0 v t ( ω ) ξ e tω ) . where v t ( ω ) = tv ( tω ) = ∫ t 0 e sω ds satisfying ωv t ( ω ) = e tω − I n . If ω is regular, v t ( ω ) = (e tω − I n ) ω − 1 . Proof. v t ( ω ) = tv ( tω ) = ∞ ∑ k =1 1 k ! t k ω k − 1 = t ∫ 1 0 e stω ds . By replacing s with st , v t ( ω ) = ∫ t 0 e sω ds .  Though the action of the euclidean move should be regarded as a “rotation” in the projective space P R n via SL( n, R n +1 ) in R n +1 , the simple euclidean move is given by the following lemma: MATHEMATICS IN CAGING OF ROBOTICS 5 Lemma 2.5. For t ∈ [0 , 1] and g = ( 0 0 ξ ω ) ∈ se ( n ) , the orbit of x ∈ E n by the simple euclidean move ψ ( t ) := e t g , i.e., ψ ( t ) x = e tω x + v t ( ω ) ξ, is reduced to (2.1) ψ ( t ) x = e tω ( x + ξ 0 ) − ξ 0 + ξ 1 t, where ξ = ωξ 0 + ξ 1 for ξ 1 ∈ ker ω and ξ 0 ∈ R n . It means the following: (1) If ξ 1 vanishes, ψ ( t ) means a rotation by e tω , at a center − ξ 0 ∈ E n by identifying R n with E n as a set. (2) If ω vanishes, ψ ( t ) is the translation ψ ( t ) x = x + ξt. (3) If both ω and ξ 1 do not vanish, it is a mixed move of the rotation and the transla- tion. Proof. Since this action satisfies ωψ ( t ) x = e tω ( ωx + ξ ) − ξ, and we have the decomposition ξ = ωξ 0 + ξ 1 where ξ 1 is the kernel of ω from Lemma 2.3, we have (2.1) by by substituting ξ into ψ ( t ) x .  Lemma 2.6. The map exp from se ( n ) to SE( n ) is surjective. Proof. Though it can be directly proved from the Lemma ?? , it is also obtained from (2.1) by setting t = 1. Then its surjectivity is can be directly proved by the triangulation of the matrix ω though it is a little bit complicate due to the maximal tori in SO( n ).  Corollary 2.7. For every pair of congruent n -subspaces M and M ′ , there is a simple euclidean move ψ ( t ) = exp( t g ) of g ∈ se ( n ) such that Φ ψ (1) ( M ) = M ′ . Definition 2.8. The euclidean move ψ ( t ) ∈ SE( n ) which is given by a collection of the simple euclidean moves { exp( t g i ) | g i ∈ se ( n ) , t ∈ [0 , 1] } i =1 ,...,ℓ , i.e., ψ ( t ) = exp ( t − t j − 1 t j − t j − 1 g j ) e g j − 1 · · · e g 2 e g 1 for t ∈ [ t j − 1 , t j ] , where t j := j ℓ , we call ψ ( t ) the piecewise euclidean move . 3. Mathematics of Caging Let us consider the subspace K ⊂ E n whose codimension is two; K is ( n − 2)-subspace in E n . K might be decomposed to p connected parts, K = p ∐ i =1 K i . Hereafter K is fixed. 6 HIROYASU HAMADA, SATOSHI MAKITA, SHIGEKI MATSUTANI Remark 3.1. The caging is to restrict some n -subspace in E n using the other subspace K whose codimension is two, which is modeled after figures, wires in three dimensional case. The subspace K is modeled by them. Thus from a practical viewpoint, we do not consider wild geometries such as the Hilbert curve but we neither exclude them in this article. For such a wild object, some of the following results might be trivial. For given K , we let [ M ] K c be the subset of the configuration space [ M ] whose element is disjoint to K , i.e., [ M ] K c := { M ′ ∈ [ M ] | M ′ ⊂ K c } , and M K c be the family of [ M ] K c . Definition 3.2. Let M and M ′ be congruent n -subspaces in K c i.e., M and M ′ belongs to [ M ] K c ∈ M K c , and there exists g ∈ SE( n ) satisfying Φ g ( M ) = M ′ . If there is ψ ∈ C 0 ([0 , 1] , SE( n )) such that its congruent family { Φ ψ ( t ) ( M ) } t ∈ [0 , 1] satisfies the conditions, (1) Φ ψ (0) = id , (2) Φ ψ (1) = Φ g and (3) Φ ψ ( t ) ( M ) ⋂ K = ∅ for every t ∈ (0 , 1) , we say that M and M ′ are K c -congruent, denoted by M ≃ K c M ′ , and Φ ψ is a K c -congruent homotopy for M and M ′ . If we cannot find ψ ∈ C 0 ([0 , 1] , SE( n )) satisfying the above conditions, we say that M and M ′ are not K c -congruent, denoted by M 6 ≃ K c M ′ . We note that the element [ M ] K c of M K c is the set of the congruent subspaces. Definition 3.3. If every element M of [ M ] K c is K c -congruent each other, we say that [ M ] K c is a K c -congruent set and we cannot cage [ M ] K c ∈ M K c for K . If we find a pair M and M ′ of [ M ] K c which are not K c -congruent, we call [ M ] K c a complete K c -caging set, and we say that we can completely cage [ M ] K c ∈ M K c . Proposition 3.4. The moduli of shapes M K c is decomposed to M K c = M (0) K c ∐ M (1) K c where M (0) K c is the family of the K c congruent sets of M K c and M (1) K c is the family of complete K c -caging sets. Proof. The decomposition is obvious from the definition.  Remark 3.5. If K of n = 3 case is a space-filling curve like the Hilbert curve such that it is dense in E n , M K c itself is the empty set though we are not concerned with such a case. However it should be noted that if M K c is not empty, [ M ] K c ∈ M K c has a non-trivial geometrical structure generally. In fact, Fruchard and Zamfirescu considered the similar problem in which the K is a circle and [ M ] K c ( ⊂ [ M ]) is of a convex object [F, Z], though in general [ M ] is not convex from a practical point of view. Now in order to find a path from M to M ′ , we express the euclidean move ψ in terms of the piecewise euclidean move in Definition 2.8. MATHEMATICS IN CAGING OF ROBOTICS 7 Definition 3.6. Let M and M ′ be K c -congruent such that Φ g ( M ) = M ′ of g ∈ SE( n ) . If g is decomposed to the piecewise euclidean move, i.e., g = g ℓ ◦ g ℓ − 1 ◦ · · · ◦ g 2 ◦ g 1 satisfying the conditions; (1) For each g i , we have g i ∈ se ( n ) satisfying g i = exp( g i ) and (2) each ψ i ∈ C 0 ([0 , 1] , SE( n )) given by ψ i ( t ) = exp( t g i ) for t ∈ [0 , 1] is K c -congruent homotopy for Φ g i − 1 ◦···◦ g 2 ◦ g 1 ( M ) and Φ g i ◦···◦ g 2 ◦ g 1 ( M ) , we say that Φ g is reduced to ℓ - SE( n ) action. If Φ g is reduced to ℓ - SE( n ) action but cannot be reduced to ( ℓ − 1) - SE( n ) action, we say that Φ g is ℓ -th type and M and M ′ are ℓ -th K c -congruent if Φ g is ℓ -th type. Further if M and M ′ are congruent but not K c -congruent, or cannot be ℓ -th K c - congruent of finite ℓ , we say that M and M ′ are ∞ -th K c -congruent. We should note that these components ψ i ’s are given as the rotations at certain points or the translations from Lemma 2.5. Proposition 3.7. For given an n -subspace M ⊂ K c , the configuration space [ M ] K c of M K c is decomposed to [ M ] K c = ∞ ∐ ℓ =1 [ M ] ( ℓ ) K c where [ M ] ( ℓ ) K c is the set of subspaces of the ℓ -th K c -congruence to M . We, now, state the main theorem, which should be contrast to Corollary 2.7: Theorem 3.8. In general K c -congruent n -subspaces M and M ′ are not the first K c - congruent. Proof. An example is illustrated in Figure 1 of n = 2 case, in which dots mean K and a N -shaped object corresponds to M . They are K c -congruent to the outer one but it is obvious that the N -shaped object (a) in Figure 1 is not the first K c -congruent to (d). (a) (b) (c) (d) Figure 1. An example: The three dots mean K and a N -shaped object corresponds to M . (a), (b), (c), and (d) show the piecewise euclidean moves of the N -shaped object. This example can be extended to M × R n − 2 and K × R n − 2 .  8 HIROYASU HAMADA, SATOSHI MAKITA, SHIGEKI MATSUTANI Remark 3.9. The decomposition to M (0) K c and M (1) K c is related to the link problem and the knot theory [Ka]. Thus K c -congruence is a profound problem. Some of kinds of caging are surely based on the braid group in the knot theory when the fundamental group π 1 ( M ) of [ M ] is not trivial. However from the practical viewpoint as mentioned in Introduction, we are concerned with the ℓ -th K c -congruence rather than the K c -congruence itself. Theorem 3.8 means that for a K c -congruent configuration [ M ] K c , there might be M ∈ [ M ] K c so that we cannot move M to M ′ ∈ [ M ] K c by the simple euclidean move. It reminds us of parking in a small garage and the wire puzzle; It is also closely related to the probabilistic treatment of connected path in [ M ] K c [DS, MP]. Let us consider M and M ′ are ℓ -th K c -congruent, M ≃ K c M ′ . If ℓ is not small, it is not easy to find the K c -congruent homotopy Φ ψ such that Φ ψ (1) ( M ) = M ′ . In the some situations, the i -th simple euclidean move in a piecewise euclidean move is restricted, and thus, countable in a certain sense, but ℓ is not small. To find the piecewise euclidean moves connecting M and M ′ is basically difficult because of the combinatorial explosion. It is the origin of the difficulty of the wire puzzle. In other words, caging problem is connected with the difficulty of combinatorial problem. This fact implies that if we want to restrict some geometrical objects [ M ] ∈ M by using the figures or something in a daily life, we do not need a complete caging in Definition 3.3 but we have to find whether it is not small ℓ of ℓ -th K c -congruence. In other words, roughly speaking, there is the degree of the difficulty to take M in the inside of K to the outside of K , though the inside and the outside are not rigorous mathematically. We need not discriminate between the higher type of K c -congruence and a complete K c -caging set in a daily life. Though it is very difficult to introduce the measure of the path space in general, we could measure the difficulty of caging and the probabilistic treatment of connected path in [ M ] K c [DS, MP]. In order to express the practical caging, we introduce another concept. Definition 3.10. For given positive integer ℓ 0 , if we find n -subspaces M and M ′ in K c such that M and M ′ are congruent but not ℓ -th K c -congruent for ℓ < ℓ 0 , we say that K dissociates M and M ′ by ℓ 0 -th caging. Remark 3.11. Practically, for a given geometrical object [ M ] ∈ M , it is very important to find a configuration K which dissociates M and M ′ by ℓ 0 -th caging. More practically, the first caging is much more important than higher ℓ -th caging case because the concerned shape [ M ] is not so complicate. Even for the first caging, it is not easy to find whether it is the first caging or not because the dimension of SE( n ) is six if n = 3. Determination of the first caging means the determination of topological property of SE( n ). For example, if we reduce the determination of continuous space to finite problem by expressing concerned area and K in terms of the voxels for 100 points per one-dimension, we have to deal with 100 6 data, which is huge; we cannot deal with MATHEMATICS IN CAGING OF ROBOTICS 9 it practically in this stage [MOO]. Thus in order to avoid the problems, there are several attempts and proposals including the C-closure method. The second named author has investigated the problem using the C-closure concept [WK]. In another way, intuitive geometrical features such as loop shape [PSK] and double fork and neck [VKP] help us derive sufficient conditions for caging constraint. References [AM] R. Abraham and J. E. Marsden, Foundations of Mechanics, second ed. Addison-Wesley, New York, 1978. [BT] R. Bott and L. W. Tu, Differential Forms in Algebraic Topology, Springer, New York, 1982. [C] H.T. Croft, A Net to Hold a Sphere , J. London Math. Soc., s1-39 (1964) 1–4. [DS] R. Diankov, S. Srinivasa, D. Ferguson and J. Kuffner, Manipulation Planning with Caging Grasps , IEEE-RAS Int. Conf. on Humanoid Robots, (2008) 285–292. [F] A. Fruchard, Small holding circles , Geom. Dedicata, 157 (2012) 397–405. [G] H. W. Guggenheimer, Differential Geometry, Dover, New York, 1963. [Kn] A. W. Knapp, Representation Theory of Semisimple Groups, Princeton Univ. Press, Princeton, 1986. [Ka] A. Kawauchi, A Survey of Knot Theory, Birkhaeuser, Boston, 1996. [MOO] S. Makita, T. Otsubo and Y. Ohta, Achievement Test of 3D Multifingered Caging for Rigid Bodies by Exploring Six Dimensional Configuration Space , IEEE Int. Conf. on Robotics and Automation, (2017) under review. [MP] T. Makapunyo, T. Phoka, P. Pipattanasomporn, N. Niparnan and A. Sudsang, Measurement Framework of Partial Cage Quality based on Probabilistic Motion Planning , IEEE Int. Conf. on Robotics and Automation, (2013) 1566–1571. [PS] P. Pipattanasomporn and A. Sudsang, Two-Finger Caging of Nonconvex Polytopes , IEEE Trans. on Robotics, 27 (2011) 324–333. [PSK] F. T. Pokorny, J. A. Stork and D. Kragic, Grasping Objects with Holes: A Topological Approach , IEEE Int. Conf. on Robotics and Automation, (2013) 1100–1107. [RB] E. Rimon and A. Blake, Caging Planar Bodies by One-Parameter Two-Fingered Gripping Sys- tems , The Int. J. of Robotics Research, 18 (1999) 299–318. [RMF] A. Rodriguez, M. T. Mason, and S. Ferry, From Caging to Grasping , Int. J. of Robotics Res., 31 (2011) 886–900. [VKP] A. Varava, D. Kragic and F. T. Pokorny, Caging Grasps of Rigid and Partially Deformable 3-D Objects With Double Fork and Neck Features , IEEE Trans. on Robotics, 32 (2016) 1479–1497. [WK] Z. Wang and V. Kumar, Object closure and manipulation by multiple cooperating mobile robots , Proc. of IEEE, Int. Conf. Robotics and Automation, (2002) 394–399. [Z] T. Zamfirescu, How to Hold a Convex Body? , Geom. Dedicate, 54 (1995) 313–316. Hiroyasu Hamada National Institute of Technology, Sasebo College, 1-1, Okishin-machi, Sasebo, Nagasaki 857-1193, Japan, Institute of Mathematics for Industry, Kyushu University, Motooka 744, Nishi-ku, Fukuoka 819-0395, Japan Satoshi Makita National Institute of Technology, Sasebo College, 10 HIROYASU HAMADA, SATOSHI MAKITA, SHIGEKI MATSUTANI 1-1, Okishin-machi, Sasebo, Nagasaki 857-1193, Japan, Shigeki Matsutani: National Institute of Technology, Sasebo College, 1-1, Okishin-machi, Sasebo, Nagasaki 857-1193, Japan, Institute of Mathematics for Industry, Kyushu University, Motooka 744, Nishi-ku, Fukuoka 819-0395, Japan smatsu@sasebo.ac.jp