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(obstacle_cruise_planner): add new package #570

Conversation

takayuki5168
Copy link
Contributor

@takayuki5168 takayuki5168 commented Mar 23, 2022

Description

Add a new reference stop/slow down package, obstacle_velocity_planner.

  • rule-based method
    • insert zero velocity for STOP, or calculate target velocity by PID control for ACC.

See
https://autowarefoundation.github.io/autoware.universe/pr-570/planning/obstacle_velocity_planner/obstacle_velocity_planner-design/

Related links

Tests performed

Notes for reviewers

Pre-review checklist for the PR author

PR author must check the checkboxes below when creating the PR.

In-review checklist for the PR reviewers

Reviewers must check the checkboxes below before approval.

  • The PR follows the pull request guidelines.
  • The PR has been properly tested.
  • The PR has been reviewed by the code owners.

Post-review checklist for the PR author

PR author must check the checkboxes below before merging.

  • There are no open discussions or they are tracked via tickets.
  • The PR is ready for merge.

After all checkboxes are checked, anyone who has the write access can merge the PR.

@codecov
Copy link

codecov bot commented Mar 23, 2022

Codecov Report

Merging #570 (b9f8dde) into main (ac96ce5) will decrease coverage by 0.24%.
The diff coverage is 0.00%.

@@           Coverage Diff            @@
##            main    #570      +/-   ##
========================================
- Coverage   9.33%   9.08%   -0.25%     
========================================
  Files        988    1006      +18     
  Lines      66676   68480    +1804     
  Branches   11591   11591              
========================================
  Hits        6221    6221              
- Misses     55280   57084    +1804     
  Partials    5175    5175              
Flag Coverage Δ *Carryforward flag
differential 0.00% <0.00%> (?)
total 9.31% <ø> (ø) Carriedforward from a93fe66

*This pull request uses carry forward flags. Click here to find out more.

Impacted Files Coverage Δ
...include/obstacle_cruise_planner/common_structs.hpp 0.00% <0.00%> (ø)
...e_planner/include/obstacle_cruise_planner/node.hpp 0.00% <0.00%> (ø)
...ruise_planner/optimization_based_planner/box2d.hpp 0.00% <0.00%> (ø)
...ation_based_planner/optimization_based_planner.hpp 0.00% <0.00%> (ø)
..._planner/optimization_based_planner/s_boundary.hpp 0.00% <0.00%> (ø)
.../optimization_based_planner/velocity_optimizer.hpp 0.00% <0.00%> (ø)
..._cruise_planner/pid_based_planner/debug_values.hpp 0.00% <0.00%> (ø)
...se_planner/pid_based_planner/pid_based_planner.hpp 0.00% <0.00%> (ø)
...ruise_planner/pid_based_planner/pid_controller.hpp 0.00% <0.00%> (ø)
...lude/obstacle_cruise_planner/planner_interface.hpp 0.00% <0.00%> (ø)
... and 8 more

Continue to review full report at Codecov.

Legend - Click here to learn more
Δ = absolute <relative> (impact), ø = not affected, ? = missing data
Powered by Codecov. Last update ac96ce5...b9f8dde. Read the comment docs.

TakumiKozaka-T4 pushed a commit to TakumiKozaka-T4/autoware.universe that referenced this pull request Mar 23, 2022
* release v0.4.0

