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

点群認識サンプルの追加 #176

Merged
merged 35 commits into from
Feb 20, 2023
Merged

点群認識サンプルの追加 #176

merged 35 commits into from
Feb 20, 2023

Conversation

Kuwamai
Copy link
Contributor

@Kuwamai Kuwamai commented Feb 7, 2023

What does this implement/fix?

点群を用いた物体を認識、把持するサンプルプログラムです。

Does this close any currently open issues?

しません

How has this been tested?

下記コマンドで起動します

ros2 launch crane_x7_examples demo.launch.py use_d435:=true
ros2 launch crane_x7_examples camera_example.launch.py example:='point_cloud_detection'

Any other comments?

Checklists

@Kuwamai Kuwamai added the Type: Feature New Feature label Feb 7, 2023
@Kuwamai Kuwamai requested a review from ShotaAk February 7, 2023 06:26
@Kuwamai Kuwamai self-assigned this Feb 7, 2023
Copy link
Collaborator

@ShotaAk ShotaAk left a comment

Choose a reason for hiding this comment

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

コードレビューを実施しました。確認お願いします。

動作確認はこれから実施します。

crane_x7_examples/src/point_cloud_detection.cpp Outdated Show resolved Hide resolved
crane_x7_examples/src/point_cloud_detection.cpp Outdated Show resolved Hide resolved
crane_x7_examples/src/point_cloud_detection.cpp Outdated Show resolved Hide resolved
crane_x7_examples/src/point_cloud_detection.cpp Outdated Show resolved Hide resolved
crane_x7_examples/src/point_cloud_detection.cpp Outdated Show resolved Hide resolved
crane_x7_examples/src/point_cloud_detection.cpp Outdated Show resolved Hide resolved
@Kuwamai Kuwamai requested a review from ShotaAk February 15, 2023 09:50
Copy link
Collaborator

@ShotaAk ShotaAk left a comment

Choose a reason for hiding this comment

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

動作確認しました。動作OKです。

細かいコメントを追加したので確認お願いします。

crane_x7_examples/src/pick_and_place_tf.cpp Outdated Show resolved Hide resolved
crane_x7_examples/src/pick_and_place_tf.cpp Outdated Show resolved Hide resolved
crane_x7_examples/src/pick_and_place_tf.cpp Outdated Show resolved Hide resolved
crane_x7_examples/src/point_cloud_detection.cpp Outdated Show resolved Hide resolved
crane_x7_examples/src/point_cloud_detection.cpp Outdated Show resolved Hide resolved
crane_x7_examples/src/point_cloud_detection.cpp Outdated Show resolved Hide resolved
crane_x7_examples/src/point_cloud_detection.cpp Outdated Show resolved Hide resolved
#include "tf2_ros/transform_broadcaster.h"
#include "tf2_ros/transform_listener.h"
#include "tf2_ros/buffer.h"

Copy link
Collaborator

Choose a reason for hiding this comment

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

今回は実施しなくて良いですが、using hoge_point_t = pcl::PointCloud<pcl::PointXYZRGB>;みたいにエイリアスを書いておくと、手首に優しくメンテナンスしやすくなります。

Kuwamai and others added 8 commits February 16, 2023 13:13
Co-authored-by: Shota Aoki <s.aoki@rt-net.jp>
Co-authored-by: Shota Aoki <s.aoki@rt-net.jp>
Co-authored-by: Shota Aoki <s.aoki@rt-net.jp>
Co-authored-by: Shota Aoki <s.aoki@rt-net.jp>
Co-authored-by: Shota Aoki <s.aoki@rt-net.jp>
Co-authored-by: Shota Aoki <s.aoki@rt-net.jp>
Co-authored-by: Shota Aoki <s.aoki@rt-net.jp>
@Kuwamai Kuwamai requested a review from ShotaAk February 16, 2023 06:38
Copy link
Collaborator

@ShotaAk ShotaAk left a comment

Choose a reason for hiding this comment

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

LGTM

@ShotaAk ShotaAk merged commit b07111d into ros2 Feb 20, 2023
@ShotaAk ShotaAk deleted the add_pointcloud_detection branch February 20, 2023 00:54
Kuwamai added a commit that referenced this pull request Feb 20, 2023
* 点群を0.5mの距離でフィルタリング

* Voxel gridでダウンサンプリング

* 点群の座標変換

* 点群の座標変換修正

* 点群の取得範囲変更

* KdTreeによるクラスタリング

* 認識した物体位置をtfで配信

* スタイル修正

* ファイル名変更

* point_cloud_detectionをサンプル実行用launchに追加

* 不要な変数を削除

* Update README

* プレース後の物体を再度把持してしまうためプレース位置修正

* 認識後の点群をRvizに表示

* 平面検出処理追加

* コメント修正

* READMEに動画URL追加

* tfの表示時間短縮

* タイムスタンプを一致させるためheaderをコピー

* 点群の重心位置を物体位置として配信

* tfの取得時間の範囲を変更

* 物体位置の高さ制限を追加

* 平面検出をコメントアウト

* newをmake_sharedに置き換え

* 点群処理を複数の関数に分割

* Copyright表記修正

Co-authored-by: Shota Aoki <s.aoki@rt-net.jp>

* Update README

* 変数の型修正

Co-authored-by: Shota Aoki <s.aoki@rt-net.jp>

* 変数の型修正

Co-authored-by: Shota Aoki <s.aoki@rt-net.jp>

* 変数名修正

Co-authored-by: Shota Aoki <s.aoki@rt-net.jp>

* 点群取得範囲修正

