Gettings ray casting and intersection testing done
Partially workign