Add func for solve ik from pose

![hrp2_ik](https://cloud.githubusercontent.com/assets/7259700/5372586/861c4532-808e-11e4-9ae7-3e407d986945.png)

Poseを受け取って、IKを解けるようにしました。