scurve trajectory planner

Arciera is hard working to try out new non-linear solvers

I'm afraid that is a bit of an overstatement, I have no experience with this and also not really the time to poke around in dark any longer. This requires somebody who actually knows what they are doing, at least somewhat.

What is needed is a robust numerical solver and then the next step is the max error fitting described in the paper.