Updates added to allow collision detection for a second robot in the environment