beginnings of lookat_ik for pr2 servoing (and other uses)