Page 283 - Autonomous Mobile Robots
P. 283

270                                    Autonomous Mobile Robots

                                matrix, K N ∈ R r×r  is a positive definite diagonal matrix which character-
                                izes the electromechanical conversion between current and torque, I denotes
                                an r-element vector of armature current, J(q) ∈ R (n−m)×n  is the matrix
                                associated with the constraint, and λ ∈ R n−m  is the vector of constraint
                                forces. The terms L = diag[L 1 , L 2 , L 3 , ... , L r ], R = diag[R 1 , R 2 , R 3 , ... , R r ],
                                                                               T
                                                                                          r
                                K a = diag[K a1 , K a2 , K a3 , ... , K ar ], ω =[ω 1 , ω 2 , ... , ω r ] , and ν ∈ R rep-
                                resent the equivalent armature inductances, resistances, back emf constants,
                                angular velocities of the driving motors, and the control input voltage vector,
                                respectively. Constraint 7.1 is assumed to be completely nonholonomic for all
                                      n
                                q ∈
 and t ∈
. To completely actuate the nonholonomic system, B(q) is
                                assumed to be a full-rank matrix and r ≥ m.
                                   Dynamic subsystem (7.2) has the following properties [31,32]:

                                Property 7.1 There exists a so-called inertial parameter p and vector θ with
                                components depending on the mechanical parameters (mass, moment of inertia,
                                etc.,) such that

                                               M(q)˙v + C(q, ˙q)v + G(q) =  (q, ˙q, v, ˙v)θ  (7.4)

                                where   is a matrix of known functions of q, ˙q, v, and ˙v; and θ is a vector of
                                inertia parameters and assumed completely unknown in this chapter.

                                              ˙
                                Property 7.2  M − 2C is skew-symmetric.
                                                                              T
                                                                                    T
                                   If matrix N ∈ R n×n  is skew-symmetric, then N =−N and Y NY = 0 for
                                        n
                                all Y ∈ R .
                                   Since J(q) ∈ R (n−m)×n , it is always realizable to find an m rank matrix
                                S(q) ∈ R n×m  formed by a set of smooth and linearly independent vector fields
                                spanning the null space of J(q), that is,
                                                               T
                                                          T
                                                         S (q)J (q) = 0                    (7.5)
                                Since S(q) =[s 1 (q), ... , s m (q)] is formed by a set of smooth and linearly
                                independent vector fields spanning the null space of J(q), define an auxiliary
                                                         T
                                                             m
                                time function v =[v 1 , ... , v m ] ∈ R such that
                                               ˙ q = S(q)v(t) = s 1 (q)v 1 + ··· + s m (q)v m  (7.6)

                                Equation (7.6) is the so-called kinematic model of nonholonomic systems in
                                the literature.
                                   Differentiating Equation (7.6) yields

                                                            ˙
                                                        ¨ q = S(q)v + S(q)˙v               (7.7)



                                 © 2006 by Taylor & Francis Group, LLC



                                 FRANKL: “dk6033_c007” — 2006/3/31 — 16:43 — page 270 — #4
   278   279   280   281   282   283   284   285   286   287   288