Add script to add end effector frames to urdf from yaml file for euslisp