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(osqp_interface): add interface to give csc matrix directly to enable warm start for computation time improvement. #377

Conversation

takayuki5168
Copy link
Contributor

Related Issue(required)

#347

Description(required)

Add a new interface in osqp_interface to enable warm-start which improves the computation time of the optimization. Details are below.

  • added initializer of osqp_interface with csc matrix, and matrix update functions with csc matrix
  • added a function to validate the size of P, q, A, l, u.
  • fixed the existing test and added test for new functions

NOTE: we do not have to care about the existing applications which use osqp_interface since the existing member functions' behavior of osqp_interface will not change.

Review Procedure(required)

run test

Related PR(optional)

Pre-Review Checklist for the PR Author

PR Author should check the checkboxes below when creating the PR.

If you are adding new package following items are required:

  • Documentation with description of the package is available
  • A sample launch file and parameter file are available if the package contains executable nodes

Checklist for the PR Reviewer

Reviewers should check the checkboxes below before approval.

  • Commits are properly organized and messages are according to the guideline
  • PR title describes the changes

Post-Review Checklist for the PR Author

PR Author should check the checkboxes below before merging.

  • All open points are addressed and tracked via issues or tickets

CI Checks

  • Build and test for PR / build-and-test-pr: Required to pass before the merge.
  • Build and test for PR / clang-tidy-pr: NOT required to pass before the merge. It is up to the reviewer(s). Found false positives? See the [guidelines][clang-tidy-guidelines].
  • Check spelling: NOT required to pass before the merge. It is up to the reviewer(s). See here if you want to add some words to the spell check dictionary.

takayuki5168 and others added 7 commits February 7, 2022 11:53
Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com>
Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com>
Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com>
Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com>
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
@takayuki5168 takayuki5168 deleted the feature/osqp-add-functions branch February 14, 2022 02:03
harihitode pushed a commit to harihitode/autoware.universe that referenced this pull request Feb 16, 2022
* release v0.4.0

