Refactoring into function

comment out collision handler, move stuff into functions
Another attempt at a ray tracing solution

Try looping to find collisions or something.
Really laggy. Would revert