Skip to content
New issue

Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.

By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.

Already on GitHub? Sign in to your account

jazzy対応(MoveitConfigsBuilder) #78

Open
wants to merge 41 commits into
base: master
Choose a base branch
from
Open

Conversation

mizonon
Copy link

@mizonon mizonon commented Aug 8, 2024

What does this implement/fix?

MoveitConfigsBuilderについてのJazzy対応です。

Does this close any currently open issues?

How has this been tested?

crane_prus_exampleのdemo.launchとサンプルプログラムを使って、humble環境と同じように動作するか確認しました。

Any other comments?

誤ってhumble_develブランチから本作業ブランチを切っていたため、改めてmasterブランチから作業ブランチを作成し、複数あったコミットを一つに集約した上でこちらのブランチにコピーし、PR作成しております。

Checklists

* MoveitCofigsBuilderを使ってmoveit_configの枠を作る

* planning_plugins, requesr_adaptorsの設定をompl_planning.yamlの先頭で行う

* ompl_planning.yamlにstart_state_max_bounds_errorの設定を追加

* 7/19ここまで

* MoveitConfigsBuilderを使うに伴った、yamlファイルの指定の項目追加

* 一通りMoveItConfigsBuilderに対応

* MoveIt Setup Assistantを使って設定ファイルを生成

* urdfの指定を追加

* crane_plus_configのrun_move_group.launchを呼ぶ

* Unable to parse SRDFのエラーが解決できない

* demo.launchが起動できるようになった

* 余計なコメントアウト部分削除

* 余計なコメントアウト削除

* rviz上でMottionPlanningができるようになった

* 余計なコメントアウト削除
@mizonon mizonon requested a review from Kuwamai August 8, 2024 06:04
Copy link
Contributor

@Kuwamai Kuwamai left a comment

Choose a reason for hiding this comment

The reason will be displayed to describe this comment to others. Learn more.

動作確認は行っていないのですが、コードの構成等についてコメントしました。ご確認お願いします。

.gitignore Outdated Show resolved Hide resolved
.docker/README.md Outdated Show resolved Hide resolved
crane_plus_examples/launch/demo.launch.py Outdated Show resolved Hide resolved
crane_plus_examples/launch/demo.launch.py Outdated Show resolved Hide resolved
crane_plus_moveit_config/config/joint_limits.yaml Outdated Show resolved Hide resolved
crane_plus_moveit_config/package.xml Outdated Show resolved Hide resolved
crane_plus_moveit_config/package.xml Outdated Show resolved Hide resolved
crane_plus_moveit_config/package.xml Outdated Show resolved Hide resolved
crane_plus_moveit_config/launch/run_move_group.rviz Outdated Show resolved Hide resolved
@Kuwamai
Copy link
Contributor

Kuwamai commented Aug 14, 2024

CIに関してはSciurus17と同様に、こちらのenv内のhumbleをjazzyに変更お願いします
https://github.com/rt-net/sciurus17_ros/blob/e96d86a6d0f9097b55ea9a1461aa38f510cde478/.github/workflows/industrial_ci.yml#L20

Copy link
Contributor

@Kuwamai Kuwamai left a comment

Choose a reason for hiding this comment

The reason will be displayed to describe this comment to others. Learn more.

主にSciurus17との共通化についてコメントしました。
まだ動作確認は行っていません。

.gitignore Show resolved Hide resolved
crane_plus_examples/launch/demo.launch.py Outdated Show resolved Hide resolved
Copy link
Contributor

Choose a reason for hiding this comment

The reason will be displayed to describe this comment to others. Learn more.

crane_plus_moveit_config/package.xml Outdated Show resolved Hide resolved
crane_plus_moveit_config/package.xml Outdated Show resolved Hide resolved
crane_plus_moveit_config/launch/run_move_group.launch.py Outdated Show resolved Hide resolved
crane_plus_moveit_config/launch/run_move_group.launch.py Outdated Show resolved Hide resolved
@Kuwamai Kuwamai added the Type: Feature New Feature label Sep 17, 2024
Copy link
Contributor

@Kuwamai Kuwamai left a comment

Choose a reason for hiding this comment

The reason will be displayed to describe this comment to others. Learn more.

PRありがとうございます。
実機ですべてのサンプルの動作確認ができました。
コメントをご確認お願いします。

また、Gazeboが起動しなかったためシミュレータによる動作確認ができていない状態です。 @mizonon さんの環境では動作しておりましたでしょうか。

