Working on IKFast
IKFAST FINALLY WORKS (6DOF)