Page 271 - Autonomous Mobile Robots
P. 271

Adaptive Neural-Fuzzy Control of Mobile Robots             257

                              model can be expressed in the matrix form (6.1) with


                                         m         0       mL sin θ
                                                                 
                                         0         m      −mL cos θ
                                                                 
                              M(q) = 
                                       mL sin θ  −mL cos θ    I

                                        0  0  mL ˙ θ cos θ                      cos θ  cos θ
                                                                                       
                              C(q, ˙q) = 0  0  mL ˙ θ sin θ  ,  G(q) = 0,  B(q) =  1   sin θ 
                                                                              sin θ
                                                      
                                       
                                                                                          
                                                                            R 1
                                        0  0      0                              R 2  −R 2
                                                                                       (6.87)
                                              T
                                                    3
                              where q =[x c y c θ] ∈ R is the generalized coordinate with (x c , y c ) being
                              the coordinates of the center of mass of the vehicle, and θ being the orientation
                                                                             T
                                                                                  2
                              angle of the vehicle with respect to the X-axis, τ =[τ r τ l ] ∈ R is the input
                              vector with τ r and τ l being the torques provided by the motors mounted on the
                              right and left respectively, m is the mass of the vehicle, I is its inertial moment
                              around the vertical axis at the center of mass, L denotes the distance between
                              the mid-distance of the rear wheels to the center of mass, 2R 1 denotes the radius
                              of the rear wheels, and 2R 2 is the distance between the two rear wheels. The
                                                   T
                              constraint forces are f = J (q)λ.
                                 The nonholonomic constraints confine the vehicle to move only in the direc-
                              tion normal to the axis of the driving wheels, that is, the mobile bases satisfying
                              the conditions of pure rolling and nonslipping


                                                  ˙ x c sin θ −˙y c cos θ + L ˙ θ = 0  (6.88)


                              From (6.88), it is known that J(q) and R(q) are in the form

                                                                             
                                                  sin θ            cos θ  −L sin θ
                                         T
                                        J (q) = − cos θ ,  R(q) = sin θ  L cos θ   (6.89)
                                               
                                                                                
                                                       
                                                                  
                                                   L                 0      1
                                                                      T
                              Thus, the constraint forces can be written as f = J (q)λ with

                                               λ = m¨x c sin θ − m¨y c cos θ + mL ¨ θ  (6.90)




                              © 2006 by Taylor & Francis Group, LLC



                                FRANKL: “dk6033_c006” — 2006/3/31 — 16:42 — page 257 — #29
   266   267   268   269   270   271   272   273   274   275   276