Page 237 -
P. 237

220                                       Computed-Torque Control































            Figure 4.4.15: PD classical joint control: k v =100, k p =2500, k i =1000.



              Adding the gravity terms in the control law, therefore, significantly increases
              the tracking performance.
                 The associated control torques are shown in Figure 4.4.14.


              b. PID Independent Joint Control
              PID independent joint control for the two-link arm is


                                                                          (3)

              This simple law is easily implemented by adding two states, x(5) and x(6),
              to subroutine arm(x, xp) in Figure 4.4.2 to account for the integrators (see
              Example 4.4.2).
                 The simulation in Figure 4.4.13(c) was repeated, but now adding an
              integral gain of k i=1000. The result is shown in Figure 4.4.15. After several
              iterations of the sinusoidal motion, the do value of the tracking errors goes
              to zero, so that the performance is much improved. That is, adding an
              integral term can compensate for neglecting the gravity terms in the control






            Copyright © 2004 by Marcel Dekker, Inc.
   232   233   234   235   236   237   238   239   240   241   242