Page 164 -
P. 164

146                                                Robot Dynamics

            nonlinearities. It is a simplified version of the feedback linearization technique
            in [Hunt et al. 1983, Gilbert and Ha 1984]. See also [Kreutz 1989].
                                                         n
              The robot dynamics are given by (3.4.2) with q   R  Let us define a general
            sort of output by

                                                                      (3.4.24)

                                                                     n
            with h(q) a general predetermined function of the joint variable q   R and s(t)
            a general predetermined time function. The control problem, then, will be to
            select the joint torque and force inputs τ(t) in order to make the output y(t) go
            to zero.
              The selection of h(q) and s(t) is based on the control objectives we have in
            mind. For instance, if h(q)=-q and s(t)=q d(t), the desired joint space trajectory
            we would like the arm to follow, then y(t)=q d(t)-q(t)=e(t) the joint space tracking
            error. Forcing y(t) to zero in this case would cause the joint variables q(t) to
            track their desired values q d(t), resulting in arm trajectory following.
              As another example,              could represent the Cartesian space
                                                              3
            tracking error, with      the position error and e 0   R  the orientation
            error. Controlling y(t) to zero would then result in trajectory following directly
            in Cartesian space, which is, after all, where the desired motion is usually
            specified.
              Finally, -h(q) could represent the nonlinear transformation to a camera
            frame of reference and s(t) the desired trajectory in that frame. Then y(t) is the
            camera frame tracking error. Forcing y(t) to zero would then result in tracking
            motion in camera space.

            Feedback Linearizing Transformation. To determine a linear state-variable
            model for robot controller design, let us simply differentiate the output y(t)
            twice to obtain


                                                                      (3.4.25)




                                                                      (3.4.26)

            where we have defined the Jacobian


                                                                      (3.4.27)


                    p
              If y   R , the Jacobian is a p×n matrix of the form


            Copyright © 2004 by Marcel Dekker, Inc.
   159   160   161   162   163   164   165   166   167   168   169