Vectorizes raycasting code and adds test code for it.
Merge pull request #6 from andybarry/quadrotorFun

Vectorizes raycasting code