Add inverse mass and moment of inertia to Body struct so we don't keep recalculating it.
replace scale_copy with an implementation of Mul using f64 as second arg.