uploading urdf file to parameter server is now possible through c++
fixed foot position according to half-step-format-3.0