Attempt at making a simple rigid body physics simulator