added infintesimal angle checking in ArmIK