Added castRay functionality

- You can now see if there is something in the way.
- Moved isPath to public and added a getWaypoints function.