Add script to add sensor (fixed link) to urdf