changes to get darwin running
got manipulators working for darwin, now check FK/IK