pybulletの６関節アーム

図のような6関節アームをpybullet上で作成した．

関節構造は6自由度アームの順運動学のものと同じである．

ハンドについているグレーの直方体はハンドに付けられたシミュレータ上のカメラの位置を表している． 形状はrealsenseのd435などを模しており，視線は手先方向になっている．

図1 6関節アーム

動画のように関節角空間での速度台形則動作をさせた．

空間軌道は，第１軸の旋回動作による円弧形状がよくわかるものとなっている．

	図2.4 空間軌道
動画1 関節各動作

各関節が最大速度を超えず，また同時に停止するように時間軌道をデザインしている．

図2.1 関節角度

図2.2 関節角速度

図2.3 関節角加速度

3次元座標系で手先座標系に対して速度台形則を適用した動作をさせている．

空間軌道を見ても手先位置が直線的に変化していることがわかる．

図の視点を変えると1点に見えており，精度の良い直線になっていることがわかる．

座標の回転に関しては１軸回りの回転を行っているので回転角度のみをグラフに表示している．

	図3.7 空間軌道	図3.7 空間軌道
動画2 手先座標動作

手先の速度および角速度がきれいな台形になっていない．

この原因は，関節角速度の上限になる関節が発生したので，安全のため速度に制限をかけたからである．

そのような場合でも，先に示したように空間軌道は定めたとおりに動作している．

図3.1 手先速度

図3.2　手先速度

図3.3 手先角加速度

図3.4 関節角速度

図3.5　関節角速度

図3.6 関節角加速度

手先の最大速度の指定を低くしてやればきれいな速度台形則で動作する．

最大速度を70%にした場合の例を示す．

図4.1 手先速度

図4.2　手先速度

図4.3 手先角加速度

図4.4 関節角速度

図4.5　関節角速度

図4.6 関節角加速度

簡単なと言っているのは物体認識を行わずシミュレータの物体情報を使っているから

クローズアップをみるとカップが注ぎ口を中心に回転していることがわかる．

干渉チェックを行えば衝突前に安全に停止させることができる．