adding singularity escaper, making cart controllers more robust to different joint types on config