Upgrade to Pro — share decks privately, control downloads, hide ads and more …

ROBOTIS DynamixelのためのROS 2 Control実装 dynamixel_...

Yutaka Kondo
September 16, 2021

ROBOTIS DynamixelのためのROS 2 Control実装 dynamixel_control

#ROSCon 2021 の講演資料です。 https://roscon.jp/#program

概要:
dynamixel_controlはROBOTIS DynamixelサーボモータのためのROS 2 Control 実装です。利用者は構成ファイルとURDFを用意するだけで多様なロボットに適用することができ、ros2_controllersに対応した様々な制御モードを使うことができます。講演ではコントローラの動的切り替えやMoveIt2、シミュレータとの接続も紹介します。

Yutaka Kondo

September 16, 2021
Tweet

More Decks by Yutaka Kondo

Other Decks in Technology

Transcript

  1. 2 • 博⼠(⼯学) • カワダロボティクス開発部主任 → Preferred Networks エンジニア •

    著書「ROS2ではじめよう 次世代ロボットプログラミング」 ◦ 増刷版はROS 2 Foxyに対応 • ROSCon JP 2021実⾏委員 • ROS Japan Users Group元主宰 • NVIDIA Jetson Influencer • 2児の⽗ 近藤 豊 http://amzn.to/2Ji8mQl
  2. • ros2_control ◦ ROS 2 Controlのフレームワーク • ros2_controllers ◦ コントローラの各種実装

    • control_msgs ◦ ROS 2 Controlのメッセージ定義 ROS 2 Controlレポジトリ 5 • control_box ◦ 補間、PIDなど制御理論のツール • realtime_tools ◦ リアルタイム制御のためのツール • ros2_control_demos ◦ ROS 2 Controlを使ったデモ
  3. • Controller Manager ◦ コントローラ(制御器)の読み込み、実⾏管理 • Resource Manager ◦ ロボット全体、アクチュエータ、センサ単位で

    指令値と現在値の読み書き管理 • Transmissions ◦ 指令値とアクチュエータ⼊⼒値の相互変換 • Hardware Resources ◦ ロボット、センサそのもの フレームワーク概要 6 https://ros-controls.github.io/control.ros.org/ getting_started.html#architecture
  4. • 各コントローラは状態遷移モデルとして実装 ◦ configure︓読み込み ◦ start (activate)︓実⾏開始 ◦ stop (deactivate)︓実⾏終了

    • 標準コントローラ ◦ ForwardCommandController ◦ JointGroupPosition/Velocity/EffortController ◦ JointTrajectoryController︓補間軌道⽣成 ◦ JointStateBroadcaster︓JointStateメッセージ送信 ◦ ... Controller Manager 7
  5. • リソースの組み合わせで多様なロボットに対応 ◦ SystemInterface︓ロボット全体 ◦ ActuatorInterface︓アクチュエータ単位 ◦ SensorInterface︓センサ単位 • 追加機能

    ◦ Transmission︓ 指令値をアクチュエータ⼊⼒値に変換 ◦ JointLimitHandle︓ 指令値をアクチュエータ限界値内に補正 Resource ManagerとTransmissions 8
  6. • 指令値とアクチュエータ⼊⼒の相互変換 ◦ SimpleTransmission ▪ 減速⽐とオフセット量に基づく変換 ◦ DifferentialTransmission ▪ 差動装置を使った2軸アクチュエータのための

    変換 ◦ FourBarLinkageTransmission ▪ 四節リンク構造を使った2軸アクチュエータの ための変換 Transmission 9 https://github.com/ros-controls/ros_control/tree/noetic- devel/transmission_interface/images
  7. • ros2cliのサブコマンドros2 control ◦ ros2 control list_controllers ▪ Controller Managerが管理するコントローラのリストアップ

    ◦ ros2 control list_hardware_interfaces ▪ Resource Managerが管理するリソースのリストアップ ◦ ros2 control load_controller ▪ コントローラの読み込み ▪ --set-stateオプションで読み込みのみか、即実⾏開始か選択可能 ◦ ros2 control switch_controllers ▪ コントローラの実⾏開始、実⾏終了の切り替え ros2controlcli 11
  8. • ROS 2 Controlのコンセプトは素晴らしい • が、実装、デモ、テスト、ドキュメンテーションは追いついていない • ROS 2 Control

    WGメンバだけでなく、私たちも貢献していくべき ROS 2 Controlに貢献しよう 12 https://github.com/ros-controls/ros2_control/pulls?q=is%3Apr+is%3Aclosed+author%3Ayoutalk https://github.com/ros-controls/ros2_control/graphs/contributors
  9. • dynamixel_hardware ◦ DynamixelロボットのためのSystemInterface実装 • open_manipulator_x_description ◦ ROBOTIS Open Manipulator-Xへの適⽤デモ

    • pantilt_bot_description ◦ パンチルト軸のみの2軸ロボットへの適⽤デモ dynamixel_controlレポジトリ 15 open_manipulator_x pantilt_bot
  10. • DynamixelHardware ◦ 現在値(state)取得︓位置、速度、トルク ◦ 指令値(command)命令︓位置、速度、トルク ◦ 変速︓擬似SimpleTransmission • コントローラ

    ◦ ForwardCommandController ◦ JointGroupPosition/Velocity/EffortController ◦ JointTrajectoryController ◦ JointStateBroadcaster 対応状況 17
  11. • リソース設定 • hardwareタグ ◦ plugin︓DynamixelHardware指定 ◦ usb_port︓USB接続ポート ◦ baud_rate︓ボーレート

    ◦ use_dummy︓ダミーモード有効化 • jointタグ ◦ id︓DynamixelモータID ◦ command︓指令値インタフェース ◦ state︓現在値インタフェース URDF ros2_controlタグ https://github.com/youtalk/dynamixel_control/blob/main/ pantilt_bot_description/urdf/pantilt_bot.ros2_control.xacro
  12. • コントローラ設定 • controller_manager ◦ Controller Managerの必要とする パラメータを記述 ◦ コントローラプラグインと名前を

    リストアップ • 各コントローラ名 ◦ 各コントローラの必要とする パラメータを記述 controllers.yaml https://github.com/youtalk/dynamixel_control/blob/main /pantilt_bot_description/controllers/controllers.yaml
  13. • Dynamixelの電流制御モードを使ったトルク制御への対応 ◦ トルク = 電流値 x 係数 ◦ すでに各軸トルクの現在値はJointStateに反映済み

    ◦ https://github.com/youtalk/dynamixel_control/pull/9 (ドラフトPR) ▪ 実機テスト不⾜... Effort Control対応 26 早く柔らかい制御に⼊⾨したい 👊 でも実機は⼀組しかないから壊したらお終い 😭
  14. • ROS 2 Control対応ロボットはMoveIt 2対応も簡単なはず ◦ すでにJointTrajectoryControllerとJointStateBroadcasterには対応済み ◦ https://github.com/youtalk/dynamixel_control/pull/4 (ドラフトPR)

    ▪ https://github.com/ros-planning/moveit_resources/tree/ros2 を参考に結構あがいたが、いまだ正常起動せず MoveIt 2対応 27 moveit_setup_assistantのROS 2版を 早くリリースしてください 😭
  15. • ROS 2 Control対応ロボットはGazebo対応も簡単なはず ◦ ただしGazebo 11(Ignition Gazeboではない) ◦ https://github.com/youtalk/dynamixel_control/pull/8

    (マージ済み) ▪ URDFのSystemInterfaceとGazebo Pluginを変更・追記するだけ ▪ ⼀応動いた︕でもGazeboSystemの起動に数分かかる︕︖ ◦ Ignition Gazeboを使う⽅が良さそう ▪ https://discourse.ros.org/t/ignition-gazebo-ros-2-august-community-meeting-cross-post/21777 Gazebo対応 28 ignition_ros2_control(的なパッケージ)を 早くリリースしてください 😭
  16. • dynamixel-workbenchのros2ブランチは2年以上更新なし... ◦ https://github.com/ROBOTIS-GIT/dynamixel-workbench/tree/ros2 • Plan A︓Dynamixel SDKの直接利⽤ ◦ ROBOTIS社Will

    Sonさん( ROS 2 TSCメンバ )とともに作業進⾏中 • Plan B︓OUXT-Polaris/dynamixel_hardware_interfaceへの移⾏ ◦ https://github.com/OUXT-Polaris/dynamixel_hardware_interface/pull/14 • Plan C︓誰か⼿伝ってください 🙏 dynamixel-workbenchからの卒業 30