Abstract
This paper presents an extension of the concept of dynamically consistent Jacobian inverse from robotic manipulators (holonomic systems) to non-holonomic robotic systems, like mobile robots. This new inverse is derived within the framework of the endogenous configuration space approach, following a strict analogy with the original derivation of the dynamically consistent Jacobian inverse for holonomic systems. The analogy is founded on replacing a finite-dimensional configuration space of the manipulation robot by the space of control functions steering the non-holonomic system. Consequently, a curve in the space of control functions corresponds to the manipulator’s trajectory in the configuration space, whereas endogenous velocities and forces are defined as elements of the tangent and cotangent spaces to the control space. Three ways of introducing the dynamically consistent Jacobian inverse are proposed, referred to as the geometric method, the force method, and the optimization method. A crucial concept underlying all these methods is a Riemannian metric in the space of control functions of the non-holonomic system as well as in its operational space. It has been shown that, similarly as for holonomic systems, the dynamically consistent Jacobian inverse obtained prevents the transmission of certain internal forces acting in the system from the endogenous configuration space to the operational space. This property is illustrated with the example of the Pioneer 2DX mobile platform. Performance of the new Jacobian inverse is demonstrated in the context of motion planning of the rolling ball.
Similar content being viewed by others
Explore related subjects
Find the latest articles, discoveries, and news in related topics.Avoid common mistakes on your manuscript.
1 Introduction
The concept of a dynamically consistent Jacobian inverse for manipulation robots was founded by Khatib, see [11, 12]; it is also known as the inertia weighted Jacobian pseudoinverse [10, 15]. The dynamic consistency of this inverse consists in decoupling a force that acts in the configuration space into a force coming from the operational space, and an internal force that affects solely the motion in the configuration space. The concept of this inverse was supported by further theoretical arguments [5, 8] and applied to the operational control of holonomic systems, including redundant manipulators [15], mobile manipulators with holonomic base [4], humanoid robots [13, 19], and biomechanical systems [6, 7]. An incorporation of the constraint consistent inertia matrix into a weighted Jacobian inverse for non-holonomic wheeled-based mobile manipulators has been proposed in [16, 25]; an inherent flaw of such an approach in the context of general non-holonomic systems was revealed in [26]. In this last reference, the endogenous configuration space approach was suggested as an alternative. The dynamically consistent Jacobian inverse serves as a tool for solving the inverse kinematics or the motion planning problem in the way that respects some basic requirements of the force transmission from the configuration to the operational space of the robot. More specifically, since the robot’s Jacobian can be regarded as a transformation of velocities from the configuration (joint) to the operational (task) space, therefore a right Jacobian inverse transforms velocities from the operational to the configuration space. Consequently, the dual Jacobian inverse transmits forces acting in the configuration space to the operational space, so in general, the forces exerted in the configuration space will produce a motion of the end effector in the operational space. A Jacobian inverse is called dynamically consistent, if forces belonging to the null space of the dual Jacobian inverse are not transmitted to the operational space, so they do not affect the motion of the end effector. This feature distinguishes the dynamic consistency.
For completeness and clarity of presentation, this paper begins with three methods of derivation of the dynamically consistent Jacobian inverse for holonomic robots. All these methods rely on Riemannian metrics in the configuration space and in the operational space, defined by the inertia matrix of the robot dynamics. In doing so, we approach the subject of Lagrangian mechanics on infinite-dimensional configuration spaces [9, 14]. The geometric method assumes commutativity of a diagram of maps between tangent and cotangent spaces to the configuration and the operational spaces. The force method reconstructs original Khatib’s construction. The optimization method designs the dynamically consistent Jacobian inverse as a solution of a constrained minimization problem of the robot’s kinetic energy. Next, the same three methods are applied to non-holonomic systems. It is assumed that the kinematics of a non-holonomic robotic system are represented by a driftless control system with output, and the endogenous configuration space approach developed in [22, 23, 26] is adopted. Conceptually, this approach is rooted in the continuation method traced back to Ważewski [24], and introduced to robotics by Sussmann [21]. A fundamental premise of the endogenous configuration space approach is an analogy between the configuration of a manipulator and the control function of the non-holonomic system; for this reason, the latter is called the endogenous configuration. This analogy encompasses the manipulator’s kinematics and the endpoint map of the control system representation of kinematics of the non-holonomic system. As a consequence, the non-holonomic system Jacobian is computed by differentiating the kinematics, and a right Jacobian inverse can be introduced as an inverse of a map between Hilbert spaces.
In the presence of the non-holonomic constraints, the dynamics equations of the system are obtained on the basis of d’Alembert’s Principle. The inertia matrix computed along the system’s trajectory defines a Riemannian metric in the endogenous configuration space. In this setting, the derivation of the dynamically consistent Jacobian inverse for a non-holonomic system is patterned on the derivation performed for the holonomic systems. Specifically, a curve in the endogenous configuration space corresponds to the manipulator’s trajectory in the configuration space, whereas endogenous velocities and forces can be defined as elements of the tangent and cotangent spaces to the endogenous configuration space. The geometric, force, and optimization methods of defining the dynamically consistent Jacobian inverse have been developed. In order to demonstrate and compare the property of dynamic consistency, an immobilization problem has been solved, for example, holonomic and non-holonomic systems, acted on by some internal force, by means of first the dynamically consistent Jacobian inverse and then the usual Jacobian pseudoinverse. Transmission of this force to the operational space has not taken place only in case of the dynamically consistent inverse. Finally, in order to illustrate performance of the dynamically consistent Jacobian inverse, a motion planning problem for the rolling ball has been solved using these two inverses. An advantages of the dynamically consistent Jacobian inverse consist in avoiding representation singularities and smoothing the motion paths.
The presentation of this paper uses some very basic concepts of analytic mechanics and differential geometry, abundantly provided in [1]. The material concerned with control theory and non-holonomic systems is covered by [3, 20]. The reference [22] may serve as an introduction to the endogenous configuration space approach. The concept of dynamically consistent Jacobian inverse was first announced by these authors in a conference paper [18]. Then, in [17], an application of the force method to the design of the dynamically consistent Jacobian inverse for mobile manipulators was proposed.
This paper is intended as a comprehensive introduction to dynamically consistent Jacobian inverses for holonomic and non-holonomic systems. Its main contribution is the following:
-
1.
Introduction of three methods of deriving the dynamically consistent Jacobian inverse for holonomic systems.
-
2.
Extension of these methods to non-holonomic systems.
-
3.
Definition of the Riemannian metric and related concepts for non-holonomic systems.
-
4.
Derivation of the dynamically consistent Jacobian inverse for non-holonomic systems.
-
5.
Demonstration of dynamical consistency for holonomic and non-holonomic systems.
-
6.
Application of the dynamically consistent Jacobian inverse to motion planning.
The composition of this paper is the following. In Sect. 2, we restate a standard derivation of the equations of motion for a non-holonomic system. Section 3 restitutes Khatib’s dynamically consistent Jacobian inverse for holonomic systems. Section 4 proposes a derivation of the dynamically consistent Jacobian inverse for non-holonomic systems. Section 5 demonstrates computational examples. The paper is concluded with Sect. 6.
2 Basic concepts
We shall study a robotic system described by generalized coordinates \(q\in Q=\mathbf R ^n\), and velocities \(\dot{q}\in T_qQ\), subject to \(l<n\) independent phase constraints in the Pfaffian form
where \(T_qQ\cong \mathbf R ^n\) denotes the tangent space to Q at q and \(\mathrm {A}(q)\) is a constraints matrix of dimension \(l\times n\) and rank l.
Our main focus will be the kinematics of the system that can be represented as a driftless control system with output function
where vector fields \(g_i(q)\) span the null space of \(\mathrm {A}(q)\), \(u\in \mathbf R ^m\), \(m=n-l\), is a control vector, and \(y\in Y= \mathbf R ^r\) denotes operational coordinates. It will be assumed that admissible control functions of (2) belong to a linear subspace of the Lebesgue square integrable functions defined on [0, T] equipped with the inner product \(<u_1(\cdot ),u_2(\cdot )> =\int _0^Tu^T_1(t)u_2(t)\mathrm{d}t\), and are such that for every the trajectory \(q(t)=\varphi _{q_0,t}(u(\cdot ))\) of (2) exists over the interval [0, T]. The initial state \(q_0\) of the system (2) and the control time horizon \(T>0\) are regarded as fixed. Following [22], the space will be called the endogenous configuration space of the robotic system.
Let , where , be a Riemannian metric on the endogenous configuration space , and \(g_Q(q):T_qQ\times T_qQ\longrightarrow \mathbf R \), \(g_Y(y):T_yY\times T_yY\longrightarrow \mathbf R \), where \(T_yY\cong \mathbf R ^r\), denote Riemannian metrics, respectively, on the configuration space and on the operational space. These metrics will be specified and exploited later on. The endpoint map
of the system (2) determines the operational space point reached from \(q_0\) at T under the action of the control function \(u(\cdot )\),
The map (3) will be identified with the kinematics of (2). The derivative of the kinematics,
\(T_{K_{q_0,T}(u(\cdot ))}Y\cong \mathbf R ^r\) being the tangent space to Y at the point \(K_{q_0,T}(u(\cdot ))\), will be referred to as the Jacobian of the robotic system. The Jacobian is determined by the linear approximation to the system (2) along the control–trajectory pair (u(t), q(t)), see [20],
initialized at \(\xi _0=0\), where \(\xi \in \mathbf R ^n\), \(v\in \mathbf R ^m\), \(w\in \mathbf R ^r\), and
Given a control , the Jacobian is computed as
where \(\varPhi (t,s)\) denotes the fundamental matrix of (5), satisfying the evolution equation
Assuming that the Jacobian (7) is known, for a prescribed operational velocity \(w\in \mathbf R ^r\), we shall solve the Jacobian equation
This equation is solvable for any w, provided that the Jacobian map is surjective, i.e. the endogenous configuration \(u(\cdot )\) is regular (non-singular). Assuming regularity of \(u(\cdot )\), a solution of (8) may be obtained by means of a right Jacobian inverse
so that \(J_{q_0,T}(u(\cdot ))J^{\#}_{q_0,T}(u(\cdot ))=I_r\).
For a non-holonomic robotic system subject to constraints (1), the dynamics equations can be derived using the Lagrangian formalism and d’Alembert’s principle. Let \(K(q,\dot{q})=\frac{1}{2}\dot{q}^TM(q)\dot{q}\) denote the kinetic energy of the unconstrained system, with the inertia matrix \(M(q)=M^T(q)>0\). In the presence of non-holonomic constraints, this inertia matrix transforms to
The matrix F(q) is symmetric and, for M(q) being positive definite and G(q) of full rank, F(q) is also positive definite.
3 Dynamically consistent Jacobian inverse for holonomic systems
The idea of the dynamically consistent Jacobian inverse is based on an assumption that the transmission of forces by the dual Jacobian inverse from the configuration to the operational space should be consistent with the system’s dynamics in the operational space. In the light of this assumption, Khatib’s approach can be reconstructed in the following way.
Suppose that there are no non-holonomic constraints (\(G(q)=I_n\)), so the system’s kinematics are described in coordinates by \(y=k(q)\), and its inertia matrix is M(q). It will be assumed that the kinematics are right invertible, so there exists a map \(l:Y\longrightarrow Q\) such that the composition \(k\circ l=id_{Y}\) equals the identity function on Y. Let \(J(q)=\hbox {D}\,k(q):T_qQ\longrightarrow T_{k(q)}Y\) denote the Jacobian, and \(J^{\#}(q):T_{y}Y\longrightarrow T_qQ\), \(y=k(q)\), be any right inverse of J(q). Having fixed this inverse, the map l(y) can be computed by a Jacobian inverse kinematics algorithm derived, e.g. on the basis of the continuation method. This derivation can be sketched as follows. Let \(q_0\) denote an initial configuration, and \(q(\theta )\in \mathbf R ^n\), \(\theta \in \mathbf R \), be a smooth curve starting from \(q(0)=q_0\). Given a desired point y in the operational space, we define an error \(e(\theta )=k(q(\theta ))-y\) and request that along the curve \(q(\theta )\) the error satisfies a differential equation
that makes the error decay exponentially with a decay rate \(\gamma >0\). After substituting for the error, we get
By using a right inverse \(J^{\#}(q)\) of the Jacobian, this equation is converted into the explicit differential equation
An often used right Jacobian inverse is the Jacobian pseudoinverse
The inertia matrix M(q) defines a Riemannian metric \(g_Q(q):T_qQ\times T_qQ\longrightarrow \mathbf R \) on Q, given as \(g_Q(q)(v_1,v_2)=v_1^TM(q)v_2\). This metric induces a pair of “musical isomorphisms” between the tangent and the cotangent space at q: the flat map \(g_Q^\flat (q):T_qQ\longrightarrow T^*_qQ\), and the sharp map \(g_Q^\sharp (q)=(g_Q^\flat )^{-1}(q):T^*_qQ\longrightarrow T_qQ\), defined as
Suppose also that there exists a Riemannian metric \(g_Y(y):T_yY\times T_yY\longrightarrow \mathbf R \) with associated isomorphisms
A specific form of \(g_Y\) will be discovered later on. The elements \(p\in T^*_qQ\) and \(r\in T^*_yY\) of cotangent spaces will be referred to as momenta and treated as covectors. Observe that the flat map results from the Legendre transformation that serves as a bridge between Lagrangian and Hamiltonian formulations of mechanics. In what follows we shall use the Riemannian metrics in order to present three methods of reconstruction of the dynamically consistent Jacobian inverse for holonomic systems.
3.1 Geometric method
By definition, the dual map to the Jacobian, \(J^*(q):T^*_{k(q)}Y\longrightarrow T^*_qQ\) and the dual map to the Jacobian inverse \(J^{\#*}(q):T^*_qQ\longrightarrow T^*_{k(q)}Y\) are such that \((J^*(q)r)v=rJ(q)v\) and \((J^{\#*}(q)p)w=pJ^{\#}(q)w\), where pv and rw denote the pairings between covectors and vectors. All these maps can be arranged into the following diagram:
An inverse \(J^{\#}(q)\) that makes this diagram commutative for a suitably defined \(g_Y(y)\) is called a dynamically consistent Jacobian inverse \(J^{\#DC}(q)\). Specifically, from commutativity of the lower left part of the diagram, it follows that
After multiplying the above identity from the left by J(q), we conclude that
In this way, the dynamically consistent Jacobian inverse is described by the matrix
The matrix \(D^{CD}(q)=J(q)M^{-1}(q)J^T(q)\) can be called a dynamically consistent dexterity matrix. Configurations q at which \(\hbox {rank}\,D^{CD}(q)\) is full are called regular, and the remaining configurations are singular. Observe that the obtained inverse does not satisfy the fourth Penrose equation [2]. It follows that the Riemannian metric on the operational space assumes the form
Alternatively, the dynamic consistency means that the momenta that live in the null space of \(J^{\#*}(q)\) should not produce any motion in Y, so the corresponding velocity in \(T_yY\) needs to vanish. In the lower right part of the diagram (16), this is tantamount to the inclusion
Since the null space of any dual right Jacobian inverse \(J^{\#*}(q)\) is spanned by \(id_{T_q^*Q}-J^*(q)J^{\#*}(q)\), in matrix form the identity (19) reads as
which yields exactly the identity (17).
3.2 Force method
So far our exposition has been purely geometric, without any reference to forces acting in the holonomic system. In order to include these forces, suppose that the system’s configuration moves along a smooth curve \(q(t)\in Q\), with instantaneous velocity \(\dot{q}(t)\) and momentum \(p(t)= \dot{q}^T(t)M(q(t))\). The corresponding operational space trajectory is \(y(t)=k(q(t))\), and the velocity in the operational space equals \(\dot{y}(t)=J(q(t))\dot{q}(t)\). As the time derivative of the momentum, the force is also a covector and belongs to the cotangent space. Thus, we compute
It is easily seen that for any right inverse of the Jacobian the cotangent space decomposes as
therefore, in matrix terms,
where \(\varGamma ^T\) is a force acting in the operational space, \(f^T_0\) acts in the configuration space. The acceleration in the operational space equals
Putting all these things together, we arrive at the following equality
In order that the force belonging to the null space of \(J^{\#*}(q)\) not affect the acceleration in the operational space, we need to have
which, again, is equivalent to (17). The decomposition formula (21) with \(J^{\#}(q)\) replaced by \(J^{\# DC}(q)\) describes a decoupling of the configuration space forces into the forces coming from the operational space, and the internal forces that affect only the motion in the configuration space.
3.3 Optimization method
Last but not least, the dynamically consistent Jacobian inverse can be obtained directly as a solution of the following constrained optimization problem
The Lagrange function
therefore \(\frac{\partial L(v, \,\lambda )}{\partial v}=0\) implies
that is tantamount to the expression (17).
4 Dynamically consistent Jacobian inverse for non-holonomic systems
Consider a non-holonomic system with the kinematics (2), the Jacobian (7), and the inertia matrix (10). As in case of the holonomic system, it will be assumed that there exists a right inverse of the kinematics, such that \( K_{q_0,T}\circ L_{q_0,T}=id_{Y}\). For a \(y=K_{q_0,T}(u(\cdot ))\), let denote a right inverse of the Jacobian. Given this right inverse, the map \(L_{q_0,T}(y)\) can be computed by a Jacobian inverse kinematics algorithm obtained by using the continuation method along the lines analogous to those taken in Sect. 3. For completeness, below we shall briefly reproduce that reasoning. Beginning with an initial endogenous configuration , we make its deformation into a smooth curve \(u_\theta (\cdot )\), where \(\theta \in \mathbf R \). Next, for a desired point y in the operational space, we define the error \(e(\theta )=K_{q_0,T}(u_\theta (\cdot ))-y\) and require that along the curve \(u_\theta (\cdot )\) the error decreases exponentially with a decay rate \(\gamma >0\), so that
Using the error definition, we write
Under the right inverse \(J^{\#}(u(\cdot ))\) of the Jacobian, this equation is transformed into a functional differential equation
The Jacobian pseudoinverse (the Moore–Penrose generalized inverse)
is a typical right inverse of the Jacobian to be plugged into (23), see [22].
The dynamically consistent Jacobian inverse will be developed by analogy to the derivation for holonomic systems, sketched in Sect. 3. We begin with the introduction of a Riemannian metric into the endogenous configuration space. Let . We define
where \({\mathscr {M}}_{q_0}(u(\cdot ))(t)=F(\varphi _{q_0,t}(u(\cdot )))\), F(q) is the inertia matrix (10), and \(q(t)=\varphi _{q_0,t}(u(\cdot ))\) denotes the trajectory of (2) subject to the control function . Given this Riemannian metric, the musical isomorphisms can be defined in the following way
where and will be called, respectively, the endogenous velocity and momentum. As in the case of the holonomic system, it is possible to define a sort of Legendre transform producing the flat isomorphism. The operational space will be equipped with a Riemannian metric \(g_Y(y)\), to be specified further on. After these preparations, the dynamically consistent Jacobian inverse can be introduced in three ways.
4.1 Geometric method
For the Jacobian (7) and its right inverse \(J^{\#}_{q_0,T}(u(\cdot ))\), we consider a pair of dual maps and , that operate in a standard way, namely
and
It follows from (27) that the dual Jacobian is determined by a matrix function
such that (27) can be formulated in terms of the inner product in the endogenous configuration space
A right Jacobian inverse will be referred to as dynamically consistent, if the following diagram of maps commutes.
Requiring commutativity of the lower left subdiagram, we obtain
A composition from the left of the above identity with \(J_{q_0,T}(u(\cdot ))\) results in
Finally, using (26), we get
or, in a more operational matrix form,
where \(w\in T_yY\). The matrix
may be referred to as a dynamically consistent dexterity (or mobility) matrix, as introduced in [26]. The endogenous configuration \(u(\cdot )\) for which \(\hbox {rank}\,{\mathscr {D}}_{q_0,T}^{DC}(u(\cdot ))=r\) is called regular; otherwise, this configuration is singular. It follows that the Riemannian metric in the operational space should be defined as
Alternatively, making use of the lower right subdiagram of (29), the dynamic consistency requires that endogenous momenta belonging to the null space of \(J^{\#*}_{q_0,T}(u(\cdot ))\) should not produce any motion in Y, i.e.
Given a right Jacobian inverse \(J^{\#}_{q_0,T}(u(\cdot ))\), the null space of \(J^{\#*}_{q_0,T}(u(\cdot ))\) is spanned by . This being so, the identity (34) implies that
from which one directly extracts (30).
4.2 Force method
We shall proceed analogously as in Sect. 3.2. Let the endogenous configuration move in along a smooth curve \(u_{\theta }(\cdot )\). Let the corresponding endogenous velocity be equal to \(\frac{\mathrm{d} u_\theta (\cdot )}{\mathrm{d}\theta }\) and the endogenous momentum \(p_\theta (\cdot )=\left( \frac{\mathrm{d} u_\theta (\cdot )}{\mathrm{d}\theta }\right) ^T{\mathscr {M}}_{q_0}(u_\theta (\cdot ))(\cdot )\). The endogenous configuration curve \(u_\theta (\cdot )\) produces an operational space curve \(y_\theta =K_{q_0,T}(u_\theta (\cdot ))\), and the velocity transformation is described by the Jacobian (7), i.e.
The endogenous force will be treated as an element of the cotangent space and can be computed as
For any right Jacobian inverse, given the dual Jacobian and the dual Jacobian inverse, we have obviously
therefore
This means that
Furthermore, if there exists \(p(\cdot )=J^*_{q_0,T}(u(\cdot ))r\in \hbox {Ker}J^{\#*}_{q_0,T}(u(\cdot ))\), then, after multiplying this equality from the left by \(J^{\#*}_{q_0,T}(u(\cdot ))\), we get \(r=0\), which produces the following decomposition of the cotangent space at \(u(\cdot )\)
This decomposition allows us to represent the endogenous force \(f_\theta (\cdot )\) as a sum
where \(\varGamma ^T\) acts in the operational space, whereas the endogenous force \(f_0^T(\cdot )\) is exerted in the endogenous configuration space. Computing from (36) the acceleration of the curve \(y_\theta \) in the operational space
we can compose the above identities into the following acceleration formula
To guarantee that the term containing \(f_0(\cdot )\) will not affect the acceleration in the operational space, we need to require that
which implies that the Jacobian inverse should be dynamically consistent (30). As in the holonomic case, after the substitution of \(J_{q_0,T}^{\# DC}(u(\cdot ))\) for \(J_{q_0,T}^{\#}(u(\cdot ))\), the decomposition formula (38) establishes a decoupling of the endogenous forces into the forces coming from the operational space, and the internal forces that affect only the motion in the endogenous configuration space.
4.3 Optimization method
Analogously to the holonomic case, the dynamically consistent Jacobian inverse for the non-holonomic system can be obtained as a solution to the following constrained optimization problem
under the equality constraint
Invoking the standard methods of the calculus of variations, we introduce the Lagrange function
where \(\lambda \in \mathbf R ^r\) stands for a vector of Lagrange multipliers, and equate its derivative with respect to \(v(\cdot )\) to 0. After the elimination of \(\lambda \) this yields
with \({\mathscr {G}}^{DC}_{q_0,T}(u(\cdot ))\) defined by (32), which is equivalent to (31). It is easily checked that the minimum value of the objective function is equal to \(w^T\left( {\mathscr {G}}^{DC}_{q_0,T}\right) ^{-1}(u(\cdot ))w\).
5 Examples
5.1 Holonomic systems
In Sect. 3.2, we have derived an operational space acceleration formula (22). Suppose that the dynamically consistent inverse (17) is used in this formula as the Jacobian inverse. Our aim will be to find an operational space force \(\varGamma \) that immobilizes the end effector. It is easily checked that this will be achieved, if
When \(\dot{y}(0)=0\), the force (40) will guarantee that \(y(t)=y(0)=const\), independently of \(f_0\). An effect of application of this force in the configuration space, thanks to the identities (20) and (21), results in
Now we take \(\dot{q}(0)=0\) (this forces \(\dot{y}(0)=0\)), and solve (41) for q(t). By the presence of \(f_0\), the joints will move, while the end effector coordinates, \(y(t)=k(q(t))=y(0)\), remain fixed. This will not be the case, if instead of the dynamically consistent inverse another Jacobian right inverse is employed.
Illustrative computations are made using a planar 3R manipulator shown in Fig. 1. For simplicity, the unit link lengths \(l_1=l_2=l_3=1\) and masses \(m_1=m_2=m_3=1\) are chosen. With these substitutions, the inertia matrix
where \(c_i\), \(c_{ij}\) denote, respectively, \(\cos q_i\) and \(\cos (q_i+q_j)\). Computations have been run for \(f_0=-1/100 (0,-9.81,0)\) and the initial conditions \(q_0=(0,\pi /3,0)\), \(\dot{q}_0=(0,0,0)\), for \(T=10\). Results are presented in Fig. 2. The end effector steered by the dynamically consistent Jacobian inverse remains at the same place, despite the joints are moving. Also, the motion under \(J^{\# DC}\) shows much more “grace”, if can be said so, than when the Jacobian pseudoinverse \(J^{\# P}\) (13) is applied.
5.2 Non-holonomic systems
By analogy to the holonomic case, we begin with the acceleration expression (39)
Under assumption that the dynamically consistent Jacobian inverse (31) has been employed, an operational space force able to immobilize the system (i.e. to get identical output \(y_\theta (T)\) for any \(\theta \)) can be computed as
It follows that, if \(\frac{d y_\theta }{d\theta }|_{\theta =0}=0\) then under the action of (42) the operational space curve \(y_\theta =y_0=const\), for any \(f_0(\cdot )\). To conclude, by combining (42) with (37) and (38) we arrive at a differential equation in the endogenous configuration space
Having solved this equation for \(u_\theta (\cdot )\) with initial condition \(\frac{\mathrm{d} u_\theta (\cdot )}{\mathrm{d}\theta }|_{\theta =0}=0\) (or any other implying \(\frac{\mathrm{d} y_\theta }{\mathrm{d}\theta }|_{\theta =0}=0\)), we find the operational space curve \(y_\theta =K_{q_0,T}(u_\theta (\cdot ))\). When the dynamically consistent Jacobian inverse is used, this curve stays constant, \(y_\theta =y_0=K_{q_0,T}(u_0(\cdot ))\); otherwise, it does not.
For computational reasons, since the Eq. (43) is defined in the infinite-dimensional endogenous configuration space, we need to introduce a finite-dimensional parametrization of control functions, e.g. using an orthogonal basis of functions in . Let the matrix P(t) contain the basic functions arranged in such a way that
where s denotes the dimension of the parametrization. Having replaced \(u(\cdot )\) by \(\lambda \), we compute the parametrized trajectory of the system (2) and the endpoint map,
as well as the Jacobian and the inertia matrix
where \(A_\lambda (t)\), \(B_\lambda (t)\), \(C_\lambda (t)\) should be computed for the parametrized control in accordance with (6). Consequently, the parametrized Riemannian metric
where \(\mu _1,\mu _2\in \mathbf R ^s\), and
This Riemannian metric generates the musical isomorphisms
Finally, in accordance with the optimization method, we minimize the quadratic form \(\mu ^T{\mathscr {R}}_{q_0,T}(\lambda )\mu \) on condition that \(\tilde{J}_{q_0,T}(\lambda )\mu =w\) and obtain the parametrized dynamically consistent Jacobian inverse in the form
where
Suppose that \(\lambda _\theta \) is a smooth curve in the parameter space \(\mathbf R ^s\), producing a curve \(u_\theta (t)=P(t)\lambda _\theta \) in the endogenous configuration space . By analogy with subsection 4.2, we introduce for the curve \(\lambda _\theta \) the parametrized operational space curve
its derivatives
as well as the parametrized momentum
and the parametrized force
Let \(\tilde{J}^{\#}_{q_0,T}(\lambda )\) denote a right inverse of the parametrized Jacobian. Then, as in (38), we have a decomposition
Using these outcomes, after suitable substitutions, we arrive at the following
In order to get \(\tilde{y}_\theta =y_0=\tilde{K}_{q_0,T}(\lambda _0)\), we use the parametrized dynamically consistent Jacobian inverse, request that
and assume that \(\frac{\mathrm{d}\lambda _\theta }{\mathrm{d}\theta }|_{\theta =0}=0\). In conclusion, a combination of (44) and (45) yields the following differential equation for \(\lambda _\theta \)
After solving (46), we get \(\tilde{y}_\theta =\tilde{K}_{q_0,T}(\lambda _\theta )\). If the parametrized dynamically consistent Jacobian inverse has been chosen, it should be \(\tilde{y}_\theta =y_0=\tilde{K}_{q_0,T}(\lambda _0)\).
We shall check this for a simplified, unicycle-type, model of the Pioneer 2DX mobile robot, moving without a lateral slip of the wheels, shown schematically in Fig. 3. The vector of generalized coordinates \(q=(x,y,\theta )\). The robot’s mass \(m=8.67\), the moment of inertia with respect to the Z-axis, \(I=0.256\), the distance between driving wheels \(2l=0.326\). The non-holonomic inertia matrix (10) is constant, \(F(q)=diag\{m,\,I\}\). The control functions are chosen in the form of the trigonometric series with nine terms for every input. The initial state \(q_0=(1,0,\pi /4)\), the control horizon \(T=5\). The initial control is set to \(\lambda _0=(1,0,0.5,0_{1\times 6},0.5,0_{1\times 8})\in \mathbf R ^{18}\). The internal force \(f_0=(0,0,1,0_{1\times 8},0.1,0,1,0_{1\times 4})\in \mathbf R ^{18}\). Results of computations are shown in Fig. 4. Driven by the dynamically consistent Jacobian inverse the Pioneer for consecutive \(\theta \) reaches the same final position and orientation, despite the existence of the force \(f_0\). It can be noticed that this does not happen in case of the Jacobian pseudoinverse (24).
In order to further demonstrate the performance of a non-holonomic system driven by the dynamically consistent Jacobian inverse, we shall solve an example motion planning problem for the rolling ball, using the dynamically consistent inverse \(J_{q_0,T}^{\# DC}\) and the Jacobian pseudoinverse \(J_{q_0,T}^{\# P}\). The ball is shown in Fig. 5. Its coordinate vector \(q=(x,y,\varphi ,\theta ,\psi )\) consists of the Cartesian coordinates of the contact point with respect to the external frame, spherical coordinates of this point with respect to the ball frame, and the ball orientation angle. The ball has the unit mass \(m=1\), the radius \(R=0.1\), and the inertia \(I=\frac{2}{5}mR^2\). The kinematics of the rolling ball are represented by the driftless control system (2) with the control matrix
\(s_i\), \(c_j\) standing for \(\sin q_i\) and \(\cos q_j\), and the output function \(k(q)=(q_1,q_2,q_5)\). The non-holonomic inertia matrix \(F(q)=(I+mR^2)diag\{s^2_4,1\}\). The motion planning problem consists in the ball reaching the position and orientation \(y_d=(1,0,-\frac{\pi }{2})\) in time \(T=5\). The control functions are assumed trigonometric, containing up to third-order harmonics. The initial state of the ball is assumed \(q_0=(0,0,0,\frac{\pi }{4},\frac{\pi }{2})\), the initial control coefficients \(\lambda _0=(5,0_{1\times 6},0.1,0_{1\times 6})\in R^{14}\), and \(\gamma =0.02.\) Figure 6 shows the solutions of this problem provided by the dynamically consistent Jacobian inverse and the Jacobian pseudoinverse. The computations have been run until the error in the operational space drops below \(10^{-4}\). The knot in the loop appearing on the path produced by \(J_{q_0,T}^{\# P}\) corresponds to the rolling through the north pole (\(q_4=\theta =0\)) that is a representation singularity of the ball, where the spherical coordinates as well the inertia matrix become singular. The introduction of \(J_{q_0,T}^{\# DC}\) avoids this kind of motion.
6 Conclusion
Within the framework of the endogenous configuration space approach, we have extended the concept of the dynamically consistent Jacobian inverse from holonomic to non-holonomic robotic systems. This new inverse has been built around a Riemannian metric in the configuration space and founded on a conceptual analogy between holonomic and non-holonomic systems. The dynamically consistent Jacobian inverse has been applied to solve a motion planning problem for the rolling ball. Further research needs to be conducted towards using this inverse to the force control problems in non-holonomic systems.
References
Abraham, R., Marsden, J.E.: Foundations of Mechanics. Benjamin, Reading (1985)
Ben-Israel, A., Greville, T.N.E.: Generalized Inverses. Springer, New York (2003)
Bloch, A.M.: Nonholonomic Mechanics and Control. Springer, New York (2003)
Brock, O., Khatib, O., Viji, S.: Task-consistent obstacle avoidance and motion behavior for mobile manipulation. In: Proceedings of IEEE International Conference on Robotics and Automation, pp. 388–393 (2002)
Bruyninckx, H., Khatib, O.: Gauss principle and the dynamics of redundant and constrained manipulators. In: Proceedings of IEEE International Conference on Robotics and Automation, pp. 2563–2568 (2000)
Demircan, E., Besier, T.F., Khatib, O.: Muscle force transmission to operational space accelerations during elite golf swings. In: Proceedings of IEEE International Conference on Robotics and Automation, pp. 1464–1469 (2012)
Demircan, E., Sentis, L., Sapio, V.D., Khatib, O.: Advances in Robot Kinematics: Motion in Man and Machine, Chap. Human Motion Reconstruction and Synthesis of Human Skills, pp. 283–292. Springer, Berlin (2010)
Featherstone, R., Khatib, O.: Load independence of the dynamically consistent inverse of the jacobian matrix. Int. J. Robot. Res. 16(2), 168–170 (1997)
Holm, D.D., Schmah, T., Stoica, C.: Geometric Mechanics and Symmetry: From Finite to Infinite Dimensions. Oxford University Press, Oxford (2009)
Kazerounian, K., Wang, Z.R.: Global versus local optimization in redundancy resolution of robotic manipulators. Int. J. Robot. Res. 7(5), 3–12 (1988)
Khatib, O.: Motion/force redundancy of manipulators. In: 1990 Japan-USA Symposium on Flexible Automation, pp. 337–342 (1990)
Khatib, O.: Inertial properties in robotics manipulation: an object-level framework. Int. J. Robot. Res. 14(1), 19–36 (1995)
Khatib, O., Sentis, L., Park, J., Warren, J.: Whole-body dynamic behavior and control of human-like robots. Int. J. Humanoid Robot. 1(1), 29–43 (2004)
Marsden, J.E., Ratiu, T.S.: Introduction to Mechanics and Symmetry. Springer, Berlin (1999)
Nakanishi, J., Cory, R., Mistry, M., Peters, J., Schaal, S.: Operational space control: a theoretical and empirical comparison. Int. J. Robot. Res. 27(6), 737–757 (2008)
Padois, V., Fourquet, J.Y., Chiron, P.: Kinematic and dynamic model-based control of wheeled mobile manipulators: a unified framework for reactive approaches. Robotica 25(2), 157–173 (2007)
Ratajczak, J., Tchoń, K.: Dynamically consistent Jacobian inverse for mobile manipulators. Int. J. Control (2015). doi:10.1080/00207179.2015.1124144
Ratajczak, J., Tchoń, K.: Nonholonomic motion planning using dynamically consistent Jacobian inverse. In: Proceedings of IMA Conference on Mathematics of Robotics. University of Oxford (2015)
Sentis, L., Park, J., Khatib, O.: Compliant control of multicontact and center-of-mass behaviors in humanoid robots. IEEE Trans. Robot. 26(3), 483–501 (2010)
Sontag, E.D.: Mathematical Control Theory. Springer, New York (1990)
Sussmann, H.J.: A continuation method for non-holonomic path finding problems. In: Proceedings of 32nd IEEE Control and Decision Conference, pp. 2718–2723 (1993)
Tchoń, K., Jakubiak, J.: Endogenous configuration space approach to mobile manipulators: a derivation and performance assessment of Jacobian inverse kinematics algorithms. Int. J. Control 76(9), 1387–1419 (2003)
Tchoń, K., Muszyński, R.: Instantaneous kinematics and dexterity of mobile manipulators. In: Proceedings of IEEE International Conference on Robotics and Automation, pp. 2493–2498 (2000)
Ważewski, T.: Surl evaluation du domaine dexistence des fonctions implicites reelles ou complexes. Ann. Soc. Pol. Math. 20(9), 81–120 (1947)
White, G.D., Bhatt, R.M., Krovi, V.N.: Dynamic redundancy resolution in a nonholonomic wheeled mobile manipulator. Robotica 25(2), 147–156 (2007)
Zadarnowska, K., Tchoń, K.: A control theory framework for performance evaluation of mobile manipulators. Robotica 25(6), 703–715 (2007)
Acknowledgments
The authors are very much indebted to anonymous reviewers whose comments and suggestions allowed them to improve both the content and the presentation of this paper.
Author information
Authors and Affiliations
Corresponding author
Additional information
This research was supported by the National Science Centre, Poland, under the Grant Decision No. DEC-2013/09/B/ST7/02368.
Rights and permissions
Open Access This article is distributed under the terms of the Creative Commons Attribution 4.0 International License (http://creativecommons.org/licenses/by/4.0/), which permits unrestricted use, distribution, and reproduction in any medium, provided you give appropriate credit to the original author(s) and the source, provide a link to the Creative Commons license, and indicate if changes were made.
About this article
Cite this article
Tchoń, K., Ratajczak, J. Dynamically consistent Jacobian inverse for non-holonomic robotic systems. Nonlinear Dyn 85, 107–122 (2016). https://doi.org/10.1007/s11071-016-2672-x
Received:
Accepted:
Published:
Issue Date:
DOI: https://doi.org/10.1007/s11071-016-2672-x