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

feat: change pointcloud concatenation timeout setting for each lidar sensors in xx1 laucher #134

Merged
merged 8 commits into from
Apr 28, 2023

Conversation

YoshiRi
Copy link
Contributor

@YoshiRi YoshiRi commented Apr 28, 2023

Changes

This PR tries to change following xx1 launch settings:

  • Default concatenation timeout from 100ms to 75ms so that the delayed sensor output will not concatenated with newer pointcloud group
  • Set individual sensors timeout to be [top: 20ms, other: 50ms].
    • This means we want to publish concatenated pointclouds soon after subscribed main sensor = top lidar
    • Due to the setting of xx1 sensors, other sensors will wait top lidar for longer time

Settings figure:

image

image

Test

Run Lsim.

@YoshiRi YoshiRi requested a review from shmpwk April 28, 2023 08:03
@@ -41,6 +41,8 @@ def launch_setup(context, *args, **kwargs):
"/sensing/lidar/rear/outlier_filtered/pointcloud",
],
"output_frame": LaunchConfiguration("base_frame"),
"input_offset": [0.055, 0.025], # each sensor will wait 20, 50, 50, 50ms
Copy link
Contributor

Choose a reason for hiding this comment

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

@YoshiRi Could you explain what does the value mean? I cannot figure out the number 0.055, for example.

Copy link
Contributor

Choose a reason for hiding this comment

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

A.

(topのlidar点群を受け取ったあとは75-55=20msまで欠損・遅れ点群を待つようになります。他のセンサは50ms待ちます。)
詳細
timerが設定されていてtopicが揃うかtimerが時間切れになるとpublishします
publish時の他に、各topicを受け取ったときにtimerを延長して他のセンサを待ちます。
この時の待ち時間は default_timeout - offset で計算されます
xx1の場合top lidarが最も重要なので他センサはtop lidarを待つために50ms程度待ちます(PRの図にあるように理想状況だとtop lidarは30ms程度遅れるはず)
逆にtop lidarを受け取ったら理想状況だと他のセンサは到着しているはずなのでさっさとpublishするために待ち時間を短くしたいです。
20ms, 50msに特別強い根拠はないです。今まで感覚的に数十msくらい遅れることがあったよねという話でぱっと決まりました。(X2のパラメータも参考にしてます)

https://star4.slack.com/archives/CEV8XMJBV/p1682679671076349?thread_ts=1682667912.118349&cid=CEV8XMJBV

aip_xx1_launch/launch/pointcloud_preprocessor.launch.py Outdated Show resolved Hide resolved
@shmpwk shmpwk merged commit 4a50e4f into tier4/universe Apr 28, 2023
@shmpwk shmpwk deleted the feat/change_lidar_concat_timeout branch April 28, 2023 11:13
badai-nguyen pushed a commit that referenced this pull request May 11, 2023
…sensors in xx1 laucher (#134)

* change lidar sync timeout settings

Signed-off-by: yoshiri <[email protected]>

* ci(pre-commit): autofix

* fix input offset size to fit with input topic num

Signed-off-by: yoshiri <[email protected]>

* ci(pre-commit): autofix

* use left/right lidar

Signed-off-by: yoshiri <[email protected]>

* ci(pre-commit): autofix

---------

Signed-off-by: yoshiri <[email protected]>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Labels
None yet
Projects
None yet
Development

Successfully merging this pull request may close these issues.

3 participants