Partial Wall collision and utils class

50% of the wall collision is done
straight on but not corners
made a utils class for reusability
reformatted some code