debug the inverse kinematic, the parsing of the upperbody in the dynamic filter and the zmpmb computation