Fleshed out sweepandprune collision system

Horribly broken though. But it runs and so it's a start.