BUG: Fix gravity in RbdModel

Force of gravity was just g not mg. Fortunately most of the times we don't use gravity with virtual coupling on the rigid body model.

Also rescaled the SDF collision example and checked the others.