commiting just for the readme, will make the missing ocp tests next, and then refactor path planning mpcs to simultaneouly support fixed paths and paths from a path planner
