quadratic programming path planning

This is a rudimentary method of path generation