Change CPhysCollide to a class
Refactor some ugly code