test
New config and zmp
Merge branch 'final' of https://github.com/mtiudaeu/RobotFoot into final