Page 272 - Autonomous Mobile Robots
P. 272

258                                    Autonomous Mobile Robots

                                In addition, the kinematic model (6.5) of the nonholonomic systems in terms
                                of linear velocity v and angular velocity ω can be written as

                                                                           
                                                          ˙ x c  cos θ  −L sin θ
                                            v     ˙ z 1                          v
                                                         
                                                               
                                       ˙ z =   =     ,  ˙y c = sin θ                  (6.91)
                                            ω     ˙ z 2                 L cos θ   ω
                                                          ˙ θ     0       1
                                The desired manifold   nhd is chosen as

                                            nhd ={(q, ˙q, λ)|z(t) = z d (t), ˙q = S(q)˙z d (t), λ = λ d }

                                with z d =˙z d = 0, λ d = 10.
                                   The existence of sgn-function in the controller (6.34) may inevitably lead
                                to chattering in control torques. To avoid such a phenomenon, a sat-function is
                                used to replace the sgn-function. The sat-function is given by

                                                              1   if σ>
                                                            
                                                            
                                                            
                                                            
                                                              −1  if σ< −
                                                    sat(σ) =
                                                            1
                                                            
                                                               σ  otherwise
                                                            

                                where   = 0.01 and K s = 5 are chosen in the simulation.
                                   The simulation is carried out using NF networks which are essentially the
                                TSK-type fuzzy system with its membership function being chosen as the
                                Gaussian function. Each element of the unknown system matrices M(q) and
                                C(q, ˙q) is modeled by the NF networks, which makes it different from con-
                                ventional adaptive control design, where a relatively large amount of a prior
                                knowledge about the system dynamics and the linear parametrization condition
                                are required. The proposed adaptive NF controller, on the other hand, can be
                                treated as an indirect adaptive scheme or partitioned NF systems [29,45], and
                                doesnotrequireanypreciseknowledgeonthesystemdynamics. Theparameters
                                in each NF subsystem can be separately tuned, which yield a faster updating
                                speed, as can be seen from the simulation results.
                                   In the simulation, the parameters of the system are taken as: m = 10 kg,
                                            2
                                I = 5 kgm , R 1 = 0.05 m, R 2 = 0.5 m, L = 0.4 m, τ d (t) =
                                                         T                          T
                                [0.5 sin t, 0.1 sin t, 0.2 cos t] , q(0) =[2.0, 0.5, 0.785] , ˙q(0) =
                                           T
                                [0.2, 0.2, 0] , and ρ 1 = diag(5, 5), ρ 2 = 1, ρ 3 = 10. The control gain K σ
                                and force control gain K λ are selected as K σ = diag(1, 1), K λ = 1. The
                                                                                          , with
                                neural weights adaptation gains are chosen as   M = 0.1I N 1  ,   C = 0.1I N 2
                                N 1 = 100 and N 2 = 200 being the number of rules of the NF system to estimate
                                matrices M and C, respectively.



                                 © 2006 by Taylor & Francis Group, LLC



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