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

Normalizing azimuth angle with wrong offset [dual_return_outlier_filter] #509

Closed
yucedagonurcan opened this issue Mar 11, 2022 · 6 comments
Assignees
Labels
component:sensing Data acquisition from sensors, drivers, preprocessing. (auto-assigned) type:bug Software flaws or errors.

Comments

@yucedagonurcan
Copy link
Contributor

Hello,

azimuth_diff = azimuth_diff < 0.f ? azimuth_diff + 36000.f : azimuth_diff;

Doesn't it need to be 360000.f? It looks like there is this error every time we try to normalize the angle.

@yucedagonurcan yucedagonurcan changed the title Normalizing azimuth angle with wrong offset Normalizing azimuth angle with wrong offset [dual_return_outlier_filter] Mar 11, 2022
satoshi-ota pushed a commit to satoshi-ota/autoware.universe that referenced this issue Mar 14, 2022
* Ros2 v0.8.0 autoware debug tools (autowarefoundation#330)

* initial commit

* fix bug

* fix lint

* delete setup.py

* fix too long line

* add copyright

* change directory structure

* fix tf2pose

* fix pose2tf.py

* add test self pose listener

* format

* delete queue size

* use timer

* fix stop_reason2pose

* fix stop_reason2tf

* fix topic name on tf2pose

* format

* Fix typo in common module (autowarefoundation#433)

* Unify Apache-2.0 license name (autowarefoundation#1242)

* Fix lint errors (autowarefoundation#1378)

* Fix lint errors

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Fix variable names

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* add sort-package-xml hook in pre-commit (autowarefoundation#1881)

* add sort xml hook in pre-commit

* change retval to exit_status

* rename

* add prettier plugin-xml

* use early return

* add license note

* add tier4 license

* restore prettier

* change license order

* move local hooks to public repo

* move prettier-xml to pre-commit-hooks-ros

* update version for bug-fix

* apply pre-commit

* Add shellcheck (autowarefoundation#2079)

* Add shellcheck

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Fix shellcheck

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Feature/add lateral error publisher (autowarefoundation#2167)

* Add CMakeLists, package.xml and base cpp/hpp for lateral_error_publisher

Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com>

* Implementing ...

Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com>

* Register lateral_error_publisher node

Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com>

* Add control/localization lateral error calculation

Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com>

* Add config file

Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com>

* Add publisher

Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com>

* Change RCLCPP_INFO to RCLCPP_DEBUG

Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com>

* Add readme and fix topic name

Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com>

* Fix a lateral error publisher overview figure

Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com>

* Fix code style

Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com>

* Fix to pre-commit test

Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com>

* Fix type to reference

Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com>

* Use MPL2 licence only at eigen library

Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com>

* Fix comment

Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com>

* Fix condition

Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com>

* Change formatter to clang-format and black (autowarefoundation#2332)

* Revert "Temporarily comment out pre-commit hooks"

This reverts commit 748e9cdb145ce12f8b520bcbd97f5ff899fc28a3.

* Replace ament_lint_common with autoware_lint_common

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Remove ament_cmake_uncrustify and ament_clang_format

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Apply Black

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Apply clang-format

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Fix build errors

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Fix for cpplint

* Fix include double quotes to angle brackets

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Apply clang-format

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Fix build errors

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Add COLCON_IGNORE (autowarefoundation#500)

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* port autoware_debug_tools (autowarefoundation#509)

Co-authored-by: Takayuki Murooka <takayuki.murooka@tier4.jp>

* fix readme

Co-authored-by: Shigeki Kobayashi <32808802+sgk-000@users.noreply.github.com>
Co-authored-by: Kazuki Miyahara <kmiya@outlook.com>
Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com>
Co-authored-by: Keisuke Shima <19993104+KeisukeShima@users.noreply.github.com>
Co-authored-by: Makoto Kurihara <mkuri8m@gmail.com>
Co-authored-by: Takayuki Murooka <takayuki5168@gmail.com>
Co-authored-by: Takayuki Murooka <takayuki.murooka@tier4.jp>
@aohsato aohsato added the component:sensing Data acquisition from sensors, drivers, preprocessing. (auto-assigned) label Apr 14, 2022
@badai-nguyen
Copy link
Contributor

badai-nguyen commented Apr 15, 2022

Hello @yucedagonurcan
I think the line is to make sure the difference of adjacent points in a ring azimuth_diff being in range [0.0f 36000.0f].
Could you describe more details about the error have you get?

@BonoloAWF BonoloAWF added the type:bug Software flaws or errors. label Apr 19, 2022
@yucedagonurcan
Copy link
Contributor Author

yucedagonurcan commented Apr 19, 2022

@badai-nguyen , I am guessing that we need to fix the difference between [0, 360) not [0, 36).

@badai-nguyen
Copy link
Contributor

badai-nguyen commented Apr 21, 2022

@yucedagonurcan Hi, I am sorry for misunderstanding your question.

Doesn't it need to be 360000.f? It looks like there is this error every time we try to normalize the angle.

Because the current LiDAR's azimuth represents angle in hundredths of degree so that it should be 36000.0f.

@yucedagonurcan
Copy link
Contributor Author

Okay, it's a fair approach if we know it is hundredths of degree

But if we are parsing the sensor data from the Ouster, user tend to calculate the azimuth value as millidegrees which is the format of the incoming data.

@badai-nguyen maybe the best approach to make it a parameter rather than fix value? What do you think?

@badai-nguyen
Copy link
Contributor

@yucedagonurcan yes, I totally agree that it is better to parameterize that. I will fix it.

@badai-nguyen
Copy link
Contributor

I close this issue because I created an related one here #1127

tkimura4 referenced this issue in tier4/autoware.universe Oct 24, 2022
* fix: add param for grid scan_ground_filter

Signed-off-by: badai-nguyen <dai.nguyen@tier4.jp>

* chore: unify parameters as universe launch

Signed-off-by: badai-nguyen <dai.nguyen@tier4.jp>

* fix search package name

Signed-off-by: Shunsuke Miura <shunsuke.miura@tier4.jp>

Signed-off-by: badai-nguyen <dai.nguyen@tier4.jp>
Signed-off-by: Shunsuke Miura <shunsuke.miura@tier4.jp>
Co-authored-by: Shunsuke Miura <shunsuke.miura@tier4.jp>
Co-authored-by: Shunsuke Miura <37187849+miursh@users.noreply.github.com>
kosuke55 pushed a commit to kosuke55/autoware.universe that referenced this issue May 29, 2023
…n#3734) (autowarefoundation#509)

* refactor(behavior_velocity_planner): use pluginlib (autowarefoundation#3734)

* feat: move interface

Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>

* feat: move utilization

Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>

* feat: add plugin loader

Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>

* feat: use plugin interface for all scene module

Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>

* feat: remove debug code

Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>

* feat: update package dependency

Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>

* feat: move crosswalk

Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>

* feat: add template package

Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>

* feat: move intersection

Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>

* feat: move traffic light

Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>

* feat: move blind spot

Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>

* feat: move detection area

Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>

* feat: move no stopping area

Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>

* feat: move occlusion spot

Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>

* feat: move occlusion spot test

Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>

* feat: move out of lane

Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>

* feat: move run out

Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>

* feat: move speed bump and virtual traffic light

Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>

* move: common test

Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>

---------

Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>

* apply Kimura-san's patch

Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com>

* add find_package pcl explicitly

Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com>

---------

Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com>
Co-authored-by: Takagi, Isamu <43976882+isamu-takagi@users.noreply.github.com>
keiota pushed a commit to keiota/autoware.universe that referenced this issue Aug 17, 2023
…tory (autowarefoundation#509)

* update launcher

Signed-off-by: kyoichi-sugahara <kyoichi.sugahara@tier4.jp>

* add config and modify launch file

Signed-off-by: kyoichi-sugahara <kyoichi.sugahara@tier4.jp>

* style(pre-commit): autofix

* feat(lane_departure_checker): add road_border departure checker (autowarefoundation#511)

add param

Signed-off-by: kyoichi-sugahara <kyoichi.sugahara@tier4.jp>

* feat(system_error_monitor): check lateral deviation in sim (autowarefoundation#516)

Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>

* restore rviz config change

Signed-off-by: kyoichi-sugahara <kyoichi.sugahara@tier4.jp>

---------

Signed-off-by: kyoichi-sugahara <kyoichi.sugahara@tier4.jp>
Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>
Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com>
kyoichi-sugahara pushed a commit that referenced this issue Sep 16, 2023
Signed-off-by: tomoya.kimura <tomoya.kimura@tier4.jp>

Signed-off-by: tomoya.kimura <tomoya.kimura@tier4.jp>
Kazunori-Nakajima pushed a commit to Kazunori-Nakajima/autoware.universe that referenced this issue Feb 6, 2025
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Labels
component:sensing Data acquisition from sensors, drivers, preprocessing. (auto-assigned) type:bug Software flaws or errors.
Projects
None yet
Development

No branches or pull requests

4 participants