Mobile Robots. Feitian Zhang

Чтение книги онлайн.

Читать онлайн книгу Mobile Robots - Feitian Zhang страница 11

Mobile Robots - Feitian Zhang

Скачать книгу

href="#fb3_img_img_5e5b1d4b-e2cc-5b38-99ed-1d3ee3a4eee8.png" alt="equation"/>

      This form of the equations is quite simple; however, it should be noted that these equations are nonlinear. Also see Dudek and Jenkin.

      Now if we wish to take into account the fact that steering angle and velocity cannot change instantaneously, we may define the derivatives or rates of these variables as control signals, i.e.,

      (1.5a)

      and

      (1.5b)

      The system of equations for this model is now fifth order. The equations provide the correct kinematic relationships among the variables for motion and rotation in the xy plane but do not include the complexity of suspension or motor dynamics. Also not included in this model are robot pitch and roll.

      It may be desirable to form a discrete‐time model from these equations. This would be useful for discrete‐time simulation as well as other applications. Clearly these equations are nonlinear. Therefore, the methods used for converting a linear continuous‐time system to a discrete‐time representation are not applicable. One approach is to use the Euler integration method. This method is a first‐order, Taylor‐series approximation to integration and says that the derivative may be approximated by a finite difference

      Setting t = kT and the sampling interval Δt = T and applying this to the above equations we have

      (1.6a)

      (1.6b)

      (1.6c)

      (1.6d)

      and

      (1.6e)

      Here the sampling interval T must be chosen to be sufficiently small depending on the dynamics of the original differential equations, i.e., the behavior of the discrete‐time model must match up with that of the original system. For a linear system, this corresponds to selecting the sampling interval to be approximately one‐fifth of the smallest time constant of the system or smaller depending on the degree of precision required. For nonlinear systems, it may be necessary to determine this limiting size empirically. This discrete‐time model may be used for analysis, control design, estimator design, and simulation.

      It should be noted that more sophisticated and more robust methods exist for converting continuous‐time dynamic system models to discrete‐time models. For more information on this topic the reader is referred to Digital Simulation of Dynamic Systems by Hartley, Beale and Chicatelli.

      From time to time, it will be convenient to interpret speed expressed in various units. For this reason the following equalities are presented.

      (1.7a)

      and

      (1.7b)

      Now subtracting the two above equations yields

      so we obtain for the angular rate of the robot

      (1.8)

      Solving for the instantaneous radius of curvature, we have:

      or finally

      (1.9)

      This results in the expression for velocity along the robot's longitudinal axis:

      In summary, the equations of motion in robot coordinates are:

      (1.10a)

      (1.10b)

      and

      (1.10c)

      If we convert to earth coordinates these become:

      (1.11a)

Скачать книгу