Point detection fix

The branch is meant to fix issue #4 where the system would freeze after ray casting was done.