added more funcs to solve ik from pose

poseのmsgからgraspだけではなく、push, moveもできるようにしました。