Todo List
Class CLFQP
implement the CLF-QP controller
Member ContinuousDynamics.calcDriftVector (x, dx)
This calculation is slow due to multiple function invoke. Better ideas to improve the speed?
Member TrajectoryOptimization.addCollocationConstraint ()
implement pseudospectral method