Improved GJK algorithm to avoid false negatives