I am trying to add an safety stop in case there is an obstacle