got manipulators working for darwin, now check FK/IK