rotation matrix added, zero_tol defined.