fixed offset for 0,0,0 origin of HRP2
fixed half sitting pos
Merge branch 'master' of github.com:orthez/feasibility