correcte the dynamic filter, add precision to it in the SPPQ solver, take form the urdf the vector from the waist to the left and right hip respectively