[irtrobot.l] fix bug in :calc-zmp-from-forces-moments

[Naoki-Hiraoka]

(load "package://euslisp/jskeus/irteus/demo/sample-robot-model.l")
(setq *robot* (instance sample-robot :init))
(send *robot* :calc-zmp-from-forces-moments (list #F(0 0 500) #F(0 0 500)) (list #F(0 0 0) #F(0 0 0)))

上記プログラムを実行すると，以下のエラーが出ました．

error: cannot find method :worldpos in (send fs :worldpos) 

これを直すPull Requestです．

[k-okada]

closed via #609