Human Gik work
Work on faster STOMP
Merge branch 'develop_jim' of github.com:jmainpri/libmove3d-planners into develop_jim