Update ik functions and ikfast to transform into robot coordinates rather than use direct IK into world coordinates
More flexible - allows the robots to move around a little
depends on #18 (closed)
More flexible - allows the robots to move around a little
depends on #18 (closed)