Documented code and added a method to check for an obstacle for later time optimization.