added collision detection

detection is simple, made to test contact resolvers