Co-authored-by: Shota Aoki <s.aoki@rt-net.jp>

* 平面検出の判定条件修正

Co-authored-by: Shota Aoki <s.aoki@rt-net.jp>

* for文を範囲for文に変更

Co-authored-by: Shota Aoki <s.aoki@rt-net.jp>

* for文を範囲for文に変更

Co-authored-by: Shota Aoki <s.aoki@rt-net.jp>

* 認識範囲に点群がない場合INFOを出力

---------

Co-authored-by: Shota Aoki <s.aoki@rt-net.jp>
Kuwamai added a commit that referenced this pull request Feb 20, 2023
* 点群を0.5mの距離でフィルタリング

* Voxel gridでダウンサンプリング

* 点群の座標変換

* 点群の座標変換修正

* 点群の取得範囲変更

* KdTreeによるクラスタリング

* 認識した物体位置をtfで配信

* スタイル修正

* ファイル名変更

* point_cloud_detectionをサンプル実行用launchに追加

* 不要な変数を削除

* Update README

* プレース後の物体を再度把持してしまうためプレース位置修正

* 認識後の点群をRvizに表示

* 平面検出処理追加

* コメント修正

* READMEに動画URL追加

* tfの表示時間短縮

* タイムスタンプを一致させるためheaderをコピー

* 点群の重心位置を物体位置として配信

* tfの取得時間の範囲を変更

* 物体位置の高さ制限を追加

* 平面検出をコメントアウト

* newをmake_sharedに置き換え

* 点群処理を複数の関数に分割

* Copyright表記修正

Co-authored-by: Shota Aoki <s.aoki@rt-net.jp>

* Update README

* 変数の型修正

Co-authored-by: Shota Aoki <s.aoki@rt-net.jp>

* 変数の型修正

Co-authored-by: Shota Aoki <s.aoki@rt-net.jp>

* 変数名修正

Co-authored-by: Shota Aoki <s.aoki@rt-net.jp>

* 点群取得範囲修正

Co-authored-by: Shota Aoki <s.aoki@rt-net.jp>

* 平面検出の判定条件修正

Co-authored-by: Shota Aoki <s.aoki@rt-net.jp>

* for文を範囲for文に変更

Co-authored-by: Shota Aoki <s.aoki@rt-net.jp>

* for文を範囲for文に変更

Co-authored-by: Shota Aoki <s.aoki@rt-net.jp>

* 認識範囲に点群がない場合INFOを出力

---------

Co-authored-by: Shota Aoki <s.aoki@rt-net.jp>
@Kuwamai Kuwamai mentioned this pull request Feb 20, 2023
2 tasks
ShotaAk added a commit that referenced this pull request Dec 19, 2023
* 点群認識サンプルの追加 (#176)

* 点群を0.5mの距離でフィルタリング

* Voxel gridでダウンサンプリング

* 点群の座標変換

* 点群の座標変換修正

* 点群の取得範囲変更

* KdTreeによるクラスタリング

* 認識した物体位置をtfで配信

* スタイル修正

* ファイル名変更

* point_cloud_detectionをサンプル実行用launchに追加

* 不要な変数を削除

* Update README

* プレース後の物体を再度把持してしまうためプレース位置修正

* 認識後の点群をRvizに表示

* 平面検出処理追加

* コメント修正

* READMEに動画URL追加

* tfの表示時間短縮

* タイムスタンプを一致させるためheaderをコピー

* 点群の重心位置を物体位置として配信

* tfの取得時間の範囲を変更

* 物体位置の高さ制限を追加

* 平面検出をコメントアウト

* newをmake_sharedに置き換え

* 点群処理を複数の関数に分割

* Copyright表記修正

Co-authored-by: Shota Aoki <s.aoki@rt-net.jp>

* Update README

* 変数の型修正

Co-authored-by: Shota Aoki <s.aoki@rt-net.jp>

* 変数の型修正

Co-authored-by: Shota Aoki <s.aoki@rt-net.jp>

* 変数名修正

Co-authored-by: Shota Aoki <s.aoki@rt-net.jp>

* 点群取得範囲修正

Co-authored-by: Shota Aoki <s.aoki@rt-net.jp>

* 平面検出の判定条件修正

Co-authored-by: Shota Aoki <s.aoki@rt-net.jp>

* for文を範囲for文に変更

Co-authored-by: Shota Aoki <s.aoki@rt-net.jp>

* for文を範囲for文に変更

Co-authored-by: Shota Aoki <s.aoki@rt-net.jp>

* 認識範囲に点群がない場合INFOを出力

---------

Co-authored-by: Shota Aoki <s.aoki@rt-net.jp>

* バージョンタグを4.2.0に更新 (#177)

v4.2.0に更新

* 色認識サンプルの追加 (#183)

* 色認識追加

* 二値化画像を配信

* 不要な処理を削除

* RVizに二値化画像を表示

* 距離のオフセット追加

* 変数名変更

* カーネルを変更

* 不要な空行を削除

* 画像取得時のheaderをtfに使用

* コメント、変数名修正

* Update README

* コメント修正

* 変数名変更

* 動画URL追加

* バージョンタグを4.3.0に更新 (#184)

* Remove gz ros2 controll installation. (#189)

Remove gz ros2 controll installation

* Gazeboのclockをtopicへ配信 (#192)

ros_gz_bridge追加

* goal_toleranceの設定と把持角の調整 (#193)

* goal_tolerance調整

* グリッパ角調整

* Prepare for release 4.4.0 (#194)

4.4.0

---------

Co-authored-by: Shota Aoki <s.aoki@rt-net.jp>
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