many fixes to ikfast degenerate cases