Add safty for near pole cases and test them better.
Add safty for near pole cases and test them better.

pasuka/eigen,ritsu1228/eigen,ritsu1228/eigen,pasuka/eigen,ritsu1228/eigen,pasuka/eigen,ritsu1228/eigen,pasuka/eigen,ritsu1228/eigen,pasuka/eigen