Research Article | Open Access
Suguru Arimoto, Morio Yoshida, "Modeling and Control of 2D Grasping under Rolling Contact Constraints between Arbitrary Shapes: A Riemannian-Geometry Approach", Journal of Robotics, vol. 2010, Article ID 926579, 13 pages, 2010. https://doi.org/10.1155/2010/926579
Modeling and Control of 2D Grasping under Rolling Contact Constraints between Arbitrary Shapes: A Riemannian-Geometry Approach
Modeling, control, and stabilization of dynamics of two-dimensional object grasping by using a pair of multijoint robot fingers are investigated under rolling contact constraints and arbitrariness of the geometry of the object and fingertips. First, modeling of rolling motion between 2D rigid bodies with arbitrary shape is treated under the assumption that the two contour curves coincide at the contact point and share the same tangent. The rolling constraints induce the Euler equation of motion that is parameterized by a pair of arclength parameters and constrained onto the kernel space as an orthogonal complement to the image space spanned from all the constraint gradients. Furthermore, it is shown that all the Pfaffian forms of the rolling constraints are integrable in the sense of Frobenius and therefore the rolling contacts are regarded as a holonomic constraint. The Euler-Lagrange equation of motion of the overall fingers/object system is rederived together with a couple of first-order differential equations that express evolution of contact points in terms of quantities of the second fundamental form. A control signal called “blind grasping” is defined and shown to be effective in maintenance or stabilization of grasping without using the details of object shape and parameters or external sensing. An extension of the Dirichlet-Lagrange stability theorem to a system of DOF-redundancy under constraints is discussed by introducing a Morse-Bott function and deriving its Hessian, in a special case that the object to be grasped is a parallelepiped.
This paper aims at tackling the control problem for dextrous multifingered hands from computational perspectives (see Figure 1), based on the assumption that a complete model of grasping must be developed even under the existence of rolling contacts and the arbitrariness of geometry of objects. So far the kinematics and geometry of contact between rigid bodies were solved by Montanna , and a set of velocity relations is given in detail . However, there is a dearth of papers except the papers mentioned in [2–4] that attempt to model dynamics of physical interactions between the fingerends and an object under the existence of rollings. However, the papers [2–4] did not yet gain physical insights into the constraint forces arising from rolling contacts and show any explicit forms of them in the object wrench space. In the series of our papers [5, 6], a set of Lagrange equations of motion of the overall fingers/object system under rolling constraints is derived under the assumption that rolling is interpreted as a constraint of the equal velocity of the contact point running on the fingerend sphere relative to running on the object surface, as originally formulated in the text book . However, all discussions in [5, 6] have been restricted to the case of ball-plate rollings. Very recently, a complete model of 2-dimensional grasping of a rigid object with arbitrary shape is given as a set of Lagrange's equations of motion of the overall fingers/object system together with a pair of first-order differential equations that update arclength parameters . It should be noted that modeling of the system assumes the full knowledge of geometry of a given object but design of control signals neither needs the information of object geometry nor uses any external sensing of contact points.
This paper further presents a complete model of grasping in the case that the geometry of fingerends is arbitrary and discusses a control scheme called “blind control" that need neither the use the geometric information of the fingerends and object nor the sense locations of the contact points and object mass center. In this paper, rolling contact is interpreted as the following conditions.(1)Two contact points on the contour curves must coincide at a single point.(2)The two contours must have the same tangent at the common contact point.
These two conditions as a whole are equivalent to Nomizu's relation  concerning tangent vectors at the contact point and normals to the common tangent. The argument presented in  can be interpreted as a kinematic extension of the well-known theorem on curves that if two smooth curves have the same curvatures along their arclengths then the two curves can be exactly superposed by using a homogeneous transformation. By virtue of this mathematical standpoint of rolling contact, we can show immediately that the Euler-Lagrange equation of motion of the overall fingers/object system is characterized by a pair of arclength parameters and quantities of only the first fundamental form of contour curves. It is further shown that the Euler-Lagrange equation should be accompanied with a pair of first-order differential equations that govern evolutions of arclength parameters, where quantities of the second fundamental form are involved. Furthermore, we show that rolling contact constraints expressed in terms of velocity relations are integrable in the sense of Frobenius. In other words, the rolling contact constraints can be regarded as a holonomic constraint. Based upon these holonomic constraint forms, we reformulate the Euler-Lagrange equation of motion of the system.
In the final two sections, we will discuss an extension of Dirichlet-Lagrange stability theorem from the standpoint of Riemannian Geometry by introducing a control signal called “blind grasping." The signal can be constructed real-time based upon the data of fingers' kinematics without referring to object kinematics, regarding the pair of robot fingers as the intrinsic world but objects to be grasped existing in the external world. We show that the blind control signal designed on the basis of the fingers-thumb opposability can be interpreted as a Morse-Bott function in the case that the object is a parallelepiped, since its Hessina in this case becomes positive semidefinite on the base manifold. Notwithstanding the redundancy in system's DOF, we prove the asymptotic convergence of a solution trajectory to the closed-loop dynamics to an equilibrium manifold that attains minimization of the Morse-Bott function. We finally point out a few of important and interesting problems that remain unsolved or not yet tackled.
2. Definitions of Tangent Vectors in Terms of Arclength Parameters
First, denote the contour curve of the left hand fingertip by in terms of arclength parameter as shown in Figure 2 and the object contour by in terms of another length parameter . Suppose that the fingertip contour contacts with the object at and so that in the frame coordinate space. In general, we assume implicitly that by rolling motion the contact point moves on each contour with the same run-length without splipping. Therefore, we characterize the contour curves and by using the same length parameter , at which and expressed in the frame space - coincide and share the same tangent vector, as shown in Figures 2 and 3.
In order to gain a physical insight into this rolling constraint, we need to denote firstly the fingertip contour curve in the local coordinates - as shown in Figure 3 and the object contour by in the object coordinates - fixed at the object. If we denote and by
and define then must be the unit tangent vector at the point and must be also the unit tangent vector at (see Figure 3). It is well known in the mathematical theory of curves and surfaces that the further derivatives of and in can be expressed as
where and are orthogonal to and respectively, and is the curvature of the fingertip contour curve and is that of the object contour in its left-hand side. It is also well known that
Next consider the rotation matrix of the object around its mass center expressed in the frame coordinates as follows:
where denotes the unit vector of -axis and that of -axis expressed in the inertial frame coordinates - as shown in Figure 2. If the object rotates by angle , that is, - rotates by from the frame coordinates -, then
where denotes the unit vector of -axis of the left-hand fingertip expressed in the frame coordinates - and that of -axis. Both the matrices and are an orthogonal matrix regarded as an element of SO(2). The derivatives of and in denoted by and are obtained as follows:
where , , and in the case of the finger mechanism (a planar robot with three joints) depicted in Figure 1. Throughout the paper, we take the positive sign of angles , , , and in the counterclockwise direction. Hence, in (9) expresses the rotation of positive angle with associating the angular velocity . In other words, or and or .
Next, denote the position vector of point as a center of the left-hand fingertip by and that of the object mass center by . Then, the first assumption that the two contact points and coincide at the common contact point implies the equality
For the sake of convenience, we denote the unit tangent vector at expressed in the frame space - by
Then, the second assumption that at the contact point the two curves share the same tangent implies
Throughout the paper we use symbol for expressing the derivative in in such a way that and . Then, differentiation of (10) in yields
which from (9) can be written in the form
It should be remarked at this stage that the position constraint expressed by (10) is holonomic with two degrees-of-freedom and the velocity constraint of (15) is Pfaffian with two DOFs, too. However, physical meanings of these two constraints are not directly connected to the constraint conditions based upon the assumptions of (1) and (2) mentioned in the previous section. In order to gain a physical insight into the rolling contact conditions, let us take the inner product of (15) and (or equivalently ), which results in
This shows the rolling contact constraint of a Pfaffian form as a condition of zero relative velocity of the contact point running on the fingertip relative to that of it running on the object. Another rolling contact constraint can be obtained by taking the inner product of (15) and in the following way:
where is taken into account. This is reduced to
Hence, if we define the column vectors
A similar argument developed above can be applied to the characterization of the rolling contact constraint at the right-hand contact point , at which the right-hand object contour and fingertip contour share the same tangent (see Figures 1 and 4). Therefore, it is possible to define smooth curves and expressed in their local coordinates - and - respectively, with respect to the same arclength parameter as indicated in Figure 4. Note that in this paper the direction of increase of is taken to be counter to that of . Hence, as shown in Figure 2 we see evidently that and , and similarly to (10) and (12) that
where , , and
where according to the planar mechanism of the right-hand finger shown in Figure 1. Apparently from Figure 4 it follows that and . Thus, similarly to the derivation of (16) and (17), we have from differentiation of (22) in the following:
Hence, if we denote , , , and
where . For convenience, we append and with the two-dimensional zero vector in the following way:
and denote and by and renewedly for the sake of convenience. Then, (21) can be written in the form
3. Derivation of Euler-Lagrange Equation of Motion and Update Law of Length Parameters
As discussed in the previous papers [11–15], a set of all possible postures of the fingers/object system depicted in Figure 1 can be regarded as a Riemannian manifold with eight degrees of freedom that can be represented by , where , , , , , and the Riemannian metric is defined as
where and denote the mass of the object and its inertia moment around , and the inertia matrix of finger for . Particularly, a set of all postures during rolling motions of the system keeping both rolling contacts can be regarded as a subset of that is subject to the constraints of (10) and (22). From the Riemannian geometric point of view, at any posture of the system with rolling contacts specified by some arclength parameters and , the four equalities of (21) and (31) give rise to an assignment of the tangent vector , where we denote by the tangent space of at the given posture having rolling contacts at contact points and . That is, the tangent vector should be orthogonal to all four vectors and for . Hence, by introducing four Lagrange's multipliers and corresponding to and for , it is possible to derive the Euler-Lagrange equation of motion in the following way:
In detail, (34) can be written as follows:
in which symbol in (37) denotes a control signal treated as an external torque that can be exerted through finger joints of finger . It should be remarked that all of equations (35) to (37) are characterized by length parameters and but only quantities of the first fundamental form of contour curves are involved in (35) to (37). It should be also noted that the posture of the object is governed by the first-order differential equation of (9). At the same time, it is important to find the update law of length parameters and through rolling contact motion of the system. In fact, note that, from the condition (1) of rolling contact mentioned in Section 1, at contact point for . This also implies
which reduces to
where denotes the curvature of the fingertip contour curve for finger for , the curvature of the left-hand object contour, and that of the right-hand object contour. Since for both , (39) is again reduced to
Thus, the inner product of and (40) yields
where we referred to the relation (as discussed below (9)):
4. Integrability of Pfaffian Forms of Rolling Contact Constraints
A rolling contact constraint between two rigid bodies is expressed traditionally by an equality of two contact-point velocities at the common contact point running on the one rigid body and on another body. In the case of rolling contact motion as shown in Figure 1, such zero relative-velocity relation is given in the Pfaffian forms of (29) and (31). We are now in a position to show that all these four Pfaffian forms are integrable in the sense of Frobenius [16, 17]. In fact, it is possible to prove the following.
Proposition 4.1. () Under the contact conditions expressed by (10) and (22), the following four geometrical relations are valid (see Figure 4):
() Each of the Pfaffian forms and for defined by (17), (19), (25), and (27) is integrable in in the following forms:
In fact, the inner product of (10) and leads to (43) for and that of (22) and does to (43) for . The inner product of (10) and leads to (44) for and that of (22) and does to (44) for . The first equation of (45) can be derived in the following manner:
Thus, by applying (41) to this equation, we have
The second equality of (45) can be verified in a similar way.
From this proposition, it follows that the Euler-Lagrange equation of motion of the system can be derived by applying the variational principle to the Lagrangian of the system
where denotes the total kinetic energy of the system. Note that is independent of the shape parameters and but and are dependent on for respectively. The variational principle is written in this case in the following form:
where . It should be noted that
Thus, (51) can be spelled out in the general form
where denotes the constant matrix defined as , signifies the zero matrix, and the identity matrix. In such a representation of the forcing term, is called the driving matrix in robotics.
5. Coordinate Control for Stable Grasping and Morse-Lyapunov Function
In order to design a control signal for establishing stable grasp from the practical standpoint, a family of control signals has been introduced, based upon the fingers-thumb opposability that is one of the functional characteristics of human hands as discussed in . The family of controls is described by the form
where stands for a position feedback gain common for with physical unit [N/m]. It should be noted that the signal of the right-hand side can be constructed by the realtime measurement data on joint angles and angular velocities of both the robot fingers together with positions and of the centers of the fingertips. In other words, the control signal of (54) should be real time computed as a feedback signal from the measurement data of variables of the intrinsic finger world seen from the multifingered hand side. That is, any information of the geometry of the object and measurement data of location the object mass center should not be referred to in (54), because objects to be grasped, that are changeable in the situation, must be regarded as a substance in the extrinsic world.
where denotes the total kinetic energy of the system defined in (32). It should be noted that the total energy defined by
is nonnegative definite in and and its time derivative is nonpositive definite as shown in (56). That is, if we regard the pair of position and velocity vectors as the state vector, then the quadratic function looks like a Lyapunov function as seen from the energy relation (56). Nevertheless, in the case of the overall fingers/object system shown in Figure 1, is of 8 dimentions and hence the state is of 16-dimension. Since there are four rolling contact constraints as discussed in Sections 3 and 4, the overall system must be of four degrees-of-freedom and therefore the state must be of 8 dimensions. However, the total energy function is not positive definite with respect to , because is not positive definite in even if all of the four rolling contact constraints are taken into account. Thus, stabilization of grasping by means of a coordinate control of (54) cannot be treated by applying the conventional Lyapunov method to the relation of (56).
In order to tackle a control problem of stable grasping from the standpoint as a combination of Riemannian geometry and Lyapunov's direct method, we first consider a simpler case that the object has a pair of flat side surfaces that are parallel as shown in Figure 5 and both the robot fingers are of a single degree-of-freedom. In this case, is of 5 dimensions and hence the overall fingers/object system is of single degrees-of-freedom. Therefore, the total energy must be positive definite in under the four holonomic rolling contact constraints, because the scalar function must have a minimum at some posture under the constraints. That is,
where “" is taken over all possible postures that are subject to rolling motion. For the sake of convenience, we will discuss the details of such a set of all possible postures reachable from a starting posture of the system by only movements of rolling motion. For the time being, we discuss what condition specifies the minimal posture that minimizes the artificial potential .
First, note that the difference vector can be expressed in terms of length parameters for as follows:
which follows from subtraction of (22) from (10). When the object is rectangular as shown in Figure 5, all and are invariant under the change of . As seen from Figure 5, if we denote the object width by then we have
Hence, by partially differentiating this equation in , we obtain (the details will be given in the Appendix)
where denotes the curvature of the fingertip contour for finger . Thus, by regarding ,
First, consider the simplest case when both the fingertips are spherical, which is called as the following:
Problem 1 (stability problem of ball-plate pinching). To find a necessary and sufficient condition under which minimization of the potential in a set of all possible postures movable from a given starting posture by rolling motions is realized.
In this stabilization problem of ball-plate pinching, must be the center of the hemispheric fingertip of finger with radius , where is constant with respect to (see Figure 5). Hence, it follows that
Thus, in this case, (63) can be written in the form
This means that arises if and only if is orthogonal to for . In other words, becomes extremal if and only if the four points , , , and are lying on the common straight line. At such a posture, it is easy to check that and the Hessian matrix becomes positive definite. Thus, we conclude that minimization of the shape function is attained if and only if all , , , and are lying on a straight line.
In the case that both the robot fingers are of a single degree-of-freedom mechanism as shown in Figure 5, the total degrees-of-freedom of the overall system becomes of one DOF, because originally the system has five DOFs but there are four holonomic constraints as discussed in Sections 3 and 4. Hence, in this case, becomes positive definite with respect to position variables under the four constraints. That is, must be a Morse function introduced on a single-dimensional submanifold of the base Riemannian manifold constrained by four holonomic constraints. Thus, the overall scalar function defined by (57) becomes positive definite. This means that the equality relation of (56) shows that can be regarded as a Lyapunov function for the closed-loop system (53) in which control inputs for defined by (54) are substituted. Therefore, the equilibrium point at which and the four points , , , and are on a common straight line becomes asymptotically stable in the sense of Lyapunov, even if the function is defined on a Riemannian submanifold.
If each robot finger has multi-DOFs as shown in Figure 1, the overall fingers/object system becomes redundant in its degrees-of-freedom. For example, the left robot finger shown in Figure 1 has three joints and the right one has two joints. Then, the total degrees-of-freedom of the system becomes of four DOFs under the four holonomic constraints. Therefore, there arises an infinite number of possible postures realizing the minimum of potential that is, a set of such possible postures themselves constitute a manifold. We call it an equilibrium manifold. In the case of a pair of robot fingers with two and three joints, respectively, pinching a rectangular object, the equilibrium manifold denoted by becomes of three dimensions. In order to avoid a possible occurence of abundant motion (it is called a self-motion in robotics ) owing to the redundancy in the system's DOF, we have adopted the following form of control signals (see ):
where denotes a positive constant, and
The details of physical importance of the last term in the control signals of (66) will be disclosed in the next section when nonspherical fingertips are treated.
6. Hessian Matrix of the Morse-Lyapunov Function
Now we are in a position to discuss a stability problem of precision prehension (pinching) under the general fingertip geometry (nonspherical fingertip). However, we assume that the object is rectangular and both the curvatures for of the fingertips are continuously differentiable in and bounded between some and as shown in Figure 6. The problem is posed as follows.
Problem 2 (stability problem of precision prehension). To find a necessary and sufficient conditon under which minimization of the potential (or ) is realized in a set of all movable postures starting from an initial posture by rolling contact motions. At the same time, to prove the asymptotic convergence of the orbit of motion to some possible equilibrium state.
First, as predicted reasonably from the analysis of Problem 1, we assume that, even in the general case of Problem 1, all the three lines connecting and , and , and and are lying on the line for minimization of . If it were true, then in the case of a pair of robot fingers with a single DOF (see Figure 5) the axes and must be parallel and hence such a condition could not be satisfied in general, because the base points and are assumed to be fixed in the frame coordinates with some specified value of the length .
Now, we treat a pair of robot fingers with multi DOFs as shown in Figure 1 and consider again a minimization problem of together with a problem of finding a necessary condition for maintaining a steady state for the object (i.e., in (35) and in (36)). First, to attain a steady state of the object, we need the conditions
Then, substituting these two equalities into (61) yields
which shows that must be perpendicular to . It is also reasonable to show that, under the equality conditions of (71), and can be expressed as
Hence, if , then the second equality of (73) becomes valid. Furthermore, in the case of Problem 2, in general and hence (63) does not imply though must be perpendicular to . In this case, we must bear in mind that length parameters and are not independent to each other.
In order to derive the Hessian of the shape function plus the extra term (the third term in the bracket of (69)) with respcet to , , and , we put
where we define
where, by denoting the object width by ,
where, in the last equality, (81) is used. By using (80), (83) reduces to (79). Equation (79) means that a local minimum of as a function of and and is attained when and . This condition is satisfied when is parallel to and . More explicitly, if we define
Apparently, steady states are attained when , , , for .
Now, let us derive the Hessian matrix of by calculating and for . In a similar way to the derivation of (83), we obtain
for , where
for and . Note that by definition, and all , , , and are positive provided that
Thus, if we denote , then we obtain
It is possible to verify that the Hessian of with respect to in a neighborhood of the posture satisfying is positive definite by choosing appropriately so as to satisfy for (note that ). Finally, the Hessian of with respect to the position state vector is given by
where is a constant -matrix of the form
because can be expressed by . Thus, the Hessian matrix is degenerate, but it is possible to see that the function can be regarded as a Morse-Bott function (see ).
7. A Proof of Dirichlet-Lagrange Stability for Precision Prehension
We define the equilibrium manifold by the set of all postures that have a form depicted in Figure 6 and maintain the contacts at some points and . More rigorously, this equilibrium manifold denoted by can be regarded as a set of all of that satisfies , , and under the situation that for are given. The submanifold is of 3 dimensions, because it satisfies and maintains both contacts (i.e., the 2-dimensional contact constraints (12) and (22)) that determine automatically the position of the object mass center. In other words, corresponds to a set of motions of the three excess degrees-of-freedom of the robot fingers.
Suppose one posture of the system belonging to the submanifold and a Riemannian ball that is defined by
where signifies the Riemannian distance defined by
where the infimum is taken over all of the orbits in connecting and from to . We denote the -entry of introduced in (32) and (33) by . We will show that, for any , there exists such that any solution trajectory as a solution to the closed-loop dynamics of (85) to (87) starting from any posture with rest state inside remains in and converges asymptotically to some posture on as . Note that numerical values of , , and are given on the basis of physical dimension [ m], that is, the dimension of the Riemannian distance defined in (96). We split the tangent space into the horizontal space spanned from the constraints of (28) and (30) and the kernel space as the orthogonal complement to the horizontal space. This is carried out by defining
where is an -matrix whose column vectors have a unit norm, and orthogonal to each other and to every column vector of . That is, is an orthogonal matrix and hence
It should be noted that is skew symmetric, too. It is also important to note that the dynamics of (98) appear to be not fully dissipated according to the definition mentioned below (98). Nevertheless, from (17) and (25) it follows that
Since the coefficient of is , (103) reduces to