Fix impedance codes2

[snozawa]

ImpedanceControllerのエンドエフェクタ座標系の計算が誤っている箇所を修正しました。

度々で申し訳ございませんが、よろしくお願いいたします。

[k-okada]

Refer to this link for build results (access rights to CI server needed):
http:https://jenkins.jsk.imi.i.u-tokyo.ac.jp:8080/job/hrpsys-qnx/1716/

Build Log
last 10 lines

[...truncated 4272 lines...]
=====
$ tar -xvzf /tmp/hrpsys-441-qnx-2015-01-05; cd hrpsys-source-441-2015-01-05/build; #make install
+ grep \*\*\* /tmp/robot-compile-hrpsys-441.log
make[2]: *** [rtc/StateHolder/CMakeFiles/StateHolderComp.dir/StateHolder.o] Error make[2]: Leaving directory `/tmp/hrpsys-source-441-2015-01-05/build'
make[1]: *** [rtc/StateHolder/CMakeFiles/StateHolderComp.dir/all] Error 2
make: *** [all] Error 2
+ exit 1
Build step 'Execute shell' marked build as failure
Sending e-mails to: [email protected] [email protected] [email protected] [email protected]

Test FAILed.