First attempt at collision physics. Still some bugs to work out