* add obstacle avoid param (autowarefoundation#62)

* Feature/add stop reason lane change (autowarefoundation#69)

* add blocked by obstacle

* add stop reason topic to lane change planner

* Revert "add blocked by obstacle"

This reverts commit 1f5ecdb30c04f7ee70a4b3271bb2099c44752801.

* removed ROS1 package

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>

* Revert "removed ROS1 package"

This reverts commit c914e2e16fed7726f8748e1f936b061f051eaf8f.

* add COLCON_IGNORE file to all ROS1 packages

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>

* rename *.launch files to *.launch.xml

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>

* port planning launch

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* add missing porting

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* replace rostopic pub with executable in behavior_planning.launch.xml

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>

* fix remapping of topics in launch files

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>

* modify integer parameters to double parameters

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>

* fix arguments in parking.launch.xml

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>

* fix remapping of topics in scenario_planning.launch.xml

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>

* ROS2 Linting: planning_launch (autowarefoundation#38)

* Ros2 port autoware launch (autowarefoundation#35)

* [autoware_launch] port CMakelists.txt and remove COLCON_IGNORE

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>

* [autoware_launch] fix planning_simulator.launch.xml

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>

* [autoware_launch] add rviz config

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>

* [autoware_launch] first port of autoware_launch

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>

* lanuch rviz with config file

Signed-off-by: kosuke murakami <kosuke.murakami@tier4.jp>

* modify launch file for making psim work

Signed-off-by: kosuke murakami <kosuke.murakami@tier4.jp>

* add vehicle model in launch

Signed-off-by: kosuke murakami <kosuke.murakami@tier4.jp>

* change from vehicle_model to vehicle_param_file

Signed-off-by: kosuke murakami <kosuke.murakami@tier4.jp>

* [autoware_launch] add autoware_web_controller and system launch

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>

* add rosbrdige_suite to build_depends.repos

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>

* Update rviz

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* update autoware.rviz

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>

* remove autoware_ros2.rviz

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>

Co-authored-by: kosuke murakami <kosuke.murakami@tier4.jp>
Co-authored-by: wep21 <border_goldenmarket@yahoo.co.jp>

* Ros2 v0.8.0 planning launch (autowarefoundation#59)

* [planning_launch] restore file name for ros2 porting

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* Add obstacle_stop_planner.yaml (autowarefoundation#82)

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

* add surround obstacle checker options (autowarefoundation#86)

* fix slow down param related to tier4/autoware.iv@a9cdcb2 (autowarefoundation#91)

* fix parame max_steer_deg (autowarefoundation#92)

* add refine_goal_search_radius_range (autowarefoundation#93)

* Change default evaluation in motion velocity optimizer (autowarefoundation#97)

* Use Linf

* Add new line

* Add maximum_deceleration parameter (autowarefoundation#98)

* Add maximum_deceleration parameter

* Change default value

* Unable abort lane change (autowarefoundation#102)

* add param stoping velocity and fix typo (autowarefoundation#106)

* Add a parameter for minimum velocity for lane change (autowarefoundation#109)

* Add parameters for collision check for lane change (autowarefoundation#110)

* Add a parameter for disable collision check at prepare phase

* Add parameters for collision check with predicted_path

* Add a parameter for backward buffer for end of lane (autowarefoundation#114)

* Add parameters for backward buffer for end of lane

* Remove comment out

* add extend_distance param (autowarefoundation#107)

* add parameter of acc (autowarefoundation#129)

Signed-off-by: Yuma Nihei <yuma.nihei@tier4.jp>

* fix typo & change static object velocity thres in lane_change_planner (autowarefoundation#104)

* change static object velocity thres

Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp>

* fix typo

Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp>

* Change minimum_lane_change_velocity (autowarefoundation#131)

* Feature/update avoidance param (autowarefoundation#140)

* update avoidance param

Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp>

* disable unnecesarry marker

Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp>

* modify min_behavior_stop_margin (autowarefoundation#127)

* modify min_behavior_stop_margin

Signed-off-by: Yamato Ando <yamato.ando@gmail.com>

* Update obstacle_stop_planner.yaml

Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com>

* Add expand_stop_range to obstacle_stop_planner.yaml (autowarefoundation#152)

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

* Update obstacle_stop_planner.yaml (autowarefoundation#153)

* Visualize echo back goal_pose instead of 2D Nav Goal (autowarefoundation#150)

* Visualize echo back goal_pose instead of 2D Nav Goal

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

* Fix mission_planning.launch

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

* Add surround_obstacle_checker.yaml (autowarefoundation#157)

* Add parameter (autowarefoundation#158)

* Revert "[planning_launch] restore file name for ros2 porting"

This reverts commit 275f0df232323bf24627adea9cb08888c250625e.

* fix namespace

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* fix relay

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* [planning_launch]: Add vehicle_param_file for turn signal decider

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* [planning_launch]: Change topic type of lane change approval

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com>
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
Co-authored-by: Taichi Higashide <taichi.higashide@tier4.jp>
Co-authored-by: Satoshi Tanaka <st14.828soccer@gmail.com>
Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com>
Co-authored-by: Yuma Nihei <yuma.nihei@tier4.jp>
Co-authored-by: Kosuke Murakami <kosuke.murakami@tier4.jp>
Co-authored-by: YamatoAndo <yamato.ando@gmail.com>
Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com>
Co-authored-by: hiroaki-ishikawa-t4 <57431939+hiroaki-ishikawa-t4@users.noreply.github.com>
Co-authored-by: wep21 <border_goldenmarket@yahoo.co.jp>

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

* add vehicle_param_file to simple planning simulator

* add vehicle_param_file to lane change planner

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

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

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

* Add missing '--'

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

* Rename vehicle_info.yaml to vehicle_info.param.yaml

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

* Fix livox param name

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

* Ros2 update v0.9.0 (autowarefoundation#67)

* Add pose history into rviz config

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* add blocked by obstacle option (autowarefoundation#164)

* fix tab name (autowarefoundation#166)

* disenable ndt visualization (autowarefoundation#169)

* disenable ndt visualization

* change alpha

* dont visualize position covariance

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* change global frame to map (autowarefoundation#171)

* add param (autowarefoundation#156)

Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com>
Co-authored-by: Taichi Higashide <taichi.higashide@tier4.jp>
Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com>
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>

* Ros2 fix topic name part1 (autowarefoundation#83)

* Fix topic name for behavior_velocity_planner

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

* Fix topic name of lane_change_planner

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

* Fix topic name of freespace_planner

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

* Fix topic name for freespace_planner

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

* Fix typo in planning launch (autowarefoundation#92)

* Fix typo in planning launch

* Fix remaining errors

* Fix various typos in launch files (autowarefoundation#97)

* add use_sim-time option (autowarefoundation#99)

* Format launch files (autowarefoundation#178)

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

* Sync public repo (autowarefoundation#185)

* add tier4 usbcam (autowarefoundation#104)

* add tier4 usbcam

* change version

* tier4/ros2

* Ros2 vehicle info param server (autowarefoundation#96)

* add vehicle info param server

* delete vehicle param file

Co-authored-by: taikitanaka <ttatcoder@outlook.jp>

* Ros2 fix topic name part2 (autowarefoundation#89)

* Fix topic name for traffic_light_classifier

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

* Fix topic name for traffic_light_visualization

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

* Fix topic name for traffic_light_ssd_fine_detector

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

Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com>
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
Co-authored-by: taikitanaka <ttatcoder@outlook.jp>
Co-authored-by: Takagi, Isamu <43976882+isamu-takagi@users.noreply.github.com>

* Ros2 lsim test (autowarefoundation#186)

* Add group to launch file for var scope

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

* Remove pointcloud relay for localization

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

* Add use_sim_time

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

* Remove pointcloud relay for localization

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

Co-authored-by: Takagi, Isamu <isamu.takagi@tier4.jp>

* Use set_parameter for use_sim_time (autowarefoundation#198)

* Use set_parameter for use_sim_time

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* Add default parameter for scenario simulator

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* Add container launch for planning (autowarefoundation#205)

* Add container launch for planning

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* fix porting miss

* fix lane_driving.launch.xml

* Add missing parameters

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

Co-authored-by: taichiH <azumade.30@gmail.com>

* Rename AstarNavi to FreespacePlannerNode (autowarefoundation#213)

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

* Fix typos in launch files (autowarefoundation#231)

* Fix typos in launch files

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

* Fix lint

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

Co-authored-by: wep21 <border_goldenmarket@yahoo.co.jp>

* Format launch files (autowarefoundation#228)

* Format launch files

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

* Format launch.py

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

* Fix lint

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

* Fix topic name of external traffic light input (autowarefoundation#236)

* Add namespace to behavior_velocity_planner (autowarefoundation#252)

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

* Fix typo applygin->applying (autowarefoundation#304)

Signed-off-by: kosuke55 <kosuke.tnp@gmail.com>

* add description for planning_launch autowarefoundation#335

* add README.md and svg files (autowarefoundation#328)

* add md and svg

* fix typo

* fix typo

* fix word

* fix typo

* add lack of things

* Update README

* fix depending packages

* fix word

* Add autoware api (autowarefoundation#376)

* Add external api adaptor (autowarefoundation#267)

* Add external api adaptor

* Add api adaptor to logging simulator

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

* Add engage status output

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

* Add internal api adaptor (autowarefoundation#273)

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

* Add map hash generator (autowarefoundation#319)

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

* Add autoware api launch (autowarefoundation#326)

* Add autoware api launch

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

* Apply autoware api launch

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

* Add deprecated comment

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

* Remove unused parameter (autowarefoundation#325)

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

* Add api parameter (autowarefoundation#341)

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

* Add start request API (autowarefoundation#321)

* Add use start request option

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

* Fix lint

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

* Feature external cmd selector heartbeat (autowarefoundation#356)

* Rename external command topic

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

* Modify command topic name

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

* Fix topic name

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

* Rename remote_cmd_converter

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

* Remove gate mode from external command

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

* Fix latest external command name (autowarefoundation#361)

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

* Fix merge conflict

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

* change external traffic light topic name in behavior velocity planner (autowarefoundation#310)

* fix topic

* change internal topic name

Co-authored-by: yabuta <makoto.yabuta@tier4.jp>

* Merge pull request autowarefoundation#359 from tier4/feature/add_plannig_error_monitor (autowarefoundation#365)

* Feature/add virtual traffic light planner (autowarefoundation#317)

* Fix pre-commit (autowarefoundation#407)

* Fix pre-commit errors

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

* Fix package.xml

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

* fix parameter name (autowarefoundation#470)

* Feature/porting behavior path planner (autowarefoundation#300)

* modify behavior_planning launch for behavior_path_planner with lane_c… (autowarefoundation#239)

* modify behavior_planning launch for behavior_path_planner with lane_change_only config

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* remove avoidance & side_shift related code

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* Fix launcher and add config files and change obstacle avoid param

* Add new line

* Fix visualization and remove multiple args

* Enable auto approve path change

Co-authored-by: rej55 <rej55.g@gmail.com>
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* add param in behavior_path_planner (autowarefoundation#255)

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* Fix param (autowarefoundation#251)

* Fix typo

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com>
Co-authored-by: rej55 <rej55.g@gmail.com>

* Feature/porting motion velocity smoother (autowarefoundation#302)

* Launch motion_velocity_smoother (autowarefoundation#215)

* Launch motion_velocity_smoother

* Change params

* Fix parameter files

* Fix

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* Fix/smoother trajectory ds (autowarefoundation#249)

* Add parameter

* Fix

* Fix

* change launcher parameter (autowarefoundation#265)

* Feature/smoother resampling (autowarefoundation#269)

* change launcher parameter

* add new parameter

Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com>
Co-authored-by: purewater0901 <43805014+purewater0901@users.noreply.github.com>

* Master sync parking module (autowarefoundation#303)

* Add namespace

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* Add freespace planner config file

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* Add missing import

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* update rviz config & planner params (autowarefoundation#305)

Co-authored-by: satoshi-ota <satoshi.ota@gmail.com>

* Feature/porting occlusion spot (autowarefoundation#309)

* add occulusion_spot marker (autowarefoundation#266)

* add blindspot marker

* to occlusion spot slow down

* remove debug info from marker (autowarefoundation#287)

* remove debug info from marker

* remove debug arrow

* fix format

* update behavior launch

* apply pep8

* fix format

Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com>

* Use multithread for lane driving planning (autowarefoundation#327)

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* Fix import order of parking.launch.py (autowarefoundation#347)

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

* Add analytical smoother config (autowarefoundation#360)

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

* update acc param (autowarefoundation#358)

* add rosparam for vehicle center optimization (autowarefoundation#362)

* update ros param for .iv (autowarefoundation#353)

* update ros param for .iv

* forward fixing mpt time: 3.0->1.0

* Fix/obstacle avoid revert some improvements (autowarefoundation#381)

* Revert "update ros param for .iv (autowarefoundation#353)"

This reverts commit f7f341a.

* Revert "add rosparam for vehicle center optimization (autowarefoundation#362)"

This reverts commit 78bbf70.

* update side shift param (autowarefoundation#370)

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* add yaml & load lane following params (autowarefoundation#377)

* add pull over/out module (autowarefoundation#430)

add yaml file and modify BT tree file path

modify parameter file

add parameter

add use_dynamic_object flag in pull out param

delete unncesarry parameters

delete unnecessary param

merge change for jpntaxi

delete blank line

modify BT file name

modify launch file

* Update behavior path planner launch files (autowarefoundation#433)

* update launch parameters for behavior_path_planner

Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com>

* update param at experiment

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* fix typo

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* Fix indent

Co-authored-by: TakaHoribe <horibe.takamasa@gmail.com>

* Fix for pre-commit (437)

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

* change threshold_distance_object_is_on_center to 1.0 (autowarefoundation#441)

Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com>

* delete optimizer (autowarefoundation#456)

* add params for acceleration prevention (autowarefoundation#454) (autowarefoundation#457)

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* Feature/use external velocity limit selector (autowarefoundation#460)

* use external velocity limit selector

* add common planning params

* update yaml params

* Feature/add slow down params (autowarefoundation#448)

* add/update slow down params

* topic remap

* update topic name

* Fix/use common param (autowarefoundation#465)

* Change formatter to black (autowarefoundation#488)

* Update pre-commit settings

* Apply Black

* Replace ament_lint_common with autoware_lint_common

* Update build_depends.repos

* Fix build_depends

* twist -> odometry (autowarefoundation#109)

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

* Auto/fix launch (autowarefoundation#110)

* fix namespace

* remove dynamic_object_visualization

* fix rviz

* remove unused depend/launcher (autowarefoundation#112)

* Fix remapping in control.launch.py (autowarefoundation#115)

* Fix remappings

* Add comment

* Sync .auto branch with the latest branch in internal repository (autowarefoundation#120)

* Disbale intersection polygon marker (autowarefoundation#483)

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* Merge pull request autowarefoundation#384 from tier4/feature/no_stopping_area

Feature/no stopping area

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

Co-authored-by: Daisuke Nishimatsu <42202095+wep21@users.noreply.github.com>
Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com>

* Update traffic light topic name (autowarefoundation#131)

* Update traffic light topic name

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* Update traffic light topic name in perception

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

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

Signed-off-by: j4tfwm6z <proj-jpntaxi@tier4.jp>

Co-authored-by: j4tfwm6z <proj-jpntaxi@tier4.jp>

* auto/fix occupancy grid map topic name (autowarefoundation#137)

* fix/rename segmentation namespace (autowarefoundation#139)

* fix namespace: rviz config

* fix namespace: planning stack

* rename segmentatino directory

* fix namespace: perception stack

* add vehicle info parameter

Signed-off-by: tomoya.kimura <tomoya.kimura@tier4.jp>

* ci(pre-commit): autofix

* remove unused import

* remove unused import

Signed-off-by: tomoya.kimura <tomoya.kimura@tier4.jp>

Co-authored-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>
Co-authored-by: Kosuke Murakami <kosuke.murakami@tier4.jp>
Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com>
Co-authored-by: Jilada Eccleston <jilada.eccleston@tier4.jp>
Co-authored-by: Ryohsuke Mitsudome <43976834+mitsudome-r@users.noreply.github.com>
Co-authored-by: wep21 <border_goldenmarket@yahoo.co.jp>
Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com>
Co-authored-by: Taichi Higashide <taichi.higashide@tier4.jp>
Co-authored-by: Satoshi Tanaka <st14.828soccer@gmail.com>
Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com>
Co-authored-by: Yuma Nihei <yuma.nihei@tier4.jp>
Co-authored-by: YamatoAndo <yamato.ando@gmail.com>
Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com>
Co-authored-by: hiroaki-ishikawa-t4 <57431939+hiroaki-ishikawa-t4@users.noreply.github.com>
Co-authored-by: Daisuke Nishimatsu <42202095+wep21@users.noreply.github.com>
Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com>
Co-authored-by: Takagi, Isamu <43976882+isamu-takagi@users.noreply.github.com>
Co-authored-by: Kazuki Miyahara <kmiya@outlook.com>
Co-authored-by: taikitanaka <ttatcoder@outlook.jp>
Co-authored-by: Takagi, Isamu <isamu.takagi@tier4.jp>
Co-authored-by: taichiH <azumade.30@gmail.com>
Co-authored-by: Kosuke Takeuchi <kosuke.tnp@gmail.com>
Co-authored-by: Hiroki OTA <hiroki.ota@tier4.jp>
Co-authored-by: yabuta <makoto.yabuta@tier4.jp>
Co-authored-by: purewater0901 <43805014+purewater0901@users.noreply.github.com>
Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com>
Co-authored-by: satoshi-ota <satoshi.ota@gmail.com>
Co-authored-by: Makoto Kurihara <mkuri8m@gmail.com>
Co-authored-by: Takayuki Murooka <takayuki5168@gmail.com>
Co-authored-by: kyoichi sugahara <81.s.kyo.19@gmail.com>
Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp>
Co-authored-by: autoware-iv-sync-ci[bot] <87871706+autoware-iv-sync-ci[bot]@users.noreply.github.com>
Co-authored-by: Takayuki Murooka <takayuki.murooka@tier4.jp>
Co-authored-by: j4tfwm6z <proj-jpntaxi@tier4.jp>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>
mitsudome-r added a commit to mitsudome-r/autoware.universe that referenced this pull request Mar 1, 2022
* release v0.4.0

* add convertToXYZCloud (#706)

* Fix/concat mutex bug (#711)

* modify defautl value

Signed-off-by: Yamato Ando <yamato.ando@gmail.com>

* fix bug

Signed-off-by: Yamato Ando <yamato.ando@gmail.com>

* fix mutex bug

Signed-off-by: Yamato Ando <yamato.ando@gmail.com>

* bug fix and reduce calc cost (#708)

* bug fix and reduce calc cost

Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com>

* fixed bug

Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com>

* Revert "bug fix and reduce calc cost (#708)" (#719)

This reverts commit e69564a4071a0849435ac8ffe54fe4e49d8e3974.

* Avoid setting CMAKE_BUILD_TYPE=Release in each CMakeLists.txt (#720)

* remove set CMAKE_BUILD_TYPE Release in each CMakeLists.txt

* remove set CMAKE_BUILD_TYPE Release in ndt_pcl_modified

* set compile options for debug in ndt_omp

* Fix indent

* add warning if -DCMAKE_BUILD_TYPE=Release is not set in ndt_omp

Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com>

* ring_outlier_filter: fix bug, and check azimuth (#727)

* fix bug, and check azimuth

Signed-off-by: Yamato Ando <yamato.ando@gmail.com>

* reduce calc cost

Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com>

Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com>

* Fix/ring outlier filter bug (#762)

* fix bug, and check azimuth

Signed-off-by: Yamato Ando <yamato.ando@gmail.com>

* reduce calc cost

Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com>

* fix bug

Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com>

* change default param

Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com>

Co-authored-by: Yamato Ando <yamato.ando@gmail.com>

* remove ROS1 packages temporarily

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>

* Revert "remove ROS1 packages temporarily"

This reverts commit bcab06f1790bbe6d2441ad18a6430fde31ca483e.

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>

* add COLCON_IGNORE to ros1 packages

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>

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

* Port points preprocessor (#114)

* Add pcl_component.h.
 - originally from Willow Garage.
 - Ported to ROS2 component class by SImon Thompson.

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* Port CMakelists & package.xml & concatenate_data
 - timer frequency handing is not ported (the logic is changed)
 - remove dependency and functions of NodeletLazy

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* move required functions from pcl_component.h to filter.h, port rayground_filter

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* add crop box filter

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* arrange make order

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* port voxel grid downsample filter

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* port pointcloud accumulator

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* port compare map filters

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* port outlier filters

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* port passthrough filters

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* fix pcl deprecates:
 - replace pcl::uint16_t -> std::uint16_t
 - replace pcl_isfinite  -> std::isfinite
 - replace pcl::getFieldIndex(input, name, fields) -> pcl::getFieldIndex<PointT>(name, fields)

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* add parameter service callback (port dynamic reconfigure)

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* remove unused file

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* fix: add missing return

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* add input/output_frame parameter service callback in Filter class

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* message_filter : boost::shared_ptr -> std::shared_ptr

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* fix pcl::getPointCloudDifference deprecate

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* add License

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* fix cmake compile options

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* fix warning

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* move init & subscribe functions to constructor

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* port ring_passthrough_filter.launch.xml

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* fix component register plugin name

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* add default param, remove duplicated node name for debug print

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* add default value for concat_data args

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* add preprocessor.launch.py

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* remove old file

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* add ros parameter initialization

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* remove unused files

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* apply clang format

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* replace _exe to _node for executable

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* remove unused main.cpp

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* minor fix: change param name

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* add preprocessor.launch.xml launch (#123)

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* [pointcloud-preprocessor] Link missing opencv libraries (#133)

to fix linker error in downstream package

* Rename h files to hpp (#142)

* Change includes

* Rename files

* Adjustments to make things compile

* Other packages

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

* Use quotes for includes where appropriate (#144)

* Use quotes for includes where appropriate

* Fix lint tests

* Make tests pass hopefully

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

* Run uncrustify on the entire Pilot.Auto codebase

* Exclude open PRs

* ROS2 Linting: pointcloud_preprocessor (#180)

* Add linter tests

* Run cppcheck and fix errors

* Address PR Comments:
 - Remove the impl file and merge the two header files

* Remove colcon build warning for PCL libraries
 - #129 issue

* Address PR comment:
 - Reorder calls to find package and build dependencies to suppress build warnings

* [ray_ground_filter] overwrite frame_id of output_msg with base_frame_ (#216)

Signed-off-by: Autoware <autoware@tier4.jp>

Co-authored-by: Autoware <autoware@tier4.jp>

* fix tf (#232)

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>

* apply env_var to  use_sim_time (#222)

* Ros2 v0.8.0 pointcloud preprocessor (#293)

* fix height threshold bug (#1102) (#371)

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>

Co-authored-by: Taichi Higashide <taichi.higashide@tier4.jp>

* Add livox_tag_filter (#368)

* Add livox_tag_filter (#1140)

* Add livox_tag_filter

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

* Remove dependency of livox_ros_driver

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

[livox_tag_filter] port to ROS2

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>

* fix test failures

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>

* Move livox_tag_filter under livox/ directory

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>

* address review comments

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>

* fix lint test error

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>

* make livox_tag_filter_node to component

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>

Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com>

* Add tier4_pcl_extensions (#1162) (#377)

* Add tier4_pcl_extensions (#1162)

* Add tier4_pcl_extensions

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

* Move to sensing/preprocessor/pointcloud

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

port to ROS2

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>

* fix lint errors

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>

* fix include brackets

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>

* add dependency to pcl

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>

Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com>

* Sync with Ros2 v0.8.0 beta (#393)

* add nullptr check when publish concatenate data (#369)

* Add warning msg when concat pointcloud is not published (#388)

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

* add timeout notification stamp msgs (#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 <taichi.higashide@tier4.jp>
Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com>

* Add approximate voxel grid filter (#1144) (#378)

* add approximate downsample filter nodelet

* add pcl_voxel_grid_modified package

* fixed cmake list

* use approximate voxel grid filter

* rename packages

* rename voxel grid filter class

Co-authored-by: RyuYamamoto <ryu.yamamoto@tier4.jp>

* Fix concatenate data (#396)

* Remove std msgs from concatenate data

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* Adaptive timer

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* Fix lint

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* Sensor data qos (#407)

* Use sensor data qos for pointcloud preprocessor

Signed-off-by: Autoware <autoware@tier4.jp>

* Use sensor data qos for pointcloud

Signed-off-by: Autoware <autoware@tier4.jp>

* Fix lint

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* Use sensor data qos for livox tag filter and vector map filter

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* Fix lint

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

Co-authored-by: Autoware <autoware@tier4.jp>

* Fix topic name in pointcloud preprocessor (#422)

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* Fix typo in sensing module (#436)

* Import v0.9.1 (#431)

* add local optimal solution ocillation check to ndt_scan_matcher (#1182)

* Add obstacle_crush diagnostic (#1186)

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

* Fix diagnostics api (#1185)

* Fix diagnostics api

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

* Don't overwrite level

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

* Overwrite level of No Fault diagnostics

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

* Add missing diag in autoware_error_monitor.yaml (#1187)

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

* Filter hazard_status (#1191)

* Filter hazard_status

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

* Filter leaf diagnostics

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

* Fix wrong calculation of available memory. (#1168)

* Fixed wrong calculation of available memory.

* Added comments about output example of free -tb command.

* Change monitoring method to get HDD temperature and usage per specified device. (#1195)

* Changed monitoring method to get temperature and usage per specified device.

* Fixed test codes.

* Removed unnecessary (void) parameter.

* return input pointcloud when ground plane not found (#1190)

* fix yaw-smoothing bug (#1198)

* Fix lint

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

Co-authored-by: Taichi Higashide <taichi.higashide@tier4.jp>
Co-authored-by: ito-san <57388357+ito-san@users.noreply.github.com>
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>

* add use_sim-time option (#454)

* Format launch files (#1219)

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

* Fix for rolling (#1226)

* Replace doc by description

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

* Replace ns by push-ros-namespace

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

* Use unique ptr publish in filters (#1240)

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* Remove invalid warning of concatenate data (#1245)

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* Unify Apache-2.0 license name (#1242)

* Refine BSD license name (#1244)

* Fix issues in downsample filter (#1253)

* Add missing return statement

* Add override to overridden virtual functions

* Add explicit to the constructor callable with a single argument

* Use using instead of typedef

* Comment out unused function parameters

* Fix cpplint warnings (include-what-you-use)

* Fix uncrustify warnings (except warnings on inclusion guard)

* Add reason why uncrustify excluded

* Add override to overridden virtual function

* change clock of tf_buffer to RCL_ROS_TIME from RCL_SYSTEM_TIME (#1261)

Signed-off-by: Azumi Suzuki <azumi.suzuki@tier4.jp>

* Remove use_sim_time for set_parameter (#1260)

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* Porting small fix (#1288)

* Delete unused code (#1183)

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

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

* Add comments for livox tag (#1188)

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

* Clear return value (#1193)

* Change tracker model of unknown object (#1204)

* treat polygon points as relative (#1205)

Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp>

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

* fix reference velocity for vehicle gear

* add initialization

* revert

* add comment

* change max area param (#1218)

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

* Update livox_tag_filter.launch.xml

* Fixup

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

Co-authored-by: shin <8327162+0x126@users.noreply.github.com>
Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com>
Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com>
Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com>
Co-authored-by: Kosuke Murakami <kosuke.murakami@tier4.jp>
Co-authored-by: Hiroki OTA <hiroki.ota@tier4.jp>
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
Co-authored-by: Kazuki Miyahara <kmiya@outlook.com>
Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Fix lint errors (#1378)

* Fix lint errors

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

* Fix variable names

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

* Use transient_local sub for compare_map_filter (#1437)

* Use transient_local sub for compare_map_filter

Signed-off-by: kosuke55 <kosuke.tnp@gmail.com>

* Rename nn_dists

Signed-off-by: kosuke55 <kosuke.tnp@gmail.com>

* Remove pointcloud_to_laserscan (#1508)

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* Feature/compare elevation map (#1488)

* suppress warnings for sensing packages (#1729)

* add Werror for tier4_pcl_extensions

* use std::type  instead of pcl::type

* use std::isfinite instead of pcl_isfinite

* fix getFieldIndex

* add Werror

* fix uninitialized

* add Werror

* fix string to char*

* Fix dependency type of rosidl_default_generators (#1801)

* Fix dependency type of rosidl_default_generators

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

* Remove unnecessary depends

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

* Use ament_cmake_auto

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

* Add concatenate_date diagnostic (#1808)

* Add concatenate_date diagnostic

Signed-off-by: kosuke55 <kosuke.tnp@gmail.com>

* Fix spell transed -> transformed

Signed-off-by: kosuke55 <kosuke.tnp@gmail.com>

* Remove unused functions

Signed-off-by: kosuke55 <kosuke.tnp@gmail.com>

* Fix output topic name

Signed-off-by: kosuke55 <kosuke.tnp@gmail.com>

* Remove pub_concat_status

Signed-off-by: kosuke55 <kosuke.tnp@gmail.com>

* Remove concat_num and not_subscribed_topic_names publisher

Signed-off-by: kosuke55 <kosuke.tnp@gmail.com>

* Use set insted of vector

* Refactor daignostics function

* Add const

* Use empty insted of size

* Remove updater_ constructor

* Initialize not_subscribed_topic_names_with input_topics and remove concat_num key-value

* Use ternary operator for diag level and message

* Clarify to use std::string instead of auto

* Use ternary operator for subscribe status

* Add const

* Fix ternary operator

* Change order of diag stat

* Change to subscribe_status

* Fix ternary operator

* Add include set for include_what_you_use

* Fix subscribe_status

* Fix -Wunused-parameter (#1836)

* Fix -Wunused-parameter

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

* Fix mistake

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

* fix spell

* Fix lint issues

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

* Ignore flake8 warnings

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

Co-authored-by: Hiroki OTA <hiroki.ota@tier4.jp>

* Fix compiler warnings (#1837)

* Fix -Wunused-private-field

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

* Fix -Wunused-variable

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

* Fix -Wformat-security

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

* Fix -Winvalid-constexpr

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

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

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

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

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

* Fix -Winconsistent-missing-override

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

* Fix -Wrange-loop-construct

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

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

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

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

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

* Fix lint

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

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

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

* Fix mistake

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

* Fix -Wunused-parameter

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

* Fix vector_map_filter downsample (#1847)

* Fix vector_map_filter downsample

Signed-off-by: kosuke55 <kosuke.tnp@gmail.com>

* Fix spell

Signed-off-by: kosuke55 <kosuke.tnp@gmail.com>

* Reserve centralized_cloud

Signed-off-by: kosuke55 <kosuke.tnp@gmail.com>

* Move returning to downsample original coords lines

* Return to the original coords when creating filtered_cloud

* Remove voxel_size_z

* Fix spell

* Remove unnecessary comment

* Remove unnecessary index check

* Remove voxel_size_z in header

* Fix spellcheck fail for some packages (#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

* fix some typos (#1941)

* fix some typos

* fix typo

* Fix typo

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

Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp>

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

* Run ament_uncrustify at pre-commit

* Reformat existing files
* Fix copyright and cpplint errors

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

* add sort-package-xml hook in pre-commit (#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

* Port filter subscribe and unsbscribe (#2048)

* Port filter subscribe and unsbscribe

Signed-off-by: kosuke55 <kosuke.tnp@gmail.com>

* Add message_filters unsubscribe

* Use filter unsubscribe for compare_elevation_map (#2049)

* Use filter unsubscribe for compare_elevation_map

Signed-off-by: kosuke55 <kosuke.tnp@gmail.com>

* Use override instead of virtual

* Add including header for clang-tidy

* Add missing dependencies of diagnostic_updater (#2242)

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

* Feature/porting occupancy grid (#1621)

* probabilistic occupancy grid map for blind spot (#1124)

* add probabilistic occupancy grid map

* cosmetic change

* bug fix

* bug fix

* cosmetic change

* cosmetic change

* cosmetic change

* bug fix

* modify topic name and launch

* fix typo

* improve occupancy grid map (#1498)

* use obstacle pointcloud

* fix bug

* update

Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com>

* add readme

* modify license and fix bug

* change param

* fix typo

* fix typo

* disable roslint

* cosmetic change

* modify readme

* bug fix (#1514)

* Fix occupancy grid map (#1524)

* bug fix

* cosmetic change

* refactor and bug fix

* Porting occupancy grid to ros2

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* Fix typo

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* Fix file name in README

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* pre-commit fixes

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com>

* Feature/porting occupancy grid filter (#1721)

* Feature/occupancy grid map based outlier filter (#1555)

* bug fix

* add occupancy grid map based outlier filter

* cosmetic change

* update occupancy grid map launch

* modify license

* cosmetic change

* disable debug

* fix definition of wrong function

* cosmetic change

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* pre-commit fixes

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* Update build_depend.repos

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* Fix message type in readme

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* Fix topic name in readme

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* Fix lint

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com>

* Add a new ground filter node (#1509) (#1691)

* Add a new ground filter node (#1509)

* Initial commit

* Implement simple classification method

* Update classification algorithm

* Change virtual ground point to front wheel center

* Update classification algorithm (classify from center of ground points cluster)

* Remove unused code and add some comments.

* Add document and sample launch file

* Fix typo

* Fix typo

* change variable name

* Fix bug

* Fix typo, Fix coding style

* Update params in launch file

* Use autoware_utils::calcDistance3d to calculate distance between two points

* Use radians instead of degrees

* Change default param config

* Add more description about the algorithm

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* Feature/occupancy grid map based outlier filter (#1555)

* bug fix

* add occupancy grid map based outlier filter

* cosmetic change

* update occupancy grid map launch

* modify license

* cosmetic change

* disable debug

* fix definition of wrong function

* cosmetic change

* pre-commit fixes

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* Fix lint

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

Co-authored-by: Shunsuke Miura <37187849+miursh@users.noreply.github.com>
Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com>

* Fix build warning (#1745)

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* Feature/porting occlusion spot (#1740)

* Feature/occlusion_spot safety planner public road (#1594)

* add blind spot safety planner public road

* remove duplicated procesing

* remove unused private param

* renaming fix typo add comments

* fix spell check

* velocity -> relative velocity

* calc2d, To param, simplify search, To original

* add the num possible collision gurd

* computational cost reduction

* Cosmetic change for PossibleCollisionInfo

* add interpolation to possible collision value

* refactor codes

* fix details

* invalid point gurd

* To Param

* refacotor to occlusion spot util

* cosmetic change

* clean up blindspot

* To Occlusion Spot

* revise readme

* refactor drawing

* for better explanation

* fix velocity profile

* clean up details

* cosmetic change for debug marker

* use max velocity in obstacle info instead

* add gtest for Too Many Possible Collision case

* change case

* refactor readme

* minor fix

* add more occlusion spot explanation

* replace svg

* add gtest build path lanelet

* hotfix lateral distance and searching method

* update g test for lateral distance

* use faster search

* set more realistic param

* add lanelet subtype highway

* cosmetic change of reviews

* add occlusion spot module in private area (#1640)

* add occlusion spot in private

* For debugging change

* add spline interpolation to path

* add review changes

* adding minor change

* cosmetic change

* Vector to retval

* Blindspot To OcclusionSpot1

* To Occlusion Spot 2

* To Occlusions spot3

* update gtest with unified anchor

* remove anchor

* add test slice

* simplify interpolation

* Too Occlusion spot4

* add test buffer

* To Occlusion spot

* namespace gurd

* correct slice and add interpolation first

* handle self crossing with check for invation

* to ros debug stream

* removed unused interpolation

* add readme to plant uml

* cosmetic change

* minor change

* update readme

* review change

* change occlusion spot text color

* To Offset no Throw

* better debug marker

* catch only inversion error

* skip return in case of inversion

* for better grid

* simplify path lanelet at first

* remove std::cout

* for better path

* limit ego path inside target lanelet location

* remove last points

* cosmetic change for markers

* apply module for limited scene

* fix interpolation gurd

* for better params

* do not includes path behind

* remove dummy perception publisher

* Revert "remove dummy perception publisher"

This reverts commit 4acad985fe31dd9befaa21a16631495de6c3a117.

* replace hard coded occupancy grid option in psim

* remove respawn

* add arg to params and remove redundunt launch

* fix spell check

* fix default value

Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>

* Feature/occlusion spot private slice size param (#1703)

* add min slice size

* for a bit narrow lateral distance

* Update planning/scenario_planning/lane_driving/behavior_planning/behavior_velocity_planner/config/occlusion_spot_param.yaml

Co-authored-by: Maxime CLEMENT <78338830+maxime-clem@users.noreply.github.com>

Co-authored-by: Maxime CLEMENT <78338830+maxime-clem@users.noreply.github.com>

* Rename files

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* Porting to ros2

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* pre-commit fixes

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* Fix typo

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* Fix launch namespace

Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>

* Fix parameter type

Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>

* Update planning/scenario_planning/lane_driving/behavior_planning/behavior_velocity_planner/src/scene_module/occlusion_spot/scene_occlusion_spot_in_private_road.cpp

Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>

Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com>
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
Co-authored-by: Maxime CLEMENT <78338830+maxime-clem@users.noreply.github.com>

* Fix out of range because of float cast (#1753)

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* catch exception at look up transform and fix index ROS2 (#1761)

* catch exception at look up transform

* add return to exception case

* fix ament lint

* fix typo and index

* add catch and fix lint

* use catch partly

* error to warn and fix indent

* add child info to logger

* add throttle and return

* Fix compile warnings (#1852)

Fix -Wunused-parameter

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

Fix -Wunused-private-field

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

Fix -Wunused-lambda-capture

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

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

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

Fix -Wrange-loop-construct

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

Ignore lint error

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

* Feature/distortion corrector (#1782)

* Fix/preprocessor format (#1921)

* Enable uncrustify

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* Apply uncrustify

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* Feature/left intensity (#1912)

* left intensity

* apply formatting rules

* leave as it is

* rename function

* Update occ grid docs (#1991)

* update docs

* cosmetic change

* update readme (#1992)

* Apply format (#1999)

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

Fix cpplint

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

* Fix/ground filter classification algorithm (#2038)

* Check the distance from object cluster for non ground following points to calculate the slope

* fix cpplint error

* fix cpplint error

* Fix package.xml (#2056)

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

* Feature/port dual return filter (#2020)

* Original commit, with basic weak first filtering

* Add simple diagnostic, ring outlier for normal points, format

* Separate weak first and normal point ring outlier filter parameters, update published topics for investigation

* rename header

* porting

* add config file

* add launch

* visiblity and noise

* add missing subscribe function

* remove unnecessary subscriber

* add publishing topic

* add visiblity diag

* enable image transport

* minor fix

* uncrusify

* add image transport

* add visiblity thresh param

* typo fix

* add dynamic reconf param

* tmp_dual_echo

* point cloud type fix

* cosmetic change

* precommit

* Update sensing/preprocessor/pointcloud/pointcloud_preprocessor/include/pointcloud_preprocessor/outlier_filter/dual_return_outlier_filter_nodelet.hpp

Co-authored-by: davidw <david.wong@tier4.jp>
Co-authored-by: Shinnosuke Hirakawa <shinnosuke.hirakawa@tier4.jp>

* add key value (#2209)

* add key value

* Update sensing/preprocessor/pointcloud/pointcloud_preprocessor/src/outlier_filter/dual_return_outlier_filter_nodelet.cpp

Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com>

* cosmetic change

Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com>

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

* Revert "Temporarily comment out pre-commit hooks"

This reverts commit 748e9cdb145ce12f8b520bcbd97f5ff899fc28a3.

* Replace ament_lint_common with autoware_lint_common

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

* Remove ament_cmake_uncrustify and ament_clang_format

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

* Apply Black

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

* Apply clang-format

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

* Fix build errors

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

* Fix for cpplint

* Fix include double quotes to angle brackets

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

* Apply clang-format

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

* Fix build errors

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

* Add COLCON_IGNORE (#500)

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

* port vector map filter (#507)

* remove COLCON_IGNORE

* use HADMapBin.idl

* remove COLCON_IGNORE (#515)

* port ground/compare map filter for perception as segmentation stack (#490)

* move ground filter to perception from sensing

* cleanup ground filter launch file

* remove ground filter from sensing

* refer pointclound_preprocessor/filter.hpp

* rename package ground_filter -> ground_segmentation

* add compare_map_filter into object_segmentation as compare_map_segmentation

* fix include guard in ground segmentation

* cleanup readme

* remove compare map filter from sensing stack

* remove unnecessary dependency

* remove more depends

* remove std_msgs from pkg depends

* [ polar grid ] add readme polar grid remove colcon ignore (#559)

* remove ignore

* add readme

* fix invalid link

* [vehicle_info_util] add readme (#560)

* add readme

* fix typo

* replace to valid link

* doc livox tag filter (#594)

* add minimal doc

* fix doc

* doc tier4 pcl extensions (#598)

* use velocity report (#596)

* use velocity report

* remove velocity report porting from gyro_odometor

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

* Remove template comments from node documents (#608)

* rename document file

* remove template comment

* Auto/document pointclound preprocessor (#607)

* add document template

* minimal doc

* rm dust

* fix path

* add minimal description

* update parameter description

* update porpose

* update document title

* fix typo

* fix outlier filter doc

* update crop-box-filter & concatenate-data

* fix typo

* add distortion corrector

* fix topic type

* add passthrough filter doc

* add vector map filter doc

* add point cloud preprocessor doc

* add downsampling doc

* fix broken link

* fix wrong input topic (#647)

* update to support velocity report header (#655)

* update to support velocity report header

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* Update simulator/simple_planning_simulator/src/simple_planning_simulator/simple_planning_simulator_core.cpp

Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>

* use maybe_unused

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* fix precommit

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>

* adapt to actuation cmd/status as control msg (#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

* initialize pointer (#660)

* add tf2_geometry_msgs include to distorction_filter (#664)

* add tf2_geometry_msgs include

* add tf2_geometry_msgs pkg depend

* Sync .auto branch with the latest branch in internal repository (#691)

* add trajectory point offset in rviz plugin (#2270)

* sync rc rc/v0.23.0 (#2258)

* fix interpolation for insert point (#2228)

* fix interpolation for insert point

* to prev interpolation pkg

* Revert "to prev interpolation pkg"

This reverts commit 9eb145b5d36e297186015fb17c267ccd5b3c21ef.

Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com>
Co-authored-by: taikitanaka <ttatcoder@outlook.jp>

* fix topic name (#2266)

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* Add namespace to diag for dual_return_filter (#2269)

* Add a function to make 'geometry_msgs::msg::TransformStamped' (#2250)

* Add a function to make 'geometry_msgs::msg::TransformStamped'
* Add 'child_frame_id' as an argument of 'pose2transform'

* Simplify marker scale initialization (#2286)

* Fix/crosswalk polygon (#2279)

* extend crosswalk polygon

* improve readability

* fix polygon shape

* Add warning when decel distance calculation fails (#2289)

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

* [motion_velocity_smoother] ignore debug print (#2292)

* cosmetic change

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* cahnge severity from WARN to DEBUG for debug info

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* use util for stop_watch

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* fix map based prediction (#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 <kmiya@outlook.com>

* Update perception/object_recognition/prediction/map_based_prediction/Readme.md

Co-authored-by: Kazuki Miyahara <kmiya@outlook.com>

* Update perception/object_recognition/prediction/map_based_prediction/Readme.md

Co-authored-by: Kazuki Miyahara <kmiya@outlook.com>

* Update Readme.md

* Update perception/object_recognition/prediction/map_based_prediction/Readme.md

Co-authored-by: Kazuki Miyahara <kmiya@outlook.com>

Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
Co-authored-by: Kazuki Miyahara <kmiya@outlook.com>

* remove failure condition for 0 velocity trajectory (#2295)

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* [mpc_follower] remove stop distance condition from stopState decision (#1916)

* [mpc_follower] remove stop distance condition from stopState decision

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* add invalid index handling

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* Move the debug marker initialization part to another file (#2288)

* Move the debug marker initialization part to 'debug.cpp'

* Make 'isLocalOptimalSolutionOscillation' independent from 'NDTScanMatcher' (#2300)

* Remove an unused function 'getTransform' (#2301)

* Simplify iteration of initial poses (#2310)

* Make a transform object const (#2311)

* Represent poses in 'std::vector' instead of 'geometry_msgs::msg::PoseArray' (#2312)

* Feature/no stopping area (#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 <yukky.saito@gmail.com>

* update license

Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com>

* update license

Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com>

* update license

Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com>

* 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 <yukky.saito@gmail.com>

* sync rc rc/v0.23.0 (#2281)

* Fix side shift planner (#2171) (#2172)

* add print debug

Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com>

* remove forward shift points when adding new point

Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com>

* remove debug print

Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com>

* format

Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com>

* Fix remove threshold

Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com>

Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* Fix/pull out and pull over (#2175)

* delete unnecessary check

* fix condition of starting pull out

* Add emergency status API (#2174) (#2182)

* Fix/mpc reset prev result (#2185) (#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 <horibe.takamasa@gmail.com>

Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com>

Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* [hotfix] 1 path point exception after resampling (#2204)

* fix 1 path point exception after resampling

Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com>

* Apply suggestions from code review

* Apply suggestions from code review

Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com>

Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>

* [hotfix] Fix lane ids (#2211)

* Fix lane ids

* Prevent acceleration on avoidance (#2214)

* prevent acceleration on avoidance

Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com>

* fix param name

Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com>

* parametrize avoidance acc

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* change param name

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* fix typo

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* Fix qos in roi cluster fusion (#2218)

* fix confidence (#2220)

* too high confidence (#2229)

* Fix/obstacle stop 0.23.0 (#2232)

* fix unexpected slow down in sharp curves (#2181)

* Fix/insert implementation (#2186)

Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com>

* [hotfix] Remove exception in avoidance module (#2233)

* Remove exception

* Fix clock

* Remove blank line

* Update traffic light state if ref stop point is ahead of previous one (#2197)

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* fix interpolation for insert point (#2228)

* fix interpolation for insert point

* to prev interpolation pkg

* fix index (#2265)

* turn signal calculation (#2280)

* add turn signal funtion in path shifter

* add ros parameters

Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com>
Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com>
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
Co-authored-by: Takagi, Isamu <43976882+isamu-takagi@users.noreply.github.com>
Co-authored-by: Daisuke Nishimatsu <42202095+wep21@users.noreply.github.com>
Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com>
Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com>
Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com>
Co-authored-by: Sugatyon <32741405+Sugatyon@users.noreply.github.com>

* [behavior_path_planner] fix sudden path change around ego (#2305) (#2318)

* fix return-from-ego shift point generation logic

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* change param for trimSimilarGradShiftPoint

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* add comment for issue

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* update comment

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* replace code with function (logic has not changed)

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* move func to cpp

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* add comment for issue

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* fix typo

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* Update planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/src/scene_module/avoidance/avoidance_module.cpp

Co-authored-by: Kazuki Miyahara <kmiya@outlook.com>

* Update planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/src/scene_module/avoidance/avoidance_module.cpp

Co-authored-by: Kazuki Miyahara <kmiya@outlook.com>

Co-authored-by: Kazuki Miyahara <kmiya@outlook.com>

Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com>
Co-authored-by: Kazuki Miyahara <kmiya@outlook.com>

* Add functions to make stamped scalar messages (#2317)

* Fix/object yaw in intersection module (#2294)

* fix object orientation

* fix function name

* add guard (#2321)

* reduce cost (double to float) (#2298)

* Add detail collision check (#2274)

* Add detail collision check

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* Remove unused function

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* Fix arc length

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* Seperate time margin

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* Fix parameter name

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* Update Readme

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* Address review: Add comment for TimeDistanceArray

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* Run pre-commit

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* Fix cpplint

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* Add return for empty polygon

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* update CenterPoint  (#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 (#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 <kmiya@outlook.com>

* 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 <kmiya@outlook.com>

* Add Planning Evaluator  (#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 <horibe.takamasa@gmail.com>

* fix yaml format to fix pre-commit check

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* fix yaml format

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* apply clang-format

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* apply clang-format

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* 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 <horibe.takamasa@gmail.com>

Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* Add keep braking function at driving state (#2346)

* Add keep braking function at driving state

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

* Remove debug messages

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

* Fix format

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

* Change diag_updater's pediod from default to 0.1sec (#2348)

* add cross judgement and common signal function (#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 (#2340)

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

* add time offset param to point cloud concatenation (#2303)

* add offset param

* clang-format

Co-authored-by: Akihito OHSATO <aohsato@gmail.com>

* Feature/add doc for keep braking function at driving state (#2366)

* Add the description of brake keeping

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

* Add the english document

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

* Improve description

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

* Add english description

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

* Fix include files (#2339)

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

* 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 (#1916)"

This reverts commit ff4f0b5a844d1f835f1b93bd3b36a76747b0cd02.

* Revert "Add keep braking function at driving state (#2346)"

This reverts commit f0478187db4c28bf6092c198723dcc5ec11a9c70.

* Revert "Feature/add doc for keep braking function at driving state (#2366)"

This reverts commit 66de2f3924a479049fce2d5c5c6b579cacbd3e49.

* Fix orientation availability in centerpoint

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* fix test_trajectory.cpp

* add target link libraries

* Use .auto msg in test code for planniing evaluator

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* fix include

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

Co-authored-by: Takayuki Murooka <takayuki5168@gmail.com>
Co-authored-by: autoware-iv-sync-ci[bot] <87871706+autoware-iv-sync-ci[bot]@users.noreply.github.com>
Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com>
Co-authored-by: taikitanaka <ttatcoder@outlook.jp>
Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com>
Co-authored-by: Takeshi Miura <57553950+1222-takeshi@users.noreply.github.com>
Co-authored-by: Takeshi Ishita <ishitah.takeshi@gmail.com>
Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com>
Co-authored-by: Makoto Kurihara <mkuri8m@gmail.com>
Co-authored-by: purewater0901 <43805014+purewater0901@users.noreply.github.com>
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
Co-authored-by: Kazuki Miyahara <kmiya@outlook.com>
Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com>
Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com>
Co-authored-by: Takagi, Isamu <43976882+isamu-takagi@users.noreply.github.com>
Co-authored-by: Sugatyon <32741405+Sugatyon@users.noreply.github.com>
Co-authored-by: s-murakami-esol <81723883+s-murakami-esol@users.noreply.github.com>
Co-authored-by: Yusuke Muramatsu <yukke42@users.noreply.github.com>
Co-authored-by: Maxime CLEMENT <78338830+maxime-clem@users.noreply.github.com>
Co-authored-by: Shunsuke Miura <37187849+miursh@users.noreply.github.com>
Co-authored-by: Shinnosuke Hirakawa <8327162+0x126@users.noreply.github.com>
Co-authored-by: Akihito OHSATO <aohsato@gmail.com>
Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp>

Co-authored-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>
Co-authored-by: Taichi Higashide <taichi.higashide@tier4.jp>
Co-authored-by: YamatoAndo <yamato.ando@gmail.com>
Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com>
Co-authored-by: Daichi Murakami <harihitode@gmail.com>
Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com>
Co-authored-by: Nikolai Morin <nnmmgit@gmail.com>
Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com>
Co-authored-by: Frederik Beaujean <72439809+fred-apex-ai@users.noreply.github.com>
Co-authored-by: Jilada Eccleston <jilada.eccleston@gmail.com>
Co-authored-by: Ryohsuke Mitsudome <43976834+mitsudome-r@users.noreply.github.com>
Co-authored-by: Autoware <autoware@tier4.jp>
Co-authored-by: Kosuke Murakami <kosuke.murakami@tier4.jp>
Co-authored-by: Daisuke Nishimatsu <42202095+wep21@users.noreply.github.com>
Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com>
Co-authored-by: RyuYamamoto <ryu.yamamoto@tier4.jp>
Co-authored-by: Kazuki Miyahara <kmiya@outlook.com>
Co-authored-by: ito-san <57388357+ito-san@users.noreply.github.com>
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
Co-authored-by: s-azumi <38061530+s-azumi@users.noreply.github.com>
Co-authored-by: Keisuke Shima <keisuke.shima@tier4.jp>
Co-authored-by: shin <8327162+0x126@users.noreply.github.com>
Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com>
Co-authored-by: Hiroki OTA <hiroki.ota@tier4.jp>
Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp>
Co-authored-by: Kosuke Takeuchi <kosuke.tnp@gmail.com>
Co-authored-by: Takeshi Ishita <ishitah.takeshi@gmail.com>
Co-authored-by: Keisuke Shima <19993104+KeisukeShima@users.noreply.github.com>
Co-authored-by: Shunsuke Miura <37187849+miursh@users.noreply.github.com>
Co-authored-by: Maxime CLEMENT <78338830+maxime-clem@users.noreply.github.com>
Co-authored-by: davidw <david.wong@tier4.jp>
Co-authored-by: Shinnosuke Hirakawa <shinnosuke.hirakawa@tier4.jp>
Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com>
Co-authored-by: Takayuki Murooka <takayuki5168@gmail.com>
Co-authored-by: Takayuki Murooka <takayuki.murooka@tier4.jp>
Co-authored-by: autoware-iv-sync-ci[bot] <87871706+autoware-iv-sync-ci[bot]@users.noreply.github.com>
Co-authored-by: taikitanaka <ttatcoder@outlook.jp>
Co-authored-by: Makoto Kurihara <mkuri8m@gmail.com>
Co-authored-by: purewater0901 <43805014+purewater0901@users.noreply.github.com>
Co-authored-by: Takagi, Isamu <43976882+isamu-takagi@users.noreply.github.com>
Co-authored-by: Sugatyon <32741405+Sugatyon@users.noreply.github.com>
Co-authored-by: s-murakami-esol <81723883+s-murakami-esol@users.noreply.github.com>
Co-authored-by: Yusuke Muramatsu <yukke42@users.noreply.github.com>
Co-authored-by: Akihito OHSATO <aohsato@gmail.com>
TomohitoAndo pushed a commit to TomohitoAndo/autoware.universe that referenced this pull request Oct 5, 2022
TomohitoAndo pushed a commit to TomohitoAndo/autoware.universe that referenced this pull request Oct 5, 2022
TomohitoAndo pushed a commit to TomohitoAndo/autoware.universe that referenced this pull request Oct 5, 2022
…ller (autowarefoundation#377)

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
mkuri pushed a commit to mkuri/autoware.universe that referenced this pull request May 27, 2023
keiota pushed a commit to keiota/autoware.universe that referenced this pull request Aug 17, 2023
* add th_blinker_on_lateral_offset: 1.0

Signed-off-by: kosuke55 <kosuke.tnp@gmail.com>

* minimum_shift_pull_out_distance: 0.0

Signed-off-by: kosuke55 <kosuke.tnp@gmail.com>

* minimum_lateral_jerk: 0.1

Signed-off-by: kosuke55 <kosuke.tnp@gmail.com>

---------

Signed-off-by: kosuke55 <kosuke.tnp@gmail.com>
HansOersted pushed a commit to HansOersted/autoware.universe that referenced this pull request Mar 8, 2024
…valuator-simulation-setting

chore: add pre-task to convert ml model delivered by ML Package
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Labels
None yet
Projects
None yet
Development

Successfully merging this pull request may close these issues.

2 participants