fixed the velocity bounds (missed to update them in ocp). initialization for path following does not work, am trying to fix it now. ikocp by self runs fine, but when run inside pathfollowing to start it, it refuses cooperation
