I am working on motion planning algorithm for quadrotor. As I have learned in Coursera Aerial robotics course, trajectories for quadrotors should minimize snap which is equivalent to interpolating waypoints with 7th degree polynomial. It's not very hard to interpolate them. However I am not sure how to make trajectory satisfy constraints on maximum velocity and acceleration. I am aware of parametrization and temporal scaling but in order to satisfy constraints it is necessary to find maximum velocity and acceleration achieved in planned trajectory. Unfortunately if function of position is 7th degree polynomial then velocity is a function of 6th degree polynomial and it would be necessary to find roots of 5th degree polynomials in order to find critical points in velocity function. The only method, I am aware of, which can solve the problem is based on computing eigenvalues of a companion matrix and it is iterative. Personally I do not like any iterative methods in run time.
Based on what is said in the above I have several questions:
1. Is it okay to solve polynomials equations with described method in run time? Especially if fast trajectory re-planning is required?
2. Maybe there is a way not to strictly satisfy the constraints but give some bounds on the planning results? Like in 95 percent trajectory will be fine and in other 5 percent it is possible to re-plan it when out of bound constraint is detected.
3. Will it make a big difference if I interpolate waypoints with 3d order polynomials instead of 7th? In case of 3d order polynomials problem of searching for critical points for velocity and acceleration becomes a trivial task.
4. Maybe there is totally another way of dealing with trajectories which exceeds bound on maximum velocity and acceleration?