Collision response working

Might be a little bit buggy.