Various code refactoring
Fixed ShouldCollide
Fixed a few things with vehicle controllers.