Fixes on smoothness feature
Add new variables for features factor
Now stomp optimizes integral of cost
Can now load motions
Change smoothness computation in stomp and add load from file in Move3d trajectory
Fix integral cost in stomp for IOC
First working IOC
Merge Jim
Add visbility feature
Clean up muskuloskeletal
Fix motion recorder import and play
Fixes velocity calculation
Can now load only left human files and draw module is on demand
Small warning fix
Can play motion vector
Commit before pulling develop_jim
Merge branch 'develop_jim' of github.com:jmainpri/libmove3d-planners into develop_rafi
Now can load workspace occupancy from file