fixing the physics system, cleaning the code a little bit.

Signed-off-by: Nico Magni <nicomagni@wolox.com.ar>