Better physics simulation

Performance enhancement etc. Beginning to more specialized physics
simulation.