Abstract
A computable model of grasping and manipulation of a 3D rigid object with arbitrary smooth surfaces by multiple robot fingers with smooth fingertip surfaces is derived under rolling contact constraints between surfaces. Geometrical conditions of pure rolling contacts are described through the moving-frame coordinates at each rolling contact point under the postulates: (1) two surfaces share a common single contact point without any mutual penetration and a common tangent plane at the contact point and (2) each path length of running of the contact point on the robot fingertip surface and the object surface is equal. It is shown that a set of Euler-Lagrange equations of motion of the fingers-object system can be derived by introducing Lagrange multipliers corresponding to geometric conditions of contacts. A set of 1st-order differential equations governing rotational motions of each fingertip and the object and updating arc-length parameters should be accompanied with the Euler-Lagrange equations. Further more, nonholonomic constraints arising from twisting between the two normal axes to each tangent plane are rewritten into a set of Frenet-Serre equations with a geometrically given normal curvature and a motion-induced geodesic curvature.
1. Introduction
In relation to the recent development of robotics research and neurophysiology, there arises an important question on a study of the functionality of the human hand in grasping and object manipulation interacting physically with environment under arbitrary geometries of objects and fingertips. Another question also arises as to whether a complete mathematical model of grasping a 3D rigid object with an arbitrary shape can be developed and used in numerical simulation to validate control models of prehensile functions of a set of multiple fingers. In particular, is it possible to develop a mathematical model as a set of Euler-Lagrange equations that govern a whole motion of the fingers-object system under rolling contact constraints between each robot fingertip and a rigid object with an arbitrary smooth surface.
Traditionally in robotics research, a rolling contact constraint between two rigid-body surfaces is defined as the zero velocity of one translational motion of the common contact point on the fingertip surface relative to another on the object surface [1]. Therefore, rolling contact constraints are expressed in terms of velocity relations called a Pfaffian form. Montana [2] presented a complete set of all velocity relations of a rolling contact by using the normalized gauss frame for expressing given smooth surfaces of fingertips and a 3D object. Based on Montanaβs set of Pfaffian forms, Paljug et al. [3] formulated a dynamic model for the control of rolling contacts in multiarm manipulation. However, it is uncertain whether the derived model of equations of motion can be computationally integrable in time in case of rolling contacts between general smooth surfaces, since in [3] only a limited case of ball-plate contacts was numerically simulated. Another work by Cole et al. [4] tried to simulate a 3D grasping, but it is uncertain whether it could overcome the problem of arise of a nonholonomic constraint pointed out by Montana [2].
Even in case of 2D grasping by means of dual robot fingers with smooth fingertip surfaces, the integrability of Pfaffian forms of rolling contact constraints was shown very recently in our previous paper [5], where a complete set of computational models of Euler-Lagrange equations of motion of the whole fingers-object system and a pair of first-order differential equations expressing update laws of arc-length parameters along smooth contour curves of the object were given. Instead of the zero relative-velocity assumption of rolling contact, the following set of postulates for pure rolling contact is introduced:(1)two contact points on each contour curve must coincide at a single common point without mutual penetration,(2)the two contours must have the same tangent at the common contact.
Owing to these postulates, the path length of one contact point running on each fingertip contour curve and that of another contact point running on the object contour must coincide, that is, the constraint can be expressed eventually in the level of position variable. Hence, it is shown in [6] that Pfaffian constraints are integrable, and their integral forms are derived explicitly by using the moving frame coordinates. It is further shown [6] that the quantities of the second fundamental form of concerned contour curves do not appear in the Euler-Lagrange equations but play a key role in the update laws of arc-length parameters of the curves.
This paper aims at extending such a moving frame coordinates approach for mathematical modelling of 2D grasping to computable mathematical modelling of 3D grasping of a rigid object with arbitrary smooth surfaces under the following set of 3D rolling contact constraints:(a1)two contact points on each curved surface must coincide at a single common point without mutual penetration,(a2)the two curved surfaces have the same tangent at the common contact point, that is, each surface has the same unit normal with mutually opposite direction at the common contact point,(a3)the two path lengths running on their corresponding surfaces must be coincident.
In the previous paper [7], a set of Euler-Lagrange equations of motion of the fingers-object system have been derived by using the moving frame coordinates, but any explicit set of update laws of moving frame coordinates have been not given yet. In particular, any mathematical role of the quantities of the second fundamental form of a contact curve running on a concerned surface has not yet been studied in a mathematically explicit way. Therefore, it still remains unsolved to construct a complete set of equations of 3D grasping under rolling contact constraints in the situation of arbitrary given geometry of surfaces. This paper shows that nonholonomic constraints arising from relative twisting among the two normal axes at the contact point can be naturally resolved into determination of each of geodesic curvatures of the curves of the contact point on the fingertip surface and the object surface. Another second fundamental form of normal curvature on each surface is assumed to be extracted from a data structure of a given rigid body object, together with that of unit normal at each specified point on its surface. Thus, a set of 3D Frenet-Serret equations with normal and geodesic curvatures that update the moving frame coordinates are determined and shown to be computationally integrable together with the set of Euler-Lagrange equations of motion of the whole system.
2. Preliminary Results on Derivation of Euler-Lagrange Equations
Consider firstly a physical situation that a pair of multijoint robot fingers is grasping a 3D rigid body as seen in Figure 1. In this figure, the inertial frame denoted by - is fixed in the Euclidean space , and local coordinates systems denoted by - for are introduced at each robot fingerend. The local coordinates system of the object is denoted by - as shown in Figure 1, where stands for the object mass center. Next, denote each locus of points of contact between the two surfaces by a curve (3-dimensional vector in ) with length parameter on its corresponding surface , where signifies the object, and does the left hand fingerend. It is possible to assume that, given a curve as a locus of points of contact on and another curve as a locus of contact points on , the two curves coincide at contact point and share the same tangent plane at (see Figure 2). Further, during continuation of rolling contact, the two curves and can be described in terms of the same length parameter in such a way that and , where and are constant.
Second, suppose that at some of the length parameter the two curves and coincide at . Since is described in local coordinates -, its expression in the frame coordinates is given by where is a rotational matrix composed of three unit orthogonal vectors , and that are expressed in the inertial frame coordinates - as shown in Figure 1, that is,
Since is parametrized by length parameter, must be expressed by the unit tangent vector at lying on the tangent plane . According to (a1) and (a2), it is possible to suppose that there exist the two unit normals and expressed in corresponding local coordinates - and -, respectively (see Figure 2). Then, it is possible to certify that at , where and , denotes the unit vector of -axis of - expressed in the inertial frame coordinates, and and have a similar meaning.
In what follows, we denote vectors and for with upper bar when they are expressed in the inertial frame coordinates as seen in Figure 2. We also denote the derivative of in time by and similarly the derivatives of and in by , and . If we assume that the instantaneous axis of angular velocity of the object through the mass center is denoted by in the frame coordinates, then the angular velocity vector attached to the local coordinates - can be defined in such a way that where we define . It is well known in the text books [8β10] that where
It is easy to check that, in the illustrative case of a spherical left hand fingertip shown in Figure 1, we have where because both the rotational axes of joints and have the same direction in -axis of the frame coordinates -.
Let us now interpret the first postulate (a1) in a mathematical form described by where denotes the position vector of (the center of the left hand fingerend) expressed in terms of the frame coordinates and , and does the position vector of (the object mass center) also expressed in the frame coordinates and . Then, differentiation of (9) in yields If during rolling of the contact point the tangent vector of the fingerend has the same direction as that of (of the object), that is, if , then on account of (a3), (10) reduces to According to the previous paper, multiplication of the rotation matrix of the moving frame coordinates defined by from the right yields where we define , , and (see Figure 2), and we use and and has a similar meaning. Equation (13) means the three equalities , , and that constitute the set of three Pfaffian forms expressing the rolling contact constraint of zero-relative velocity. In the previous paper [7], it is shown that the Pfaffian forms of (13) are integrable with the integral forms where provided that .
By virtue of the integrability of each Pfaffian form of rolling contact constraints, the Lagrangian of the system is written into where In these equations, denotes the mass of the object, , the inertia matrix of the object around its mass center, , the inertia matrix of finger , , the potential energy of finger , , the gravity constant, and , , and express Lagrange multipliers corresponding to constraints and . Then, by applying the variational principle to described as with control input at finger joints, it is possible to obtain the following set of Euler-Lagrange equations: where , and the meaning of will be explained later. It should be noted that the sum of inner products of and (21), and (22), and and (23) for yields the energy relation
3. Necessary Conditions for Updating Moving Frame Coordinates
In order to always keep the tangent vector of the fingerend at the contact point to coincide with the tangent vector of the object surface at the same common contact point, we first show that the following two equations should be satisfied necessarily: as shown in detail in () of Appendix A, where denotes the normal curvature of the object surface at the contact point , and does that of the fingerend surface at . Both the normal curvatures and should be determined in accordance with the geometric structure of their corresponding surfaces, once the direction of each locus of contact points, that is, or , is given. Similarly, as shown in () of Appendix A, the conditions and imply where denotes the geodesic curvature of the object surface at , and has a similar meaning. This equation does not determine each or individually. Therefore, let us try to differentiate and in . However, as shown in () of Appendix A, we rederive only (25) and (26).
We are now in a position to find a necessary condition for maintaining the equality of (25) for the time being. To this end, it is important to see that the time rate of the equality (25) reduces to as shown in () of Appendix A. Then, this equation together with (27) leads to where Thus, it is possible to determine each geodesic curvature individually by inverting the coefficient matrix of (29) in the following way:
Finally, it is possible to see that the moving frames denoted by and should satisfy the Frenet-Serre equations
4. Sufficient Conditions for Updating the Moving Frame Coordinates
In the Frenet-Serre equation of (31), the coefficient called the normal curvature is determined by the geometric shape of the object surface at point denoted by in the local coordinates , and the other normal curvature in (32) is also determined similarly. The geodesic curvatures and are determined via the instantaneous motion of rolling contact, so that they satisfy (27) and (28). We now show under the postulates (a1) to (a3) that if and are determined by (31) and (32), respectively, and the tangent vectors and of the moving frame coordinates at the initial time are chosen to coincide with each other and at the same time to satisfy (25) at , then for any , it follows that To prove this, first note again that the postulates (a1) and (a2) imply Next, note that the sum of (31) and (32) implies (27). At this stage, suppose that is not coincident with at some though both and are lying on the same tangent plane. In other words, suppose that and stands for , then, as shown in Appendix B, we have Further, as discussed in () of Appendix B, geodesic curvatures and should be defined as It is important to remark that (36) was first derived by Montana [2] as a nonholonomic constraint of rolling. Equation (36) can be interpreted by Murray et al. [1] as the nonholonomic constraint that governs the rotating motion of one tangent plane to the fingerend relative to another tangent plane of the object surface caused by relative βtwistingβ between the axis of normal and that of . Nevertheless, it is further important to note that if and are set as shown in (31) and (32), respectively, then the right hand side of (36) becomes zero due to (27). That is, (31) and (32) imply . Therefore, if at the initial time , then the setting of (31) and (32) for geodesic curvatures and leads to for as far as . Since as far as the contact is maintained, the equality implies for , then, from () of Appendix A, (25) and (26) follow. At the same time, from (26) and (27), it follows that in view of the first two equations of () of Appendix A. Thus, it is concluded that all equalities in (34) follow.
5. A Numerically Integrable Set of Differential Equations Under Rolling Constraints
It is now possible to show a set of all the differential equations of motion of the fingers-object system under rolling contact constraints. In what follows, we use the suffix ββ for expressing variables on quantities of the object at contact point of the -th finger and the suffix for those of the fingerend surface of finger at . For convenience, we use instead of . In the following, we give the set of Euler-Lagrange equations, first-order equations of rotation matrices and , update equations of length parameters, and Frenet-Serre equations for updating moving frame coordinates at contact points where and denotes the contact point on the object surface expressed by the object local coordinates -, and does that of on the fingerend surface of finger expressed by the fingerend local coordinates -. In , is an matrix depending on , where denotes the degrees of freedom. In the case of a pair of robot fingers depicted in Figure 1, it is obvious to see that It should be remarked again that expresses a set of Frenet-Serre equations for determining each moving frame coordinates at contact point , and then the geodesic curvatures and are determined in the same manner as shown in (31) and (32). Further, computation of and appearing in (31) and (32) through defined by (30) can be executed simultaneously via numerical integration of and . In practice, it is possible to compute by Analogously, it is possible to compute since must be expressed by a function form of , and can be calculated by multiplying () by from the left.
6. Conclusions
A computational model of dynamics of 3D object grasping and manipulation under rolling contact constraints by means of multiple multijoint robot fingers with smooth fingerend surfaces is derived on the basis of the postulates of pure rolling contact constraint. The postulates are summarized: (1) at the contact point, the fingerend and object surfaces share a common tangent plane with each normal with opposite direction and (2) the path length of contact points running on the fingerend is coincident with that running on the object surface. The postulates are adopted by referring to Nomizuβs work [11] in which it is assumed that any relative twist motion does not arise. The proposed model is composed of a set of 2nd-order Euler-Lagrange equations derived by using the moving frame coordinates and 1st-order Frenet-Serre equations together with 1st-order differential equations governing update laws of length parameters and rotational motions of the local coordinates. The nonholonomic constraint arising from possible relative twist of the two normal axes at the contact point is resolved into determination of the geodesic curvatures of the fingerend and object surfaces. This leads to a conclusion that the whole set of simultaneous differential equations with constraints are numerically integrable (as a preliminary result of numerical simulation, see [12]).
Appendices
A. Necessary Conditions
()Note that and , If and , then it follows that ()Similarly, it follows that These two equations imply and if and .()Similarly, it follows that These two equations imply and if , , and .()Time rate of reduces to Since for , the above equality reduces toB. Preliminary Remarks on Geodesic Curvature
both and are skew symmetric.()Derivation of where .
If , then ()With derivation of , ()With derivation of and ,