FIR filters for online trajectory planning with time- and frequency-domain specifications

摘要

In this paper, the use of FIR (Finite Impulse Response) filters for planning minimum-time trajectories for robots or automatic machines under constraints of velocity, acceleration, etc. is presented and discussed. In particular, the relationship between multi-segment polynomial trajectories, i.e. trajectories composed of several polynomial segments, each one possibly characterized by constraints on one or more specific derivatives (i.e. velocity, acceleration, jerk, etc.), and FIR filters disposed in a cascade configuration is demonstrated and exploited in order to design a digital filter for online trajectory planning. The connection between analytic functions and dynamic filters allows a generalization of these trajectories, usually obtained by second- or third-order polynomial functions (e.g. trapezoidal velocity and double S velocity trajectories), to a generic order with only a modest increase of the complexity. As a matter of fact, the computation of trajectories with higher degree of continuity simply requires additional FIR filters in the chain. Moreover, the modular structure of the planner provides a direct frequency characterization of the motion law. In this way, it is possible to define the trajectories by considering constraints expressed in the frequency-domain besides the classical time-domain specifications, such as bounds on velocity, acceleration, and so on. Two examples illustrate the main features of the proposed trajectory planner, in particular with respect to the problems of multi-point trajectories generation and residual vibrations suppression.