* Use MkDocs to generate the documentation (autowarefoundation#1346)

* Use MkDocs to generate the documentation

* Serach all docs source files under the root directory

* Add space

Co-authored-by: Kenji Miyake <[email protected]>

* Fix layout errors and 404 in the generated documentation (autowarefoundation#1348)

* Specify the site_url to prevent layout errors
* Add README.md since the top-level file could not be generated
* Change the MathJax URL since the current one will be deprecated 

Signed-off-by: Kenji Miyake <[email protected]>

Co-authored-by: IshitaTakeshi <[email protected]>

* adding css and favicons (autowarefoundation#1452)

* adding css and favicons

Signed-off-by: Masaya Kataoka <[email protected]>

* Update tierivcolor.css

* Rename CSS

Signed-off-by: Kenji Miyake <[email protected]>

* Don't remove css files

Signed-off-by: Kenji Miyake <[email protected]>

Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>

* Add dependabot (autowarefoundation#1561)

* add dependabot

* add pull request limit

* Change nested_indent for mkdocs (autowarefoundation#1639)

* Change nested_indent for mkdocs

Signed-off-by: Kenji Miyake <[email protected]>

* Fix a lint issue

Signed-off-by: Kenji Miyake <[email protected]>

* Add "/" to documentation URL

Signed-off-by: Kenji Miyake <[email protected]>

* Add pre-commit (autowarefoundation#1560)

* add pre-commit

* add pre-commit-config

* add additional settings for private repository

* use default pre-commit-config

* update pre-commit setting

* Ignore whitespace for line breaks in markdown

* Update .github/workflows/pre-commit.yml

Co-authored-by: Kazuki Miyahara <[email protected]>

* exclude svg

* remove pretty-format-json

* add double-quote-string-fixer

* consider COLCON_IGNORE file when seaching modified package

* format file

* pre-commit fixes

* Update pre-commit.yml

* Update .pre-commit-config.yaml

Co-authored-by: Kazuki Miyahara <[email protected]>
Co-authored-by: pre-commit <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>

* Add markdownlint and prettier (autowarefoundation#1661)

* Add markdownlint and prettier

Signed-off-by: Kenji Miyake <[email protected]>

* Ignore .param.yaml

Signed-off-by: Kenji Miyake <[email protected]>

* Apply format

Signed-off-by: Kenji Miyake <[email protected]>

* Fix MD029 (autowarefoundation#1813)

Signed-off-by: Kenji Miyake <[email protected]>

* Invoke code formatter at pre-commit (autowarefoundation#1935)

* Run ament_uncrustify at pre-commit

* Reformat existing files
* Fix copyright and cpplint errors

Signed-off-by: Kenji Miyake <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>

* 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 <[email protected]>

* Fix shellcheck

Signed-off-by: Kenji Miyake <[email protected]>

* update pre-commit-hooks-ros to v0.2.0 (autowarefoundation#2137)

* Auto-update pre-commit hooks (autowarefoundation#2138)

Co-authored-by: KeisukeShima <[email protected]>

* Auto-update pre-commit hooks (autowarefoundation#2146)

* Auto-update pre-commit hooks

* Update update-pre-commit.yml

Co-authored-by: kenji-miyake <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>

* Add markdown-link-check pre-commit (autowarefoundation#2215)

* add markdown-lint-check pre-commit

* delete files argument

* add optional hook

* modify comment

* add comment

* delete hook

* add retry option

* add option

* add files arg

* Fix links in hdd_reader.md

Signed-off-by: Kenji Miyake <[email protected]>

* Ignore 403

Signed-off-by: Kenji Miyake <[email protected]>

* Ignore tier4 github url

Signed-off-by: Kenji Miyake <[email protected]>

* Update link

Signed-off-by: Kenji Miyake <[email protected]>

Co-authored-by: Kenji Miyake <[email protected]>

* Auto-update pre-commit hooks (autowarefoundation#2323)

Co-authored-by: kenji-miyake <[email protected]>

* ignore .swp file (autowarefoundation#1833)

* Add settings for new formatters (autowarefoundation#2330)

* Update .pre-commit-config.yaml

Signed-off-by: Kenji Miyake <[email protected]>

* Ignore .cu for cpplint

Signed-off-by: Kenji Miyake <[email protected]>

* Update .clang-format

Signed-off-by: Kenji Miyake <[email protected]>

* Add setup.cfg

Signed-off-by: Kenji Miyake <[email protected]>

* Add CPPLINT.cfg

Signed-off-by: Kenji Miyake <[email protected]>

* Add autoware-lint-common

Signed-off-by: Kenji Miyake <[email protected]>

* Remove unnecessary part

Signed-off-by: Kenji Miyake <[email protected]>

* Add includeorder=standardcfirst

Signed-off-by: Kenji Miyake <[email protected]>

* Use clang-format-12

Signed-off-by: Kenji Miyake <[email protected]>

* Add IncludeCategories to clang-format

Signed-off-by: Kenji Miyake <[email protected]>

* Remove unnecessary file

Signed-off-by: Kenji Miyake <[email protected]>

* Temporarily comment out pre-commit hooks

Signed-off-by: Kenji Miyake <[email protected]>

* Fix indent miss

Signed-off-by: Kenji Miyake <[email protected]>

* Change include order rule and ignore build/include_order in cpplint

Signed-off-by: Kenji Miyake <[email protected]>

* 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 <[email protected]>

* Remove ament_cmake_uncrustify and ament_clang_format

Signed-off-by: Kenji Miyake <[email protected]>

* Apply Black

Signed-off-by: Kenji Miyake <[email protected]>

* Apply clang-format

Signed-off-by: Kenji Miyake <[email protected]>

* Fix build errors

Signed-off-by: Kenji Miyake <[email protected]>

* Fix for cpplint

* Fix include double quotes to angle brackets

Signed-off-by: Kenji Miyake <[email protected]>

* Apply clang-format

Signed-off-by: Kenji Miyake <[email protected]>

* Fix build errors

Signed-off-by: Kenji Miyake <[email protected]>

* Back port .auto control packages (autowarefoundation#571)

* Implement Lateral and Longitudinal Control Muxer

* [autowarefoundation#570] Porting wf_simulator

* [autowarefoundation#1189] Deactivate flaky test in 'trajectory_follower_nodes'

* [autowarefoundation#1189] Fix flacky test in 'trajectory_follower_nodes/latlon_muxer'

* [autowarefoundation#1057] Add osqp_interface package

* [autowarefoundation#1057] Add library code for MPC-based lateral control

* [autowarefoundation#1271] Use std::abs instead of abs

* [autowarefoundation#1057] Implement Lateral Controller for Cargo ODD

* [autowarefoundation#1246] Resolve "Test case names currently use snake_case but should be CamelCase"

* [autowarefoundation#1325] Deactivate flaky smoke test in 'trajectory_follower_nodes'

* [autowarefoundation#1058] Add library code of longitudinal controller

* Fix build error for trajectory follower

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

* Fix build error for trajectory follower nodes

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

* [autowarefoundation#1272] Add AckermannControlCommand support to simple_planning_simulator

* [autowarefoundation#1058] Add Longitudinal Controller node

* [autowarefoundation#1058] Rename velocity_controller -> longitudinal_controller

* [autowarefoundation#1058] Update CMakeLists.txt for the longitudinal_controller_node

* [autowarefoundation#1058] Add smoke test python launch file

* [autowarefoundation#1058] Use LowPassFilter1d from trajectory_follower

* [autowarefoundation#1058] Use autoware_auto_msgs

* [autowarefoundation#1058] Changes for .auto (debug msg tmp fix, common func, tf listener)

* [autowarefoundation#1058] Remove unused parameters

* [autowarefoundation#1058] Fix ros test

* [autowarefoundation#1058] Rm default params from declare_parameters + use autoware types

* [autowarefoundation#1058] Use default param file to setup NodeOptions in the ros test

* [autowarefoundation#1058] Fix docstring

* [autowarefoundation#1058] Replace receiving a Twist with a VehicleKinematicState

* [autowarefoundation#1058] Change class variables format to m_ prefix

* [autowarefoundation#1058] Fix plugin name of LongitudinalController in CMakeLists.txt

* [autowarefoundation#1058] Fix copyright dates

* [autowarefoundation#1058] Reorder includes

* [autowarefoundation#1058] Add some tests (~89% coverage without disabling flaky tests)

* [autowarefoundation#1058] Add more tests (90+% coverage without disabling flaky tests)

* [autowarefoundation#1058] Use Float32MultiArrayDiagnostic message for debug and slope

* [autowarefoundation#1058] Calculate wheel_base value from vehicle parameters

* [autowarefoundation#1058] Cleanup redundant logger setting in tests

* [autowarefoundation#1058] Set ROS_DOMAIN_ID when running tests to prevent CI failures

* [autowarefoundation#1058] Remove TF listener and use published vehicle state instead

* [autowarefoundation#1058] Change smoke tests to use autoware_testing

* [autowarefoundation#1058] Add plotjuggler cfg for both lateral and longitudinal control

* [autowarefoundation#1058] Improve design documents

* [autowarefoundation#1058] Disable flaky test

* [autowarefoundation#1058] Properly transform vehicle state in longitudinal node

* [autowarefoundation#1058] Fix TF buffer of lateral controller

* [autowarefoundation#1058] Tuning of lateral controller for LGSVL

* [autowarefoundation#1058] Fix formating

* [autowarefoundation#1058] Fix /tf_static sub to be transient_local

* [autowarefoundation#1058] Fix yaw recalculation of reverse trajs in the lateral controller

* modify trajectory_follower for galactic build

Signed-off-by: Takamasa Horibe <[email protected]>

* [autowarefoundation#1379] Update trajectory_follower

* [autowarefoundation#1379] Update simple_planning_simulator

* [autowarefoundation#1379] Update trajectory_follower_nodes

* apply trajectory msg modification in control

Signed-off-by: Takamasa Horibe <[email protected]>

* move directory

Signed-off-by: Takamasa Horibe <[email protected]>

* remote control/trajectory_follower level dorectpry

Signed-off-by: Takamasa Horibe <[email protected]>

* remove .iv trajectory follower

Signed-off-by: Takamasa Horibe <[email protected]>

* use .auto trajectory_follower

Signed-off-by: Takamasa Horibe <[email protected]>

* remove .iv simple_planning_simulator & osqp_interface

Signed-off-by: Takamasa Horibe <[email protected]>

* use .iv simple_planning_simulator & osqp_interface

Signed-off-by: Takamasa Horibe <[email protected]>

* add tmp_autoware_auto_dependencies

Signed-off-by: Takamasa Horibe <[email protected]>

* tmporally add autoware_auto_msgs

Signed-off-by: Takamasa Horibe <[email protected]>

* apply .auto message split

Signed-off-by: Takamasa Horibe <[email protected]>

* fix build depend

Signed-off-by: Takamasa Horibe <[email protected]>

* fix packages using osqp

* fix autoware_auto_geometry

* ignore lint of some packages

* ignore ament_lint of some packages

* ignore lint/pre-commit of trajectory_follower_nodes

* disable unit tests of some packages

Co-authored-by: Maxime CLEMENT <[email protected]>
Co-authored-by: Joshua Whitley <[email protected]>
Co-authored-by: Igor Bogoslavskyi <[email protected]>
Co-authored-by: MIURA Yasuyuki <[email protected]>
Co-authored-by: wep21 <[email protected]>
Co-authored-by: tomoya.kimura <[email protected]>

* Port parking planner packages from .Auto (autowarefoundation#600)

* Copy code of 'vehicle_constants_manager'

* Fix vehicle_constants_manager for ROS galactic

* Rm .iv costmap_generator freespace_planner freespace_planning_aglorihtms

* Add astar_search (from .Auto)

* Copy freespace_planner from .Auto

* Update freespace_planner for .IV

* Copy costmap_generator from .Auto

* Copy and update had_map_utils from .Auto

* Update costmap_generator

* Copy costmap_generator_nodes

* Update costmap_generator_nodes

* Comment out all tests

* Move vehicle_constant_managers to tmp_autoware_auto_dependencies

* ignore pre-commit for back-ported packages

Signed-off-by: Takamasa Horibe <[email protected]>

* ignore testing

Signed-off-by: Takamasa Horibe <[email protected]>

Co-authored-by: Takamasa Horibe <[email protected]>

* adding autoware_auto_perception_rviz_plugin (autowarefoundation#574)

* [152] Implement BoundingBoxArray rviz display plugin.

* [285] Clear bounding box markers before adding new markers on new message

* [274] Trajectory visualization plugin

* raw types to sized type

* ControllerTestingNode: added publish_state(), publish_trajectory(), no timer hack to start test, all init is init()

* Squashed 'src/external/mpc/' changes from 8fc7cfdd..eaa5908b

eaa5908b Merge branch 'input-weight-modify' into 'master'
b9ee8e4f Update default mpc_controller_node parameters
8d15f49d Add weights to acceleration and steer controls; loosen simulation test case:

git-subtree-dir: src/external/mpc
git-subtree-split: eaa5908bdd987051a9dcd9c505f99bfd7f028547

* [autowarefoundation#404] apply ament_auto macro to autoware_rviz_plugins

* Adding missing dependency on rviz2.

* Squashed 'src/external/autoware_auto_msgs/' changes from 56550efd..f40970ea

f40970ea Adding velocity_mps to VehicleControlCommand.

git-subtree-dir: src/external/autoware_auto_msgs
git-subtree-split: f40970ead34d36a695b432dc37accff9d67c17e2

* Update copyright headers to transfer ownership to Autoware Foundation

Signed-off-by: Juan Pablo Samper <[email protected]>

* Add CHANGELOG and update package versions for release

Add CHANGELOG and update package versions for release

* [autowarefoundation#286] Parameterize boundingbox colors from rviz
 - Add visualization colours via Qt

* [autowarefoundation#813] use autoware_set_compile_options() for nearly all compiled tests

- fix a few causes of warnings and disable warning flags as needed for
other tests
- set CXX_STANDARD strictly and only in a single place
- add CMake flag `AUTOWARE_OPTIMIZATION_OF_SLOW_TARGETS`. Default: OFF
- update building instructions and MR template
- fix nasty initialization error of static constexpr member in `GenericState`
of Kalman filter

* [autowarefoundation#910] remove private compilation warning ignore flags

* [autowarefoundation#900] Implement rviz plugin to visualize TrackedObjects

* [autowarefoundation#1110] Implement rviz plugin for DetectedObjects msg

* Resolve "Clarify meaning of pose in *ObjectKinematics messages"

* [autowarefoundation#1221] Add co-developed entry to copyright

* [autowarefoundation#1282] Fix double free in ObjectPolygonDisplayBase rviz plugin

* [autowarefoundation#1355] Make DetectedObject shape corners be in object-local coordinates

* porting AAP perception visualization from https://github.com/tier4/AutowareArchitectureProposal.iv/blob/main/perception/util/visualizer/dynamic_object_visualization/include/dynamic_object_visualization/dynamic_object_visualizer.hpp

* rename to autoware_auto_perception_rviz_plugin

* fix copyright

* format code

* fix typo

* convert camel to snake case

* Apply suggestions from code review

Co-authored-by: Daisuke Nishimatsu <[email protected]>

* change color

* replace boost::optional to std::optional

* add icons

* set marker id to value corresponding to the upper 32 bits of uuid

* format code

* change motorsycle color

* add uuid map to set marker id

* format code

* remove brief comment

* fix lint error

* fix include sort

* format code

* fix include

* add autoware_auto_perception_rviz_plugin to pre commit excluded list

Co-authored-by: Yunus Emre Caliskan <[email protected]>
Co-authored-by: Christopher Ho <[email protected]>
Co-authored-by: MIURA Yasuyuki <[email protected]>
Co-authored-by: Jit Ray Chowdhury <[email protected]>
Co-authored-by: Joshua Whitley <[email protected]>
Co-authored-by: Juan Pablo Samper <[email protected]>
Co-authored-by: Jilada Eccleston <[email protected]>
Co-authored-by: Frederik Beaujean <[email protected]>
Co-authored-by: Vincent Richard <[email protected]>
Co-authored-by: Gowtham <[email protected]>
Co-authored-by: Nikolai Morin <[email protected]>
Co-authored-by: Igor Bogoslavskyi <[email protected]>
Co-authored-by: Daisuke Nishimatsu <[email protected]>

* style(prettier): change printWitdh

Signed-off-by: Kenji Miyake <[email protected]>

* chore: add empty build_depends.repos

Signed-off-by: Kenji Miyake <[email protected]>

* style: fix styles of .pre-commit-config.yaml

Signed-off-by: Kenji Miyake <[email protected]>

* docs(mkdocs): update settings

Signed-off-by: Kenji Miyake <[email protected]>

* chore: update .gitignore

Signed-off-by: Kenji Miyake <[email protected]>

* chore: update .markdown-link-check.json

Signed-off-by: Kenji Miyake <[email protected]>

* chore: update .pre-commit-config.yaml

Signed-off-by: Kenji Miyake <[email protected]>

Co-authored-by: mitsudome-r <[email protected]>
Co-authored-by: Ishita Takeshi <[email protected]>
Co-authored-by: Masaya Kataoka <[email protected]>
Co-authored-by: Keisuke Shima <[email protected]>
Co-authored-by: Kazuki Miyahara <[email protected]>
Co-authored-by: pre-commit <[email protected]>
Co-authored-by: autoware-iv-sync-ci[bot] <87871706+autoware-iv-sync-ci[bot]@users.noreply.github.com>
Co-authored-by: KeisukeShima <[email protected]>
Co-authored-by: kenji-miyake <[email protected]>
Co-authored-by: Satoshi OTA <[email protected]>
Co-authored-by: Takamasa Horibe <[email protected]>
Co-authored-by: Maxime CLEMENT <[email protected]>
Co-authored-by: Joshua Whitley <[email protected]>
Co-authored-by: Igor Bogoslavskyi <[email protected]>
Co-authored-by: MIURA Yasuyuki <[email protected]>
Co-authored-by: wep21 <[email protected]>
Co-authored-by: tomoya.kimura <[email protected]>
Co-authored-by: Maxime CLEMENT <[email protected]>
Co-authored-by: Taichi Higashide <[email protected]>
Co-authored-by: Yunus Emre Caliskan <[email protected]>
Co-authored-by: Christopher Ho <[email protected]>
Co-authored-by: Jit Ray Chowdhury <[email protected]>
Co-authored-by: Juan Pablo Samper <[email protected]>
Co-authored-by: Jilada Eccleston <[email protected]>
Co-authored-by: Frederik Beaujean <[email protected]>
Co-authored-by: Vincent Richard <[email protected]>
Co-authored-by: Gowtham <[email protected]>
Co-authored-by: Nikolai Morin <[email protected]>
Co-authored-by: Daisuke Nishimatsu <[email protected]>
TakumiKozaka-T4 pushed a commit to TakumiKozaka-T4/autoware.universe that referenced this pull request Mar 23, 2022
* Ros2 v0.8.0 velodyne monitor (autowarefoundation#285)

* Rename ROS-related .yaml to .param.yaml (autowarefoundation#352)

* Rename ROS-related .yaml to .param.yaml

Signed-off-by: Kenji Miyake <[email protected]>

* Remove prefix 'default_' of yaml files

Signed-off-by: Kenji Miyake <[email protected]>

* Rename vehicle_info.yaml to vehicle_info.param.yaml

Signed-off-by: Kenji Miyake <[email protected]>

* Rename diagnostic_aggregator's param files

Signed-off-by: Kenji Miyake <[email protected]>

* Fix overlooked parameters

Signed-off-by: Kenji Miyake <[email protected]>

* add use_sim-time option (autowarefoundation#454)

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

* Remove use_sim_time for set_parameter (autowarefoundation#1260)

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

* Add exception handling for extract_json() (autowarefoundation#1779)

* Add exception handling for extract_json()

Signed-off-by: Takayuki AKAMINE <[email protected]>

* Add diagnostics error when catching exception

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

Co-authored-by: Takayuki AKAMINE <[email protected]>

* Fix -Wunused-parameter (autowarefoundation#1836)

* Fix -Wunused-parameter

Signed-off-by: Kenji Miyake <[email protected]>

* Fix mistake

Signed-off-by: Kenji Miyake <[email protected]>

* fix spell

* Fix lint issues

Signed-off-by: Kenji Miyake <[email protected]>

* Ignore flake8 warnings

Signed-off-by: Kenji Miyake <[email protected]>

Co-authored-by: Hiroki OTA <[email protected]>

* Fix compiler warnings (autowarefoundation#1837)

* Fix -Wunused-private-field

Signed-off-by: Kenji Miyake <[email protected]>

* Fix -Wunused-variable

Signed-off-by: Kenji Miyake <[email protected]>

* Fix -Wformat-security

Signed-off-by: Kenji Miyake <[email protected]>

* Fix -Winvalid-constexpr

Signed-off-by: Kenji Miyake <[email protected]>

* Fix -Wdelete-non-abstract-non-virtual-dtor

Signed-off-by: Kenji Miyake <[email protected]>

* Fix -Wdelete-abstract-non-virtual-dtor

Signed-off-by: Kenji Miyake <[email protected]>

* Fix -Winconsistent-missing-override

Signed-off-by: Kenji Miyake <[email protected]>

* Fix -Wrange-loop-construct

Signed-off-by: Kenji Miyake <[email protected]>

* Fix "invalid application of 'sizeof' to an incomplete type"

Signed-off-by: Kenji Miyake <[email protected]>

* Ignore -Wgnu-anonymous-struct and -Wnested-anon-types

Signed-off-by: Kenji Miyake <[email protected]>

* Fix lint

Signed-off-by: Kenji Miyake <[email protected]>

* Ignore -Wno-deprecated-declarations in CUDA-related packages

Signed-off-by: Kenji Miyake <[email protected]>

* Fix mistake

Signed-off-by: Kenji Miyake <[email protected]>

* Fix -Wunused-parameter

Signed-off-by: Kenji Miyake <[email protected]>

* Remove duplicated update (autowarefoundation#2072) (autowarefoundation#2084)

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

Co-authored-by: Daisuke Nishimatsu <[email protected]>

* Fix velodyne monitor config file variable name (autowarefoundation#2090) (autowarefoundation#2092)

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

Co-authored-by: j4tfwm6z <[email protected]>

Co-authored-by: Daisuke Nishimatsu <[email protected]>
Co-authored-by: j4tfwm6z <[email protected]>

* 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 <[email protected]>

* Remove ament_cmake_uncrustify and ament_clang_format

Signed-off-by: Kenji Miyake <[email protected]>

* Apply Black

Signed-off-by: Kenji Miyake <[email protected]>

* Apply clang-format

Signed-off-by: Kenji Miyake <[email protected]>

* Fix build errors

Signed-off-by: Kenji Miyake <[email protected]>

* Fix for cpplint

* Fix include double quotes to angle brackets

Signed-off-by: Kenji Miyake <[email protected]>

* Apply clang-format

Signed-off-by: Kenji Miyake <[email protected]>

* Fix build errors

Signed-off-by: Kenji Miyake <[email protected]>

* Add COLCON_IGNORE (autowarefoundation#500)

Signed-off-by: Kenji Miyake <[email protected]>

* remove COLCON_IGNORE in system_packages and map_tf_generator (autowarefoundation#532)

* [Velodyne monitor]add readme (autowarefoundation#570)

* add readme

* change the description

* Update system/velodyne_monitor/Readme.md

Co-authored-by: Kazuki Miyahara <[email protected]>

* Update system/velodyne_monitor/Readme.md

Co-authored-by: Kazuki Miyahara <[email protected]>

* Update system/velodyne_monitor/Readme.md

Co-authored-by: Kazuki Miyahara <[email protected]>

* velodyne -> velodyne lidar

* Update system/velodyne_monitor/Readme.md

Co-authored-by: Daisuke Nishimatsu <[email protected]>

* Update system/velodyne_monitor/Readme.md

Co-authored-by: Kazuki Miyahara <[email protected]>

Co-authored-by: Kazuki Miyahara <[email protected]>
Co-authored-by: Daisuke Nishimatsu <[email protected]>

Co-authored-by: Daisuke Nishimatsu <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Kazuki Miyahara <[email protected]>
Co-authored-by: Takayuki AKAMINE <[email protected]>
Co-authored-by: Hiroki OTA <[email protected]>
Co-authored-by: autoware-iv-sync-ci[bot] <87871706+autoware-iv-sync-ci[bot]@users.noreply.github.com>
Co-authored-by: j4tfwm6z <[email protected]>
Co-authored-by: Takeshi Miura <[email protected]>
Co-authored-by: taikitanaka3 <[email protected]>
TakumiKozaka-T4 pushed a commit to TakumiKozaka-T4/autoware.universe that referenced this pull request Mar 23, 2022
* release v0.4.0

* Add spline interpolation library (autowarefoundation#705)

* Feature/intersection use spline interpolation library (autowarefoundation#710)

* Use spline_interpolation module

* Remove debug messages

* Fix/spline interpolation in intersection module (autowarefoundation#726)

* Remove duplicating sample points

* Change isValidInput

* Apply clang-format

* Fix convergence check in PCG

* update osqp interface (autowarefoundation#730)

* remove ROS1 packages temporarily

Signed-off-by: mitsudome-r <[email protected]>

* add sample ros2 packages

Signed-off-by: mitsudome-r <[email protected]>

* remove ROS1 packages

Signed-off-by: mitsudome-r <[email protected]>

* Revert "remove ROS1 packages temporarily"

This reverts commit 7127cf7.

Signed-off-by: mitsudome-r <[email protected]>

* add COLCON_IGNORE to ros1 packages

Signed-off-by: mitsudome-r <[email protected]>

* Port osqp-interface to ros2 (autowarefoundation#45)

It doesn't use any ros functionality so the source code is unchanged, only `package.xml` and `CMakeLists.txt` needed to
be modified. But osqp is added through a vendor package created at https://github.com/tier4/osqp_vendor

To test this locally, eigen needs to be installed in the environment with

    sudo apt install libeigen3-dev

* Port spline interpolation to ros2. (autowarefoundation#65)

* Fix osqp_interface dependencies (autowarefoundation#66)

* [osqp_interface] fix eigen3 dependencies

fixes autowarefoundation#63

* Fix link order in consumers of osqp_interface

* Update logger name for SOR class (autowarefoundation#87)

Signed-off-by: Servando German Serrano <[email protected]>

* Rename h files to hpp (autowarefoundation#142)

* Change includes

* Rename files

* Adjustments to make things compile

* Other packages

* Adjust copyright notice on 532 out of 699 source files (autowarefoundation#143)

* Use quotes for includes where appropriate (autowarefoundation#144)

* Use quotes for includes where appropriate

* Fix lint tests

* Make tests pass hopefully

* Run uncrustify on the entire Pilot.Auto codebase (autowarefoundation#151)

* Run uncrustify on the entire Pilot.Auto codebase

* Exclude open PRs

* ROS2 Linting: osqp_interface (autowarefoundation#202)

* Add linters

* Fix clang-tidy missing header error

* ROS2 Linting: spline_interpolation (autowarefoundation#203)

* Add linters and fix indentation in package.xml

* Address PR comments:
 - Convert indents to spaces

* Use two spaces for indent

Co-authored-by: Esteve Fernandez <[email protected]>

* Fix out-of-range bug of spline_interpolation (autowarefoundation#917) (autowarefoundation#273)

Signed-off-by: Kenji Miyake <[email protected]>

Co-authored-by: Kenji Miyake <[email protected]>

* Ros2 v0.8.0 osqp interface (autowarefoundation#271)

* restore file name for v0.8.0 update

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

* Fix typos in common modules (autowarefoundation#914)

* fix typos in common modules

* minor fix (lowercasing)

* revert changes in PathPoint.msg

* Fix/osqp interface api error (autowarefoundation#969)

* [osqp_interface] fix update setting api

Signed-off-by: Takamasa Horibe <[email protected]>

* [osqp_interface] fix format

Signed-off-by: Takamasa Horibe <[email protected]>

* Revert "restore file name for v0.8.0 update"

This reverts commit b767c308d492c6f754f9aa45ab9521f209ad9c9c.

Co-authored-by: Kazuki Miyahara <[email protected]>
Co-authored-by: Takamasa Horibe <[email protected]>

* Ros2 v0.8.0 ekf localizer (autowarefoundation#270)

* restore file name for v0.8.0 update

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

* fix typos in localization (autowarefoundation#890)

* move kalman filter to lib package (autowarefoundation#1141)

* move kalman filter to lib package

* add kalman_filter dir

* Revert "restore file name for v0.8.0 update"

This reverts commit 485111da0aba91eeddda77e1e3b6b3f517373163.

Co-authored-by: Kazuki Miyahara <[email protected]>
Co-authored-by: Yukihiro Saito <[email protected]>

* Feature/ekf tracker (autowarefoundation#1158) (autowarefoundation#381)

* Feature/ekf tracker (autowarefoundation#1158)

* change to ekf tracker

* visualize covariance

* cosmetic change

* cosmetic change

* change param

* add multi model ekf tracker (autowarefoundation#1165)

* add multi model ekf tracker

* cosmetic change

* cosmetic change

* add iou filter

* change correct license

* change correct license

* cosmetic change

* bug fix

* cosmetic change

* check clockwise

* change param

* bug fix

* cosmetic change

* add comment

* add enum

* cosmetic change

* cosmetic change

* apply format

* apply format

* fix config name

Signed-off-by: mitsudome-r <[email protected]>

* [multi_object_tracker] apply ament_uncrustify

Signed-off-by: mitsudome-r <[email protected]>

* [multi_object_tracker] fix lint errors

Signed-off-by: mitsudome-r <[email protected]>

* fix include brackets

Signed-off-by: mitsudome-r <[email protected]>

* Fix typo in common module (autowarefoundation#433)

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

* Make control modules components (autowarefoundation#1262)

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

* Make planning modules components (autowarefoundation#1263)

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

* Porting small fix (autowarefoundation#1288)

* Delete unused code (autowarefoundation#1183)

* Fix control topic name of closest_velocity_checker.py (autowarefoundation#1174)

Signed-off-by: Kenji Miyake <[email protected]>

* Add comments for livox tag (autowarefoundation#1188)

Signed-off-by: Kenji Miyake <[email protected]>

* Clear return value (autowarefoundation#1193)

* Change tracker model of unknown object (autowarefoundation#1204)

* treat polygon points as relative (autowarefoundation#1205)

Signed-off-by: Kosuke Murakami <[email protected]>

* hotfix: reference velocity in consideration of vehicle gear (autowarefoundation#1213)

* fix reference velocity for vehicle gear

* add initialization

* revert

* add comment

* change max area param (autowarefoundation#1218)

* Fix an identical code for different branches (autowarefoundation#1230)

* Update livox_tag_filter.launch.xml

* Fixup

Signed-off-by: Kenji Miyake <[email protected]>

Co-authored-by: shin <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Fumiya Watanabe <[email protected]>
Co-authored-by: Yukihiro Saito <[email protected]>
Co-authored-by: Kosuke Murakami <[email protected]>
Co-authored-by: Hiroki OTA <[email protected]>
Co-authored-by: tkimura4 <[email protected]>
Co-authored-by: Kazuki Miyahara <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>

* Fix osqp interface double free problem (autowarefoundation#1327)

* Use smart pointers for members

* Add test code

* Fix typo

* Fix test code

* Change variable name

* Fix for lint test

* Fix include

* Fix header and CMakeLists.txt

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

Co-authored-by: wep21 <[email protected]>

* add new updater function to osqp_interface (autowarefoundation#1433) (autowarefoundation#1483)

* add new updater function

* modify spell

Co-authored-by: purewater0901 <[email protected]>

* Add pre-commit (autowarefoundation#1560)

* add pre-commit

* add pre-commit-config

* add additional settings for private repository

* use default pre-commit-config

* update pre-commit setting

* Ignore whitespace for line breaks in markdown

* Update .github/workflows/pre-commit.yml

Co-authored-by: Kazuki Miyahara <[email protected]>

* exclude svg

* remove pretty-format-json

* add double-quote-string-fixer

* consider COLCON_IGNORE file when seaching modified package

* format file

* pre-commit fixes

* Update pre-commit.yml

* Update .pre-commit-config.yaml

Co-authored-by: Kazuki Miyahara <[email protected]>
Co-authored-by: pre-commit <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>

* Fix -Wunused-parameter (autowarefoundation#1836)

* Fix -Wunused-parameter

Signed-off-by: Kenji Miyake <[email protected]>

* Fix mistake

Signed-off-by: Kenji Miyake <[email protected]>

* fix spell

* Fix lint issues

Signed-off-by: Kenji Miyake <[email protected]>

* Ignore flake8 warnings

Signed-off-by: Kenji Miyake <[email protected]>

Co-authored-by: Hiroki OTA <[email protected]>

* Fix bugprone-fold-init-type in spline_interpolation (autowarefoundation#1816)

* Fix bugprone-fold-init-type

* Fix modernize-use-override

* Fix cppcoreguidelines-pro-type-member-init

* Fix modernize-loop-convert

* 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

* remove spline_interpolation, and create interpolation package that ha… (autowarefoundation#2114)

* remove spline_interpolation and add interpolation package

* fix bugs and add simple test

* modify application for interpolation package

* add some tests and fix ci test

* add some tests

* add -Werror

* move functions to anonymous

* fix reviews

* fix typo

* fix review and lint

* add tests

* resolve TODOs

* add README.md

* Update common/math/interpolation/test/src/test_interpolation_utils.cpp

Co-authored-by: Kenji Miyake <[email protected]>

* Update common/math/interpolation/test/src/test_interpolation_utils.cpp

Co-authored-by: Kenji Miyake <[email protected]>

* Update common/math/interpolation/test/src/test_interpolation_utils.cpp

Co-authored-by: Kenji Miyake <[email protected]>

* fix README.md

* dealt with reviews

* update README.md

* update README.md

* Update common/math/interpolation/README.md

* fix some bugs

* fix typo

* update README.md

* Update common/math/interpolation/README.md

Co-authored-by: Kazuki Miyahara <[email protected]>

* fix test

* Update common/math/interpolation/README.md

Co-authored-by: Kazuki Miyahara <[email protected]>

* fix cdots

* fix README.md

* Update common/math/interpolation/README.md

Co-authored-by: Kazuki Miyahara <[email protected]>

Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Kazuki Miyahara <[email protected]>

* Feature/lpf in common ros2 (autowarefoundation#1628)

* add first order lowpass filter (autowarefoundation#1505)

* add first order lowpass filter

* fix bugs, and add tests

* update copyright

* apply clang-format

* add another constructor

* add another reset member function

* update

* add test

* update test

* update test

* rename lowpass filter to signal processing

* Porting lpf1d to ros2

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

Co-authored-by: Takayuki Murooka <[email protected]>

* [osqp interface] size check invalid argument error ros2 (autowarefoundation#1870)

* throw invalid_argument when osqp matrix/vector are invalid

* add test for invalid_argumetn

* 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 <[email protected]>

* Remove ament_cmake_uncrustify and ament_clang_format

Signed-off-by: Kenji Miyake <[email protected]>

* Apply Black

Signed-off-by: Kenji Miyake <[email protected]>

* Apply clang-format

Signed-off-by: Kenji Miyake <[email protected]>

* Fix build errors

Signed-off-by: Kenji Miyake <[email protected]>

* Fix for cpplint

* Fix include double quotes to angle brackets

Signed-off-by: Kenji Miyake <[email protected]>

* Apply clang-format

Signed-off-by: Kenji Miyake <[email protected]>

* Fix build errors

Signed-off-by: Kenji Miyake <[email protected]>

* Add COLCON_IGNORE (autowarefoundation#500)

Signed-off-by: Kenji Miyake <[email protected]>

* remove COLCON_IGNORE (autowarefoundation#506)

Co-authored-by: Takayuki Murooka <[email protected]>

* Remove COLCON_IGNORE from interpolation (autowarefoundation#516)

* delete COLCON IGNORE in signal processing package(autowarefoundation#537)

* Delet colcon ignore (autowarefoundation#534)

* Back port .auto control packages (autowarefoundation#571)

* Implement Lateral and Longitudinal Control Muxer

* [autowarefoundation#570] Porting wf_simulator

* [autowarefoundation#1189] Deactivate flaky test in 'trajectory_follower_nodes'

* [autowarefoundation#1189] Fix flacky test in 'trajectory_follower_nodes/latlon_muxer'

* [autowarefoundation#1057] Add osqp_interface package

* [autowarefoundation#1057] Add library code for MPC-based lateral control

* [autowarefoundation#1271] Use std::abs instead of abs

* [autowarefoundation#1057] Implement Lateral Controller for Cargo ODD

* [autowarefoundation#1246] Resolve "Test case names currently use snake_case but should be CamelCase"

* [autowarefoundation#1325] Deactivate flaky smoke test in 'trajectory_follower_nodes'

* [autowarefoundation#1058] Add library code of longitudinal controller

* Fix build error for trajectory follower

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

* Fix build error for trajectory follower nodes

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

* [autowarefoundation#1272] Add AckermannControlCommand support to simple_planning_simulator

* [autowarefoundation#1058] Add Longitudinal Controller node

* [autowarefoundation#1058] Rename velocity_controller -> longitudinal_controller

* [autowarefoundation#1058] Update CMakeLists.txt for the longitudinal_controller_node

* [autowarefoundation#1058] Add smoke test python launch file

* [autowarefoundation#1058] Use LowPassFilter1d from trajectory_follower

* [autowarefoundation#1058] Use autoware_auto_msgs

* [autowarefoundation#1058] Changes for .auto (debug msg tmp fix, common func, tf listener)

* [autowarefoundation#1058] Remove unused parameters

* [autowarefoundation#1058] Fix ros test

* [autowarefoundation#1058] Rm default params from declare_parameters + use autoware types

* [autowarefoundation#1058] Use default param file to setup NodeOptions in the ros test

* [autowarefoundation#1058] Fix docstring

* [autowarefoundation#1058] Replace receiving a Twist with a VehicleKinematicState

* [autowarefoundation#1058] Change class variables format to m_ prefix

* [autowarefoundation#1058] Fix plugin name of LongitudinalController in CMakeLists.txt

* [autowarefoundation#1058] Fix copyright dates

* [autowarefoundation#1058] Reorder includes

* [autowarefoundation#1058] Add some tests (~89% coverage without disabling flaky tests)

* [autowarefoundation#1058] Add more tests (90+% coverage without disabling flaky tests)

* [autowarefoundation#1058] Use Float32MultiArrayDiagnostic message for debug and slope

* [autowarefoundation#1058] Calculate wheel_base value from vehicle parameters

* [autowarefoundation#1058] Cleanup redundant logger setting in tests

* [autowarefoundation#1058] Set ROS_DOMAIN_ID when running tests to prevent CI failures

* [autowarefoundation#1058] Remove TF listener and use published vehicle state instead

* [autowarefoundation#1058] Change smoke tests to use autoware_testing

* [autowarefoundation#1058] Add plotjuggler cfg for both lateral and longitudinal control

* [autowarefoundation#1058] Improve design documents

* [autowarefoundation#1058] Disable flaky test

* [autowarefoundation#1058] Properly transform vehicle state in longitudinal node

* [autowarefoundation#1058] Fix TF buffer of lateral controller

* [autowarefoundation#1058] Tuning of lateral controller for LGSVL

* [autowarefoundation#1058] Fix formating

* [autowarefoundation#1058] Fix /tf_static sub to be transient_local

* [autowarefoundation#1058] Fix yaw recalculation of reverse trajs in the lateral controller

* modify trajectory_follower for galactic build

Signed-off-by: Takamasa Horibe <[email protected]>

* [autowarefoundation#1379] Update trajectory_follower

* [autowarefoundation#1379] Update simple_planning_simulator

* [autowarefoundation#1379] Update trajectory_follower_nodes

* apply trajectory msg modification in control

Signed-off-by: Takamasa Horibe <[email protected]>

* move directory

Signed-off-by: Takamasa Horibe <[email protected]>

* remote control/trajectory_follower level dorectpry

Signed-off-by: Takamasa Horibe <[email protected]>

* remove .iv trajectory follower

Signed-off-by: Takamasa Horibe <[email protected]>

* use .auto trajectory_follower

Signed-off-by: Takamasa Horibe <[email protected]>

* remove .iv simple_planning_simulator & osqp_interface

Signed-off-by: Takamasa Horibe <[email protected]>

* use .iv simple_planning_simulator & osqp_interface

Signed-off-by: Takamasa Horibe <[email protected]>

* add tmp_autoware_auto_dependencies

Signed-off-by: Takamasa Horibe <[email protected]>

* tmporally add autoware_auto_msgs

Signed-off-by: Takamasa Horibe <[email protected]>

* apply .auto message split

Signed-off-by: Takamasa Horibe <[email protected]>

* fix build depend

Signed-off-by: Takamasa Horibe <[email protected]>

* fix packages using osqp

* fix autoware_auto_geometry

* ignore lint of some packages

* ignore ament_lint of some packages

* ignore lint/pre-commit of trajectory_follower_nodes

* disable unit tests of some packages

Co-authored-by: Maxime CLEMENT <[email protected]>
Co-authored-by: Joshua Whitley <[email protected]>
Co-authored-by: Igor Bogoslavskyi <[email protected]>
Co-authored-by: MIURA Yasuyuki <[email protected]>
Co-authored-by: wep21 <[email protected]>
Co-authored-by: tomoya.kimura <[email protected]>

* add readme signal processing (autowarefoundation#587)

* add readme signal processing

* better fix

* add readme in kalman_filter (autowarefoundation#633)

* ci(pre-commit): autofix

Co-authored-by: mitsudome-r <[email protected]>
Co-authored-by: Fumiya Watanabe <[email protected]>
Co-authored-by: Kosuke Murakami <[email protected]>
Co-authored-by: Frederik Beaujean <[email protected]>
Co-authored-by: Yunus Emre Çalışkan <[email protected]>
Co-authored-by: Servando <[email protected]>
Co-authored-by: Nikolai Morin <[email protected]>
Co-authored-by: Jilada Eccleston <[email protected]>
Co-authored-by: Jilada Eccleston <[email protected]>
Co-authored-by: Esteve Fernandez <[email protected]>
Co-authored-by: Daisuke Nishimatsu <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Kazuki Miyahara <[email protected]>
Co-authored-by: Takamasa Horibe <[email protected]>
Co-authored-by: Yukihiro Saito <[email protected]>
Co-authored-by: Ryohsuke Mitsudome <[email protected]>
Co-authored-by: Keisuke Shima <[email protected]>
Co-authored-by: shin <[email protected]>
Co-authored-by: Hiroki OTA <[email protected]>
Co-authored-by: tkimura4 <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: wep21 <[email protected]>
Co-authored-by: purewater0901 <[email protected]>
Co-authored-by: Keisuke Shima <[email protected]>
Co-authored-by: pre-commit <[email protected]>
Co-authored-by: Takayuki Murooka <[email protected]>
Co-authored-by: Takayuki Murooka <[email protected]>
Co-authored-by: Sugatyon <[email protected]>
Co-authored-by: Yohei Mishina <[email protected]>
Co-authored-by: Maxime CLEMENT <[email protected]>
Co-authored-by: Joshua Whitley <[email protected]>
Co-authored-by: Igor Bogoslavskyi <[email protected]>
Co-authored-by: MIURA Yasuyuki <[email protected]>
Co-authored-by: Takeshi Miura <[email protected]>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>
TakumiKozaka-T4 pushed a commit to TakumiKozaka-T4/autoware.universe that referenced this pull request Mar 23, 2022
* release v0.4.0

* add dynamic_reconfigure to obstacle avoidance planner (autowarefoundation#673)

* fix apply dynamic param (autowarefoundation#704)

* add warning logging to foa.data.is_is_avoidance_possible (autowarefoundation#725)

* Feature/improve obstacle avoidance (autowarefoundation#731)

* add license terms (autowarefoundation#941)

* remove ROS1 packages temporarily

Signed-off-by: mitsudome-r <[email protected]>

* Revert "remove ROS1 packages temporarily"

This reverts commit 10813fa0e7b67c9ad6c7d4df6aeee0931c866b41.

Signed-off-by: mitsudome-r <[email protected]>

* add COLCON_IGNORE to ros1 packages

Signed-off-by: mitsudome-r <[email protected]>

* Rename launch files to launch.xml (autowarefoundation#28)

* Port of obstacle avoidance planner to ROS2 (autowarefoundation#83)

* Port to ROS2

Signed-off-by: Servando German Serrano <[email protected]>

* Removed ros/console include

Signed-off-by: Servando German Serrano <[email protected]>

* Added THROTTLE

Signed-off-by: Servando German Serrano <[email protected]>

* Changed numbers to floats

Signed-off-by: Servando German Serrano <[email protected]>

* Removed <double> from params

Signed-off-by: Servando German Serrano <[email protected]>

* Added new msg

Signed-off-by: Servando German Serrano <[email protected]>

* Use new msg

Signed-off-by: Servando German Serrano <[email protected]>

* Replaced dynamic reconfigure

Signed-off-by: Servando German Serrano <[email protected]>

* Added EnableAvoidance.msg

Signed-off-by: Servando German Serrano <[email protected]>

* Fixed parameter mismatch

Signed-off-by: Servando German Serrano <[email protected]>

* Fix launch files (autowarefoundation#122)

* [surround_obstacle_checker] add parameter and arguments to launch file

Signed-off-by: mitsudome-r <[email protected]>

* [obstacle_stop_planner] modify launch file to remap trajectory from argument

Signed-off-by: mitsudome-r <[email protected]>

* [obstacle_avoidance_planner] modify launch file to remap topics from arguments

Signed-off-by: mitsudome-r <[email protected]>

* [motion_velocity_optimizer] modify launch file to enable remapping from argument

Signed-off-by: mitsudome-r <[email protected]>

* Convert calls of Duration to Duration::from_seconds where appropriate (autowarefoundation#131)

* Rename h files to hpp (autowarefoundation#142)

* Change includes

* Rename files

* Adjustments to make things compile

* Other packages

* Adjust copyright notice on 532 out of 699 source files (autowarefoundation#143)

* Use quotes for includes where appropriate (autowarefoundation#144)

* Use quotes for includes where appropriate

* Fix lint tests

* Make tests pass hopefully

* Run uncrustify on the entire Pilot.Auto codebase (autowarefoundation#151)

* Run uncrustify on the entire Pilot.Auto codebase

* Exclude open PRs

* [lane_change_planner] [obstacle_avoidance_planner] fix clock type (autowarefoundation#183)

Signed-off-by: mitsudome-r <[email protected]>

* Add linters to obstacle_avoidance_planner (autowarefoundation#158)

* Added linters to obstacle_avoidance_planner

* Fix header issues

* Fix linting issues

* Fix more linting issues

* Fix even more linting issues

* Final linting fixes

* Fix dependencies

* Use ament_cmake_cppcheck and ament_cmake_cpplint

* [obstacle_avoidance_planner] add missing return values (autowarefoundation#214)

Signed-off-by: mitsudome-r <[email protected]>

* Obstacle avoidance planner 0.8 (autowarefoundation#308)

* fix rosparam typo

Signed-off-by: Kosuke Murakami <[email protected]>

* empty check before access

Signed-off-by: Kosuke Murakami <[email protected]>

* modify way to fix the points

Signed-off-by: Kosuke Murakami <[email protected]>

* apply format

Signed-off-by: Kosuke Murakami <[email protected]>

* add baselink2front dist for virutual_wall

Signed-off-by: Kosuke Murakami <[email protected]>

* add avoiding object type

Signed-off-by: Kosuke Murakami <[email protected]>

* add exception handling for avoiding object

Signed-off-by: Kosuke Murakami <[email protected]>

* apply format

Signed-off-by: Kosuke Murakami <[email protected]>

* add vehicle_info dependency

Signed-off-by: Kosuke Murakami <[email protected]>

* modify to pass lint

Signed-off-by: Kosuke Murakami <[email protected]>

* fix lint

Signed-off-by: Kosuke Murakami <[email protected]>

* add vehicle_info_param in launch

Signed-off-by: Kosuke Murakami <[email protected]>

* modify nested pram declaration

Signed-off-by: Kosuke Murakami <[email protected]>

* apply ament-uncrastify

Signed-off-by: Kosuke Murakami <[email protected]>

* fix boost_none handling (autowarefoundation#349)

* fix boost_none handling

Signed-off-by: Kosuke Murakami <[email protected]>

* add another one

Signed-off-by: Kosuke Murakami <[email protected]>

* add another one

Signed-off-by: Kosuke Murakami <[email protected]>

* add another one

Signed-off-by: Kosuke Murakami <[email protected]>

* Rename ROS-related .yaml to .param.yaml (autowarefoundation#352)

* Rename ROS-related .yaml to .param.yaml

Signed-off-by: Kenji Miyake <[email protected]>

* Remove prefix 'default_' of yaml files

Signed-off-by: Kenji Miyake <[email protected]>

* Rename vehicle_info.yaml to vehicle_info.param.yaml

Signed-off-by: Kenji Miyake <[email protected]>

* Rename diagnostic_aggregator's param files

Signed-off-by: Kenji Miyake <[email protected]>

* Fix overlooked parameters

Signed-off-by: Kenji Miyake <[email protected]>

* rename vehicle_info_param to vehicle_param_file (autowarefoundation#353)

Signed-off-by: Kosuke Murakami <[email protected]>

* Ros2 fix topic name part1 (autowarefoundation#408)

* Fix topic name of lane_departure_checker debug

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of mpc_follower debug

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of velocity_controller debug

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of motion_velocity_optimizer debug

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of lane_change_planner debug

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of behavior_velocity_planner debug

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of obstacle_avoidance_planner debug

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of behavior_velocity_planner

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of motion_velocity_optimizer

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of lane_departure_checker

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of mpc_follower

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of behavior_velocity_planner

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of velocity_controller

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of lane_change_planner

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of obstacle_avoidance_planner

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of obstacle_stop_planner

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of costmap_generator

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of freespace_planner

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of surround_obstacle_checker

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of costmap_generator

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of emergency_handler

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix lint errors

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix typo

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix typo in planning module (autowarefoundation#432)

* Fix typo in planning module

* Fix remaining errors

Signed-off-by: Kenji Miyake <[email protected]>

* Apply cpplint and uncrustify.

Co-authored-by: Kenji Miyake <[email protected]>

* fix duration (autowarefoundation#445)

* fix duration

Signed-off-by: Kosuke Murakami <[email protected]>

* change to from_seconds

Signed-off-by: Kosuke Murakami <[email protected]>

* fix other duration

Signed-off-by: Kosuke Murakami <[email protected]>

* replace -1 with 0

Signed-off-by: Kosuke Murakami <[email protected]>

* apply ament_lint_common

Signed-off-by: Kosuke Murakami <[email protected]>

* uncrustify

Signed-off-by: Kosuke Murakami <[email protected]>

* add space

Signed-off-by: Kosuke Murakami <[email protected]>

* add another space

Signed-off-by: Kosuke Murakami <[email protected]>

* update log (autowarefoundation#456)

Signed-off-by: Kosuke Murakami <[email protected]>

* fix bug (autowarefoundation#457)

* add use_sim-time option (autowarefoundation#454)

* Format launch files (autowarefoundation#1219)

Signed-off-by: Kenji Miyake <[email protected]>

* Fix rolling build errors (autowarefoundation#1225)

* Add missing include files

Signed-off-by: Kenji Miyake <[email protected]>

* Replace rclcpp::Duration

Signed-off-by: Kenji Miyake <[email protected]>

* Use reference for exceptions

Signed-off-by: Kenji Miyake <[email protected]>

* Use from_seconds

Signed-off-by: Kenji Miyake <[email protected]>

* Sync public repo (autowarefoundation#1228)

* [simple_planning_simulator] add readme (autowarefoundation#424)

* add readme of simple_planning_simulator

Signed-off-by: Takamasa Horibe <[email protected]>

* Update simulator/simple_planning_simulator/README.md

* set transit_margin_time to intersect. planner (autowarefoundation#460)

* Fix pose2twist (autowarefoundation#462)

Signed-off-by: Takagi, Isamu <[email protected]>

* Ros2 vehicle info param server (autowarefoundation#447)

* add vehicle_info_param_server

* update vehicle info

* apply format

* fix bug

* skip unnecessary search

* delete vehicle param file

* fix bug

* Ros2 fix topic name part2 (autowarefoundation#425)

* Fix topic name of traffic_light_classifier

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of traffic_light_visualization

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of traffic_light_ssd_fine_detector

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of traffic_light_map_based_detector

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix lint traffic_light_recognition

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix lint traffic_light_ssd_fine_detector

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix lint traffic_light_classifier

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix lint traffic_light_classifier

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix lint traffic_light_ssd_fine_detector

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix issues in hdd_reader (autowarefoundation#466)

* Fix some issues detected by Coverity Scan and Clang-Tidy

* Update launch command

* Add more `close(new_sock)`

* Simplify the definitions of struct

* fix: re-construct laneletMapLayer for reindex RTree (autowarefoundation#463)

* Rviz overlay render fix (autowarefoundation#461)

* Moved painiting in SteeringAngle plugin to update()

Signed-off-by: Adam Dabrowski <[email protected]>

* super class now back to MFD

Signed-off-by: Adam Dabrowski <[email protected]>

* uncrustified

Signed-off-by: Adam Dabrowski <[email protected]>

* acquire data in mutex

Signed-off-by: Adam Dabrowski <[email protected]>

* back to RTD as superclass

Signed-off-by: Adam Dabrowski <[email protected]>

* Rviz overlay render in update (autowarefoundation#465)

* Moved painiting in SteeringAngle plugin to update()

Signed-off-by: Adam Dabrowski <[email protected]>

* super class now back to MFD

Signed-off-by: Adam Dabrowski <[email protected]>

* uncrustified

Signed-off-by: Adam Dabrowski <[email protected]>

* acquire data in mutex

Signed-off-by: Adam Dabrowski <[email protected]>

* removed unnecessary includes and some dead code

Signed-off-by: Adam Dabrowski <[email protected]>

* Adepted remaining vehicle plugin classes to render-in-update concept. Returned to MFD superclass

Signed-off-by: Adam Dabrowski <[email protected]>

* restored RTD superclass

Signed-off-by: Adam Dabrowski <[email protected]>

Co-authored-by: Takamasa Horibe <[email protected]>
Co-authored-by: tkimura4 <[email protected]>
Co-authored-by: Takagi, Isamu <[email protected]>
Co-authored-by: Kazuki Miyahara <[email protected]>
Co-authored-by: Makoto Tokunaga <[email protected]>
Co-authored-by: Adam Dąbrowski <[email protected]>

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

* Make planning modules components (autowarefoundation#1263)

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

* Remove use_sim_time for set_parameter (autowarefoundation#1260)

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

* Porting small fix (autowarefoundation#1288)

* Delete unused code (autowarefoundation#1183)

* Fix control topic name of closest_velocity_checker.py (autowarefoundation#1174)

Signed-off-by: Kenji Miyake <[email protected]>

* Add comments for livox tag (autowarefoundation#1188)

Signed-off-by: Kenji Miyake <[email protected]>

* Clear return value (autowarefoundation#1193)

* Change tracker model of unknown object (autowarefoundation#1204)

* treat polygon points as relative (autowarefoundation#1205)

Signed-off-by: Kosuke Murakami <[email protected]>

* hotfix: reference velocity in consideration of vehicle gear (autowarefoundation#1213)

* fix reference velocity for vehicle gear

* add initialization

* revert

* add comment

* change max area param (autowarefoundation#1218)

* Fix an identical code for different branches (autowarefoundation#1230)

* Update livox_tag_filter.launch.xml

* Fixup

Signed-off-by: Kenji Miyake <[email protected]>

Co-authored-by: shin <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Fumiya Watanabe <[email protected]>
Co-authored-by: Yukihiro Saito <[email protected]>
Co-authored-by: Kosuke Murakami <[email protected]>
Co-authored-by: Hiroki OTA <[email protected]>
Co-authored-by: tkimura4 <[email protected]>
Co-authored-by: Kazuki Miyahara <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>

* Refactor vehicle info util (autowarefoundation#1305)

* Update license

Signed-off-by: Kenji Miyake <[email protected]>

* Refactor vehicle_info_util

Signed-off-by: Kenji Miyake <[email protected]>

* Rename and split files

Signed-off-by: Kenji Miyake <[email protected]>

* Fix interfaces

Signed-off-by: Kenji Miyake <[email protected]>

* Fix bug and add error handling

Signed-off-by: Kenji Miyake <[email protected]>

* Add "// namespace"

Signed-off-by: Kenji Miyake <[email protected]>

* Add missing include

Signed-off-by: Kenji Miyake <[email protected]>

* Fix lint errors (autowarefoundation#1378)

* Fix lint errors

Signed-off-by: Kenji Miyake <[email protected]>

* Fix variable names

Signed-off-by: Kenji Miyake <[email protected]>

* Disable debug output of obstacle_avoidance_planner by default (autowarefoundation#1391)

* Disable debug output of obstacle_avoidance_planner by default

Signed-off-by: Kenji Miyake <[email protected]>

* Fix typo

Signed-off-by: Kenji Miyake <[email protected]>

* suppress warnings for obstacle avoidance planner (autowarefoundation#1764)

* add Werror

* fix Duration

* fix debug.cpp

* fix node.cpp

* fix util.cpp

* fix for loop for mpt_optimizer.cpp

* fix unused for mpt_optimizer.cpp

* fix process_cv.cpp

* fix sign compare for eb_path_optimizer.cpp

* fix unused for eb_path_optimizer.cpp

* fix for cpplint

* fix for cpplint

* re fix debug.cpp

* fix typo

* fix typo

* re fix process_cv.cpp

* fix typo

* re fix util.cpp

* re re fix util.cpp

* Fix -Wunused-parameter (autowarefoundation#1836)

* Fix -Wunused-parameter

Signed-off-by: Kenji Miyake <[email protected]>

* Fix mistake

Signed-off-by: Kenji Miyake <[email protected]>

* fix spell

* Fix lint issues

Signed-off-by: Kenji Miyake <[email protected]>

* Ignore flake8 warnings

Signed-off-by: Kenji Miyake <[email protected]>

Co-authored-by: Hiroki OTA <[email protected]>

* Fix compiler warnings (autowarefoundation#1837)

* Fix -Wunused-private-field

Signed-off-by: Kenji Miyake <[email protected]>

* Fix -Wunused-variable

Signed-off-by: Kenji Miyake <[email protected]>

* Fix -Wformat-security

Signed-off-by: Kenji Miyake <[email protected]>

* Fix -Winvalid-constexpr

Signed-off-by: Kenji Miyake <[email protected]>

* Fix -Wdelete-non-abstract-non-virtual-dtor

Signed-off-by: Kenji Miyake <[email protected]>

* Fix -Wdelete-abstract-non-virtual-dtor

Signed-off-by: Kenji Miyake <[email protected]>

* Fix -Winconsistent-missing-override

Signed-off-by: Kenji Miyake <[email protected]>

* Fix -Wrange-loop-construct

Signed-off-by: Kenji Miyake <[email protected]>

* Fix "invalid application of 'sizeof' to an incomplete type"

Signed-off-by: Kenji Miyake <[email protected]>

* Ignore -Wgnu-anonymous-struct and -Wnested-anon-types

Signed-off-by: Kenji Miyake <[email protected]>

* Fix lint

Signed-off-by: Kenji Miyake <[email protected]>

* Ignore -Wno-deprecated-declarations in CUDA-related packages

Signed-off-by: Kenji Miyake <[email protected]>

* Fix mistake

Signed-off-by: Kenji Miyake <[email protected]>

* Fix -Wunused-parameter

Signed-off-by: Kenji Miyake <[email protected]>

* Fix spellcheck fail for some packages (autowarefoundation#1842)

* fix transed -> transformed

* fix Urefex to Uref_ex

* fix spell

* Yrefex -> Yref_ex

* add space

* fix for spellcheck

* fix for lint

* fix feedbacked to feedback

* delete Yref_ex

* [obstacle avoidance planner] move doc from develop (autowarefoundation#1898)

* move doc from develop

* add figures

* update docs

* fix

* update doc

* use /approx

* use \sin \cos \tan

* use \arctan

* use \cos

* 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

* remove spline_interpolation, and create interpolation package that ha… (autowarefoundation#2114)

* remove spline_interpolation and add interpolation package

* fix bugs and add simple test

* modify application for interpolation package

* add some tests and fix ci test

* add some tests

* add -Werror

* move functions to anonymous

* fix reviews

* fix typo

* fix review and lint

* add tests

* resolve TODOs

* add README.md

* Update common/math/interpolation/test/src/test_interpolation_utils.cpp

Co-authored-by: Kenji Miyake <[email protected]>

* Update common/math/interpolation/test/src/test_interpolation_utils.cpp

Co-authored-by: Kenji Miyake <[email protected]>

* Update common/math/interpolation/test/src/test_interpolation_utils.cpp

Co-authored-by: Kenji Miyake <[email protected]>

* fix README.md

* dealt with reviews

* update README.md

* update README.md

* Update common/math/interpolation/README.md

* fix some bugs

* fix typo

* update README.md

* Update common/math/interpolation/README.md

Co-authored-by: Kazuki Miyahara <[email protected]>

* fix test

* Update common/math/interpolation/README.md

Co-authored-by: Kazuki Miyahara <[email protected]>

* fix cdots

* fix README.md

* Update common/math/interpolation/README.md

Co-authored-by: Kazuki Miyahara <[email protected]>

Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Kazuki Miyahara <[email protected]>

* update doc (autowarefoundation#2164)

* update doc

* Update planning/scenario_planning/lane_driving/motion_planning/obstacle_avoidance_planner/obstacle_avoidance_planner-design.ja.md

* Update planning/scenario_planning/lane_driving/motion_planning/obstacle_avoidance_planner/obstacle_avoidance_planner-design.ja.md

* Update planning/scenario_planning/lane_driving/motion_planning/obstacle_avoidance_planner/obstacle_avoidance_planner-design.ja.md

Co-authored-by: Kazuki Miyahara <[email protected]>

* Update planning/scenario_planning/lane_driving/motion_planning/obstacle_avoidance_planner/obstacle_avoidance_planner-design.ja.md

Co-authored-by: Kazuki Miyahara <[email protected]>

* fix \min, \max

* Update planning/scenario_planning/lane_driving/motion_planning/obstacle_avoidance_planner/obstacle_avoidance_planner-design.ja.md

Co-authored-by: Kazuki Miyahara <[email protected]>

Co-authored-by: Kazuki Miyahara <[email protected]>

* update readme for how to debug (autowarefoundation#2253)

Signed-off-by: Takamasa Horibe <[email protected]>

* add explanation of drivable area in obstacle avoidance planner (autowarefoundation#2291)

* add explanation of drivable area in obstacle avoidance planner

* fix spell

* add explanations

* Sync develop/fix interpolation and speed up calculation (autowarefoundation#2290)

* debug slope calculation in behavior (autowarefoundation#1566) (autowarefoundation#1727)

* debug slope calculation in behavior (autowarefoundation#1566)

* update

* update

* revert change of autoware_utils

* define getPose in behavior_path_planner

* update

* update

* update

* update

* interpolate z in obstacle_avoidance_planner

* update velocity controller

* fix detection area and scene

* Update planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/src/utilities.cpp

Co-authored-by: tkimura4 <[email protected]>

* update comment in velocity controller

* remove debug print

* update

Co-authored-by: tkimura4 <[email protected]>
Signed-off-by: wep21 <[email protected]>

* Fix typo

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

* Fix variable names

Signed-off-by: Kenji Miyake <[email protected]>

* Fix uncrustify

Signed-off-by: Kenji Miyake <[email protected]>

* Fix mistake

Signed-off-by: Kenji Miyake <[email protected]>

Co-authored-by: Takayuki Murooka <[email protected]>
Co-authored-by: tkimura4 <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>

* add underscore to marker namespace (autowarefoundation#1785)

Co-authored-by: satoshi-ota <[email protected]>

* [obstacle_avoidance_planner] remove useless get nearest idx (autowarefoundation#1851)

* modify velocity insertion in obstacle_avoidance_planner

Signed-off-by: Takamasa Horibe <[email protected]>

* [obstacle_avoidance_planner] reduce calculation cost in relative/absolute transformation (autowarefoundation#1844)

* implement relative/absolute transformation without yaw but directly sin/cos of yaw

* rename: relative_p to absolute_p

* assigin point.z to rel/abs_z

* fix cpp-lint error

Co-authored-by: Daisuke Nishimatsu <[email protected]>
Co-authored-by: Takayuki Murooka <[email protected]>
Co-authored-by: tkimura4 <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Satoshi OTA <[email protected]>
Co-authored-by: satoshi-ota <[email protected]>
Co-authored-by: Takamasa Horibe <[email protected]>

* Feature/obstacle avoidance planner some improvements (autowarefoundation#1964)

* add some improvements

* fix typo

* Revert "Feature/obstacle avoidance planner some improvements (autowarefoundation#1964)" (autowarefoundation#2000)

This reverts commit 07795e57bf03cb2fbb95a8f82253d8757b4686e9.

* 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 <[email protected]>

* Remove ament_cmake_uncrustify and ament_clang_format

Signed-off-by: Kenji Miyake <[email protected]>

* Apply Black

Signed-off-by: Kenji Miyake <[email protected]>

* Apply clang-format

Signed-off-by: Kenji Miyake <[email protected]>

* Fix build errors

Signed-off-by: Kenji Miyake <[email protected]>

* Fix for cpplint

* Fix include double quotes to angle brackets

Signed-off-by: Kenji Miyake <[email protected]>

* Apply clang-format

Signed-off-by: Kenji Miyake <[email protected]>

* Fix build errors

Signed-off-by: Kenji Miyake <[email protected]>

* Add COLCON_IGNORE (autowarefoundation#500)

Signed-off-by: Kenji Miyake <[email protected]>

* port obstacle avoidance planner (autowarefoundation#484)

* use_auto_msgs

* use predicted object

* use autoware_auto_perception_msgs

* complile succeeded

* use odom

* assign header to twist staped as well

* rename to readme.md

Co-authored-by: Takayuki Murooka <[email protected]>

* [apply_predicted_obj_type] adapt to autoware auto msgs (autowarefoundation#564)

* fix obj shape

* fix obj shape

* fix goal pose

* update README.md in obstacle avoidance planner (autowarefoundation#555)

* update README.md

* fix typo

* update README.md

* fix typo

* minor change

Co-authored-by: Takayuki Murooka <[email protected]>

* update iv_msgs -> auto_msgs in planning readme (autowarefoundation#576)

* update iv_msgs -> auto_msgs in planning readme

* minor change

* some fix

* some fix

Co-authored-by: Takayuki Murooka <[email protected]>

* Back port .auto control packages (autowarefoundation#571)

* Implement Lateral and Longitudinal Control Muxer

* [autowarefoundation#570] Porting wf_simulator

* [autowarefoundation#1189] Deactivate flaky test in 'trajectory_follower_nodes'

* [autowarefoundation#1189] Fix flacky test in 'trajectory_follower_nodes/latlon_muxer'

* [autowarefoundation#1057] Add osqp_interface package

* [autowarefoundation#1057] Add library code for MPC-based lateral control

* [autowarefoundation#1271] Use std::abs instead of abs

* [autowarefoundation#1057] Implement Lateral Controller for Cargo ODD

* [autowarefoundation#1246] Resolve "Test case names currently use snake_case but should be CamelCase"

* [autowarefoundation#1325] Deactivate flaky smoke test in 'trajectory_follower_nodes'

* [autowarefoundation#1058] Add library code of longitudinal controller

* Fix build error for trajectory follower

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

* Fix build error for trajectory follower nodes

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

* [autowarefoundation#1272] Add AckermannControlCommand support to simple_planning_simulator

* [autowarefoundation#1058] Add Longitudinal Controller node

* [autowarefoundation#1058] Rename velocity_controller -> longitudinal_controller

* [autowarefoundation#1058] Update CMakeLists.txt for the longitudinal_controller_node

* [autowarefoundation#1058] Add smoke test python launch file

* [autowarefoundation#1058] Use LowPassFilter1d from trajectory_follower

* [autowarefoundation#1058] Use autoware_auto_msgs

* [autowarefoundation#1058] Changes for .auto (debug msg tmp fix, common func, tf listener)

* [autowarefoundation#1058] Remove unused parameters

* [autowarefoundation#1058] Fix ros test

* [autowarefoundation#1058] Rm default params from declare_parameters + use autoware types

* [autowarefoundation#1058] Use default param file to setup NodeOptions in the ros test

* [autowarefoundation#1058] Fix docstring

* [autowarefoundation#1058] Replace receiving a Twist with a VehicleKinematicState

* [autowarefoundation#1058] Change class variables format to m_ prefix

* [autowarefoundation#1058] Fix plugin name of LongitudinalController in CMakeLists.txt

* [autowarefoundation#1058] Fix copyright dates

* [autowarefoundation#1058] Reorder includes

* [autowarefoundation#1058] Add some tests (~89% coverage without disabling flaky tests)

* [autowarefoundation#1058] Add more tests (90+% coverage without disabling flaky tests)

* [autowarefoundation#1058] Use Float32MultiArrayDiagnostic message for debug and slope

* [autowarefoundation#1058] Calculate wheel_base value from vehicle parameters

* [autowarefoundation#1058] Cleanup redundant logger setting in tests

* [autowarefoundation#1058] Set ROS_DOMAIN_ID when running tests to prevent CI failures

* [autowarefoundation#1058] Remove TF listener and use published vehicle state instead

* [autowarefoundation#1058] Change smoke tests to use autoware_testing

* [autowarefoundation#1058] Add plotjuggler cfg for both lateral and longitudinal control

* [autowarefoundation#1058] Improve design documents

* [autowarefoundation#1058] Disable flaky test

* [autowarefoundation#1058] Properly transform vehicle state in longitudinal node

* [autowarefoundation#1058] Fix TF buffer of lateral controller

* [autowarefoundation#1058] Tuning of lateral controller for LGSVL

* [autowarefoundation#1058] Fix formating

* [autowarefoundation#1058] Fix /tf_static sub to be transient_local

* [autowarefoundation#1058] Fix yaw recalculation of reverse trajs in the lateral controller

* modify trajectory_follower for galactic build

Signed-off-by: Takamasa Horibe <[email protected]>

* [autowarefoundation#1379] Update trajectory_follower

* [autowarefoundation#1379] Update simple_planning_simulator

* [autowarefoundation#1379] Update trajectory_follower_nodes

* apply trajectory msg modification in control

Signed-off-by: Takamasa Horibe <[email protected]>

* move directory

Signed-off-by: Takamasa Horibe <[email protected]>

* remote control/trajectory_follower level dorectpry

Signed-off-by: Takamasa Horibe <[email protected]>

* remove .iv trajectory follower

Signed-off-by: Takamasa Horibe <[email protected]>

* use .auto trajectory_follower

Signed-off-by: Takamasa Horibe <[email protected]>

* remove .iv simple_planning_simulator & osqp_interface

Signed-off-by: Takamasa Horibe <[email protected]>

* use .iv simple_planning_simulator & osqp_interface

Signed-off-by: Takamasa Horibe <[email protected]>

* add tmp_autoware_auto_dependencies

Signed-off-by: Takamasa Horibe <[email protected]>

* tmporally add autoware_auto_msgs

Signed-off-by: Takamasa Horibe <[email protected]>

* apply .auto message split

Signed-off-by: Takamasa Horibe <[email protected]>

* fix build depend

Signed-off-by: Takamasa Horibe <[email protected]>

* fix packages using osqp

* fix autoware_auto_geometry

* ignore lint of some packages

* ignore ament_lint of some packages

* ignore lint/pre-commit of trajectory_follower_nodes

* disable unit tests of some packages

Co-authored-by: Maxime CLEMENT <[email protected]>
Co-authored-by: Joshua Whitley <[email protected]>
Co-authored-by: Igor Bogoslavskyi <[email protected]>
Co-authored-by: MIURA Yasuyuki <[email protected]>
Co-authored-by: wep21 <[email protected]>
Co-authored-by: tomoya.kimura <[email protected]>

* [planning module]fix bug (autowarefoundation#643)

* fix topic name

* remove angular z from LinearInterpolation in motion_velocity_smoother

* fix readme

* ci(pre-commit): autofix

Co-authored-by: mitsudome-r <[email protected]>
Co-authored-by: Taichi Higashide <[email protected]>
Co-authored-by: Satoshi Tanaka <[email protected]>
Co-authored-by: Kosuke Murakami <[email protected]>
Co-authored-by: Ryohsuke Mitsudome <[email protected]>
Co-authored-by: Nikolai Morin <[email protected]>
Co-authored-by: Servando <[email protected]>
Co-authored-by: Esteve Fernandez <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Takagi, Isamu <[email protected]>
Co-authored-by: Kazuki Miyahara <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Takamasa Horibe <[email protected]>
Co-authored-by: Makoto Tokunaga <[email protected]>
Co-authored-by: Adam Dąbrowski <[email protected]>
Co-authored-by: Daisuke Nishimatsu <[email protected]>
Co-authored-by: Keisuke Shima <[email protected]>
Co-authored-by: shin <[email protected]>
Co-authored-by: Fumiya Watanabe <[email protected]>
Co-authored-by: Yukihiro Saito <[email protected]>
Co-authored-by: Hiroki OTA <[email protected]>
Co-authored-by: Takayuki Murooka <[email protected]>
Co-authored-by: Keisuke Shima <[email protected]>
Co-authored-by: Makoto Kurihara <[email protected]>
Co-authored-by: Satoshi OTA <[email protected]>
Co-authored-by: satoshi-ota <[email protected]>
Co-authored-by: Takayuki Murooka <[email protected]>
Co-authored-by: taikitanaka3 <[email protected]>
Co-authored-by: Maxime CLEMENT <[email protected]>
Co-authored-by: Joshua Whitley <[email protected]>
Co-authored-by: Igor Bogoslavskyi <[email protected]>
Co-authored-by: MIURA Yasuyuki <[email protected]>
Co-authored-by: wep21 <[email protected]>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>
TakumiKozaka-T4 pushed a commit to TakumiKozaka-T4/autoware.universe that referenced this pull request Mar 23, 2022
* Back port .auto control packages (autowarefoundation#571)

* Implement Lateral and Longitudinal Control Muxer

* [autowarefoundation#570] Porting wf_simulator

* [autowarefoundation#1189] Deactivate flaky test in 'trajectory_follower_nodes'

* [autowarefoundation#1189] Fix flacky test in 'trajectory_follower_nodes/latlon_muxer'

* [autowarefoundation#1057] Add osqp_interface package

* [autowarefoundation#1057] Add library code for MPC-based lateral control

* [autowarefoundation#1271] Use std::abs instead of abs

* [autowarefoundation#1057] Implement Lateral Controller for Cargo ODD

* [autowarefoundation#1246] Resolve "Test case names currently use snake_case but should be CamelCase"

* [autowarefoundation#1325] Deactivate flaky smoke test in 'trajectory_follower_nodes'

* [autowarefoundation#1058] Add library code of longitudinal controller

* Fix build error for trajectory follower

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

* Fix build error for trajectory follower nodes

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

* [autowarefoundation#1272] Add AckermannControlCommand support to simple_planning_simulator

* [autowarefoundation#1058] Add Longitudinal Controller node

* [autowarefoundation#1058] Rename velocity_controller -> longitudinal_controller

* [autowarefoundation#1058] Update CMakeLists.txt for the longitudinal_controller_node

* [autowarefoundation#1058] Add smoke test python launch file

* [autowarefoundation#1058] Use LowPassFilter1d from trajectory_follower

* [autowarefoundation#1058] Use autoware_auto_msgs

* [autowarefoundation#1058] Changes for .auto (debug msg tmp fix, common func, tf listener)

* [autowarefoundation#1058] Remove unused parameters

* [autowarefoundation#1058] Fix ros test

* [autowarefoundation#1058] Rm default params from declare_parameters + use autoware types

* [autowarefoundation#1058] Use default param file to setup NodeOptions in the ros test

* [autowarefoundation#1058] Fix docstring

* [autowarefoundation#1058] Replace receiving a Twist with a VehicleKinematicState

* [autowarefoundation#1058] Change class variables format to m_ prefix

* [autowarefoundation#1058] Fix plugin name of LongitudinalController in CMakeLists.txt

* [autowarefoundation#1058] Fix copyright dates

* [autowarefoundation#1058] Reorder includes

* [autowarefoundation#1058] Add some tests (~89% coverage without disabling flaky tests)

* [autowarefoundation#1058] Add more tests (90+% coverage without disabling flaky tests)

* [autowarefoundation#1058] Use Float32MultiArrayDiagnostic message for debug and slope

* [autowarefoundation#1058] Calculate wheel_base value from vehicle parameters

* [autowarefoundation#1058] Cleanup redundant logger setting in tests

* [autowarefoundation#1058] Set ROS_DOMAIN_ID when running tests to prevent CI failures

* [autowarefoundation#1058] Remove TF listener and use published vehicle state instead

* [autowarefoundation#1058] Change smoke tests to use autoware_testing

* [autowarefoundation#1058] Add plotjuggler cfg for both lateral and longitudinal control

* [autowarefoundation#1058] Improve design documents

* [autowarefoundation#1058] Disable flaky test

* [autowarefoundation#1058] Properly transform vehicle state in longitudinal node

* [autowarefoundation#1058] Fix TF buffer of lateral controller

* [autowarefoundation#1058] Tuning of lateral controller for LGSVL

* [autowarefoundation#1058] Fix formating

* [autowarefoundation#1058] Fix /tf_static sub to be transient_local

* [autowarefoundation#1058] Fix yaw recalculation of reverse trajs in the lateral controller

* modify trajectory_follower for galactic build

Signed-off-by: Takamasa Horibe <[email protected]>

* [autowarefoundation#1379] Update trajectory_follower

* [autowarefoundation#1379] Update simple_planning_simulator

* [autowarefoundation#1379] Update trajectory_follower_nodes

* apply trajectory msg modification in control

Signed-off-by: Takamasa Horibe <[email protected]>

* move directory

Signed-off-by: Takamasa Horibe <[email protected]>

* remote control/trajectory_follower level dorectpry

Signed-off-by: Takamasa Horibe <[email protected]>

* remove .iv trajectory follower

Signed-off-by: Takamasa Horibe <[email protected]>

* use .auto trajectory_follower

Signed-off-by: Takamasa Horibe <[email protected]>

* remove .iv simple_planning_simulator & osqp_interface

Signed-off-by: Takamasa Horibe <[email protected]>

* use .iv simple_planning_simulator & osqp_interface

Signed-off-by: Takamasa Horibe <[email protected]>

* add tmp_autoware_auto_dependencies

Signed-off-by: Takamasa Horibe <[email protected]>

* tmporally add autoware_auto_msgs

Signed-off-by: Takamasa Horibe <[email protected]>

* apply .auto message split

Signed-off-by: Takamasa Horibe <[email protected]>

* fix build depend

Signed-off-by: Takamasa Horibe <[email protected]>

* fix packages using osqp

* fix autoware_auto_geometry

* ignore lint of some packages

* ignore ament_lint of some packages

* ignore lint/pre-commit of trajectory_follower_nodes

* disable unit tests of some packages

Co-authored-by: Maxime CLEMENT <[email protected]>
Co-authored-by: Joshua Whitley <[email protected]>
Co-authored-by: Igor Bogoslavskyi <[email protected]>
Co-authored-by: MIURA Yasuyuki <[email protected]>
Co-authored-by: wep21 <[email protected]>
Co-authored-by: tomoya.kimura <[email protected]>

* Fix no ground pointcloud topic name (autowarefoundation#733)

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

Co-authored-by: j4tfwm6z <[email protected]>

* Update twist topic name (autowarefoundation#736)

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

* fix/rename segmentation namespace (autowarefoundation#742)

* rename segmentation directory

* fix namespace: system stack

* fix namespace: planning

* fix namespace: control stack

* fix namespace: perception stack

* fix readme

* ci(pre-commit): autofix

Co-authored-by: Takamasa Horibe <[email protected]>
Co-authored-by: Maxime CLEMENT <[email protected]>
Co-authored-by: Joshua Whitley <[email protected]>
Co-authored-by: Igor Bogoslavskyi <[email protected]>
Co-authored-by: MIURA Yasuyuki <[email protected]>
Co-authored-by: wep21 <[email protected]>
Co-authored-by: tomoya.kimura <[email protected]>
Co-authored-by: Daisuke Nishimatsu <[email protected]>
Co-authored-by: j4tfwm6z <[email protected]>
Co-authored-by: Satoshi OTA <[email protected]>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>
TakumiKozaka-T4 pushed a commit to TakumiKozaka-T4/autoware.universe that referenced this pull request Mar 23, 2022
* Back port .auto control packages (autowarefoundation#571)

* Implement Lateral and Longitudinal Control Muxer

* [autowarefoundation#570] Porting wf_simulator

* [autowarefoundation#1189] Deactivate flaky test in 'trajectory_follower_nodes'

* [autowarefoundation#1189] Fix flacky test in 'trajectory_follower_nodes/latlon_muxer'

* [autowarefoundation#1057] Add osqp_interface package

* [autowarefoundation#1057] Add library code for MPC-based lateral control

* [autowarefoundation#1271] Use std::abs instead of abs

* [autowarefoundation#1057] Implement Lateral Controller for Cargo ODD

* [autowarefoundation#1246] Resolve "Test case names currently use snake_case but should be CamelCase"

* [autowarefoundation#1325] Deactivate flaky smoke test in 'trajectory_follower_nodes'

* [autowarefoundation#1058] Add library code of longitudinal controller

* Fix build error for trajectory follower

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

* Fix build error for trajectory follower nodes

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

* [autowarefoundation#1272] Add AckermannControlCommand support to simple_planning_simulator

* [autowarefoundation#1058] Add Longitudinal Controller node

* [autowarefoundation#1058] Rename velocity_controller -> longitudinal_controller

* [autowarefoundation#1058] Update CMakeLists.txt for the longitudinal_controller_node

* [autowarefoundation#1058] Add smoke test python launch file

* [autowarefoundation#1058] Use LowPassFilter1d from trajectory_follower

* [autowarefoundation#1058] Use autoware_auto_msgs

* [autowarefoundation#1058] Changes for .auto (debug msg tmp fix, common func, tf listener)

* [autowarefoundation#1058] Remove unused parameters

* [autowarefoundation#1058] Fix ros test

* [autowarefoundation#1058] Rm default params from declare_parameters + use autoware types

* [autowarefoundation#1058] Use default param file to setup NodeOptions in the ros test

* [autowarefoundation#1058] Fix docstring

* [autowarefoundation#1058] Replace receiving a Twist with a VehicleKinematicState

* [autowarefoundation#1058] Change class variables format to m_ prefix

* [autowarefoundation#1058] Fix plugin name of LongitudinalController in CMakeLists.txt

* [autowarefoundation#1058] Fix copyright dates

* [autowarefoundation#1058] Reorder includes

* [autowarefoundation#1058] Add some tests (~89% coverage without disabling flaky tests)

* [autowarefoundation#1058] Add more tests (90+% coverage without disabling flaky tests)

* [autowarefoundation#1058] Use Float32MultiArrayDiagnostic message for debug and slope

* [autowarefoundation#1058] Calculate wheel_base value from vehicle parameters

* [autowarefoundation#1058] Cleanup redundant logger setting in tests

* [autowarefoundation#1058] Set ROS_DOMAIN_ID when running tests to prevent CI failures

* [autowarefoundation#1058] Remove TF listener and use published vehicle state instead

* [autowarefoundation#1058] Change smoke tests to use autoware_testing

* [autowarefoundation#1058] Add plotjuggler cfg for both lateral and longitudinal control

* [autowarefoundation#1058] Improve design documents

* [autowarefoundation#1058] Disable flaky test

* [autowarefoundation#1058] Properly transform vehicle state in longitudinal node

* [autowarefoundation#1058] Fix TF buffer of lateral controller

* [autowarefoundation#1058] Tuning of lateral controller for LGSVL

* [autowarefoundation#1058] Fix formating

* [autowarefoundation#1058] Fix /tf_static sub to be transient_local

* [autowarefoundation#1058] Fix yaw recalculation of reverse trajs in the lateral controller

* modify trajectory_follower for galactic build

Signed-off-by: Takamasa Horibe <[email protected]>

* [autowarefoundation#1379] Update trajectory_follower

* [autowarefoundation#1379] Update simple_planning_simulator

* [autowarefoundation#1379] Update trajectory_follower_nodes

* apply trajectory msg modification in control

Signed-off-by: Takamasa Horibe <[email protected]>

* move directory

Signed-off-by: Takamasa Horibe <[email protected]>

* remote control/trajectory_follower level dorectpry

Signed-off-by: Takamasa Horibe <[email protected]>

* remove .iv trajectory follower

Signed-off-by: Takamasa Horibe <[email protected]>

* use .auto trajectory_follower

Signed-off-by: Takamasa Horibe <[email protected]>

* remove .iv simple_planning_simulator & osqp_interface

Signed-off-by: Takamasa Horibe <[email protected]>

* use .iv simple_planning_simulator & osqp_interface

Signed-off-by: Takamasa Horibe <[email protected]>

* add tmp_autoware_auto_dependencies

Signed-off-by: Takamasa Horibe <[email protected]>

* tmporally add autoware_auto_msgs

Signed-off-by: Takamasa Horibe <[email protected]>

* apply .auto message split

Signed-off-by: Takamasa Horibe <[email protected]>

* fix build depend

Signed-off-by: Takamasa Horibe <[email protected]>

* fix packages using osqp

* fix autoware_auto_geometry

* ignore lint of some packages

* ignore ament_lint of some packages

* ignore lint/pre-commit of trajectory_follower_nodes

* disable unit tests of some packages

Co-authored-by: Maxime CLEMENT <[email protected]>
Co-authored-by: Joshua Whitley <[email protected]>
Co-authored-by: Igor Bogoslavskyi <[email protected]>
Co-authored-by: MIURA Yasuyuki <[email protected]>
Co-authored-by: wep21 <[email protected]>
Co-authored-by: tomoya.kimura <[email protected]>

* add isValidData (autowarefoundation#686)

Signed-off-by: Takamasa Horibe <[email protected]>

* Fix lane departure (autowarefoundation#688)

* rename

Signed-off-by: Takamasa Horibe <[email protected]>

* fix bug

Signed-off-by: Takamasa Horibe <[email protected]>

* Update twist topic name (autowarefoundation#736)

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

* ci(pre-commit): autofix

Co-authored-by: Takamasa Horibe <[email protected]>
Co-authored-by: Maxime CLEMENT <[email protected]>
Co-authored-by: Joshua Whitley <[email protected]>
Co-authored-by: Igor Bogoslavskyi <[email protected]>
Co-authored-by: MIURA Yasuyuki <[email protected]>
Co-authored-by: wep21 <[email protected]>
Co-authored-by: tomoya.kimura <[email protected]>
Co-authored-by: Daisuke Nishimatsu <[email protected]>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>
Co-authored-by: Takeshi Miura <[email protected]>
TakumiKozaka-T4 pushed a commit to TakumiKozaka-T4/autoware.universe that referenced this pull request Mar 23, 2022
* Ros2 v0.8.0 lane departure checker (autowarefoundation#327)

* Add lane departure checker (autowarefoundation#928)

Signed-off-by: Kenji Miyake <[email protected]>

* Fix bug of lane_departure_checker (autowarefoundation#1011)

* Fix bug of lane_departure_checker

Since preceeding lanelets are missing, when vehicle is at the beginning of a lanelet, it's mistakenly considered as out of lane.

Signed-off-by: Kenji Miyake <[email protected]>

* Fix typo

Signed-off-by: Kenji Miyake <[email protected]>

* Reduce computational cost of lane_departure_checker (autowarefoundation#1026)

Lanelet visualization will be too slow when big lanelets are visualized.

Signed-off-by: Kenji Miyake <[email protected]>

* Fix typo (autowarefoundation#1062)

Signed-off-by: Kenji Miyake <[email protected]>

* [lane_departure_checker]: Port to ROS2

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

* [lane_departure_checker]: Fix lint

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

* [autoware_utils]: Publish autoware debug msgs

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

* [lane_departure_checker]: Use autoware_debug_msgs instead of std_msgs

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

* [goal_distance_calculator]: Use autoware_debug_msgs instead of std_msgs

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

* [autoware_utils]: Add namespace to debug traits

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

* [lane_departure_checker]: Fix lint

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

Co-authored-by: Kenji Miyake <[email protected]>
Signed-off-by: tanaka3 <[email protected]>

* Ros2 v0.8.0 obstacle collision checker (autowarefoundation#316)

* Feature/obstacle collision checker (autowarefoundation#1063)

* Add template

* Remove unnecessary code

* Add obstacle_collision_checker

* add braking distance

* delete unuse file

* change resample traj

* Format files

Signed-off-by: Kenji Miyake <[email protected]>

* Add author

Signed-off-by: Kenji Miyake <[email protected]>

* Remove vehicle_footprint visualization

Signed-off-by: Kenji Miyake <[email protected]>

* Move package under control/trajectory_follower

Signed-off-by: Kenji Miyake <[email protected]>

* Add space

Signed-off-by: Kenji Miyake <[email protected]>

* Fix visualization error

Signed-off-by: Kenji Miyake <[email protected]>

* Remove comment out lines

Signed-off-by: Kenji Miyake <[email protected]>

Co-authored-by: Kenji Miyake <[email protected]>

* ros2 porting

* remove "dynamic_reconfigure"

* fix CMAKELists.txt & apply lint

* fix paramCallback

* remove unnecessary comment

* fix include statement

Co-authored-by: Satoshi Tanaka <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Signed-off-by: tanaka3 <[email protected]>

* Ros2 v0.8.0 fix packages (autowarefoundation#351)

* add subscription to QoS

* add vihicle_param _file to simple_planning_sim

* update cmake/packages.xml

* comment out unused parameter

* apply lint

* add vehicle_info_util to lane_change_planner

* add vehicle_info_util to vehicle_cmd_gate

* fix cmake of simple planning simulator

* update cmake/packages.xml of vehicle cmd gate

* apply lint

* apply lint

* add latch option to autoware_state_monitor

* delete unused comment

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

* Rename ROS-related .yaml to .param.yaml (autowarefoundation#352)

* Rename ROS-related .yaml to .param.yaml

Signed-off-by: Kenji Miyake <[email protected]>

* Remove prefix 'default_' of yaml files

Signed-off-by: Kenji Miyake <[email protected]>

* Rename vehicle_info.yaml to vehicle_info.param.yaml

Signed-off-by: Kenji Miyake <[email protected]>

* Rename diagnostic_aggregator's param files

Signed-off-by: Kenji Miyake <[email protected]>

* Fix overlooked parameters

Signed-off-by: Kenji Miyake <[email protected]>
Signed-off-by: tanaka3 <[email protected]>

* Fix/lane departure checker (autowarefoundation#386)

* Fix/lane departure checker (autowarefoundation#1177)

* Add more processing time measurement

Signed-off-by: Kenji Miyake <[email protected]>

* Rename processing_time to processing_time_ms

Signed-off-by: Kenji Miyake <[email protected]>

* Refactor StopWatch class

Signed-off-by: Kenji Miyake <[email protected]>

* apply ament_uncrustify

Signed-off-by: mitsudome-r <[email protected]>
Signed-off-by: tanaka3 <[email protected]>

* Ros2 fix topic name part1 (autowarefoundation#408)

* Fix topic name of lane_departure_checker debug

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of mpc_follower debug

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of velocity_controller debug

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of motion_velocity_optimizer debug

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of lane_change_planner debug

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of behavior_velocity_planner debug

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of obstacle_avoidance_planner debug

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of behavior_velocity_planner

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of motion_velocity_optimizer

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of lane_departure_checker

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of mpc_follower

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of behavior_velocity_planner

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of velocity_controller

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of lane_change_planner

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of obstacle_avoidance_planner

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of obstacle_stop_planner

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of costmap_generator

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of freespace_planner

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of surround_obstacle_checker

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of costmap_generator

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of emergency_handler

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix lint errors

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix typo

Signed-off-by: Takagi, Isamu <[email protected]>
Signed-off-by: tanaka3 <[email protected]>

* Fix typo in control module (autowarefoundation#428)

* Fix typo in control module

* Change admissible_yaw_error to admissible_yaw_error_rad

* Change 90.0 deg to 1.57 rad and remove trailing whitespace

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

* fix duration (autowarefoundation#445)

* fix duration

Signed-off-by: Kosuke Murakami <[email protected]>

* change to from_seconds

Signed-off-by: Kosuke Murakami <[email protected]>

* fix other duration

Signed-off-by: Kosuke Murakami <[email protected]>

* replace -1 with 0

Signed-off-by: Kosuke Murakami <[email protected]>

* apply ament_lint_common

Signed-off-by: Kosuke Murakami <[email protected]>

* uncrustify

Signed-off-by: Kosuke Murakami <[email protected]>

* add space

Signed-off-by: Kosuke Murakami <[email protected]>

* add another space

Signed-off-by: Kosuke Murakami <[email protected]>
Signed-off-by: tanaka3 <[email protected]>

* add use_sim-time option (autowarefoundation#454)

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

* Ros2 delete vehicle info (autowarefoundation#1227)

* remove dependency on vehicle info in autoware_utils

* delete vehicle_info in autoware_utils

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

* Sync public repo (autowarefoundation#1228)

* [simple_planning_simulator] add readme (autowarefoundation#424)

* add readme of simple_planning_simulator

Signed-off-by: Takamasa Horibe <[email protected]>

* Update simulator/simple_planning_simulator/README.md

* set transit_margin_time to intersect. planner (autowarefoundation#460)

* Fix pose2twist (autowarefoundation#462)

Signed-off-by: Takagi, Isamu <[email protected]>

* Ros2 vehicle info param server (autowarefoundation#447)

* add vehicle_info_param_server

* update vehicle info

* apply format

* fix bug

* skip unnecessary search

* delete vehicle param file

* fix bug

* Ros2 fix topic name part2 (autowarefoundation#425)

* Fix topic name of traffic_light_classifier

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of traffic_light_visualization

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of traffic_light_ssd_fine_detector

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of traffic_light_map_based_detector

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix lint traffic_light_recognition

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix lint traffic_light_ssd_fine_detector

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix lint traffic_light_classifier

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix lint traffic_light_classifier

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix lint traffic_light_ssd_fine_detector

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix issues in hdd_reader (autowarefoundation#466)

* Fix some issues detected by Coverity Scan and Clang-Tidy

* Update launch command

* Add more `close(new_sock)`

* Simplify the definitions of struct

* fix: re-construct laneletMapLayer for reindex RTree (autowarefoundation#463)

* Rviz overlay render fix (autowarefoundation#461)

* Moved painiting in SteeringAngle plugin to update()

Signed-off-by: Adam Dabrowski <[email protected]>

* super class now back to MFD

Signed-off-by: Adam Dabrowski <[email protected]>

* uncrustified

Signed-off-by: Adam Dabrowski <[email protected]>

* acquire data in mutex

Signed-off-by: Adam Dabrowski <[email protected]>

* back to RTD as superclass

Signed-off-by: Adam Dabrowski <[email protected]>

* Rviz overlay render in update (autowarefoundation#465)

* Moved painiting in SteeringAngle plugin to update()

Signed-off-by: Adam Dabrowski <[email protected]>

* super class now back to MFD

Signed-off-by: Adam Dabrowski <[email protected]>

* uncrustified

Signed-off-by: Adam Dabrowski <[email protected]>

* acquire data in mutex

Signed-off-by: Adam Dabrowski <[email protected]>

* removed unnecessary includes and some dead code

Signed-off-by: Adam Dabrowski <[email protected]>

* Adepted remaining vehicle plugin classes to render-in-update concept. Returned to MFD superclass

Signed-off-by: Adam Dabrowski <[email protected]>

* restored RTD superclass

Signed-off-by: Adam Dabrowski <[email protected]>

Co-authored-by: Takamasa Horibe <[email protected]>
Co-authored-by: tkimura4 <[email protected]>
Co-authored-by: Takagi, Isamu <[email protected]>
Co-authored-by: Kazuki Miyahara <[email protected]>
Co-authored-by: Makoto Tokunaga <[email protected]>
Co-authored-by: Adam Dąbrowski <[email protected]>
Signed-off-by: tanaka3 <[email protected]>

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

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

* Make control modules components (autowarefoundation#1262)

Signed-off-by: wep21 <[email protected]>
Signed-off-by: tanaka3 <[email protected]>

* Remove use_sim_time for set_parameter (autowarefoundation#1260)

Signed-off-by: wep21 <[email protected]>
Signed-off-by: tanaka3 <[email protected]>

* Remove vehicle info param server (autowarefoundation#1304)

* Remove vehicle info param server

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

* Fix ament_uncrustify

Signed-off-by: Kenji Miyake <[email protected]>

* Fix ament_uncrustify

Signed-off-by: Kenji Miyake <[email protected]>

Co-authored-by: Kenji Miyake <[email protected]>
Signed-off-by: tanaka3 <[email protected]>

* Refactor vehicle info util (autowarefoundation#1305)

* Update license

Signed-off-by: Kenji Miyake <[email protected]>

* Refactor vehicle_info_util

Signed-off-by: Kenji Miyake <[email protected]>

* Rename and split files

Signed-off-by: Kenji Miyake <[email protected]>

* Fix interfaces

Signed-off-by: Kenji Miyake <[email protected]>

* Fix bug and add error handling

Signed-off-by: Kenji Miyake <[email protected]>

* Add "// namespace"

Signed-off-by: Kenji Miyake <[email protected]>

* Add missing include

Signed-off-by: Kenji Miyake <[email protected]>
Signed-off-by: tanaka3 <[email protected]>

* Fix/fix utils (autowarefoundation#1310)

* Add missing namespace to autoware_utils

Signed-off-by: Kenji Miyake <[email protected]>

* Add createVehicleInfo

Signed-off-by: Kenji Miyake <[email protected]>

* Add rethrow

Signed-off-by: Kenji Miyake <[email protected]>

* Format package.xml

Signed-off-by: Kenji Miyake <[email protected]>

* Fix usage of autoware_utils

Signed-off-by: Kenji Miyake <[email protected]>

* Add missing namespace comment

Signed-off-by: Kenji Miyake <[email protected]>
Signed-off-by: tanaka3 <[email protected]>

* Initialize Input and Output struct correctly to avoid the undefined behavior (autowarefoundation#1408)

* Initialize Input and Output struct correctly to avoid the undefined behavior

This fixes the following UBSan error:
```
/src/autoware/autoware.iv/control/trajectory_follower/lane_departure_checker/src/lane_departure_checker_node/lane_departure_checker_node.cpp:363:15: runtime error: load of value 104, which is not a valid value for type 'bool'
src/autoware/autoware.iv/control/trajectory_follower/lane_departure_checker/src/lane_departure_checker_node/lane_departure_checker_node.cpp:358:15: runtime error: load of value 114, which is not a valid value for type 'bool'
```

* Improve how to initialize struct with NSDMI (non-static data member initializer)

* Fix styles

Signed-off-by: Kenji Miyake <[email protected]>

Co-authored-by: Kenji Miyake <[email protected]>
Signed-off-by: tanaka3 <[email protected]>

* Fix -Wunused-parameter (autowarefoundation#1836)

* Fix -Wunused-parameter

Signed-off-by: Kenji Miyake <[email protected]>

* Fix mistake

Signed-off-by: Kenji Miyake <[email protected]>

* fix spell

* Fix lint issues

Signed-off-by: Kenji Miyake <[email protected]>

* Ignore flake8 warnings

Signed-off-by: Kenji Miyake <[email protected]>

Co-authored-by: Hiroki OTA <[email protected]>
Signed-off-by: tanaka3 <[email protected]>

* Feature/expand footprint (autowarefoundation#1757)

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

* 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

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

* Fix processing time output of lane_departure_checker (autowarefoundation#2071)

Signed-off-by: Kenji Miyake <[email protected]>
Signed-off-by: tanaka3 <[email protected]>

* Fix missing declare_parameter of lane_departure_checker (autowarefoundation#2073)

* Fix missing declare_parameter of lane_departure_checker

Signed-off-by: Kenji Miyake <[email protected]>

* Change marker color

Signed-off-by: Kenji Miyake <[email protected]>
Signed-off-by: tanaka3 <[email protected]>

* reduce lanelet calc of lane_departure_checker (improved logic) (#2102)

* reduce lanelet calc of lane_departure_checker (improved logic)

* fix ament_cpplint error (delete redundant blank line)

* modify createVehiclePassingAreas not to use unnecessary local variable

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

* 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 <[email protected]>

* Remove ament_cmake_uncrustify and ament_clang_format

Signed-off-by: Kenji Miyake <[email protected]>

* Apply Black

Signed-off-by: Kenji Miyake <[email protected]>

* Apply clang-format

Signed-off-by: Kenji Miyake <[email protected]>

* Fix build errors

Signed-off-by: Kenji Miyake <[email protected]>

* Fix for cpplint

* Fix include double quotes to angle brackets

Signed-off-by: Kenji Miyake <[email protected]>

* Apply clang-format

Signed-off-by: Kenji Miyake <[email protected]>

* Fix build errors

Signed-off-by: Kenji Miyake <[email protected]>
Signed-off-by: tanaka3 <[email protected]>

* Add COLCON_IGNORE (autowarefoundation#500)

Signed-off-by: Kenji Miyake <[email protected]>
Signed-off-by: tanaka3 <[email protected]>

* port obstacle collision checker (autowarefoundation#481)

* port obstacle collision checker

* remove COLCON_IGNORE

* use odometry instead of twist

* rename topic name input/twist -> input/odometry

* add nav_msgs

Co-authored-by: Takayuki Murooka <[email protected]>
Signed-off-by: tanaka3 <[email protected]>

* port lane_departure_checker (autowarefoundation#499)

* Use autoware_auto_msgs

* Fix document

* Remove COLCON_IGNORE

* Use TrajectoryPointArray for resampling

* Rename TrajectoryPointArray to TrajectoryPoints, fix order of member variable

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

* add readme to obstacle collision checker (autowarefoundation#541)

* add readme to obstacle collision checker

* fix spelling

* Format Doc

Co-authored-by: Kazuki Miyahara <[email protected]>

* Fix Typo

Co-authored-by: Kazuki Miyahara <[email protected]>

* Remove Duplicated

Co-authored-by: Kazuki Miyahara <[email protected]>

* update readme

* To publish diag error

* Update readme

Co-authored-by: tkimura4 <[email protected]>

* fix uml

Co-authored-by: Kazuki Miyahara <[email protected]>
Co-authored-by: tkimura4 <[email protected]>
Signed-off-by: tanaka3 <[email protected]>

* Back port .auto control packages (autowarefoundation#571)

* Implement Lateral and Longitudinal Control Muxer

* [autowarefoundation#570] Porting wf_simulator

* [autowarefoundation#1189] Deactivate flaky test in 'trajectory_follower_nodes'

* [autowarefoundation#1189] Fix flacky test in 'trajectory_follower_nodes/latlon_muxer'

* [autowarefoundation#1057] Add osqp_interface package

* [autowarefoundation#1057] Add library code for MPC-based lateral control

* [autowarefoundation#1271] Use std::abs instead of abs

* [autowarefoundation#1057] Implement Lateral Controller for Cargo ODD

* [autowarefoundation#1246] Resolve "Test case names currently use snake_case but should be CamelCase"

* [autowarefoundation#1325] Deactivate flaky smoke test in 'trajectory_follower_nodes'

* [autowarefoundation#1058] Add library code of longitudinal controller

* Fix build error for trajectory follower

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

* Fix build error for trajectory follower nodes

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

* [autowarefoundation#1272] Add AckermannControlCommand support to simple_planning_simulator

* [autowarefoundation#1058] Add Longitudinal Controller node

* [autowarefoundation#1058] Rename velocity_controller -> longitudinal_controller

* [autowarefoundation#1058] Update CMakeLists.txt for the longitudinal_controller_node

* [autowarefoundation#1058] Add smoke test python launch file

* [autowarefoundation#1058] Use LowPassFilter1d from trajectory_follower

* [autowarefoundation#1058] Use autoware_auto_msgs

* [autowarefoundation#1058] Changes for .auto (debug msg tmp fix, common func, tf listener)

* [autowarefoundation#1058] Remove unused parameters

* [autowarefoundation#1058] Fix ros test

* [autowarefoundation#1058] Rm default params from declare_parameters + use autoware types

* [autowarefoundation#1058] Use default param file to setup NodeOptions in the ros test

* [autowarefoundation#1058] Fix docstring

* [autowarefoundation#1058] Replace receiving a Twist with a VehicleKinematicState

* [autowarefoundation#1058] Change class variables format to m_ prefix

* [autowarefoundation#1058] Fix plugin name of LongitudinalController in CMakeLists.txt

* [autowarefoundation#1058] Fix copyright dates

* [autowarefoundation#1058] Reorder includes

* [autowarefoundation#1058] Add some tests (~89% coverage without disabling flaky tests)

* [autowarefoundation#1058] Add more tests (90+% coverage without disabling flaky tests)

* [autowarefoundation#1058] Use Float32MultiArrayDiagnostic message for debug and slope

* [autowarefoundation#1058] Calculate wheel_base value from vehicle parameters

* [autowarefoundation#1058] Cleanup redundant logger setting in tests

* [autowarefoundation#1058] Set ROS_DOMAIN_ID when running tests to prevent CI failures

* [autowarefoundation#1058] Remove TF listener and use published vehicle state instead

* [autowarefoundation#1058] Change smoke tests to use autoware_testing

* [autowarefoundation#1058] Add plotjuggler cfg for both lateral and longitudinal control

* [autowarefoundation#1058] Improve design documents

* [autowarefoundation#1058] Disable flaky test

* [autowarefoundation#1058] Properly transform vehicle state in longitudinal node

* [autowarefoundation#1058] Fix TF buffer of lateral controller

* [autowarefoundation#1058] Tuning of lateral controller for LGSVL

* [autowarefoundation#1058] Fix formating

* [autowarefoundation#1058] Fix /tf_static sub to be transient_local

* [autowarefoundation#1058] Fix yaw recalculation of reverse trajs in the lateral controller

* modify trajectory_follower for galactic build

Signed-off-by: Takamasa Horibe <[email protected]>

* [autowarefoundation#1379] Update trajectory_follower

* [autowarefoundation#1379] Update simple_planning_simulator

* [autowarefoundation#1379] Update trajectory_follower_nodes

* apply trajectory msg modification in control

Signed-off-by: Takamasa Horibe <[email protected]>

* move directory

Signed-off-by: Takamasa Horibe <[email protected]>

* remote control/trajectory_follower level dorectpry

Signed-off-by: Takamasa Horibe <[email protected]>

* remove .iv trajectory follower

Signed-off-by: Takamasa Horibe <[email protected]>

* use .auto trajectory_follower

Signed-off-by: Takamasa Horibe <[email protected]>

* remove .iv simple_planning_simulator & osqp_interface

Signed-off-by: Takamasa Horibe <[email protected]>

* use .iv simple_planning_simulator & osqp_interface

Signed-off-by: Takamasa Horibe <[email protected]>

* add tmp_autoware_auto_dependencies

Signed-off-by: Takamasa Horibe <[email protected]>

* tmporally add autoware_auto_msgs

Signed-off-by: Takamasa Horibe <[email protected]>

* apply .auto message split

Signed-off-by: Takamasa Horibe <[email protected]>

* fix build depend

Signed-off-by: Takamasa Horibe <[email protected]>

* fix packages using osqp

* fix autoware_auto_geometry

* ignore lint of some packages

* ignore ament_lint of some packages

* ignore lint/pre-commit of trajectory_follower_nodes

* disable unit tests of some packages

Co-authored-by: Maxime CLEMENT <[email protected]>
Co-authored-by: Joshua Whitley <[email protected]>
Co-authored-by: Igor Bogoslavskyi <[email protected]>
Co-authored-by: MIURA Yasuyuki <[email protected]>
Co-authored-by: wep21 <[email protected]>
Co-authored-by: tomoya.kimura <[email protected]>
Signed-off-by: tanaka3 <[email protected]>

* Fix message interface and tests of 'trajectory_follower_nodes' (autowarefoundation#617)

* Update longitudinal_controller_node to use VehicleOdometry

* Update lateral_controller_node for VehicleOdometry and SteeringReport

* Fix tests

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

* Update lateral controller (autowarefoundation#708)

* Fix parameter names of mpc_follower (autowarefoundation#1376)

* remove yaw_recalc param in mpc (autowarefoundation#1241) (autowarefoundation#1476)

* parameterize curvature num (autowarefoundation#1674) (autowarefoundation#1577)

* fix rosparam steer_rate_lim_degs to steer_rate_lim_dps in mpc_follower (autowarefoundation#1848)

* Fix spellcheck fail for some packages autowarefoundation#1842

* use interpolation::slerp (autowarefoundation#2161)

* Fix/mpc reset prev result (autowarefoundation#2185)

* add add guard (autowarefoundation#2184)

* add-mpc-optimization-status-print (autowarefoundation#2189)

* Apply ament_uncrustify

* Update control/trajectory_follower/src/qp_solver/qp_solver_osqp.cpp

Co-authored-by: Takamasa Horibe <[email protected]>

Co-authored-by: Takamasa Horibe <[email protected]>
Signed-off-by: tanaka3 <[email protected]>

* velocity_controller sync to .iv develop latest (autowarefoundation#699)

* non extrapolate velocity in lerpTrajectory to avoid negative velocity just before vehicle stops (autowarefoundation#2033)

* Add keep braking function at driving state (autowarefoundation#2346)

* Add keep braking function at driving state

Signed-off-by: Makoto Kurihara <[email protected]>

* Remove debug messages

Signed-off-by: Makoto Kurihara <[email protected]>

* Fix format

Signed-off-by: Makoto Kurihara <[email protected]>

* Feature/add doc for keep braking function at driving state (autowarefoundation#2366)

* Add the description of brake keeping

Signed-off-by: Makoto Kurihara <[email protected]>

* Add the english document

Signed-off-by: Makoto Kurihara <[email protected]>

* Improve description

Signed-off-by: Makoto Kurihara <[email protected]>

* Add english description

Signed-off-by: Makoto Kurihara <[email protected]>

Co-authored-by: Takayuki Murooka <[email protected]>
Co-authored-by: Makoto Kurihara <[email protected]>
Co-authored-by: Fumiya Watanabe <[email protected]>
Signed-off-by: tanaka3 <[email protected]>

Co-authored-by: Daisuke Nishimatsu <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Shinnosuke Hirakawa <[email protected]>
Co-authored-by: Satoshi Tanaka <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: tkimura4 <[email protected]>
Co-authored-by: Ryohsuke Mitsudome <[email protected]>
Co-authored-by: Takagi, Isamu <[email protected]>
Co-authored-by: Kazuki Miyahara <[email protected]>
Co-authored-by: Kosuke Murakami <[email protected]>
Co-authored-by: Takamasa Horibe <[email protected]>
Co-authored-by: Makoto Tokunaga <[email protected]>
Co-authored-by: Adam Dąbrowski <[email protected]>
Co-authored-by: Hiroki OTA <[email protected]>
Co-authored-by: Keisuke Shima <[email protected]>
Co-authored-by: v-hara8206-esol <[email protected]>
Co-authored-by: Takayuki Murooka <[email protected]>
Co-authored-by: Takayuki Murooka <[email protected]>
Co-authored-by: Fumiya Watanabe <[email protected]>
Co-authored-by: Maxime CLEMENT <[email protected]>
Co-authored-by: Joshua Whitley <[email protected]>
Co-authored-by: Igor Bogoslavskyi <[email protected]>
Co-authored-by: MIURA Yasuyuki <[email protected]>
Co-authored-by: wep21 <[email protected]>
Co-authored-by: Maxime CLEMENT <[email protected]>
Co-authored-by: Makoto Kurihara <[email protected]>
TakumiKozaka-T4 pushed a commit to TakumiKozaka-T4/autoware.universe that referenced this pull request Mar 23, 2022
* feat: add detected object feature remover

* change output type of shape_estimation

* remove unused function

* add dynamic_object_converter

* rename

* fix typo

* fix dummy_perception_publisher

* update readme

* fix copyright

* rename package

* add readme

* fix launch name

* remove unused variable

* fix readme

* fix convert function

* change topic name of DynamicObjectsWithFeature

* feat: add autoware_version package (autowarefoundation#11)

* Add autoware version node (autowarefoundation#394)

* Add autoware version node

Signed-off-by: Takagi, Isamu <[email protected]>

* Remove todo

Signed-off-by: Takagi, Isamu <[email protected]>

* Remove unused variable

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix node name

Signed-off-by: Takagi, Isamu <[email protected]>

* Modify autoware_version not to use transient_local (workaround) (autowarefoundation#403)

* Modify autoware_version not to use transient_local

Signed-off-by: Takagi, Isamu <[email protected]>

* Add todo comment

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix for lint

Signed-off-by: Takagi, Isamu <[email protected]>

* Revert "Modify autoware_version not to use transient_local (workaround) (autowarefoundation#403)" (autowarefoundation#418)

This reverts commit 39b7ef232a3d21c619d28935fa122abf23891961.

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix -Wunused-parameter (autowarefoundation#1836)

* Fix -Wunused-parameter

Signed-off-by: Kenji Miyake <[email protected]>

* Fix mistake

Signed-off-by: Kenji Miyake <[email protected]>

* fix spell

* Fix lint issues

Signed-off-by: Kenji Miyake <[email protected]>

* Ignore flake8 warnings

Signed-off-by: Kenji Miyake <[email protected]>

Co-authored-by: Hiroki OTA <[email protected]>

* Add package version API (autowarefoundation#2150)

* Add package version API

* Fix format

* Fix message type

* 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 <[email protected]>

* Remove ament_cmake_uncrustify and ament_clang_format

Signed-off-by: Kenji Miyake <[email protected]>

* Apply Black

Signed-off-by: Kenji Miyake <[email protected]>

* Apply clang-format

Signed-off-by: Kenji Miyake <[email protected]>

* Fix build errors

Signed-off-by: Kenji Miyake <[email protected]>

* Fix for cpplint

* Fix include double quotes to angle brackets

Signed-off-by: Kenji Miyake <[email protected]>

* Apply clang-format

Signed-off-by: Kenji Miyake <[email protected]>

* Fix build errors

Signed-off-by: Kenji Miyake <[email protected]>

* Add COLCON_IGNORE (autowarefoundation#500)

Signed-off-by: Kenji Miyake <[email protected]>

* remove COLCON_IGNORE in autoware_version (autowarefoundation#530)

* Add readme of autoware_version (autowarefoundation#612)

* change type

* add readme

* ci(pre-commit): autofix

Co-authored-by: Takagi, Isamu <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Hiroki OTA <[email protected]>
Co-authored-by: Takeshi Miura <[email protected]>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>

* feat: add emergency_handler package (autowarefoundation#13)

* release v0.4.0

* remove ROS1 packages temporarily

Signed-off-by: mitsudome-r <[email protected]>

* Revert "remove ROS1 packages temporarily"

This reverts commit bb6fdb15dd23df7eab978525dd7a1541cf61df4a.

Signed-off-by: mitsudome-r <[email protected]>

* add COLCON_IGNORE to ros1 packages

Signed-off-by: mitsudome-r <[email protected]>

* Rename launch files to launch.xml (autowarefoundation#28)

* ROS2 Porting: emergency_handler (autowarefoundation#40)

* Pull emergency handler package from master for porting

* Fix CMakeList
 - Change to format similar to the simple_simulation_planner
 - Doesn't compile due to src files

* Rename of core implementation to be compliant with ROS2 naming guidelines

* Use the node/core naming convention
 - Add _core file to hold the implementation
 - _node file now holds the executable
 - Modify CMakeLists to point to the new executable

* Conversion of msg types
 - Compiles now
 - Add back functions

* Convert node intrinsics to ROS2
 - Add subscriptions
 - Add publisher
 - Add timer subscription
 - Add publishing and logging

* Rearrange files and folders

* Fix cmake and package xml

* Interface with parameters and fix launch file
 - Fix configuration files
 - Correct main implementation
 - Clean up
 - Fix headers

* Use correct timer implementation

* Use throttle logs

* Use class method to get time instead of static method

* Make parameter file agnostic to node name

Co-authored-by: Ryohsuke Mitsudome <[email protected]>

Co-authored-by: Ryohsuke Mitsudome <[email protected]>

* fix duration unit for RCLCPP_*_THROTTLE (autowarefoundation#75)

Signed-off-by: Takamasa Horibe <[email protected]>

* Adjust copyright notice on 532 out of 699 source files (autowarefoundation#143)

* Use quotes for includes where appropriate (autowarefoundation#144)

* Use quotes for includes where appropriate

* Fix lint tests

* Make tests pass hopefully

* Add linters (autowarefoundation#206)

* Ros2 v0.8.0 emergency handler (autowarefoundation#280)

* Ros2 v0.8.0 fix packages2 (autowarefoundation#354)

* fix topic name

* fix duration rate

* fix sensing.yaml

* fix topic name

* add latch-option to autoware_state_monitor

* fix timer callback

* fix autoware state monitor config

* fix sensing.yaml

* fix emergency handler (autowarefoundation#361)

* Sync with Ros2 v0.8.0 beta (autowarefoundation#393)

* add nullptr check when publish concatenate data (autowarefoundation#369)

* Add warning msg when concat pointcloud is not published (autowarefoundation#388)

Signed-off-by: Kenji Miyake <[email protected]>

* add timeout notification stamp msgs (autowarefoundation#363)

* add timeout notification stamp msgs

* fix uncursify

* delete timeout notification stamped

* Revert "delete timeout notification stamped"

This reverts commit 365d29209f6a7f5ec75eb80c5d8c2ef38daeae79.

* fix message

Co-authored-by: Taichi Higashide <[email protected]>
Co-authored-by: taikitanaka3 <[email protected]>

* fix state_timeout (autowarefoundation#399)

Signed-off-by: Kosuke Murakami <[email protected]>

* fix param name (autowarefoundation#412)

* add timeout_ignore_state to emergency_handler (autowarefoundation#415)

* add timeout_ignore_state in emergency_handler

* do not ignore is_state_timeout_->is_timeout

* sort condition

* Ros2 fix topic name part1 (autowarefoundation#408)

* Fix topic name of lane_departure_checker debug

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of mpc_follower debug

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of velocity_controller debug

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of motion_velocity_optimizer debug

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of lane_change_planner debug

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of behavior_velocity_planner debug

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of obstacle_avoidance_planner debug

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of behavior_velocity_planner

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of motion_velocity_optimizer

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of lane_departure_checker

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of mpc_follower

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of behavior_velocity_planner

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of velocity_controller

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of lane_change_planner

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of obstacle_avoidance_planner

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of obstacle_stop_planner

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of costmap_generator

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of freespace_planner

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of surround_obstacle_checker

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of costmap_generator

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of emergency_handler

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix lint errors

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix typo

Signed-off-by: Takagi, Isamu <[email protected]>

* fix launch arg (autowarefoundation#426)

Signed-off-by: Kosuke Murakami <[email protected]>

* add use_sim-time option (autowarefoundation#454)

* Fix for rolling (autowarefoundation#1226)

* Replace doc by description

Signed-off-by: Kenji Miyake <[email protected]>

* Replace ns by push-ros-namespace

Signed-off-by: Kenji Miyake <[email protected]>

* Remove state_timeout_checker (autowarefoundation#1247)

Signed-off-by: Kenji Miyake <[email protected]>

* Remove use_sim_time for set_parameter (autowarefoundation#1260)

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

* Prevent emergency hold during manual driving (autowarefoundation#1390)

* Prevent emergency hold during manual driving

Signed-off-by: Kenji Miyake <[email protected]>

* Update README.md

* Fix typo

* Fix -Wunused-parameter (autowarefoundation#1836)

* Fix -Wunused-parameter

Signed-off-by: Kenji Miyake <[email protected]>

* Fix mistake

Signed-off-by: Kenji Miyake <[email protected]>

* fix spell

* Fix lint issues

Signed-off-by: Kenji Miyake <[email protected]>

* Ignore flake8 warnings

Signed-off-by: Kenji Miyake <[email protected]>

Co-authored-by: Hiroki OTA <[email protected]>

* Add autoware api (autowarefoundation#1979)

* enable autonomous recovery (autowarefoundation#1904)

* Use EmergencyState instead of deprecated EmergencyMode (autowarefoundation#2030)

* Use EmergencyState instead of deprecated EmergencyMode

Signed-off-by: Kenji Miyake <[email protected]>

* Use stamped type

Signed-off-by: Kenji Miyake <[email protected]>

* 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 takeover-request feature in emergency_handler (autowarefoundation#2032)

* Add takeover-request feature in emergency_handler

Signed-off-by: Kenji Miyake <[email protected]>

* Rename tor to takeover_request

Signed-off-by: Kenji Miyake <[email protected]>

* Use transitionTo

Signed-off-by: Kenji Miyake <[email protected]>

* Replace image URL

Signed-off-by: Kenji Miyake <[email protected]>

* Add error handling

Signed-off-by: Kenji Miyake <[email protected]>

* Fix state transition

Signed-off-by: Kenji Miyake <[email protected]>

* Fix state transition

Signed-off-by: Kenji Miyake <[email protected]>

* Fix cpplint

Signed-off-by: Kenji Miyake <[email protected]>

* Return after state transition

Signed-off-by: Kenji Miyake <[email protected]>

* Fix state transition

Signed-off-by: Kenji Miyake <[email protected]>

* Add initialization for control mode (autowarefoundation#2118)

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

* 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 <[email protected]>

* Remove ament_cmake_uncrustify and ament_clang_format

Signed-off-by: Kenji Miyake <[email protected]>

* Apply Black

Signed-off-by: Kenji Miyake <[email protected]>

* Apply clang-format

Signed-off-by: Kenji Miyake <[email protected]>

* Fix build errors

Signed-off-by: Kenji Miyake <[email protected]>

* Fix for cpplint

* Fix include double quotes to angle brackets

Signed-off-by: Kenji Miyake <[email protected]>

* Apply clang-format

Signed-off-by: Kenji Miyake <[email protected]>

* Fix build errors

Signed-off-by: Kenji Miyake <[email protected]>

* Add COLCON_IGNORE (autowarefoundation#500)

Signed-off-by: Kenji Miyake <[email protected]>

* [emergency_handler]support autoware.auto msg (autowarefoundation#513)

* support auto msg

* add readme

* remove VehicleStateReport/VehicleStateCommand/VehicleControlCommand (autowarefoundation#549)

* fix autoware_error_monitor

* fix state monitor

* fix emergency handler(vehicle_state_report)

* fix emergency Handler(vehicle_state_command)

* fix shift_decider

* fix emergency_handler(vehicle_control_command)

* fix topic name

* fix readme

* Update system/autoware_state_monitor/Readme.md

Co-authored-by: taikitanaka3 <[email protected]>

* fix format

* Update system/autoware_state_monitor/launch/autoware_state_monitor.launch.xml

Co-authored-by: taikitanaka3 <[email protected]>

* fix typo

Co-authored-by: taikitanaka3 <[email protected]>

* [autowere_web_controller/autoware_state_monitor/emergency_handler]fix some packages (autowarefoundation#603)

* fix vehicle_engage.js

* fix autoware_state_monitor param

* fix emergency_handler

* oh

* update autoware_state.js

* fix topic name (autowarefoundation#679)

* Fix/psim topics emergency handler awapi (autowarefoundation#702)

* fix emergency handler

* fix awapi

* remove unused topic

* remove duplecated vehicle cmd

Co-authored-by: mitsudome-r <[email protected]>
Co-authored-by: Nikolai Morin <[email protected]>
Co-authored-by: Jilada Eccleston <[email protected]>
Co-authored-by: Ryohsuke Mitsudome <[email protected]>
Co-authored-by: Takamasa Horibe <[email protected]>
Co-authored-by: Daisuke Nishimatsu <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Taichi Higashide <[email protected]>
Co-authored-by: taikitanaka3 <[email protected]>
Co-authored-by: Kosuke Murakami <[email protected]>
Co-authored-by: Takagi, Isamu <[email protected]>
Co-authored-by: Hiroki OTA <[email protected]>
Co-authored-by: Keisuke Shima <[email protected]>
Co-authored-by: Takeshi Miura <[email protected]>

* feat: add lane depature checker package (autowarefoundation#44)

* Back port .auto control packages (autowarefoundation#571)

* Implement Lateral and Longitudinal Control Muxer

* [autowarefoundation#570] Porting wf_simulator

* [autowarefoundation#1189] Deactivate flaky test in 'trajectory_follower_nodes'

* [autowarefoundation#1189] Fix flacky test in 'trajectory_follower_nodes/latlon_muxer'

* [autowarefoundation#1057] Add osqp_interface package

* [autowarefoundation#1057] Add library code for MPC-based lateral control

* [autowarefoundation#1271] Use std::abs instead of abs

* [autowarefoundation#1057] Implement Lateral Controller for Cargo ODD

* [autowarefoundation#1246] Resolve "Test case names currently use snake_case but should be CamelCase"

* [autowarefoundation#1325] Deactivate flaky smoke test in 'trajectory_follower_nodes'

* [autowarefoundation#1058] Add library code of longitudinal controller

* Fix build error for trajectory follower

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

* Fix build error for trajectory follower nodes

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

* [autowarefoundation#1272] Add AckermannControlCommand support to simple_planning_simulator

* [autowarefoundation#1058] Add Longitudinal Controller node

* [autowarefoundation#1058] Rename velocity_controller -> longitudinal_controller

* [autowarefoundation#1058] Update CMakeLists.txt for the longitudinal_controller_node

* [autowarefoundation#1058] Add smoke test python launch file

* [autowarefoundation#1058] Use LowPassFilter1d from trajectory_follower

* [autowarefoundation#1058] Use autoware_auto_msgs

* [autowarefoundation#1058] Changes for .auto (debug msg tmp fix, common func, tf listener)

* [autowarefoundation#1058] Remove unused parameters

* [autowarefoundation#1058] Fix ros test

* [autowarefoundation#1058] Rm default params from declare_parameters + use autoware types

* [autowarefoundation#1058] Use default param file to setup NodeOptions in the ros test

* [autowarefoundation#1058] Fix docstring

* [autowarefoundation#1058] Replace receiving a Twist with a VehicleKinematicState

* [autowarefoundation#1058] Change class variables format to m_ prefix

* [autowarefoundation#1058] Fix plugin name of LongitudinalController in CMakeLists.txt

* [autowarefoundation#1058] Fix copyright dates

* [autowarefoundation#1058] Reorder includes

* [autowarefoundation#1058] Add some tests (~89% coverage without disabling flaky tests)

* [autowarefoundation#1058] Add more tests (90+% coverage without disabling flaky tests)

* [autowarefoundation#1058] Use Float32MultiArrayDiagnostic message for debug and slope

* [autowarefoundation#1058] Calculate wheel_base value from vehicle parameters

* [autowarefoundation#1058] Cleanup redundant logger setting in tests

* [autowarefoundation#1058] Set ROS_DOMAIN_ID when running tests to prevent CI failures

* [autowarefoundation#1058] Remove TF listener and use published vehicle state instead

* [autowarefoundation#1058] Change smoke tests to use autoware_testing

* [autowarefoundation#1058] Add plotjuggler cfg for both lateral and longitudinal control

* [autowarefoundation#1058] Improve design documents

* [autowarefoundation#1058] Disable flaky test

* [autowarefoundation#1058] Properly transform vehicle state in longitudinal node

* [autowarefoundation#1058] Fix TF buffer of lateral controller

* [autowarefoundation#1058] Tuning of lateral controller for LGSVL

* [autowarefoundation#1058] Fix formating

* [autowarefoundation#1058] Fix /tf_static sub to be transient_local

* [autowarefoundation#1058] Fix yaw recalculation of reverse trajs in the lateral controller

* modify trajectory_follower for galactic build

Signed-off-by: Takamasa Horibe <[email protected]>

* [autowarefoundation#1379] Update trajectory_follower

* [autowarefoundation#1379] Update simple_planning_simulator

* [autowarefoundation#1379] Update trajectory_follower_nodes

* apply trajectory msg modification in control

Signed-off-by: Takamasa Horibe <[email protected]>

* move directory

Signed-off-by: Takamasa Horibe <[email protected]>

* remote control/trajectory_follower level dorectpry

Signed-off-by: Takamasa Horibe <[email protected]>

* remove .iv trajectory follower

Signed-off-by: Takamasa Horibe <[email protected]>

* use .auto trajectory_follower

Signed-off-by: Takamasa Horibe <[email protected]>

* remove .iv simple_planning_simulator & osqp_interface

Signed-off-by: Takamasa Horibe <[email protected]>

* use .iv simple_planning_simulator & osqp_interface

Signed-off-by: Takamasa Horibe <[email protected]>

* add tmp_autoware_auto_dependencies

Signed-off-by: Takamasa Horibe <[email protected]>

* tmporally add autoware_auto_msgs

Signed-off-by: Takamasa Horibe <[email protected]>

* apply .auto message split

Signed-off-by: Takamasa Horibe <[email protected]>

* fix build depend

Signed-off-by: Takamasa Horibe <[email protected]>

* fix packages using osqp

* fix autoware_auto_geometry

* ignore lint of some packages

* ignore ament_lint of some packages

* ignore lint/pre-commit of trajectory_follower_nodes

* disable unit tests of some packages

Co-authored-by: Maxime CLEMENT <[email protected]>
Co-authored-by: Joshua Whitley <[email protected]>
Co-authored-by: Igor Bogoslavskyi <[email protected]>
Co-authored-by: MIURA Yasuyuki <[email protected]>
Co-authored-by: wep21 <[email protected]>
Co-authored-by: tomoya.kimura <[email protected]>

* add isValidData (autowarefoundation#686)

Signed-off-by: Takamasa Horibe <[email protected]>

* Fix lane departure (autowarefoundation#688)

* rename

Signed-off-by: Takamasa Horibe <[email protected]>

* fix bug

Signed-off-by: Takamasa Horibe <[email protected]>

* Update twist topic name (autowarefoundation#736)

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

* ci(pre-commit): autofix

Co-authored-by: Takamasa Horibe <[email protected]>
Co-authored-by: Maxime CLEMENT <[email protected]>
Co-authored-by: Joshua Whitley <[email protected]>
Co-authored-by: Igor Bogoslavskyi <[email protected]>
Co-authored-by: MIURA Yasuyuki <[email protected]>
Co-authored-by: wep21 <[email protected]>
Co-authored-by: tomoya.kimura <[email protected]>
Co-authored-by: Daisuke Nishimatsu <[email protected]>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>
Co-authored-by: Takeshi Miura <[email protected]>

* feat: add multi_object_tracker package (autowarefoundation#74)

* release v0.4.0

* remove ROS1 packages temporarily

Signed-off-by: mitsudome-r <[email protected]>

* Revert "remove ROS1 packages temporarily"

This reverts commit 4acc04bb2a3b2ef21e687a8d3ba88008fa32846b.

Signed-off-by: mitsudome-r <[email protected]>

* add COLCON_IGNORE to ros1 packages

Signed-off-by: mitsudome-r <[email protected]>

* Rename launch files to launch.xml (autowarefoundation#28)

* ROS2 Porting: multi_object_tracker (autowarefoundation#24)

* First pass at node (exclude tracker library)
 - Rename files to match existing packages
   - node -> _core
   - main -> _node

 - Add publishers and subscribers
 - Add TF and logging
 - issue with lookupTransform from tf2::BufferCore doesn't allow for duration specification in foxy
bfe938b

* Add the base implementation of the helper class and files
 - Depends on the unique_id package which has not been release rosdep yet
 - Point to the correct packages
 - Add vehicle_tracker class
 - Missing uuid implementation for the object id creation
 - Convert bicycle_tracker class
 - Convert pedestrian_tracker to ROS2
 - Add successive_shortest_path library
   - Changed header file extension to match existing files
 - Convert data_association to ROS2
   - Return type change to resolve -Wreturn-type warning

* Add data associator and tracker method calls back into the MultiObjectTracker implementation

* Clean up
 - Align headers
 - Fix typo
 - Add back the transform with no duration;  see issue
 - Remove comments

* Clean up package.xml and CMakelists

* Clean up header order

* Remove main file

* Fix issues after rebase
 - Add wait for transform to add duration
 - Add UUID generation
 - Add -Werror

* Address PR comment:
 - Reintroduce getUUID method in tracker code

* Fix the waitForTransform implementation
 - Use the synchronous approach to getting the transform using wait_for()

* Address PR comments:
 - Add further comments in CMakelist explaining Eigen library deps
 - Use durable transient_local QoS for subscriber
 - Remove second explicit string type decl
 - Convert buffer and listener to plain objects, move initialization to initialization list
 - Make generation of random bits more idiomatic
 - Use indepedent_bit_engine instead of uniform distribution

* Address PR comments:
 - Fix eigen cmake dep

* Fix Eigen3 deps
 - find cmake module

* fix duration unit for RCLCPP_*_THROTTLE (autowarefoundation#75)

Signed-off-by: Takamasa Horibe <[email protected]>

* Adjust copyright notice on 532 out of 699 source files (autowarefoundation#143)

* Use quotes for includes where appropriate (autowarefoundation#144)

* Use quotes for includes where appropriate

* Fix lint tests

* Make tests pass hopefully

* Run uncrustify on the entire Pilot.Auto codebase (autowarefoundation#151)

* Run uncrustify on the entire Pilot.Auto codebase

* Exclude open PRs

* adding linters to multi_object_tracker (autowarefoundation#177)

* [multi_object_tracker] fix bug in calculating timer period (autowarefoundation#198)

Signed-off-by: mitsudome-r <[email protected]>

* Replace waitForTransform with lookupTransform in multi_object_tracker (autowarefoundation#213)

* Ros2 v0.8.0 multi object tracker (autowarefoundation#259)

* restore file name for v0.8.0 update

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

* fix typos in perception (autowarefoundation#862)

* Feature/camera lidar perception (autowarefoundation#937)

* add object splitter

Signed-off-by: Yukihiro Saito <[email protected]>

* add object merger

Signed-off-by: Yukihiro Saito <[email protected]>

* change pkg name

Signed-off-by: Yukihiro Saito <[email protected]>

* cosmetic change

Signed-off-by: Yukihiro Saito <[email protected]>

* add comment

Signed-off-by: Yukihiro Saito <[email protected]>

* remove litter

Signed-off-by: Yukihiro Saito <[email protected]>

* bug fix : debug code

Signed-off-by: Yukihiro Saito <[email protected]>

* enable vehicle to unknown track

Signed-off-by: Yukihiro Saito <[email protected]>

* bug fix

* add object position in clustering

* 🚮

* change param

* fix name

* bug fix

* add install

* add delay compensation param (autowarefoundation#1035)

* fix tracking bug and change tracking param (autowarefoundation#1036)

* fix bug

* cut stop noise velocity

* update param

* support unknown labeled object tracking (autowarefoundation#1017)

* add data association matrix param

* fix typo

* apply clang-format-6.0

* set pedestrian model when label is unknown

Co-authored-by: Yukihiro Saito <[email protected]>

* Add missing install of config directory (autowarefoundation#1045)

Signed-off-by: Kenji Miyake <[email protected]>

* Revert "restore file name for v0.8.0 update"

This reverts commit 5fdf5b179f2395f01672c976920da1f8de8cc33a.

* Fix typo

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

* Fix parameter type

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

* Fix missing arg

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

Co-authored-by: Kazuki Miyahara <[email protected]>
Co-authored-by: Yukihiro Saito <[email protected]>
Co-authored-by: Taichi Higashide <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>

* fix min_area (autowarefoundation#347)

Signed-off-by: Kosuke Murakami <[email protected]>

* Rename ROS-related .yaml to .param.yaml (autowarefoundation#352)

* Rename ROS-related .yaml to .param.yaml

Signed-off-by: Kenji Miyake <[email protected]>

* Remove prefix 'default_' of yaml files

Signed-off-by: Kenji Miyake <[email protected]>

* Rename vehicle_info.yaml to vehicle_info.param.yaml

Signed-off-by: Kenji Miyake <[email protected]>

* Rename diagnostic_aggregator's param files

Signed-off-by: Kenji Miyake <[email protected]>

* Fix overlooked parameters

Signed-off-by: Kenji Miyake <[email protected]>

* Feature/ekf tracker (autowarefoundation#1158) (autowarefoundation#381)

* Feature/ekf tracker (autowarefoundation#1158)

* change to ekf tracker

* visualize covariance

* cosmetic change

* cosmetic change

* change param

* add multi model ekf tracker (autowarefoundation#1165)

* add multi model ekf tracker

* cosmetic change

* cosmetic change

* add iou filter

* change correct license

* change correct license

* cosmetic change

* bug fix

* cosmetic change

* check clockwise

* change param

* bug fix

* cosmetic change

* add comment

* add enum

* cosmetic change

* cosmetic change

* apply format

* apply format

* fix config name

Signed-off-by: mitsudome-r <[email protected]>

* [multi_object_tracker] apply ament_uncrustify

Signed-off-by: mitsudome-r <[email protected]>

* [multi_object_tracker] fix lint errors

Signed-off-by: mitsudome-r <[email protected]>

* fix include brackets

Signed-off-by: mitsudome-r <[email protected]>

* fix duration (autowarefoundation#445)

* fix duration

Signed-off-by: Kosuke Murakami <[email protected]>

* change to from_seconds

Signed-off-by: Kosuke Murakami <[email protected]>

* fix other duration

Signed-off-by: Kosuke Murakami <[email protected]>

* replace -1 with 0

Signed-off-by: Kosuke Murakami <[email protected]>

* apply ament_lint_common

Signed-off-by: Kosuke Murakami <[email protected]>

* uncrustify

Signed-off-by: Kosuke Murakami <[email protected]>

* add space

Signed-off-by: Kosuke Murakami <[email protected]>

* add another space

Signed-off-by: Kosuke Murakami <[email protected]>

* Fix typo in perception module (autowarefoundation#440)

* add use_sim-time option (autowarefoundation#454)

* Remove use_sim_time for set_parameter (autowarefoundation#1260)

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

* fix calculation of corners (autowarefoundation#1271) (autowarefoundation#1273)

* fix calculation of corners

* reduce calc cost

Co-authored-by: Yukihiro Saito <[email protected]>

Co-authored-by: Yusuke Muramatsu <[email protected]>
Co-authored-by: Yukihiro Saito <[email protected]>

* Porting small fix (autowarefoundation#1288)

* Delete unused code (autowarefoundation#1183)

* Fix control topic name of closest_velocity_checker.py (autowarefoundation#1174)

Signed-off-by: Kenji Miyake <[email protected]>

* Add comments for livox tag (autowarefoundation#1188)

Signed-off-by: Kenji Miyake <[email protected]>

* Clear return value (autowarefoundation#1193)

* Change tracker model of unknown object (autowarefoundation#1204)

* treat polygon points as relative (autowarefoundation#1205)

Signed-off-by: Kosuke Murakami <[email protected]>

* hotfix: reference velocity in consideration of vehicle gear (autowarefoundation#1213)

* fix reference velocity for vehicle gear

* add initialization

* revert

* add comment

* change max area param (autowarefoundation#1218)

* Fix an identical code for different branches (autowarefoundation#1230)

* Update livox_tag_filter.launch.xml

* Fixup

Signed-off-by: Kenji Miyake <[email protected]>

Co-authored-by: shin <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Fumiya Watanabe <[email protected]>
Co-authored-by: Yukihiro Saito <[email protected]>
Co-authored-by: Kosuke Murakami <[email protected]>
Co-authored-by: Hiroki OTA <[email protected]>
Co-authored-by: tkimura4 <[email protected]>
Co-authored-by: Kazuki Miyahara <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>

* fix bug (change noise in measurement update) (autowarefoundation#1313)

* fix bug (change noise in measurement update)

* Uncrustify

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

Co-authored-by: Yukihiro Saito <[email protected]>

* Feature/porting mussp with vendor (autowarefoundation#1323)

* change to mussp (autowarefoundation#1180)

* change to mussp

* add license

* add license

* change to solver plugin

* fix bug

* cosmetic change

* modified to follow ROS2 coding style

* Use mussp vendor

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

* Fix dependencies in package.xml

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

* Add mussp_vendor into build_depends.repos

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

* Fix lint

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

* Fix typo

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

* Fix typo

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

* Fix lint

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

* Use fork instead of vendor package

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

* Cleanup CMakeLists.txt

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

* Remove comment

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

* Sort package dependencies in alphabetical order

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

Co-authored-by: Yukihiro Saito <[email protected]>
Co-authored-by: Keisuke Shima <[email protected]>

* Porting unknown tracker (autowarefoundation#1292)

* add unknown tracker (autowarefoundation#1211)

* add unknown tracker

* bug fix

* fix typo

* fix for test

Co-authored-by: Yukihiro Saito <[email protected]>

* Fix/tracking ros2 (autowarefoundation#1478)

* cosmetic change and fix multi model tracker update bug (autowarefoundation#1335)

* Fix lint

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

* Fix typo

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

Co-authored-by: Yukihiro Saito <[email protected]>

* Add missing eigen macro (autowarefoundation#1336) (autowarefoundation#1477)

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

* Fix parameter file for mot (autowarefoundation#1489)

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

* Add pre-commit (autowarefoundation#1560)

* add pre-commit

* add pre-commit-config

* add additional settings for private repository

* use default pre-commit-config

* update pre-commit setting

* Ignore whitespace for line breaks in markdown

* Update .github/workflows/pre-commit.yml

Co-authored-by: Kazuki Miyahara <[email protected]>

* exclude svg

* remove pretty-format-json

* add double-quote-string-fixer

* consider COLCON_IGNORE file when seaching modified package

* format file

* pre-commit fixes

* Update pre-commit.yml

* Update .pre-commit-config.yaml

Co-authored-by: Kazuki Miyahara <[email protected]>
Co-authored-by: pre-commit <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>

* Add markdownlint and prettier (autowarefoundation#1661)

* Add markdownlint and prettier

Signed-off-by: Kenji Miyake <[email protected]>

* Ignore .param.yaml

Signed-off-by: Kenji Miyake <[email protected]>

* Apply format

Signed-off-by: Kenji Miyake <[email protected]>

* suppress warnings for declare parameters (autowarefoundation#1724)

* fix for lanelet2_extension

* fix for traffic light ssd fine detector

* fix for topic_state_monitor

* fix for dummy diag publisher

* fix for remote cmd converter

* fix for vehicle_info_util

* fix for multi object tracker

* fix for freespace planner

* fix for autoware_error_monitor

* add Werror for multi object tracker

* fix for multi object tracker

* add Werror for liraffic light ssd fine detector

* add Werror for topic state monitor

* add Werror

* add Werror

* add Werror

* add Werror

* fix style

* Fix -Wunused-parameter (autowarefoundation#1836)

* Fix -Wunused-parameter

Signed-off-by: Kenji Miyake <[email protected]>

* Fix mistake

Signed-off-by: Kenji Miyake <[email protected]>

* fix spell

* Fix lint issues

Signed-off-by: Kenji Miyake <[email protected]>

* Ignore flake8 warnings

Signed-off-by: Kenji Miyake <[email protected]>

Co-authored-by: Hiroki OTA <[email protected]>

* Fix clang warnings (autowarefoundation#1859)

* Fix -Wreturn-std-move

Signed-off-by: Kenji Miyake <[email protected]>

* Fix -Wunused-private-field

Signed-off-by: Kenji Miyake <[email protected]>

* Ignore -Wnonportable-include-path for mussp

Signed-off-by: Kenji Miyake <[email protected]>

* Fix -Wunused-const-variable

Signed-off-by: Kenji Miyake <[email protected]>

* Fix "can not be used when making a shared object"

Signed-off-by: Kenji Miyake <[email protected]>

* Feature/porting modify tracker life cycle (autowarefoundation#1675)

* Modify tracker life cycle (autowarefoundation#1462)

* add z lpf

Signed-off-by: Yukihiro Saito <[email protected]>

* modify life cycle

Signed-off-by: Yukihiro Saito <[email protected]>

* refactor

* apply format

* fix typo

* add read me

* fix typo

* change readme

* modify readme

* fix typo

* cosmetic change

* cosmetic change

* refactor and change removal conditions

* cosmetic change

* add note

* bug fix

* change specific alive pattern

* format code

Co-authored-by: Takamasa Horibe <[email protected]>

* Apply lint

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

* pre-commit fixes

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

* fix bug

Co-authored-by: Yukihiro Saito <[email protected]>
Co-authored-by: Takamasa Horibe <[email protected]>
Co-authored-by: tkimura4 <[email protected]>

* Detection by tracker (autowarefoundation#1910)

* initial commit

* backup

* apply format

* cosmetic change

* implement divided under segmenterd clusters

* cosmetic change

* bug fix

* bug fix

* bug fix

* modify launch

* add debug and bug fix

* bug fix

* bug fix

* add no found tracked object

* modify parameters and cmake

* bug fix

* remove debug info

* add readme

* modify clustering launch

* run pre-commit

* cosmetic change

* cosmetic change

* cosmetic change

* apply markdownlint

* modify launch

* modify for cpplint

* modify qos

* change int to size_T

* bug fix

* change perception qos

* Update perception/object_recognition/detection/detection_by_tracker/package.xml

Co-authored-by: Daisuke Nishimatsu <[email protected]>

* cosmetic change

* cosmetic change

* fix launch

* Update perception/object_recognition/detection/detection_by_tracker/src/utils.cpp

Co-authored-by: Daisuke Nishimatsu <[email protected]>

* modify header include order

* change include order

* Update perception/object_recognition/detection/detection_by_tracker/src/detection_by_tracker_core.cpp

Co-authored-by: Daisuke Nishimatsu <[email protected]>

* change to std::optional

* cosmetic change

* Update perception/object_recognition/detection/detection_by_tracker/src/detection_by_tracker_core.cpp

Co-authored-by: Daisuke Nishimatsu <[email protected]>

* Update perception/object_recognition/detection/detection_by_tracker/src/detection_by_tracker_core.cpp

Co-authored-by: Daisuke Nishimatsu <[email protected]>

* bug fix

* modify readme

Co-authored-by: Daisuke Nishimatsu <[email protected]>

* 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 <[email protected]>

* Remove ament_cmake_uncrustify and ament_clang_format

Signed-off-by: Kenji Miyake <[email protected]>

* Apply Black

Signed-off-by: Kenji Miyake <[email protected]>

* Apply clang-format

Signed-off-by: Kenji Miyake <[email protected]>

* Fix build errors

Signed-off-by: Kenji Miyake <[email protected]>

* Fix for cpplint

* Fix include double quotes to angle brackets

Signed-off-by: Kenji Miyake <[email protected]>

* Apply clang-format

Signed-off-by: Kenji Miyake <[email protected]>

* Fix build errors

Signed-off-by: Kenji Miyake <[email protected]>

* Add COLCON_IGNORE (autowarefoundation#500)

Signed-off-by: Kenji Miyake <[email protected]>

* Port multi object tracker for autoware_auto_msgs (autowarefoundation#526)

* backup

* backup

* backup

* add todo author

* apply pre-commit

* remove COLCON_IGNORE

* fix: fix README.md

* ci(pre-commit): autofix

* Apply suggestions from code review

Co-authored-by: mitsudome-r <[email protected]>
Co-authored-by: Nikolai Morin <[email protected]>
Co-authored-by: Jilada Eccleston <[email protected]>
Co-authored-by: Takamasa Horibe <[email protected]>
Co-authored-by: nik-tier4 <[email protected]>
Co-authored-by: Ryohsuke Mitsudome <[email protected]>
Co-authored-by: Daisuke Nishimatsu <[email protected]>
Co-authored-by: Kazuki Miyahara <[email protected]>
Co-authored-by: Yukihiro Saito <[email protected]>
Co-authored-by: Taichi Higashide <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Kosuke Murakami <[email protected]>
Co-authored-by: tkimura4 <[email protected]>
Co-authored-by: Yusuke Muramatsu <[email protected]>
Co-authored-by: Keisuke Shima <[email protected]>
Co-authored-by: shin <[email protected]>
Co-authored-by: Fumiya Watanabe <[email protected]>
Co-authored-by: Hiroki OTA <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Keisuke Shima <[email protected]>
Co-authored-by: pre-commit <[email protected]>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>

* feat: add imu_corrector package (autowarefoundation#28)

* Feature/imu corrector (autowarefoundation#1587)

* add imu_corrector

* add reamdme

* modify reamdme

* fix typo

* add explicit

* apply clang-format

* add unit

* remove unneccessary lines

* remove unneccessary lines

* pre-commit fixes

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

* update readme

* pre-commit fixes

Co-authored-by: wep21 <[email protected]>
Co-authored-by: pre-commit <[email protected]>

* imu corrector param units and link (autowarefoundation#1791)

* fix unit

* fix link

* fix format

* Fix -Wunused-parameter (autowarefoundation#1836)

* Fix -Wunused-parameter

Signed-off-by: Kenji Miyake <[email protected]>

* Fix mistake

Signed-off-by: Kenji Miyake <[email protected]>

* fix spell

* Fix lint issues

Signed-off-by: Kenji Miyake <[email protected]>

* Ignore flake8 warnings

Signed-off-by: Kenji Miyake <[email protected]>

Co-authored-by: Hiroki OTA <[email protected]>

* 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 <[email protected]>

* Remove ament_cmake_uncrustify and ament_clang_format

Signed-off-by: Kenji Miyake <[email protected]>

* Apply Black

Signed-off-by: Kenji Miyake <[email protected]>

* Apply clang-format

Signed-off-by: Kenji Miyake <[email protected]>

* Fix build errors

Signed-off-by: Kenji Miyake <[email protected]>

* Fix for cpplint

* Fix include double quotes to angle brackets

Signed-off-by: Kenji Miyake <[email protected]>

* Apply clang-format

Signed-off-by: Kenji Miyake <[email protected]>

* Fix build errors

Signed-off-by: Kenji Miyake <[email protected]>

* Add COLCON_IGNORE (autowarefoundation#500)

Signed-off-by: Kenji Miyake <[email protected]>

* remove COLCON_IGNORE (autowarefoundation#515)

* Remove template comments from node documents (autowarefoundation#608)

* rename document file

* remove template comment

Co-authored-by: YamatoAndo <[email protected]>
Co-authored-by: wep21 <[email protected]>
Co-authored-by: pre-commit <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Hiroki OTA <[email protected]>
Co-authored-by: Satoshi OTA <[email protected]>
Co-authored-by: taikitanaka3 <[email protected]>
Co-authored-by: Tomoya Kimura <[email protected]>

Co-authored-by: tkimura4 <[email protected]>
Co-authored-by: Takeshi Miura <[email protected]>
Co-authored-by: Takagi, Isamu <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Hiroki OTA <[email protected]>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>
Co-authored-by: mitsudome-r <[email protected]>
Co-authored-by: Nikolai Morin <[email protected]>
Co-authored-by: Jilada Eccleston <[email protected]>
Co-authored-by: Ryohsuke Mitsudome <[email protected]>
Co-authored-by: Takamasa Horibe <[email protected]>
Co-authored-by: Daisuke Nishimatsu <[email protected]>
Co-authored-by: Taichi Higashide <[email protected]>
Co-authored-by: taikitanaka3 <[email protected]>
Co-authored-by: Kosuke Murakami <[email protected]>
Co-authored-by: Keisuke Shima <[email protected]>
Co-authored-by: Maxime CLEMENT <[email protected]>
Co-authored-by: Joshua Whitley <[email protected]>
Co-authored-by: Igor Bogoslavskyi <[email protected]>
Co-authored-by: MIURA Yasuyuki <[email protected]>
Co-authored-by: wep21 <[email protected]>
Co-authored-by: nik-tier4 <[email protected]>
Co-authored-by: Kazuki Miyahara <[email protected]>
Co-authored-by: Yukihiro Saito <[email protected]>
Co-authored-by: Yusuke Muramatsu <[email protected]>
Co-authored-by: Keisuke Shima <[email protected]>
Co-authored-by: shin <[email protected]>
Co-authored-by: Fumiya Watanabe <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: pre-commit <[email protected]>
Co-authored-by: YamatoAndo <[email protected]>
Co-authored-by: Satoshi OTA <[email protected]>
TakumiKozaka-T4 pushed a commit to TakumiKozaka-T4/autoware.universe that referenced this pull request Mar 23, 2022
* Feature/porting motion velocity smoother (autowarefoundation#1653)

* Add motion_velocity_smoother (autowarefoundation#1333)

* Refactor node and utilities

* Fix utilities

* Fix utilities

* Fixing...

* Runs with L2 smoother

* Use boost::optional

* Add Linf, JerkFiltered

* JerkFiltered

* Fix

* Fix awapi

* Fix bug

* Add config files

* Fix bug

* Fix bug and apply clang-format

* Remove unused variable

* Fix bug

* Change C-style cast to static_cast

* Add destructors

* Use smart pointers for members

* Add test

* Fix test code

* Tmp: add L2 norm of jerk in objective function

* Fix external velocity limit

* Fix interpolate in velocity controller and remove prevent move to close stop line

* add initial velocity and acceleration to the filter function

* Fix index calculation

* add new marge function

* handle edge case

* Tmp: skip osqp_interface build test

* Revert get_modified_package.sh

* Fix CI

* Fix version of osqp

* Fix

* Add design docment (JPN)

* Fix linear interpolation

* Refactor node and utilities

* Fix utilities

* Fix utilities

* Fixing...

* Runs with L2 smoother

* Use boost::optional

* Add Linf, JerkFiltered

* JerkFiltered

* Fix

* Fix awapi

* Fix bug

* Add config files

* Fix bug

* Fix bug and apply clang-format

* Remove unused variable

* Fix bug

* Change C-style cast to static_cast

* Add destructors

* Use smart pointers for members

* Add test

* Fix test code

* Tmp: add L2 norm of jerk in objective function

* Fix external velocity limit

* Fix interpolate in velocity controller and remove prevent move to close stop line

* add initial velocity and acceleration to the filter function

* Fix index calculation

* add new marge function

* handle edge case

* Tmp: skip osqp_interface build test

* Revert get_modified_package.sh

* Fix CI

* Fix version of osqp

* Fix

* Add design docment (JPN)

* Fix linear interpolation

* add new sample function

* Fix

* Revert velocity_controller

* Reset motion_velocity_optimizer

* Fix parameter setting

* Refactor and fix bugs

* Use autoware_utils

* Fix doc and bug

* Fix doc

* Fix external velocity limit and parametrize margin and jerk weight

* Fix typo

* Fix typo and remove old readme

* add stop point calculation and modify objective function

* Add parameter handling functions and add namespace

* Rename calcClosestTrajectoryPoint to calcInterpolatedTrajectoryPoint and remove unused function

* Fix applyExternalVelocityLimit and fix comments

* Fix variable name

* Fix variable name

* Fix yaml comment

* Add const

* Fix interpolaion

* Remove run() and change type of prev_closest_point_

* Update planning/scenario_planning/common/motion_velocity_smoother/src/smoother/smoother_base.cpp

Co-authored-by: tkimura4 <[email protected]>

* fix stop point error

* Fix linear interpolation and external velocity calculation

* Remove debug code

* Rename BaseParam

* Remove unused func and fix misc

* Fix package.xml, include, apply formatting

* Fix external velocity limit

* add debug calculation time

* modify calculation time debugger

* modify calculation time publisher

* rescale the calculation time

* Fix some problem

* Update planning/scenario_planning/common/motion_velocity_smoother/launch/motion_velocity_smoother.launch

Co-authored-by: tkimura4 <[email protected]>

Co-authored-by: yutaka <[email protected]>
Co-authored-by: tkimura4 <[email protected]>

* Add Resample Procedure after the optimization in motion_velocity_smoother (autowarefoundation#1530)

* do resample after the optimization

* modify resample timing

* add 0 at the end of the resampeld output trajectory

* Manage parameters

* Fix format

* Fix format

* Devide resample function in other file

* Update default_motion_velocity_smoother.yaml

* Update default_motion_velocity_smoother.yaml

Co-authored-by: Fumiya Watanabe <[email protected]>

* Output debug trajectories in motion velocity smoother (autowarefoundation#1533)

* add debug trajectory

* add rqt_multiplot setting files

* add calculation tiem visualization

* guard emtpy output (autowarefoundation#1537)

* Motion velocity smoother doc (autowarefoundation#1563)

* Fix doc

* Add english doc (tmp)

* Add english file

* Remove unused files

* Fix

* Fix typo

* Modify 1-size trajectory handling & warning messages (autowarefoundation#1540)

* add new guard to delete unnecessary message

* change message

* add warning messages

* chnage message to warning

* chnage to throttle

* Fix jerk filter calculation (autowarefoundation#1593)

* modify jerk filter calculation

* remove unnecessary code

* change the way of interp. of pose in smoother (autowarefoundation#1600)

* Update smoother resampling (autowarefoundation#1595)

* add new guard to delete unnecessary message

* change message

* add warning messages

* chnage message to warning

* chnage to throttle

* modify jerk filter calculation

* modify jerk filter calculation

* separate resampling code

* add new parameter

* add new parameter to dynamic reconfigure

* remove unnecessary code

* add sampling before optimization

* add const and blocker

* change access to at

* fix terminal length value

* add comments

* clean code

* add comment

* Fix/insert backward on reverse trajectory (autowarefoundation#1602)

* remove unused code

Signed-off-by: Takamasa Horibe <[email protected]>

* move debug code

Signed-off-by: Takamasa Horibe <[email protected]>

* fix insert backward on reverse trajectory

Signed-off-by: Takamasa Horibe <[email protected]>

* Porting motion velocity smoother to ros2

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

* Fix launch and fix warning

* pre-commit fixes

* Remove unused argument

* Comment out unused parameter

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

* Add distance threshold in motion_velocity_smoother (autowarefoundation#1659)

* Add distance threshold

* Remove parameters and use default value

* Fix for pre-commit

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

* Support Non-zero Stop Point Acceleration (autowarefoundation#1651)

* Support non-zero stop point acceleration

* modify zero velocity id search function (autowarefoundation#1690)

* modify zero velocity id search function

* Fix resample function and error handling

* Add comment

Co-authored-by: Fumiya Watanabe <[email protected]>

* Apply lint

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

* pre-commit fixes

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

Co-authored-by: Fumiya Watanabe <[email protected]>
Co-authored-by: yutaka <[email protected]>
Co-authored-by: tkimura4 <[email protected]>
Co-authored-by: purewater0901 <[email protected]>
Co-authored-by: Takamasa Horibe <[email protected]>
Co-authored-by: pre-commit <[email protected]>

* Feature/add trajectory_visualizer and closest_velocity_checker to motion_velocity_smoother (autowarefoundation#1820)

* add trajectory_visualizer and closest_velocity_optimizer to motion_velocity_smoother.

* Fix CMakeLists

Co-authored-by: Fumiya Watanabe <[email protected]>

* Feature/port analytical smoother (autowarefoundation#1896)

* Port analytical jerk constrained smoother

Signed-off-by: Makoto Kurihara <[email protected]>

* Fix parameters format

Signed-off-by: Makoto Kurihara <[email protected]>

* Resolve warnings and remove unnecessary processing

Signed-off-by: Makoto Kurihara <[email protected]>

* Change default parameters

Signed-off-by: Makoto Kurihara <[email protected]>

* Change slash to dot for declare_parameter

Signed-off-by: Makoto Kurihara <[email protected]>

* Fix debug messages

Signed-off-by: Makoto Kurihara <[email protected]>

* Change pragma once to ifndef and endif

Signed-off-by: Makoto Kurihara <[email protected]>

* Add #include vector, utility and string

Signed-off-by: Makoto Kurihara <[email protected]>

* Remove extra white spaces

Signed-off-by: Makoto Kurihara <[email protected]>

* Fix acceleration calculation at type 3

Signed-off-by: Makoto Kurihara <[email protected]>

* Apply clang-format

Signed-off-by: Makoto Kurihara <[email protected]>

* Change copyright format

Signed-off-by: Makoto Kurihara <[email protected]>

* Fix to be less than 100 characters per line

Signed-off-by: Makoto Kurihara <[email protected]>

* Implement and remove TODO

Signed-off-by: Makoto Kurihara <[email protected]>

* Add include to src

Signed-off-by: Makoto Kurihara <[email protected]>

* Use static_cast

Signed-off-by: Makoto Kurihara <[email protected]>

* Follow uncrustify

Signed-off-by: Makoto Kurihara <[email protected]>

* Disable uncrustify at include guard

Signed-off-by: Makoto Kurihara <[email protected]>

* Disable uncrustify at include

Signed-off-by: Makoto Kurihara <[email protected]>

* Follow uncrustify

Signed-off-by: Makoto Kurihara <[email protected]>

* Fix include order error

Signed-off-by: Makoto Kurihara <[email protected]>

* Fix typo

Signed-off-by: Makoto Kurihara <[email protected]>

* Change index type to size_t

Signed-off-by: Makoto Kurihara <[email protected]>

* Fix size_t

Signed-off-by: Makoto Kurihara <[email protected]>

* Add const

Signed-off-by: Makoto Kurihara <[email protected]>

* Fix parameter namespace signs from slash to dot and add latacc one

Signed-off-by: Makoto Kurihara <[email protected]>

* fix for createQuaternionFromRPY/Yaw (autowarefoundation#2154)

* fix stop dist calc bug (autowarefoundation#2152)

* use interpolation::slerp (autowarefoundation#2161)

* Add post resampling explanations (autowarefoundation#2155)

* Update motion_velocity_smoother-design.ja.md

* Update motion_velocity_smoother-design.md

* Feature/use external jerk/acc constraints (autowarefoundation#2130)

* use external jerk/acc constraints

* update VelocityLimit.msg

* Feature/add external velocity limit selector (autowarefoundation#2217)

* add external velocity limit selector

* add README.md

* improve document

* apply document template

* update external velocity limit selector & use commot params

* update smoother & use commot params

* update launch file

* Fix/smoother params (autowarefoundation#2239)

* Update velocity debug script (add vehicle engage check) (autowarefoundation#2267)

* add vehicle engage

Signed-off-by: Takamasa Horibe <[email protected]>

* fix format

Signed-off-by: Takamasa Horibe <[email protected]>

* [motion_velocity_smoother] fix trajectory size guard condition (autowarefoundation#2297)

* change condition for input trajectory validation chack

Signed-off-by: Takamasa Horibe <[email protected]>

* organize guard code into function

Signed-off-by: Takamasa Horibe <[email protected]>

* 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 <[email protected]>

* Remove ament_cmake_uncrustify and ament_clang_format

Signed-off-by: Kenji Miyake <[email protected]>

* Apply Black

Signed-off-by: Kenji Miyake <[email protected]>

* Apply clang-format

Signed-off-by: Kenji Miyake <[email protected]>

* Fix build errors

Signed-off-by: Kenji Miyake <[email protected]>

* Fix for cpplint

* Fix include double quotes to angle brackets

Signed-off-by: Kenji Miyake <[email protected]>

* Apply clang-format

Signed-off-by: Kenji Miyake <[email protected]>

* Fix build errors

Signed-off-by: Kenji Miyake <[email protected]>

* Add COLCON_IGNORE (autowarefoundation#500)

Signed-off-by: Kenji Miyake <[email protected]>

* port motion velocity smoother (autowarefoundation#495)

* Use autoware_auto_msgs

* Fix bugs and apply clang-format

* Remove COLCON_IGNORE

* Rename TrajectoryPointArray to TrajectoryPoints, use conversion functions in autoware_utils

* Apply clang-format

* Use odometry

* Fix document

* rename to README.md (autowarefoundation#550)

* rename to README.md

* dealt with new auto_msgs format

Co-authored-by: Takayuki Murooka <[email protected]>

* update iv_msgs -> auto_msgs in planning readme (autowarefoundation#576)

* update iv_msgs -> auto_msgs in planning readme

* minor change

* some fix

* some fix

Co-authored-by: Takayuki Murooka <[email protected]>

* Back port .auto control packages (autowarefoundation#571)

* Implement Lateral and Longitudinal Control Muxer

* [autowarefoundation#570] Porting wf_simulator

* [autowarefoundation#1189] Deactivate flaky test in 'trajectory_follower_nodes'

* [autowarefoundation#1189] Fix flacky test in 'trajectory_follower_nodes/latlon_muxer'

* [autowarefoundation#1057] Add osqp_interface package

* [autowarefoundation#1057] Add library code for MPC-based lateral control

* [autowarefoundation#1271] Use std::abs instead of abs

* [autowarefoundation#1057] Implement Lateral Controller for Cargo ODD

* [autowarefoundation#1246] Resolve "Test case names currently use snake_case but should be CamelCase"

* [autowarefoundation#1325] Deactivate flaky smoke test in 'trajectory_follower_nodes'

* [autowarefoundation#1058] Add library code of longitudinal controller

* Fix build error for trajectory follower

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

* Fix build error for trajectory follower nodes

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

* [autowarefoundation#1272] Add AckermannControlCommand support to simple_planning_simulator

* [autowarefoundation#1058] Add Longitudinal Controller node

* [autowarefoundation#1058] Rename velocity_controller -> longitudinal_controller

* [autowarefoundation#1058] Update CMakeLists.txt for the longitudinal_controller_node

* [autowarefoundation#1058] Add smoke test python launch file

* [autowarefoundation#1058] Use LowPassFilter1d from trajectory_follower

* [autowarefoundation#1058] Use autoware_auto_msgs

* [autowarefoundation#1058] Changes for .auto (debug msg tmp fix, common func, tf listener)

* [autowarefoundation#1058] Remove unused parameters

* [autowarefoundation#1058] Fix ros test

* [autowarefoundation#1058] Rm default params from declare_parameters + use autoware types

* [autowarefoundation#1058] Use default param file to setup NodeOptions in the ros test

* [autowarefoundation#1058] Fix docstring

* [autowarefoundation#1058] Replace receiving a Twist with a VehicleKinematicState

* [autowarefoundation#1058] Change class variables format to m_ prefix

* [autowarefoundation#1058] Fix plugin name of LongitudinalController in CMakeLists.txt

* [autowarefoundation#1058] Fix copyright dates

* [autowarefoundation#1058] Reorder includes

* [autowarefoundation#1058] Add some tests (~89% coverage without disabling flaky tests)

* [autowarefoundation#1058] Add more tests (90+% coverage without disabling flaky tests)

* [autowarefoundation#1058] Use Float32MultiArrayDiagnostic message for debug and slope

* [autowarefoundation#1058] Calculate wheel_base value from vehicle parameters

* [autowarefoundation#1058] Cleanup redundant logger setting in tests

* [autowarefoundation#1058] Set ROS_DOMAIN_ID when running tests to prevent CI failures

* [autowarefoundation#1058] Remove TF listener and use published vehicle state instead

* [autowarefoundation#1058] Change smoke tests to use autoware_testing

* [autowarefoundation#1058] Add plotjuggler cfg for both lateral and longitudinal control

* [autowarefoundation#1058] Improve design documents

* [autowarefoundation#1058] Disable flaky test

* [autowarefoundation#1058] Properly transform vehicle state in longitudinal node

* [autowarefoundation#1058] Fix TF buffer of lateral controller

* [autowarefoundation#1058] Tuning of lateral controller for LGSVL

* [autowarefoundation#1058] Fix formating

* [autowarefoundation#1058] Fix /tf_static sub to be transient_local

* [autowarefoundation#1058] Fix yaw recalculation of reverse trajs in the lateral controller

* modify trajectory_follower for galactic build

Signed-off-by: Takamasa Horibe <[email protected]>

* [autowarefoundation#1379] Update trajectory_follower

* [autowarefoundation#1379] Update simple_planning_simulator

* [autowarefoundation#1379] Update trajectory_follower_nodes

* apply trajectory msg modification in control

Signed-off-by: Takamasa Horibe <[email protected]>

* move directory

Signed-off-by: Takamasa Horibe <[email protected]>

* remote control/trajectory_follower level dorectpry

Signed-off-by: Takamasa Horibe <[email protected]>

* remove .iv trajectory follower

Signed-off-by: Takamasa Horibe <[email protected]>

* use .auto trajectory_follower

Signed-off-by: Takamasa Horibe <[email protected]>

* remove .iv simple_planning_simulator & osqp_interface

Signed-off-by: Takamasa Horibe <[email protected]>

* use .iv simple_planning_simulator & osqp_interface

Signed-off-by: Takamasa Horibe <[email protected]>

* add tmp_autoware_auto_dependencies

Signed-off-by: Takamasa Horibe <[email protected]>

* tmporally add autoware_auto_msgs

Signed-off-by: Takamasa Horibe <[email protected]>

* apply .auto message split

Signed-off-by: Takamasa Horibe <[email protected]>

* fix build depend

Signed-off-by: Takamasa Horibe <[email protected]>

* fix packages using osqp

* fix autoware_auto_geometry

* ignore lint of some packages

* ignore ament_lint of some packages

* ignore lint/pre-commit of trajectory_follower_nodes

* disable unit tests of some packages

Co-authored-by: Maxime CLEMENT <[email protected]>
Co-authored-by: Joshua Whitley <[email protected]>
Co-authored-by: Igor Bogoslavskyi <[email protected]>
Co-authored-by: MIURA Yasuyuki <[email protected]>
Co-authored-by: wep21 <[email protected]>
Co-authored-by: tomoya.kimura <[email protected]>

* [planning module]fix bug (autowarefoundation#643)

* fix topic name

* remove angular z from LinearInterpolation in motion_velocity_smoother

* FIx vehicle status topic name/type (autowarefoundation#658)

* shift -> gear_status

* twist -> velocity_status

* port closest velocity checker (autowarefoundation#672)

Signed-off-by: Takamasa Horibe <[email protected]>

* port trajectory visualizer (autowarefoundation#682)

Signed-off-by: Takamasa Horibe <[email protected]>

* add header for debug trajectories (autowarefoundation#681)

Signed-off-by: Takamasa Horibe <[email protected]>

* Sync .auto branch with the latest branch in internal repository (autowarefoundation#691)

* add trajectory point offset in rviz plugin (autowarefoundation#2270)

* sync rc rc/v0.23.0 (autowarefoundation#2258)

* fix interpolation for insert point (autowarefoundation#2228)

* fix interpolation for insert point

* to prev interpolation pkg

* Revert "to prev interpolation pkg"

This reverts commit 9eb145b5d36e297186015fb17c267ccd5b3c21ef.

Co-authored-by: taikitanaka3 <[email protected]>
Co-authored-by: taikitanaka <[email protected]>

* fix topic name (autowarefoundation#2266)

Signed-off-by: Takamasa Horibe <[email protected]>

* Add namespace to diag for dual_return_filter (autowarefoundation#2269)

* Add a function to make 'geometry_msgs::msg::TransformStamped' (autowarefoundation#2250)

* Add a function to make 'geometry_msgs::msg::TransformStamped'
* Add 'child_frame_id' as an argument of 'pose2transform'

* Simplify marker scale initialization (autowarefoundation#2286)

* Fix/crosswalk polygon (autowarefoundation#2279)

* extend crosswalk polygon

* improve readability

* fix polygon shape

* Add warning when decel distance calculation fails (autowarefoundation#2289)

Signed-off-by: Makoto Kurihara <[email protected]>

* [motion_velocity_smoother] ignore debug print (autowarefoundation#2292)

* cosmetic change

Signed-off-by: Takamasa Horibe <[email protected]>

* cahnge severity from WARN to DEBUG for debug info

Signed-off-by: Takamasa Horibe <[email protected]>

* use util for stop_watch

Signed-off-by: Takamasa Horibe <[email protected]>

* fix map based prediction (autowarefoundation#2200)

* fix map based prediction

* fix format

* change map based prediction

* fix spells

* fix spells in comments

* fix for cpplint

* fix some problems

* fix format and code for clang-tidy

* fix space for cpplint

* Update Readme.md

* Update perception/object_recognition/prediction/map_based_prediction/Readme.md

* Update perception/object_recognition/prediction/map_based_prediction/Readme.md

* Update perception/object_recognition/prediction/map_based_prediction/Readme.md

* Update perception/object_recognition/prediction/map_based_prediction/Readme.md

* Update perception/object_recognition/prediction/map_based_prediction/Readme.md

* Update perception/object_recognition/prediction/map_based_prediction/Readme.md

* fix vector access method

* fix readme format

* add parameter

* Update perception/object_recognition/prediction/map_based_prediction/Readme.md

Co-authored-by: Kazuki Miyahara <[email protected]>

* Update perception/object_recognition/prediction/map_based_prediction/Readme.md

Co-authored-by: Kazuki Miyahara <[email protected]>

* Update perception/object_recognition/prediction/map_based_prediction/Readme.md

Co-authored-by: Kazuki Miyahara <[email protected]>

* Update Readme.md

* Update perception/object_recognition/prediction/map_based_prediction/Readme.md

Co-authored-by: Kazuki Miyahara <[email protected]>

Co-authored-by: tkimura4 <[email protected]>
Co-authored-by: Kazuki Miyahara <[email protected]>

* remove failure condition for 0 velocity trajectory (autowarefoundation#2295)

Signed-off-by: Takamasa Horibe <[email protected]>

* [mpc_follower] remove stop distance condition from stopState decision (autowarefoundation#1916)

* [mpc_follower] remove stop distance condition from stopState decision

Signed-off-by: Takamasa Horibe <[email protected]>

* add invalid index handling

Signed-off-by: Takamasa Horibe <[email protected]>

* Move the debug marker initialization part to another file (autowarefoundation#2288)

* Move the debug marker initialization part to 'debug.cpp'

* Make 'isLocalOptimalSolutionOscillation' independent from 'NDTScanMatcher' (autowarefoundation#2300)

* Remove an unused function 'getTransform' (autowarefoundation#2301)

* Simplify iteration of initial poses (autowarefoundation#2310)

* Make a transform object const (autowarefoundation#2311)

* Represent poses in 'std::vector' instead of 'geometry_msgs::msg::PoseArray' (autowarefoundation#2312)

* Feature/no stopping area (autowarefoundation#2163)

* add no stopping area module to behavior velocity planner

* apply utils

* add polygon interpolation module order stopline around area is considered

* devide jpass udge with stop line polygon

* update docs

* rename file name

* update to latest

* minor change for marker

* update license

Co-authored-by: Yukihiro Saito <[email protected]>

* update license

Co-authored-by: Yukihiro Saito <[email protected]>

* update license

Co-authored-by: Yukihiro Saito <[email protected]>

* update license

Co-authored-by: Yukihiro Saito <[email protected]>

* minor fix

* add parameter tuning at experiment

* update readme

* format doc

* apply comments

* add exception gurd

* cosmetic change

* fix ament

* fix typo and remove for statement

* & to " "

* better ns

* return pass judge param

* add missing stoppable condition

* add clear pass judge and stoppable flag

* add comment

* precommit fix

* cpplint

Co-authored-by: Yukihiro Saito <[email protected]>

* sync rc rc/v0.23.0 (autowarefoundation#2281)

* Fix side shift planner (autowarefoundation#2171) (autowarefoundation#2172)

* add print debug

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

* remove forward shift points when adding new point

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

* remove debug print

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

* format

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

* Fix remove threshold

Co-authored-by: Fumiya Watanabe <[email protected]>

Co-authored-by: Takamasa Horibe <[email protected]>

* Fix/pull out and pull over (autowarefoundation#2175)

* delete unnecessary check

* fix condition of starting pull out

* Add emergency status API (autowarefoundation#2174) (autowarefoundation#2182)

* Fix/mpc reset prev result (autowarefoundation#2185) (autowarefoundation#2195)

* reset prev result

* clean code

* reset only raw_steer_cmd

* Update control/mpc_follower/src/mpc_follower_core.cpp

Co-authored-by: Takamasa Horibe <[email protected]>

Co-authored-by: Takamasa Horibe <[email protected]>

Co-authored-by: Takamasa Horibe <[email protected]>

* [hotfix] 1 path point exception after resampling (autowarefoundation#2204)

* fix 1 path point exception after resampling

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

* Apply suggestions from code review

* Apply suggestions from code review

Co-authored-by: Takamasa Horibe <[email protected]>

Co-authored-by: tkimura4 <[email protected]>

* [hotfix] Fix lane ids (autowarefoundation#2211)

* Fix lane ids

* Prevent acceleration on avoidance (autowarefoundation#2214)

* prevent acceleration on avoidance

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

* fix param name

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

* parametrize avoidance acc

Signed-off-by: Takamasa Horibe <[email protected]>

* change param name

Signed-off-by: Takamasa Horibe <[email protected]>

* fix typo

Signed-off-by: Takamasa Horibe <[email protected]>

* Fix qos in roi cluster fusion (autowarefoundation#2218)

* fix confidence (autowarefoundation#2220)

* too high confidence (autowarefoundation#2229)

* Fix/obstacle stop 0.23.0 (autowarefoundation#2232)

* fix unexpected slow down in sharp curves (autowarefoundation#2181)

* Fix/insert implementation (autowarefoundation#2186)

Co-authored-by: Satoshi OTA <[email protected]>

* [hotfix] Remove exception in avoidance module (autowarefoundation#2233)

* Remove exception

* Fix clock

* Remove blank line

* Update traffic light state if ref stop point is ahead of previous one (autowarefoundation#2197)

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

* fix interpolation for insert point (autowarefoundation#2228)

* fix interpolation for insert point

* to prev interpolation pkg

* fix index (autowarefoundation#2265)

* turn signal calculation (#2280)

* add turn signal funtion in path shifter

* add ros parameters

Co-authored-by: Fumiya Watanabe <[email protected]>
Co-authored-by: Takamasa Horibe <[email protected]>
Co-authored-by: tkimura4 <[email protected]>
Co-authored-by: Takagi, Isamu <[email protected]>
Co-authored-by: Daisuke Nishimatsu <[email protected]>
Co-authored-by: Yukihiro Saito <[email protected]>
Co-authored-by: Satoshi OTA <[email protected]>
Co-authored-by: taikitanaka3 <[email protected]>
Co-authored-by: Sugatyon <[email protected]>

* [behavior_path_planner] fix sudden path change around ego (autowarefoundation#2305) (autowarefoundation#2318)

* fix return-from-ego shift point generation logic

Signed-off-by: Takamasa Horibe <[email protected]>

* change param for trimSimilarGradShiftPoint

Signed-off-by: Takamasa Horibe <[email protected]>

* add comment for issue

Signed-off-by: Takamasa Horibe <[email protected]>

* update comment

Signed-off-by: Takamasa Horibe <[email protected]>

* replace code with function (logic has not changed)

Signed-off-by: Takamasa Horibe <[email protected]>

* move func to cpp

Signed-off-by: Takamasa Horibe <[email protected]>

* add comment for issue

Signed-off-by: Takamasa Horibe <[email protected]>

* fix typo

Signed-off-by: Takamasa Horibe <[email protected]>

* Update planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/src/scene_module/avoidance/avoidance_module.cpp

Co-authored-by: Kazuki Miyahara <[email protected]>

* Update planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/src/scene_module/avoidance/avoidance_module.cpp

Co-authored-by: Kazuki Miyahara <[email protected]>

Co-authored-by: Kazuki Miyahara <[email protected]>

Co-authored-by: Takamasa Horibe <[email protected]>
Co-authored-by: Kazuki Miyahara <[email protected]>

* Add functions to make stamped scalar messages (autowarefoundation#2317)

* Fix/object yaw in intersection module (autowarefoundation#2294)

* fix object orientation

* fix function name

* add guard (autowarefoundation#2321)

* reduce cost (double to float) (autowarefoundation#2298)

* Add detail collision check (autowarefoundation#2274)

* Add detail collision check

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

* Remove unused function

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

* Fix arc length

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

* Seperate time margin

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

* Fix parameter name

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

* Update Readme

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

* Address review: Add comment for TimeDistanceArray

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

* Run pre-commit

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

* Fix cpplint

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

* Add return for empty polygon

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

* update CenterPoint  (autowarefoundation#2222)

* update to model trained by mmdet3d

* add vizualizer (debug)

* for multi-frame inputs

* chagne config

* use autoware_utils::pi

* project specific model and param

* rename vfe -> encoder

* rename general to common

* update download link

* update

* fix

* rename model_name

* change training toolbox link

* chage lint package

* fix test error

* commit suggestion

* Feature/lane change detection (autowarefoundation#2331)

* add old information deleter

* fix access bug

* change to deque

* update obstacle buffer

* fix some bugs

* add lane change detector

* make a update lanelet function

* fix code style

* parameterize essential values

* Update perception/object_recognition/prediction/map_based_prediction/src/map_based_prediction_ros.cpp

Co-authored-by: Kazuki Miyahara <[email protected]>

* fix slash position

* remove unnecessary lines

* fix format

* fix format

* change to new enum

* fix format

* fix typo and add guard

* change funciton name

* add lane change description

Co-authored-by: Kazuki Miyahara <[email protected]>

* Add Planning Evaluator  (autowarefoundation#2293)

* Add prototype planning evaluator

Produced data for dist between points, curvature, and relative angle

* Cleanup the code to make adding metrics easier

* Add remaining basic metrics (length, duration, vel, accel, jerk)

* Add motion_evaluator to evaluate the actual ego motion + code cleanup

* Add deviation metrics

* Add naive stability metric

* Handle invalid stat (TODO: fix the output file formatting)

* Add parameter file and cleanup

* Add basic obstacle metric (TTC not yet implemented) and fix output file format

* Add basic time to collision

* Add lateral-distance based stability metric

* Add check (at init time) that metrics' maps are complete

* Publish metrics as ParamaterDeclaration msg (for openscenario)

* Use lookahead and start from ego_pose when calculating stability metrics

* Code cleanup

* Fix lint

* Add tests

* Fix bug with Frechet dist and the last traj point

* Finish implementing tests

* Fix lint

* Code cleanup

* Update README.md

* Remove unused metric

* Change msg type of published metrics to DiagnosticArray

* fix format to fix pre-commit check

Signed-off-by: Takamasa Horibe <[email protected]>

* fix yaml format to fix pre-commit check

Signed-off-by: Takamasa Horibe <[email protected]>

* fix yaml format

Signed-off-by: Takamasa Horibe <[email protected]>

* apply clang-format

Signed-off-by: Takamasa Horibe <[email protected]>

* apply clang-format

Signed-off-by: Takamasa Horibe <[email protected]>

* Update planning/planning_diagnostics/planning_evaluator/include/planning_evaluator/planning_evaluator_node.hpp

* Update planning/planning_diagnostics/planning_evaluator/test/test_planning_evaluator_node.cpp

* Update planning/planning_diagnostics/planning_evaluator/test/test_planning_evaluator_node.cpp

* change lint format to autoware_lint_common

Signed-off-by: Takamasa Horibe <[email protected]>

Co-authored-by: Takamasa Horibe <[email protected]>

* Add keep braking function at driving state (autowarefoundation#2346)

* Add keep braking function at driving state

Signed-off-by: Makoto Kurihara <[email protected]>

* Remove debug messages

Signed-off-by: Makoto Kurihara <[email protected]>

* Fix format

Signed-off-by: Makoto Kurihara <[email protected]>

* Change diag_updater's pediod from default to 0.1sec (autowarefoundation#2348)

* add cross judgement and common signal function (autowarefoundation#2319)

* merge branch turn_signal_common

* add turn signal function in signal decider

* add cross judge in path_utilities and delete from turn_signal_decider

* remove original signal calculation in lane change

* omit substitution

* replace turn signal decider in pull over function

* modify cross judge logic

* replace turn signal decider in avoidance

* add readme of turn signal

* update

* delete print debug

* update

* delete lane change decider in path shifter

* delete blank line

* fix indent

* fix typo

* fix typo

* decrease nest

* run pre commit

* Add 0 limit at forward jerk velocity filter (autowarefoundation#2340)

Signed-off-by: Makoto Kurihara <[email protected]>

* add time offset param to point cloud concatenation (autowarefoundation#2303)

* add offset param

* clang-format

Co-authored-by: Akihito OHSATO <[email protected]>

* Feature/add doc for keep braking function at driving state (autowarefoundation#2366)

* Add the description of brake keeping

Signed-off-by: Makoto Kurihara <[email protected]>

* Add the english document

Signed-off-by: Makoto Kurihara <[email protected]>

* Improve description

Signed-off-by: Makoto Kurihara <[email protected]>

* Add english description

Signed-off-by: Makoto Kurihara <[email protected]>

* Fix include files (autowarefoundation#2339)

Signed-off-by: Kenji Miyake <[email protected]>

* fix behavior intersection module

* fix behavior no stopping area module

* fix planning_evaluator

* fix motion_velocity_smoother

* rename variable

* Revert "[mpc_follower] remove stop distance condition from stopState decision (autowarefoundation#1916)"

This reverts commit ff4f0b5a844d1f835f1b93bd3b36a76747b0cd02.

* Revert "Add keep braking function at driving state (autowarefoundation#2346)"

This reverts commit f0478187db4c28bf6092c198723dcc5ec11a9c70.

* Revert "Feature/add doc for keep braking function at driving state (autowarefoundation#2366)"

This reverts commit 66de2f3924a479049fce2d5c5c6b579cacbd3e49.

* Fix orientation availability in centerpoint

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

* fix test_trajectory.cpp

* add target link libraries

* Use .auto msg in test code for planniing evaluator

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

* fix include

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

Co-authored-by: Takayuki Murooka <[email protected]>
Co-authored-by: autoware-iv-sync-ci[bot] <87871706+autoware-iv-sync-ci[bot]@users.noreply.github.com>
Co-authored-by: taikitanaka3 <[email protected]>
Co-authored-by: taikitanaka <[email protected]>
Co-authored-by: Takamasa Horibe <[email protected]>
Co-authored-by: Takeshi Miura <[email protected]>
Co-authored-by: Takeshi Ishita <[email protected]>
Co-authored-by: Satoshi OTA <[email protected]>
Co-authored-by: Makoto Kurihara <[email protected]>
Co-authored-by: purewater0901 <[email protected]>
Co-authored-by: tkimura4 <[email protected]>
Co-authored-by: Kazuki Miyahara <[email protected]>
Co-authored-by: Yukihiro Saito <[email protected]>
Co-authored-by: Fumiya Watanabe <[email protected]>
Co-authored-by: Takagi, Isamu <[email protected]>
Co-authored-by: Sugatyon <[email protected]>
Co-authored-by: s-murakami-esol <[email protected]>
Co-authored-by: Yusuke Muramatsu <[email protected]>
Co-authored-by: Maxime CLEMENT <[email protected]>
Co-authored-by: Shunsuke Miura <[email protected]>
Co-authored-by: Shinnosuke Hirakawa <[email protected]>
Co-authored-by: Akihito OHSATO <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>

* fix osqp link (autowarefoundation#700)

* Update twist topic name (autowarefoundation#736)

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

* rename readme.ja

* add default parameter file

Co-authored-by: Daisuke Nishimatsu <[email protected]>
Co-authored-by: Fumiya Watanabe <[email protected]>
Co-authored-by: yutaka <[email protected]>
Co-authored-by: purewater0901 <[email protected]>
Co-authored-by: Takamasa Horibe <[email protected]>
Co-authored-by: pre-commit <[email protected]>
Co-authored-by: td12321 <[email protected]>
Co-authored-by: Makoto Kurihara <[email protected]>
Co-authored-by: Takayuki Murooka <[email protected]>
Co-authored-by: Satoshi OTA <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Takayuki Murooka <[email protected]>
Co-authored-by: Maxime CLEMENT <[email protected]>
Co-authored-by: Joshua Whitley <[email protected]>
Co-authored-by: Igor Bogoslavskyi <[email protected]>
Co-authored-by: MIURA Yasuyuki <[email protected]>
Co-authored-by: wep21 <[email protected]>
Co-authored-by: autoware-iv-sync-ci[bot] <87871706+autoware-iv-sync-ci[bot]@users.noreply.github.com>
Co-authored-by: taikitanaka3 <[email protected]>
Co-authored-by: taikitanaka <[email protected]>
Co-authored-by: Takeshi Miura <[email protected]>
Co-authored-by: Takeshi Ishita <[email protected]>
Co-authored-by: Kazuki Miyahara <[email protected]>
Co-authored-by: Yukihiro Saito <[email protected]>
Co-authored-by: Takagi, Isamu <[email protected]>
Co-authored-by: Sugatyon <[email protected]>
Co-authored-by: s-murakami-esol <[email protected]>
Co-authored-by: Yusuke Muramatsu <[email protected]>
Co-authored-by: Maxime CLEMENT <[email protected]>
Co-authored-by: Shunsuke Miura <[email protected]>
Co-authored-by: Shinnosuke Hirakawa <[email protected]>
Co-authored-by: Akihito OHSATO <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Kosuke Murakami <[email protected]>
TakumiKozaka-T4 pushed a commit to TakumiKozaka-T4/autoware.universe that referenced this pull request Mar 23, 2022
* release v0.4.0

* remove ROS1 packages temporarily

Signed-off-by: mitsudome-r <[email protected]>

* add sample ros2 packages

Signed-off-by: mitsudome-r <[email protected]>

* add COLCON_IGNORE to ros1 packages

Signed-off-by: mitsudome-r <[email protected]>

* Fix simple planning simulator (autowarefoundation#26)

* simple planning simulator: fix params & launch file

Signed-off-by: Takamasa Horibe <[email protected]>

* remove unused file

Signed-off-by: Takamasa Horibe <[email protected]>

* fix timercallback

Signed-off-by: Takamasa Horibe <[email protected]>

* [simple_planning_simulator] add rostopic relay in launch file (autowarefoundation#117)

* [simple_planning_simulator] add rostopic relay in launch file

Signed-off-by: mitsudome-r <[email protected]>

* add topic_tools as exec_depend

Signed-off-by: mitsudome-r <[email protected]>

* Adjust copyright notice on 532 out of 699 source files (autowarefoundation#143)

* Use quotes for includes where appropriate (autowarefoundation#144)

* Use quotes for includes where appropriate

* Fix lint tests

* Make tests pass hopefully

* Run uncrustify on the entire Pilot.Auto codebase (autowarefoundation#151)

* Run uncrustify on the entire Pilot.Auto codebase

* Exclude open PRs

* reduce terminal ouput for better error message visibility (autowarefoundation#200)

* reduce terminal ouput for better error message visibility

Signed-off-by: mitsudome-r <[email protected]>

* [costmap_generator] fix waiting for first transform

Signed-off-by: mitsudome-r <[email protected]>

* fix tests

Signed-off-by: mitsudome-r <[email protected]>

* fix test

Signed-off-by: mitsudome-r <[email protected]>

* Use trajectory for z position source (autowarefoundation#243)

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

* Ros2 v0.8.0 engage (autowarefoundation#342)

* [autoware_vehicle_msgs]: Add engage message

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

* [as]: Update message

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

* [awapi_awiv_adapter]: Update message

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

* [web_controller]: Update message

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

* [vehicle_cmd_gate]: Update message

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

* [autoware_state_monitor]: Update message

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

* [autoware_control_msgs]: Remove EngageMode message

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

* [simple_planning_simulator]: Update message

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

* Ros2 v0.8.0 fix packages (autowarefoundation#351)

* add subscription to QoS

* add vihicle_param _file to simple_planning_sim

* update cmake/packages.xml

* comment out unused parameter

* apply lint

* add vehicle_info_util to lane_change_planner

* add vehicle_info_util to vehicle_cmd_gate

* fix cmake of simple planning simulator

* update cmake/packages.xml of vehicle cmd gate

* apply lint

* apply lint

* add latch option to autoware_state_monitor

* delete unused comment

* Rename ROS-related .yaml to .param.yaml (autowarefoundation#352)

* Rename ROS-related .yaml to .param.yaml

Signed-off-by: Kenji Miyake <[email protected]>

* Remove prefix 'default_' of yaml files

Signed-off-by: Kenji Miyake <[email protected]>

* Rename vehicle_info.yaml to vehicle_info.param.yaml

Signed-off-by: Kenji Miyake <[email protected]>

* Rename diagnostic_aggregator's param files

Signed-off-by: Kenji Miyake <[email protected]>

* Fix overlooked parameters

Signed-off-by: Kenji Miyake <[email protected]>

* Fix typo in simulator module (autowarefoundation#439)

* add use_sim-time option (autowarefoundation#454)

* Format launch files (autowarefoundation#1219)

Signed-off-by: Kenji Miyake <[email protected]>

* Fix rolling build errors (autowarefoundation#1225)

* Add missing include files

Signed-off-by: Kenji Miyake <[email protected]>

* Replace rclcpp::Duration

Signed-off-by: Kenji Miyake <[email protected]>

* Use reference for exceptions

Signed-off-by: Kenji Miyake <[email protected]>

* Use from_seconds

Signed-off-by: Kenji Miyake <[email protected]>

* Sync public repo (autowarefoundation#1228)

* [simple_planning_simulator] add readme (autowarefoundation#424)

* add readme of simple_planning_simulator

Signed-off-by: Takamasa Horibe <[email protected]>

* Update simulator/simple_planning_simulator/README.md

* set transit_margin_time to intersect. planner (autowarefoundation#460)

* Fix pose2twist (autowarefoundation#462)

Signed-off-by: Takagi, Isamu <[email protected]>

* Ros2 vehicle info param server (autowarefoundation#447)

* add vehicle_info_param_server

* update vehicle info

* apply format

* fix bug

* skip unnecessary search

* delete vehicle param file

* fix bug

* Ros2 fix topic name part2 (autowarefoundation#425)

* Fix topic name of traffic_light_classifier

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of traffic_light_visualization

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of traffic_light_ssd_fine_detector

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name of traffic_light_map_based_detector

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix lint traffic_light_recognition

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix lint traffic_light_ssd_fine_detector

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix lint traffic_light_classifier

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix lint traffic_light_classifier

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix lint traffic_light_ssd_fine_detector

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix issues in hdd_reader (autowarefoundation#466)

* Fix some issues detected by Coverity Scan and Clang-Tidy

* Update launch command

* Add more `close(new_sock)`

* Simplify the definitions of struct

* fix: re-construct laneletMapLayer for reindex RTree (autowarefoundation#463)

* Rviz overlay render fix (autowarefoundation#461)

* Moved painiting in SteeringAngle plugin to update()

Signed-off-by: Adam Dabrowski <[email protected]>

* super class now back to MFD

Signed-off-by: Adam Dabrowski <[email protected]>

* uncrustified

Signed-off-by: Adam Dabrowski <[email protected]>

* acquire data in mutex

Signed-off-by: Adam Dabrowski <[email protected]>

* back to RTD as superclass

Signed-off-by: Adam Dabrowski <[email protected]>

* Rviz overlay render in update (autowarefoundation#465)

* Moved painiting in SteeringAngle plugin to update()

Signed-off-by: Adam Dabrowski <[email protected]>

* super class now back to MFD

Signed-off-by: Adam Dabrowski <[email protected]>

* uncrustified

Signed-off-by: Adam Dabrowski <[email protected]>

* acquire data in mutex

Signed-off-by: Adam Dabrowski <[email protected]>

* removed unnecessary includes and some dead code

Signed-off-by: Adam Dabrowski <[email protected]>

* Adepted remaining vehicle plugin classes to render-in-update concept. Returned to MFD superclass

Signed-off-by: Adam Dabrowski <[email protected]>

* restored RTD superclass

Signed-off-by: Adam Dabrowski <[email protected]>

Co-authored-by: Takamasa Horibe <[email protected]>
Co-authored-by: tkimura4 <[email protected]>
Co-authored-by: Takagi, Isamu <[email protected]>
Co-authored-by: Kazuki Miyahara <[email protected]>
Co-authored-by: Makoto Tokunaga <[email protected]>
Co-authored-by: Adam Dąbrowski <[email protected]>

* Remove use_sim_time for set_parameter (autowarefoundation#1260)

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

* Refactor vehicle info util (autowarefoundation#1305)

* Update license

Signed-off-by: Kenji Miyake <[email protected]>

* Refactor vehicle_info_util

Signed-off-by: Kenji Miyake <[email protected]>

* Rename and split files

Signed-off-by: Kenji Miyake <[email protected]>

* Fix interfaces

Signed-off-by: Kenji Miyake <[email protected]>

* Fix bug and add error handling

Signed-off-by: Kenji Miyake <[email protected]>

* Add "// namespace"

Signed-off-by: Kenji Miyake <[email protected]>

* Add missing include

Signed-off-by: Kenji Miyake <[email protected]>

* Fix lint errors (autowarefoundation#1378)

* Fix lint errors

Signed-off-by: Kenji Miyake <[email protected]>

* Fix variable names

Signed-off-by: Kenji Miyake <[email protected]>

* Add pre-commit (autowarefoundation#1560)

* add pre-commit

* add pre-commit-config

* add additional settings for private repository

* use default pre-commit-config

* update pre-commit setting

* Ignore whitespace for line breaks in markdown

* Update .github/workflows/pre-commit.yml

Co-authored-by: Kazuki Miyahara <[email protected]>

* exclude svg

* remove pretty-format-json

* add double-quote-string-fixer

* consider COLCON_IGNORE file when seaching modified package

* format file

* pre-commit fixes

* Update pre-commit.yml

* Update .pre-commit-config.yaml

Co-authored-by: Kazuki Miyahara <[email protected]>
Co-authored-by: pre-commit <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>

* Add markdownlint and prettier (autowarefoundation#1661)

* Add markdownlint and prettier

Signed-off-by: Kenji Miyake <[email protected]>

* Ignore .param.yaml

Signed-off-by: Kenji Miyake <[email protected]>

* Apply format

Signed-off-by: Kenji Miyake <[email protected]>

* add cov pub in psim (autowarefoundation#1732)

* Fix -Wunused-parameter (autowarefoundation#1836)

* Fix -Wunused-parameter

Signed-off-by: Kenji Miyake <[email protected]>

* Fix mistake

Signed-off-by: Kenji Miyake <[email protected]>

* fix spell

* Fix lint issues

Signed-off-by: Kenji Miyake <[email protected]>

* Ignore flake8 warnings

Signed-off-by: Kenji Miyake <[email protected]>

Co-authored-by: Hiroki OTA <[email protected]>

* fix some typos (autowarefoundation#1941)

* fix some typos

* fix typo

* Fix typo

Signed-off-by: Kenji Miyake <[email protected]>

Co-authored-by: Kenji Miyake <[email protected]>

* Add autoware api (autowarefoundation#1979)

* 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

* Feature/add ideal accel model interface (autowarefoundation#1894)

* Add IDEAL_ACCEL model interface for simple planning simulator

Signed-off-by: Makoto Kurihara <[email protected]>

* Add IDEAL_ACCEL model descriptions

Signed-off-by: Makoto Kurihara <[email protected]>

* Fix format

Signed-off-by: Makoto Kurihara <[email protected]>

* Change vehicle model type description at config file

Signed-off-by: Makoto Kurihara <[email protected]>

* 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 <[email protected]>

* Remove ament_cmake_uncrustify and ament_clang_format

Signed-off-by: Kenji Miyake <[email protected]>

* Apply Black

Signed-off-by: Kenji Miyake <[email protected]>

* Apply clang-format

Signed-off-by: Kenji Miyake <[email protected]>

* Fix build errors

Signed-off-by: Kenji Miyake <[email protected]>

* Fix for cpplint

* Fix include double quotes to angle brackets

Signed-off-by: Kenji Miyake <[email protected]>

* Apply clang-format

Signed-off-by: Kenji Miyake <[email protected]>

* Fix build errors

Signed-off-by: Kenji Miyake <[email protected]>

* Add COLCON_IGNORE (autowarefoundation#500)

Signed-off-by: Kenji Miyake <[email protected]>

* Back port .auto control packages (autowarefoundation#571)

* Implement Lateral and Longitudinal Control Muxer

* [autowarefoundation#570] Porting wf_simulator

* [autowarefoundation#1189] Deactivate flaky test in 'trajectory_follower_nodes'

* [autowarefoundation#1189] Fix flacky test in 'trajectory_follower_nodes/latlon_muxer'

* [autowarefoundation#1057] Add osqp_interface package

* [autowarefoundation#1057] Add library code for MPC-based lateral control

* [autowarefoundation#1271] Use std::abs instead of abs

* [autowarefoundation#1057] Implement Lateral Controller for Cargo ODD

* [autowarefoundation#1246] Resolve "Test case names currently use snake_case but should be CamelCase"

* [autowarefoundation#1325] Deactivate flaky smoke test in 'trajectory_follower_nodes'

* [autowarefoundation#1058] Add library code of longitudinal controller

* Fix build error for trajectory follower

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

* Fix build error for trajectory follower nodes

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

* [autowarefoundation#1272] Add AckermannControlCommand support to simple_planning_simulator

* [autowarefoundation#1058] Add Longitudinal Controller node

* [autowarefoundation#1058] Rename velocity_controller -> longitudinal_controller

* [autowarefoundation#1058] Update CMakeLists.txt for the longitudinal_controller_node

* [autowarefoundation#1058] Add smoke test python launch file

* [autowarefoundation#1058] Use LowPassFilter1d from trajectory_follower

* [autowarefoundation#1058] Use autoware_auto_msgs

* [autowarefoundation#1058] Changes for .auto (debug msg tmp fix, common func, tf listener)

* [autowarefoundation#1058] Remove unused parameters

* [autowarefoundation#1058] Fix ros test

* [autowarefoundation#1058] Rm default params from declare_parameters + use autoware types

* [autowarefoundation#1058] Use default param file to setup NodeOptions in the ros test

* [autowarefoundation#1058] Fix docstring

* [autowarefoundation#1058] Replace receiving a Twist with a VehicleKinematicState

* [autowarefoundation#1058] Change class variables format to m_ prefix

* [autowarefoundation#1058] Fix plugin name of LongitudinalController in CMakeLists.txt

* [autowarefoundation#1058] Fix copyright dates

* [autowarefoundation#1058] Reorder includes

* [autowarefoundation#1058] Add some tests (~89% coverage without disabling flaky tests)

* [autowarefoundation#1058] Add more tests (90+% coverage without disabling flaky tests)

* [autowarefoundation#1058] Use Float32MultiArrayDiagnostic message for debug and slope

* [autowarefoundation#1058] Calculate wheel_base value from vehicle parameters

* [autowarefoundation#1058] Cleanup redundant logger setting in tests

* [autowarefoundation#1058] Set ROS_DOMAIN_ID when running tests to prevent CI failures

* [autowarefoundation#1058] Remove TF listener and use published vehicle state instead

* [autowarefoundation#1058] Change smoke tests to use autoware_testing

* [autowarefoundation#1058] Add plotjuggler cfg for both lateral and longitudinal control

* [autowarefoundation#1058] Improve design documents

* [autowarefoundation#1058] Disable flaky test

* [autowarefoundation#1058] Properly transform vehicle state in longitudinal node

* [autowarefoundation#1058] Fix TF buffer of lateral controller

* [autowarefoundation#1058] Tuning of lateral controller for LGSVL

* [autowarefoundation#1058] Fix formating

* [autowarefoundation#1058] Fix /tf_static sub to be transient_local

* [autowarefoundation#1058] Fix yaw recalculation of reverse trajs in the lateral controller

* modify trajectory_follower for galactic build

Signed-off-by: Takamasa Horibe <[email protected]>

* [autowarefoundation#1379] Update trajectory_follower

* [autowarefoundation#1379] Update simple_planning_simulator

* [autowarefoundation#1379] Update trajectory_follower_nodes

* apply trajectory msg modification in control

Signed-off-by: Takamasa Horibe <[email protected]>

* move directory

Signed-off-by: Takamasa Horibe <[email protected]>

* remote control/trajectory_follower level dorectpry

Signed-off-by: Takamasa Horibe <[email protected]>

* remove .iv trajectory follower

Signed-off-by: Takamasa Horibe <[email protected]>

* use .auto trajectory_follower

Signed-off-by: Takamasa Horibe <[email protected]>

* remove .iv simple_planning_simulator & osqp_interface

Signed-off-by: Takamasa Horibe <[email protected]>

* use .iv simple_planning_simulator & osqp_interface

Signed-off-by: Takamasa Horibe <[email protected]>

* add tmp_autoware_auto_dependencies

Signed-off-by: Takamasa Horibe <[email protected]>

* tmporally add autoware_auto_msgs

Signed-off-by: Takamasa Horibe <[email protected]>

* apply .auto message split

Signed-off-by: Takamasa Horibe <[email protected]>

* fix build depend

Signed-off-by: Takamasa Horibe <[email protected]>

* fix packages using osqp

* fix autoware_auto_geometry

* ignore lint of some packages

* ignore ament_lint of some packages

* ignore lint/pre-commit of trajectory_follower_nodes

* disable unit tests of some packages

Co-authored-by: Maxime CLEMENT <[email protected]>
Co-authored-by: Joshua Whitley <[email protected]>
Co-authored-by: Igor Bogoslavskyi <[email protected]>
Co-authored-by: MIURA Yasuyuki <[email protected]>
Co-authored-by: wep21 <[email protected]>
Co-authored-by: tomoya.kimura <[email protected]>

* [simple planning simulator]change type of msg (autowarefoundation#590)

* remove kinematic_state

* remove vehicle_state_command/report

* get z-position from trajectory

* set topic name of trajectory

* twist -> velocity report

* change default param

* Update simulator/simple_planning_simulator/test/test_simple_planning_simulator.cpp

Co-authored-by: taikitanaka3 <[email protected]>

* Update simulator/simple_planning_simulator/include/simple_planning_simulator/simple_planning_simulator_core.hpp

Co-authored-by: taikitanaka3 <[email protected]>

* fix typo

Co-authored-by: taikitanaka3 <[email protected]>

* [autoware_vehicle_rviz_plugin/route_handler/simple_planning_simulator]fix some packages (autowarefoundation#606)

* fix console meter

* fix velocity_history

* fix route handler

* change topic name

* update to support velocity report header (autowarefoundation#655)

* update to support velocity report header

Signed-off-by: Takamasa Horibe <[email protected]>

* Update simulator/simple_planning_simulator/src/simple_planning_simulator/simple_planning_simulator_core.cpp

Co-authored-by: tkimura4 <[email protected]>

* use maybe_unused

Signed-off-by: Takamasa Horibe <[email protected]>

* fix precommit

Signed-off-by: Takamasa Horibe <[email protected]>

Co-authored-by: tkimura4 <[email protected]>

* adapt to actuation cmd/status as control msg (autowarefoundation#646)

* adapt to actuation cmd/status as control msg

* fix readme

* fix topics

* fix remaing topics

* as to pacmod interface

* fix vehicle status

* add header to twist

* revert gyro_odometer_change

* revert twist topic change

* revert unchanged package

* FIx vehicle status topic name/type (autowarefoundation#658)

* shift -> gear_status

* twist -> velocity_status

* fix topic name (autowarefoundation#674)

* fix topic name

Signed-off-by: Takamasa Horibe <[email protected]>

* fix gear message name

Signed-off-by: Takamasa Horibe <[email protected]>

* Fix psim param path (autowarefoundation#696)

* Fix/psim topics emergency handler awapi (autowarefoundation#702)

* fix emergency handler

* fix awapi

* remove unused topic

* remove duplecated vehicle cmd

* Auto/add turn indicators and hazards (autowarefoundation#717)

* add turn indicators

* add hazard light

* omit name space

* remap topic name

* delete unnecessary blank line

* [simple_planning_simulator]fix bug (autowarefoundation#727)

* input z-axis of trajectory to pose(tf/odometry)

* output 0 velocity when invalid gear is input

* fix gear process in sim (autowarefoundation#728)

* Fix for integration test (autowarefoundation#732)

* Add backward compatibility of autoware state

* Add simulator initial pose service

* Fix pre-commit

* Fix pre-commit

* Simple planning simulator update for latest develop (autowarefoundation#735)

* Refactor vehicle info util (autowarefoundation#1305)

Signed-off-by: Takamasa Horibe <[email protected]>

* add cov pub in psim (autowarefoundation#1732)

Signed-off-by: Takamasa Horibe <[email protected]>

* remove pose_with_covariance publisher and add covariance information in Odometry

Signed-off-by: Takamasa Horibe <[email protected]>

* Fix acceleration for reverse (autowarefoundation#737)

* Fix acceleration for reverse

* Fix acceleration in set_input

* remove unused using

* Fix code

* ci(pre-commit): autofix

* remove tests

Co-authored-by: mitsudome-r <[email protected]>
Co-authored-by: Takamasa Horibe <[email protected]>
Co-authored-by: Ryohsuke Mitsudome <[email protected]>
Co-authored-by: Nikolai Morin <[email protected]>
Co-authored-by: Daisuke Nishimatsu <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Kazuki Miyahara <[email protected]>
Co-authored-by: Takagi, Isamu <[email protected]>
Co-authored-by: Makoto Tokunaga <[email protected]>
Co-authored-by: Adam Dąbrowski <[email protected]>
Co-authored-by: Keisuke Shima <[email protected]>
Co-authored-by: pre-commit <[email protected]>
Co-authored-by: Kosuke Murakami <[email protected]>
Co-authored-by: Hiroki OTA <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Makoto Kurihara <[email protected]>
Co-authored-by: Maxime CLEMENT <[email protected]>
Co-authored-by: Joshua Whitley <[email protected]>
Co-authored-by: Igor Bogoslavskyi <[email protected]>
Co-authored-by: MIURA Yasuyuki <[email protected]>
Co-authored-by: wep21 <[email protected]>
Co-authored-by: taikitanaka3 <[email protected]>
Co-authored-by: Sugatyon <[email protected]>
Co-authored-by: Fumiya Watanabe <[email protected]>
Co-authored-by: Takeshi Miura <[email protected]>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>
TakumiKozaka-T4 pushed a commit to TakumiKozaka-T4/autoware.universe that referenced this pull request Mar 23, 2022
* Back port .auto control packages (autowarefoundation#571)

* Implement Lateral and Longitudinal Control Muxer

* [autowarefoundation#570] Porting wf_simulator

* [autowarefoundation#1189] Deactivate flaky test in 'trajectory_follower_nodes'

* [autowarefoundation#1189] Fix flacky test in 'trajectory_follower_nodes/latlon_muxer'

* [autowarefoundation#1057] Add osqp_interface package

* [autowarefoundation#1057] Add library code for MPC-based lateral control

* [autowarefoundation#1271] Use std::abs instead of abs

* [autowarefoundation#1057] Implement Lateral Controller for Cargo ODD

* [autowarefoundation#1246] Resolve "Test case names currently use snake_case but should be CamelCase"

* [autowarefoundation#1325] Deactivate flaky smoke test in 'trajectory_follower_nodes'

* [autowarefoundation#1058] Add library code of longitudinal controller

* Fix build error for trajectory follower

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

* Fix build error for trajectory follower nodes

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

* [autowarefoundation#1272] Add AckermannControlCommand support to simple_planning_simulator

* [autowarefoundation#1058] Add Longitudinal Controller node

* [autowarefoundation#1058] Rename velocity_controller -> longitudinal_controller

* [autowarefoundation#1058] Update CMakeLists.txt for the longitudinal_controller_node

* [autowarefoundation#1058] Add smoke test python launch file

* [autowarefoundation#1058] Use LowPassFilter1d from trajectory_follower

* [autowarefoundation#1058] Use autoware_auto_msgs

* [autowarefoundation#1058] Changes for .auto (debug msg tmp fix, common func, tf listener)

* [autowarefoundation#1058] Remove unused parameters

* [autowarefoundation#1058] Fix ros test

* [autowarefoundation#1058] Rm default params from declare_parameters + use autoware types

* [autowarefoundation#1058] Use default param file to setup NodeOptions in the ros test

* [autowarefoundation#1058] Fix docstring

* [autowarefoundation#1058] Replace receiving a Twist with a VehicleKinematicState

* [autowarefoundation#1058] Change class variables format to m_ prefix

* [autowarefoundation#1058] Fix plugin name of LongitudinalController in CMakeLists.txt

* [autowarefoundation#1058] Fix copyright dates

* [autowarefoundation#1058] Reorder includes

* [autowarefoundation#1058] Add some tests (~89% coverage without disabling flaky tests)

* [autowarefoundation#1058] Add more tests (90+% coverage without disabling flaky tests)

* [autowarefoundation#1058] Use Float32MultiArrayDiagnostic message for debug and slope

* [autowarefoundation#1058] Calculate wheel_base value from vehicle parameters

* [autowarefoundation#1058] Cleanup redundant logger setting in tests

* [autowarefoundation#1058] Set ROS_DOMAIN_ID when running tests to prevent CI failures

* [autowarefoundation#1058] Remove TF listener and use published vehicle state instead

* [autowarefoundation#1058] Change smoke tests to use autoware_testing

* [autowarefoundation#1058] Add plotjuggler cfg for both lateral and longitudinal control

* [autowarefoundation#1058] Improve design documents

* [autowarefoundation#1058] Disable flaky test

* [autowarefoundation#1058] Properly transform vehicle state in longitudinal node

* [autowarefoundation#1058] Fix TF buffer of lateral controller

* [autowarefoundation#1058] Tuning of lateral controller for LGSVL

* [autowarefoundation#1058] Fix formating

* [autowarefoundation#1058] Fix /tf_static sub to be transient_local

* [autowarefoundation#1058] Fix yaw recalculation of reverse trajs in the lateral controller

* modify trajectory_follower for galactic build

Signed-off-by: Takamasa Horibe <[email protected]>

* [autowarefoundation#1379] Update trajectory_follower

* [autowarefoundation#1379] Update simple_planning_simulator

* [autowarefoundation#1379] Update trajectory_follower_nodes

* apply trajectory msg modification in control

Signed-off-by: Takamasa Horibe <[email protected]>

* move directory

Signed-off-by: Takamasa Horibe <[email protected]>

* remote control/trajectory_follower level dorectpry

Signed-off-by: Takamasa Horibe <[email protected]>

* remove .iv trajectory follower

Signed-off-by: Takamasa Horibe <[email protected]>

* use .auto trajectory_follower

Signed-off-by: Takamasa Horibe <[email protected]>

* remove .iv simple_planning_simulator & osqp_interface

Signed-off-by: Takamasa Horibe <[email protected]>

* use .iv simple_planning_simulator & osqp_interface

Signed-off-by: Takamasa Horibe <[email protected]>

* add tmp_autoware_auto_dependencies

Signed-off-by: Takamasa Horibe <[email protected]>

* tmporally add autoware_auto_msgs

Signed-off-by: Takamasa Horibe <[email protected]>

* apply .auto message split

Signed-off-by: Takamasa Horibe <[email protected]>

* fix build depend

Signed-off-by: Takamasa Horibe <[email protected]>

* fix packages using osqp

* fix autoware_auto_geometry

* ignore lint of some packages

* ignore ament_lint of some packages

* ignore lint/pre-commit of trajectory_follower_nodes

* disable unit tests of some packages

Co-authored-by: Maxime CLEMENT <[email protected]>
Co-authored-by: Joshua Whitley <[email protected]>
Co-authored-by: Igor Bogoslavskyi <[email protected]>
Co-authored-by: MIURA Yasuyuki <[email protected]>
Co-authored-by: wep21 <[email protected]>
Co-authored-by: tomoya.kimura <[email protected]>
Signed-off-by: tanaka3 <[email protected]>

* Fix message interface and tests of 'trajectory_follower_nodes' (autowarefoundation#617)

* Update longitudinal_controller_node to use VehicleOdometry

* Update lateral_controller_node for VehicleOdometry and SteeringReport

* Fix tests

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

* Change the topic name of the control_cmd to align them in trajectory_follower_node (autowarefoundation#659)

* Fix topic names

* Fix namespace

* Fix test codes

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

* Fix type of current odometry in trajectory_follower_node (autowarefoundation#666)

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

* [latlon muxer] fix gtest (autowarefoundation#670)

* fix gtest

* remove unchanged

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

* Update lateral controller (autowarefoundation#708)

* Fix parameter names of mpc_follower (autowarefoundation#1376)

* remove yaw_recalc param in mpc (autowarefoundation#1241) (autowarefoundation#1476)

* parameterize curvature num (autowarefoundation#1674) (autowarefoundation#1577)

* fix rosparam steer_rate_lim_degs to steer_rate_lim_dps in mpc_follower (autowarefoundation#1848)

* Fix spellcheck fail for some packages autowarefoundation#1842

* use interpolation::slerp (autowarefoundation#2161)

* Fix/mpc reset prev result (autowarefoundation#2185)

* add add guard (autowarefoundation#2184)

* add-mpc-optimization-status-print (autowarefoundation#2189)

* Apply ament_uncrustify

* Update control/trajectory_follower/src/qp_solver/qp_solver_osqp.cpp

Co-authored-by: Takamasa Horibe <[email protected]>

Co-authored-by: Takamasa Horibe <[email protected]>
Signed-off-by: tanaka3 <[email protected]>

* Use vehicle info utils (autowarefoundation#709)

* Use vehicle info utils and disable unit test

* Update trajectory_follower_nodes default parameters and reenable tests

* Separate vehicle info param file for test

Co-authored-by: Maxime CLEMENT <[email protected]>
Signed-off-by: tanaka3 <[email protected]>

* remove stop distance condition from stopState decision (autowarefoundation#1916) (autowarefoundation#715)

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

* velocity_controller sync to .iv develop latest (autowarefoundation#699)

* non extrapolate velocity in lerpTrajectory to avoid negative velocity just before vehicle stops (autowarefoundation#2033)

* Add keep braking function at driving state (autowarefoundation#2346)

* Add keep braking function at driving state

Signed-off-by: Makoto Kurihara <[email protected]>

* Remove debug messages

Signed-off-by: Makoto Kurihara <[email protected]>

* Fix format

Signed-off-by: Makoto Kurihara <[email protected]>

* Feature/add doc for keep braking function at driving state (autowarefoundation#2366)

* Add the description of brake keeping

Signed-off-by: Makoto Kurihara <[email protected]>

* Add the english document

Signed-off-by: Makoto Kurihara <[email protected]>

* Improve description

Signed-off-by: Makoto Kurihara <[email protected]>

* Add english description

Signed-off-by: Makoto Kurihara <[email protected]>

Co-authored-by: Takayuki Murooka <[email protected]>
Co-authored-by: Makoto Kurihara <[email protected]>
Co-authored-by: Fumiya Watanabe <[email protected]>
Signed-off-by: tanaka3 <[email protected]>

* fix topic name in plot juggler (autowarefoundation#734)

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

* Fix unstable test in trajectory_follower_nodes (autowarefoundation#731)

* Added spin_some to store tf_buffer

* add more spin

* uncomment statement

* Remove temp file

* Update control/trajectory_follower_nodes/src/lateral_controller_node.cpp

Co-authored-by: Takamasa Horibe <[email protected]>

Co-authored-by: Takamasa Horibe <[email protected]>
Signed-off-by: tanaka3 <[email protected]>

Co-authored-by: Takamasa Horibe <[email protected]>
Co-authored-by: Maxime CLEMENT <[email protected]>
Co-authored-by: Joshua Whitley <[email protected]>
Co-authored-by: Igor Bogoslavskyi <[email protected]>
Co-authored-by: MIURA Yasuyuki <[email protected]>
Co-authored-by: wep21 <[email protected]>
Co-authored-by: tomoya.kimura <[email protected]>
Co-authored-by: Maxime CLEMENT <[email protected]>
Co-authored-by: Fumiya Watanabe <[email protected]>
Co-authored-by: Takayuki Murooka <[email protected]>
Co-authored-by: Makoto Kurihara <[email protected]>
Co-authored-by: Keisuke Shima <[email protected]>
TakumiKozaka-T4 pushed a commit to TakumiKozaka-T4/autoware.universe that referenced this pull request Mar 23, 2022
* Back port .auto control packages (autowarefoundation#571)

* Implement Lateral and Longitudinal Control Muxer

* [autowarefoundation#570] Porting wf_simulator

* [autowarefoundation#1189] Deactivate flaky test in 'trajectory_follower_nodes'

* [autowarefoundation#1189] Fix flacky test in 'trajectory_follower_nodes/latlon_muxer'

* [autowarefoundation#1057] Add osqp_interface package

* [autowarefoundation#1057] Add library code for MPC-based lateral control

* [autowarefoundation#1271] Use std::abs instead of abs

* [autowarefoundation#1057] Implement Lateral Controller for Cargo ODD

* [autowarefoundation#1246] Resolve "Test case names currently use snake_case but should be CamelCase"

* [autowarefoundation#1325] Deactivate flaky smoke test in 'trajectory_follower_nodes'

* [autowarefoundation#1058] Add library code of longitudinal controller

* Fix build error for trajectory follower

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

* Fix build error for trajectory follower nodes

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

* [autowarefoundation#1272] Add AckermannControlCommand support to simple_planning_simulator

* [autowarefoundation#1058] Add Longitudinal Controller node

* [autowarefoundation#1058] Rename velocity_controller -> longitudinal_controller

* [autowarefoundation#1058] Update CMakeLists.txt for the longitudinal_controller_node

* [autowarefoundation#1058] Add smoke test python launch file

* [autowarefoundation#1058] Use LowPassFilter1d from trajectory_follower

* [autowarefoundation#1058] Use autoware_auto_msgs

* [autowarefoundation#1058] Changes for .auto (debug msg tmp fix, common func, tf listener)

* [autowarefoundation#1058] Remove unused parameters

* [autowarefoundation#1058] Fix ros test

* [autowarefoundation#1058] Rm default params from declare_parameters + use autoware types

* [autowarefoundation#1058] Use default param file to setup NodeOptions in the ros test

* [autowarefoundation#1058] Fix docstring

* [autowarefoundation#1058] Replace receiving a Twist with a VehicleKinematicState

* [autowarefoundation#1058] Change class variables format to m_ prefix

* [autowarefoundation#1058] Fix plugin name of LongitudinalController in CMakeLists.txt

* [autowarefoundation#1058] Fix copyright dates

* [autowarefoundation#1058] Reorder includes

* [autowarefoundation#1058] Add some tests (~89% coverage without disabling flaky tests)

* [autowarefoundation#1058] Add more tests (90+% coverage without disabling flaky tests)

* [autowarefoundation#1058] Use Float32MultiArrayDiagnostic message for debug and slope

* [autowarefoundation#1058] Calculate wheel_base value from vehicle parameters

* [autowarefoundation#1058] Cleanup redundant logger setting in tests

* [autowarefoundation#1058] Set ROS_DOMAIN_ID when running tests to prevent CI failures

* [autowarefoundation#1058] Remove TF listener and use published vehicle state instead

* [autowarefoundation#1058] Change smoke tests to use autoware_testing

* [autowarefoundation#1058] Add plotjuggler cfg for both lateral and longitudinal control

* [autowarefoundation#1058] Improve design documents

* [autowarefoundation#1058] Disable flaky test

* [autowarefoundation#1058] Properly transform vehicle state in longitudinal node

* [autowarefoundation#1058] Fix TF buffer of lateral controller

* [autowarefoundation#1058] Tuning of lateral controller for LGSVL

* [autowarefoundation#1058] Fix formating

* [autowarefoundation#1058] Fix /tf_static sub to be transient_local

* [autowarefoundation#1058] Fix yaw recalculation of reverse trajs in the lateral controller

* modify trajectory_follower for galactic build

Signed-off-by: Takamasa Horibe <[email protected]>

* [autowarefoundation#1379] Update trajectory_follower

* [autowarefoundation#1379] Update simple_planning_simulator

* [autowarefoundation#1379] Update trajectory_follower_nodes

* apply trajectory msg modification in control

Signed-off-by: Takamasa Horibe <[email protected]>

* move directory

Signed-off-by: Takamasa Horibe <[email protected]>

* remote control/trajectory_follower level dorectpry

Signed-off-by: Takamasa Horibe <[email protected]>

* remove .iv trajectory follower

Signed-off-by: Takamasa Horibe <[email protected]>

* use .auto trajectory_follower

Signed-off-by: Takamasa Horibe <[email protected]>

* remove .iv simple_planning_simulator & osqp_interface

Signed-off-by: Takamasa Horibe <[email protected]>

* use .iv simple_planning_simulator & osqp_interface

Signed-off-by: Takamasa Horibe <[email protected]>

* add tmp_autoware_auto_dependencies

Signed-off-by: Takamasa Horibe <[email protected]>

* tmporally add autoware_auto_msgs

Signed-off-by: Takamasa Horibe <[email protected]>

* apply .auto message split

Signed-off-by: Takamasa Horibe <[email protected]>

* fix build depend

Signed-off-by: Takamasa Horibe <[email protected]>

* fix packages using osqp

* fix autoware_auto_geometry

* ignore lint of some packages

* ignore ament_lint of some packages

* ignore lint/pre-commit of trajectory_follower_nodes

* disable unit tests of some packages

Co-authored-by: Maxime CLEMENT <[email protected]>
Co-authored-by: Joshua Whitley <[email protected]>
Co-authored-by: Igor Bogoslavskyi <[email protected]>
Co-authored-by: MIURA Yasuyuki <[email protected]>
Co-authored-by: wep21 <[email protected]>
Co-authored-by: tomoya.kimura <[email protected]>

* Port parking planner packages from .Auto (autowarefoundation#600)

* Copy code of 'vehicle_constants_manager'

* Fix vehicle_constants_manager for ROS galactic

* Rm .iv costmap_generator freespace_planner freespace_planning_aglorihtms

* Add astar_search (from .Auto)

* Copy freespace_planner from .Auto

* Update freespace_planner for .IV

* Copy costmap_generator from .Auto

* Copy and update had_map_utils from .Auto

* Update costmap_generator

* Copy costmap_generator_nodes

* Update costmap_generator_nodes

* Comment out all tests

* Move vehicle_constant_managers to tmp_autoware_auto_dependencies

* ignore pre-commit for back-ported packages

Signed-off-by: Takamasa Horibe <[email protected]>

* ignore testing

Signed-off-by: Takamasa Horibe <[email protected]>

Co-authored-by: Takamasa Horibe <[email protected]>

* fix: fix pre-commit

* fix: fix markdownlint

* fix: fix cpplint

* feat: remove autoware_auto_dependencies

Co-authored-by: Takamasa Horibe <[email protected]>
Co-authored-by: Maxime CLEMENT <[email protected]>
Co-authored-by: Joshua Whitley <[email protected]>
Co-authored-by: Igor Bogoslavskyi <[email protected]>
Co-authored-by: MIURA Yasuyuki <[email protected]>
Co-authored-by: wep21 <[email protected]>
Co-authored-by: tomoya.kimura <[email protected]>
Co-authored-by: Maxime CLEMENT <[email protected]>
@takayuki5168 takayuki5168 force-pushed the feature/reference-obstacle-velocity-planner branch 2 times, most recently from f5e9177 to 7121ce0 Compare April 1, 2022 07:20
@takayuki5168 takayuki5168 force-pushed the feature/reference-obstacle-velocity-planner branch from be68eb6 to cc067d5 Compare April 21, 2022 16:44
@takayuki5168 takayuki5168 added the type:documentation Creating or refining documentation. (auto-assigned) label May 24, 2022
@takayuki5168 takayuki5168 marked this pull request as ready for review May 24, 2022 11:53
@takayuki5168 takayuki5168 marked this pull request as draft May 24, 2022 11:54
@takayuki5168 takayuki5168 added type:documentation Creating or refining documentation. (auto-assigned) and removed type:documentation Creating or refining documentation. (auto-assigned) labels May 24, 2022
@takayuki5168 takayuki5168 force-pushed the feature/reference-obstacle-velocity-planner branch 7 times, most recently from b5c42d8 to cd0c823 Compare May 25, 2022 10:10
Signed-off-by: Takayuki Murooka <[email protected]>
Signed-off-by: Takayuki Murooka <[email protected]>
Signed-off-by: Takayuki Murooka <[email protected]>
Signed-off-by: Takayuki Murooka <[email protected]>
Signed-off-by: Takayuki Murooka <[email protected]>
Signed-off-by: Takayuki Murooka <[email protected]>
@takayuki5168 takayuki5168 force-pushed the feature/reference-obstacle-velocity-planner branch from 9c565b8 to 4108ef3 Compare June 6, 2022 01:35
Signed-off-by: Takayuki Murooka <[email protected]>
@takayuki5168 takayuki5168 changed the title feat(adaptive_cruise_planner): add new package feat(obstacle_cruise_planner): add new package Jun 6, 2022
@tkimura4 tkimura4 self-requested a review June 6, 2022 03:41
Copy link
Contributor

@tkimura4 tkimura4 left a comment

Choose a reason for hiding this comment

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

LGTM

@tkimura4
Copy link
Contributor

tkimura4 commented Jun 6, 2022

humble build check: failed
image

@takayuki5168
Copy link
Contributor Author

I force-pushed and changes for fixing humble CI error was removed... Its change is only in my computer at the office 😇

@takayuki5168 takayuki5168 force-pushed the feature/reference-obstacle-velocity-planner branch from ba75adf to eced432 Compare June 6, 2022 06:57
Signed-off-by: Takayuki Murooka <[email protected]>
@takayuki5168 takayuki5168 force-pushed the feature/reference-obstacle-velocity-planner branch from eced432 to b9f8dde Compare June 6, 2022 07:01
@takayuki5168 takayuki5168 merged commit 528350c into autowarefoundation:main Jun 6, 2022
@takayuki5168 takayuki5168 deleted the feature/reference-obstacle-velocity-planner branch June 6, 2022 08:00
ktro2828 pushed a commit to ktro2828/autoware.universe that referenced this pull request Jun 7, 2022
* feat(obstacle_velocity_planner): add obstacle_velocity_planner

Signed-off-by: Takayuki Murooka <[email protected]>

* udpate yaml

Signed-off-by: Takayuki Murooka <[email protected]>

* update dependency

Signed-off-by: Takayuki Murooka <[email protected]>

* fix maybe-unused false positive error

Signed-off-by: Takayuki Murooka <[email protected]>

* Tier IV -> TIER IV

Signed-off-by: Takayuki Murooka <[email protected]>

* fix some reviews

Signed-off-by: Takayuki Murooka <[email protected]>

* fix some reviews

Signed-off-by: Takayuki Murooka <[email protected]>

* minor change

Signed-off-by: Takayuki Murooka <[email protected]>

* minor changes

Signed-off-by: Takayuki Murooka <[email protected]>

* use obstacle_stop by default

Signed-off-by: Takayuki Murooka <[email protected]>

* fix compile error

Signed-off-by: Takayuki Murooka <[email protected]>

* obstacle_velocity -> adaptive_cruise

Signed-off-by: Takayuki Murooka <[email protected]>

* fix for autoware meta repository

Signed-off-by: Takayuki Murooka <[email protected]>

* fix compile error on CI

Signed-off-by: Takayuki Murooka <[email protected]>

* add min_ego_accel_for_rss

Signed-off-by: Takayuki Murooka <[email protected]>

* fix CI error

Signed-off-by: Takayuki Murooka <[email protected]>

* rename to obstacle_cruise_planner

Signed-off-by: Takayuki Murooka <[email protected]>

* fix tier4_planning_launch

Signed-off-by: Takayuki Murooka <[email protected]>

* fix humble CI

Signed-off-by: Takayuki Murooka <[email protected]>
Signed-off-by: ktro2828 <[email protected]>
SoohyeokPark-MORAI pushed a commit to SoohyeokPark-MORAI/autoware.universe that referenced this pull request Jun 15, 2022
* feat(obstacle_velocity_planner): add obstacle_velocity_planner

Signed-off-by: Takayuki Murooka <[email protected]>

* udpate yaml

Signed-off-by: Takayuki Murooka <[email protected]>

* update dependency

Signed-off-by: Takayuki Murooka <[email protected]>

* fix maybe-unused false positive error

Signed-off-by: Takayuki Murooka <[email protected]>

* Tier IV -> TIER IV

Signed-off-by: Takayuki Murooka <[email protected]>

* fix some reviews

Signed-off-by: Takayuki Murooka <[email protected]>

* fix some reviews

Signed-off-by: Takayuki Murooka <[email protected]>

* minor change

Signed-off-by: Takayuki Murooka <[email protected]>

* minor changes

Signed-off-by: Takayuki Murooka <[email protected]>

* use obstacle_stop by default

Signed-off-by: Takayuki Murooka <[email protected]>

* fix compile error

Signed-off-by: Takayuki Murooka <[email protected]>

* obstacle_velocity -> adaptive_cruise

Signed-off-by: Takayuki Murooka <[email protected]>

* fix for autoware meta repository

Signed-off-by: Takayuki Murooka <[email protected]>

* fix compile error on CI

Signed-off-by: Takayuki Murooka <[email protected]>

* add min_ego_accel_for_rss

Signed-off-by: Takayuki Murooka <[email protected]>

* fix CI error

Signed-off-by: Takayuki Murooka <[email protected]>

* rename to obstacle_cruise_planner

Signed-off-by: Takayuki Murooka <[email protected]>

* fix tier4_planning_launch

Signed-off-by: Takayuki Murooka <[email protected]>

* fix humble CI

Signed-off-by: Takayuki Murooka <[email protected]>
Signed-off-by: SoohyeokPark-MORAI <[email protected]>
SoohyeokPark-MORAI pushed a commit to SoohyeokPark-MORAI/autoware.universe that referenced this pull request Jun 15, 2022
* feat(obstacle_velocity_planner): add obstacle_velocity_planner

Signed-off-by: Takayuki Murooka <[email protected]>

* udpate yaml

Signed-off-by: Takayuki Murooka <[email protected]>

* update dependency

Signed-off-by: Takayuki Murooka <[email protected]>

* fix maybe-unused false positive error

Signed-off-by: Takayuki Murooka <[email protected]>

* Tier IV -> TIER IV

Signed-off-by: Takayuki Murooka <[email protected]>

* fix some reviews

Signed-off-by: Takayuki Murooka <[email protected]>

* fix some reviews

Signed-off-by: Takayuki Murooka <[email protected]>

* minor change

Signed-off-by: Takayuki Murooka <[email protected]>

* minor changes

Signed-off-by: Takayuki Murooka <[email protected]>

* use obstacle_stop by default

Signed-off-by: Takayuki Murooka <[email protected]>

* fix compile error

Signed-off-by: Takayuki Murooka <[email protected]>

* obstacle_velocity -> adaptive_cruise

Signed-off-by: Takayuki Murooka <[email protected]>

* fix for autoware meta repository

Signed-off-by: Takayuki Murooka <[email protected]>

* fix compile error on CI

Signed-off-by: Takayuki Murooka <[email protected]>

* add min_ego_accel_for_rss

Signed-off-by: Takayuki Murooka <[email protected]>

* fix CI error

Signed-off-by: Takayuki Murooka <[email protected]>

* rename to obstacle_cruise_planner

Signed-off-by: Takayuki Murooka <[email protected]>

* fix tier4_planning_launch

Signed-off-by: Takayuki Murooka <[email protected]>

* fix humble CI

Signed-off-by: Takayuki Murooka <[email protected]>
boyali referenced this pull request in boyali/autoware.universe Jul 1, 2022
* feat(obstacle_velocity_planner): add obstacle_velocity_planner

Signed-off-by: Takayuki Murooka <[email protected]>

* udpate yaml

Signed-off-by: Takayuki Murooka <[email protected]>

* update dependency

Signed-off-by: Takayuki Murooka <[email protected]>

* fix maybe-unused false positive error

Signed-off-by: Takayuki Murooka <[email protected]>

* Tier IV -> TIER IV

Signed-off-by: Takayuki Murooka <[email protected]>

* fix some reviews

Signed-off-by: Takayuki Murooka <[email protected]>

* fix some reviews

Signed-off-by: Takayuki Murooka <[email protected]>

* minor change

Signed-off-by: Takayuki Murooka <[email protected]>

* minor changes

Signed-off-by: Takayuki Murooka <[email protected]>

* use obstacle_stop by default

Signed-off-by: Takayuki Murooka <[email protected]>

* fix compile error

Signed-off-by: Takayuki Murooka <[email protected]>

* obstacle_velocity -> adaptive_cruise

Signed-off-by: Takayuki Murooka <[email protected]>

* fix for autoware meta repository

Signed-off-by: Takayuki Murooka <[email protected]>

* fix compile error on CI

Signed-off-by: Takayuki Murooka <[email protected]>

* add min_ego_accel_for_rss

Signed-off-by: Takayuki Murooka <[email protected]>

* fix CI error

Signed-off-by: Takayuki Murooka <[email protected]>

* rename to obstacle_cruise_planner

Signed-off-by: Takayuki Murooka <[email protected]>

* fix tier4_planning_launch

Signed-off-by: Takayuki Murooka <[email protected]>

* fix humble CI

Signed-off-by: Takayuki Murooka <[email protected]>
boyali referenced this pull request in boyali/autoware.universe Sep 28, 2022
* feat(obstacle_velocity_planner): add obstacle_velocity_planner

Signed-off-by: Takayuki Murooka <[email protected]>

* udpate yaml

Signed-off-by: Takayuki Murooka <[email protected]>

* update dependency

Signed-off-by: Takayuki Murooka <[email protected]>

* fix maybe-unused false positive error

Signed-off-by: Takayuki Murooka <[email protected]>

* Tier IV -> TIER IV

Signed-off-by: Takayuki Murooka <[email protected]>

* fix some reviews

Signed-off-by: Takayuki Murooka <[email protected]>

* fix some reviews

Signed-off-by: Takayuki Murooka <[email protected]>

* minor change

Signed-off-by: Takayuki Murooka <[email protected]>

* minor changes

Signed-off-by: Takayuki Murooka <[email protected]>

* use obstacle_stop by default

Signed-off-by: Takayuki Murooka <[email protected]>

* fix compile error

Signed-off-by: Takayuki Murooka <[email protected]>

* obstacle_velocity -> adaptive_cruise

Signed-off-by: Takayuki Murooka <[email protected]>

* fix for autoware meta repository

Signed-off-by: Takayuki Murooka <[email protected]>

* fix compile error on CI

Signed-off-by: Takayuki Murooka <[email protected]>

* add min_ego_accel_for_rss

Signed-off-by: Takayuki Murooka <[email protected]>

* fix CI error

Signed-off-by: Takayuki Murooka <[email protected]>

* rename to obstacle_cruise_planner

Signed-off-by: Takayuki Murooka <[email protected]>

* fix tier4_planning_launch

Signed-off-by: Takayuki Murooka <[email protected]>

* fix humble CI

Signed-off-by: Takayuki Murooka <[email protected]>
boyali referenced this pull request in boyali/autoware.universe Oct 3, 2022
* feat(obstacle_velocity_planner): add obstacle_velocity_planner

Signed-off-by: Takayuki Murooka <[email protected]>

* udpate yaml

Signed-off-by: Takayuki Murooka <[email protected]>

* update dependency

Signed-off-by: Takayuki Murooka <[email protected]>

* fix maybe-unused false positive error

Signed-off-by: Takayuki Murooka <[email protected]>

* Tier IV -> TIER IV

Signed-off-by: Takayuki Murooka <[email protected]>

* fix some reviews

Signed-off-by: Takayuki Murooka <[email protected]>

* fix some reviews

Signed-off-by: Takayuki Murooka <[email protected]>

* minor change

Signed-off-by: Takayuki Murooka <[email protected]>

* minor changes

Signed-off-by: Takayuki Murooka <[email protected]>

* use obstacle_stop by default

Signed-off-by: Takayuki Murooka <[email protected]>

* fix compile error

Signed-off-by: Takayuki Murooka <[email protected]>

* obstacle_velocity -> adaptive_cruise

Signed-off-by: Takayuki Murooka <[email protected]>

* fix for autoware meta repository

Signed-off-by: Takayuki Murooka <[email protected]>

* fix compile error on CI

Signed-off-by: Takayuki Murooka <[email protected]>

* add min_ego_accel_for_rss

Signed-off-by: Takayuki Murooka <[email protected]>

* fix CI error

Signed-off-by: Takayuki Murooka <[email protected]>

* rename to obstacle_cruise_planner

Signed-off-by: Takayuki Murooka <[email protected]>

* fix tier4_planning_launch

Signed-off-by: Takayuki Murooka <[email protected]>

* fix humble CI

Signed-off-by: Takayuki Murooka <[email protected]>
boyali referenced this pull request in boyali/autoware.universe Oct 3, 2022
* feat(obstacle_velocity_planner): add obstacle_velocity_planner

Signed-off-by: Takayuki Murooka <[email protected]>

* udpate yaml

Signed-off-by: Takayuki Murooka <[email protected]>

* update dependency

Signed-off-by: Takayuki Murooka <[email protected]>

* fix maybe-unused false positive error

Signed-off-by: Takayuki Murooka <[email protected]>

* Tier IV -> TIER IV

Signed-off-by: Takayuki Murooka <[email protected]>

* fix some reviews

Signed-off-by: Takayuki Murooka <[email protected]>

* fix some reviews

Signed-off-by: Takayuki Murooka <[email protected]>

* minor change

Signed-off-by: Takayuki Murooka <[email protected]>

* minor changes

Signed-off-by: Takayuki Murooka <[email protected]>

* use obstacle_stop by default

Signed-off-by: Takayuki Murooka <[email protected]>

* fix compile error

Signed-off-by: Takayuki Murooka <[email protected]>

* obstacle_velocity -> adaptive_cruise

Signed-off-by: Takayuki Murooka <[email protected]>

* fix for autoware meta repository

Signed-off-by: Takayuki Murooka <[email protected]>

* fix compile error on CI

Signed-off-by: Takayuki Murooka <[email protected]>

* add min_ego_accel_for_rss

Signed-off-by: Takayuki Murooka <[email protected]>

* fix CI error

Signed-off-by: Takayuki Murooka <[email protected]>

* rename to obstacle_cruise_planner

Signed-off-by: Takayuki Murooka <[email protected]>

* fix tier4_planning_launch

Signed-off-by: Takayuki Murooka <[email protected]>

* fix humble CI

Signed-off-by: Takayuki Murooka <[email protected]>
boyali referenced this pull request in boyali/autoware.universe Oct 19, 2022
* feat(obstacle_velocity_planner): add obstacle_velocity_planner

Signed-off-by: Takayuki Murooka <[email protected]>

* udpate yaml

Signed-off-by: Takayuki Murooka <[email protected]>

* update dependency

Signed-off-by: Takayuki Murooka <[email protected]>

* fix maybe-unused false positive error

Signed-off-by: Takayuki Murooka <[email protected]>

* Tier IV -> TIER IV

Signed-off-by: Takayuki Murooka <[email protected]>

* fix some reviews

Signed-off-by: Takayuki Murooka <[email protected]>

* fix some reviews

Signed-off-by: Takayuki Murooka <[email protected]>

* minor change

Signed-off-by: Takayuki Murooka <[email protected]>

* minor changes

Signed-off-by: Takayuki Murooka <[email protected]>

* use obstacle_stop by default

Signed-off-by: Takayuki Murooka <[email protected]>

* fix compile error

Signed-off-by: Takayuki Murooka <[email protected]>

* obstacle_velocity -> adaptive_cruise

Signed-off-by: Takayuki Murooka <[email protected]>

* fix for autoware meta repository

Signed-off-by: Takayuki Murooka <[email protected]>

* fix compile error on CI

Signed-off-by: Takayuki Murooka <[email protected]>

* add min_ego_accel_for_rss

Signed-off-by: Takayuki Murooka <[email protected]>

* fix CI error

Signed-off-by: Takayuki Murooka <[email protected]>

* rename to obstacle_cruise_planner

Signed-off-by: Takayuki Murooka <[email protected]>

* fix tier4_planning_launch

Signed-off-by: Takayuki Murooka <[email protected]>

* fix humble CI

Signed-off-by: Takayuki Murooka <[email protected]>
dmoszynski pushed a commit to RobotecAI/autoware.universe that referenced this pull request Jun 22, 2023
kyoichi-sugahara pushed a commit that referenced this pull request Sep 16, 2023
Signed-off-by: GitHub <[email protected]>

Signed-off-by: GitHub <[email protected]>
Co-authored-by: kenji-miyake <[email protected]>
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Labels
type:documentation Creating or refining documentation. (auto-assigned)
Projects
None yet
Development

Successfully merging this pull request may close these issues.

4 participants