Start and Goal detection

updated small.jpg
created  function goal()