Collision test finished

Collision with quad geometry does not work yet. I'll probably skip them.
README update