fixed the [link inertia not positive definite] bug