<div dir="ltr">服部です。<br><div><div class="gmail_extra"><br><div class="gmail_quote">2014年7月31日 18:53 山田浩貴 <span dir="ltr"><<a href="mailto:h_yamada@sugano.mech.waseda.ac.jp" target="_blank">h_yamada@sugano.mech.waseda.ac.jp</a>></span>:<br>
<blockquote class="gmail_quote" style="margin:0px 0px 0px 0.8ex;border-left:1px solid rgb(204,204,204);padding-left:1ex">
  

    
  
  <div text="#000000" bgcolor="#FFFFFF"><i>
</i>
    として, hrplib/hrpUtil/Eigen3d.cpp の中にある,hrp::rpyFromRot を用いて
    Roll,Pitch,Yawを算出しました.<br>
    計算が上手くいっているか確認するために,<br>
    初期状態として,<br>
    Roll=90°<br>
    Yaw=-90°<br>
    Pitch=0°<br>
    として,目標状態を<br>
    Roll=90°<br>
    Yaw=-90°<br>
    Pitch=90°<br>
    となるように,ロボットモデルを作成して,関節を動かしました.<br></div></blockquote><div><br>すみませんが、これが、何をされているのか、よくわかりません。<br><br></div><div>hrpFromRotの計算にバグがあるということでしょうか?<br>でしたら、入力した行列と、出力されたRoll,Pitch,Yawの値を比較してみてください。<br>数学的に、0度と180度とか、マイナスの角度とかがうまく計算できないことはあるかと思います。<br>
<br>それとも、ロボットの動作シミュレーションの結果がおかしいということでしょうか?<br>問題の切り分けをおねがいします。<br> </div></div><br></div></div></div>