Introduction
Quintic splines are a common path parametrization in robotics. A quintic polynomial is a 5th order polynomial. Each dimension is represented as a quintic polynomial. The coefficients and can be solved for provided we give the robot's start position, velocity and acceleration (, , ) as well as the end position, velocity and acceleration (, , ); these are also known the boundary conditions.
Issues
There are discontinuities in the curvature parametrization of quintic splines, which makes the curvature hard to constrain. From the equation of curvature below, we can see that the denominator of the equation could be undefined.
Solving the Equation
Let us consider only . We can solve for provided that we are given the start position, velocity and acceleration (, , ) as well as the end position, velocity and acceleration (, , ); these are also known the boundary conditions of 's zeroth, first and second derivative.
First derivative:
Second derivative:
Using our initial boundary conditions for we can easily solve for , , .
Now lets solve for , , using our boundary conditions of .
Eqn 1:
Eqn 2:
Eqn 3:
Since we have already solved for , , , we can rearrange (1), (2) and (3) to have all of our unknowns on the left and known variables on the right side of the equality.
Eqn 1:
Eqn 2:
Eqn 3:
The three equations above can now be conveniently factored into a system of linear equations .
Since our A matrix will be invertible and we can solve for , , using .