irp6p inverse kinematic scheelton in progress