Added IK tests, got it semi-running