A general framework for solving inverse dynamics problems in multi-axis motion control.

An inverse dynamics compensation (IDC) scheme for the execution of curvilinear paths by multi-axis motion controllers is proposed. For a path specified by a parametric curve r(ξ), the IDC scheme computes a real-time path correction Δr(ξ) that (theoretically) eliminates path deviations incurred by the inertia and damping of the machine axes. To exploit the linear time-invariant nature of the dynamic equations, the correction term is computed as a function of elapsed time t, and the corresponding curve parameter values ξ are only determined as the final step of the IDC scheme, through a real-time interpolator algorithm. It is shown that, in general, the correction term for P, PI, and PID controllers consists of derivative, natural, and integral terms (the integrand of the latter involving only the path r(ξ), and not its derivatives). The use of lead segments to minimize transient effects associated with the initial conditions is also discussed, and the performance of the method is illustrated by simulation results. The IDC scheme is expressed in terms of a linear differential operator formalism to provide a clear, general, and systematic development, amenable to further adaptations and extensions

Path planning with PH G2 splines in R2

International audienceIn this article, we justify the use of parametric planar Pythagorean Hodograph spline curves in path planning. The elegant properties of such splines enable us to design an efficient interpolator algorithm, more precise than the classical Taylor interpolators and faster than an interpolator based on arc length computations

Optimization of Corner Blending Curves

The blending or filleting of sharp corners is a common requirement in geometric design applications — motivated by aesthetic, ergonomic, kinematic, or mechanical stress considerations. Corner blending curves are usually required to exhibit a specified order of geometric continuity with the segments they connect, and to satisfy specific constraints on their curvature profiles and the extremum deviation from the original corner. The free parameters of polynomial corner curves of degree ≤6 and continuity up to G3 are exploited to solve a convex optimization problem, that minimizes a weighted sum of dimensionless measures of the mid-point curvature, maximum deviation, and the uniformity of parametric speed. It is found that large mid-point curvature weights result in undesirable bimodal curvature profiles, but emphasizing the parametric speed uniformity typically yields good corner shapes (since the curvature is strongly dependent upon parametric speed variation). A constrained optimization problem, wherein a particular value of the corner curve deviation is specified, is also addressed. Finally, the shape of Pythagorean-hodograph corner curves is compared with that of the optimized “ordinary” polynomial corner curves

Smooth path planning with Pythagorean-hodoghraph spline curves geometric design and motion control

This thesis addresses two significative problems regarding autonomous systems, namely path and trajectory planning. Path planning deals with finding a suitable path from a start to a goal position by exploiting a given representation of the environment. Trajectory planning schemes govern the motion along the path by generating appropriate reference (path) points. We propose a two-step approach for the construction of planar smooth collision-free navigation paths. Obstacle avoidance techniques that rely on classical data structures are initially considered for the identification of piecewise linear paths that do not intersect with the obstacles of a given scenario. In the second step of the scheme we rely on spline interpolation algorithms with tension parameters to provide a smooth planar control strategy. In particular, we consider Pythagorean\u2013hodograph (PH) curves, since they provide an exact computation of fundamental geometric quantities. The vertices of the previously produced piecewise linear paths are interpolated by using a G1 or G2 interpolation scheme with tension based on PH splines. In both cases, a strategy based on the asymptotic analysis of the interpolation scheme is developed in order to get an automatic selection of the tension parameters. To completely describe the motion along the path we present a configurable trajectory planning strategy for the offline definition of time-dependent C2 piece-wise quintic feedrates. When PH spline curves are considered, the corresponding accurate and efficient CNC interpolator algorithms can be exploited

Arc lengths of rational Pythagorean–hodograph curves

In a recent paper (Lee et al., 2014) a family of rational Pythagorean-hodograph (PH) curves is introduced, characterized by constraints on the coefficients of a truncated Laurent series, and used to solve the first-order Hermite interpolation problem. Contrary to a claim made in this paper, it is shown that these rational PH curves have rational arc length functions only in degenerate cases, where the center of the Laurent series is a real value

Smooth path planning with Pythagorean-hodoghraph spline curves geometric design and motion control

This thesis addresses two significative problems regarding autonomous systems, namely path and trajectory planning. Path planning deals with finding a suitable path from a start to a goal position by exploiting a given representation of the environment. Trajectory planning schemes govern the motion along the path by generating appropriate reference (path) points. We propose a two-step approach for the construction of planar smooth collision-free navigation paths. Obstacle avoidance techniques that rely on classical data structures are initially considered for the identification of piecewise linear paths that do not intersect with the obstacles of a given scenario. In the second step of the scheme we rely on spline interpolation algorithms with tension parameters to provide a smooth planar control strategy. In particular, we consider Pythagorean–hodograph (PH) curves, since they provide an exact computation of fundamental geometric quantities. The vertices of the previously produced piecewise linear paths are interpolated by using a G1 or G2 interpolation scheme with tension based on PH splines. In both cases, a strategy based on the asymptotic analysis of the interpolation scheme is developed in order to get an automatic selection of the tension parameters. To completely describe the motion along the path we present a configurable trajectory planning strategy for the offline definition of time-dependent C2 piece-wise quintic feedrates. When PH spline curves are considered, the corresponding accurate and efficient CNC interpolator algorithms can be exploited

Real-time CNC interpolators for precision machining of complex shapes with Pythagorean -hodograph curves.

Computer numerical control (CNC) machining is the prevalent means for precision fabrication of mechanical parts. CNC systems have traditionally employed real-time interpolators that can only interpret piece-wise linear/circular (G code) tool paths: free-form geometry must be approximated by many short linear/circular segments before being downloaded to the CNC system. Such G code approximations can seriously degrade the ability of the controller to accurately realize rapid and smooth tool motions, especially in the high-speed machining of complex shapes. The restriction to piecewise-linear/circular tool paths stems from the impossibility of exact real-time computation of reference points along general curved paths, traversed according to prescribed federate functions. Many researchers have proposed approximate interpolators for free-form parametric curves. However, only the interpolators for Pythagorean-hodograph (PH) curves offer essentially exact real-time computation of reference points at constant or varying feedrates. In this thesis, new algorithms for PH curve CNC interpolators, are developed and tested empirically on an open-architecture 3-axis CNC milling machine. The proposed new methods include (i) least-squares approximations of existing G code part programs by PH curves; (ii) physical-constraints feedrate analysis, to determine feedrates and feed accelerations within the torque and power capacity of the drives; (iii) algorithms for general time-dependent feedrates along PH curves; and (iv) variable-feedrate interpolators for general Bezier curves, based on Taylor expansions. These techniques comprise a comprehensive software library that offers powerful motion planning capability, and the accurate and smooth realization of rapid tool motions. The methods have been verified by extensive experiments that compare the relative performance of G code and PH curve interpolators. Adoption of these methods can have a significant impact on the accuracy, reliability, and flexibility of high-speed machining applications.Ph.D.Applied SciencesMechanical engineeringUniversity of Michigan, Horace H. Rackham School of Graduate Studieshttp://deepblue.lib.umich.edu/bitstream/2027.42/132700/2/9977274.pd