Whole-body end-effector pose tracking