Fix scale calculation in orthogonalize