Navigation algorithm for bot

started navigation algorithm for following a wall