crane_plus_moveit_config/config/controllers.yaml Outdated Show resolved Hide resolved
crane_plus_moveit_config/config/kinematics.yaml Outdated Show resolved Hide resolved
crane_plus_moveit_config/launch/run_move_group.launch.py Outdated Show resolved Hide resolved
crane_plus_moveit_config/launch/run_move_group.launch.py Outdated Show resolved Hide resolved
crane_plus_moveit_config/launch/run_move_group.launch.py Outdated Show resolved Hide resolved
.gitignore Show resolved Hide resolved
crane_plus_moveit_config/config/moveit.rviz Outdated Show resolved Hide resolved
Comment on lines +45 to 54
ld.add_action(
DeclareLaunchArgument(
'rviz_config',
default_value=get_package_share_directory(
'crane_plus_moveit_config'
)
+ '/config/moveit.rviz',
description='Set the path to rviz configuration file.',
)
)
Copy link
Contributor

Choose a reason for hiding this comment

The reason will be displayed to describe this comment to others. Learn more.

こちらでコンフィグファイルのパスを設定していますが、その変更が反映されていないようです。ご確認お願いします。

@Kuwamai
Copy link
Contributor

Kuwamai commented Nov 12, 2024

demo.launch.py実行時に警告が出ています。
原因はわかりませんが一旦記録として残します。

WARNING:root:Cannot infer URDF from `/home/rt-user/ros2_ws/install/crane_plus_moveit_config/share/crane_plus_moveit_config`. -- using config/crane_plus.urdf
WARNING:root:Cannot infer SRDF from `/home/rt-user/ros2_ws/install/crane_plus_moveit_config/share/crane_plus_moveit_config`. -- using config/crane_plus.srdf
WARNING:root:Cannot infer URDF from `/home/rt-user/ros2_ws/install/crane_plus_moveit_config/share/crane_plus_moveit_config`. -- using config/crane_plus.urdf
WARNING:root:Cannot infer SRDF from `/home/rt-user/ros2_ws/install/crane_plus_moveit_config/share/crane_plus_moveit_config`. -- using config/crane_plus.srdf
WARNING:root:Cannot infer URDF from `/home/rt-user/ros2_ws/install/crane_plus_moveit_config/share/crane_plus_moveit_config`. -- using config/crane_plus.urdf
WARNING:root:Cannot infer SRDF from `/home/rt-user/ros2_ws/install/crane_plus_moveit_config/share/crane_plus_moveit_config`. -- using config/crane_plus.srdf

@Kuwamai
Copy link
Contributor

Kuwamai commented Nov 12, 2024

Planning時にタイムアウトエラーが多いように思いました。
自分の環境では5回に1回くらい発生しています。
こちらも原因がわかれば改善したいです。

[move_group-1] [INFO] [1731406028.536946246] [move_group]: Calling Planner 'OMPL'
[move_group-1] [INFO] [1731406028.537147255] [move_group.moveit.moveit.planners.ompl.model_based_planning_context]: arm: Allocating specialized state sampler for state space
[move_group-1] [ERROR] [1731406033.543253139] [move_group.moveit.moveit.planners.ompl.planner_manager]: ./src/ompl/geometric/planners/rrt/src/RRTConnect.cpp:252 - arm/arm: Unable to sample any valid states for goal tree
[move_group-1] [WARN] [1731406033.543364259] [move_group.moveit.moveit.planners.ompl.model_based_planning_context]: Timed out: 5.0s ≥ 5.0s
[move_group-1] [ERROR] [1731406033.587224122] [move_group.moveit.moveit.planners.ompl.model_based_planning_context]: Unable to solve the planning problem
[move_group-1] [ERROR] [1731406033.587336950] [move_group]: Planner 'OMPL' failed with error code TIMED_OUT
[move_group-1] [INFO] [1731406033.587374166] [move_group.moveit.moveit.ros.move_group.move_action]: TIMED_OUT
[move_group-1] [INFO] [1731406033.588601237] [move_group.moveit.moveit.ros.move_group.move_action]: MoveGroupMoveA

@Kuwamai
Copy link
Contributor

Kuwamai commented Nov 14, 2024

@mizonon ご対応ありがとうございます。Sciurus17のほうで生じていたGazeboの不具合なのですが、CRANE+ V2では関係なさそうでしたので引き続き対応お願いします。
既知の不具合として、GazeboがXorgでないと動作しないようですので下記サイト等を参考に切り替えたうえで開発お願いします。
https://kledgeb.blogspot.com/2022/05/ubuntu-2204-95-xorgwayland.html#google_vignette

Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Labels
Type: Feature New Feature
Projects
None yet
Development

Successfully merging this pull request may close these issues.

2 participants