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_avoidance_planner): add options for plan_from_ego #1191

Merged
merged 5 commits into from
Jul 4, 2022

Conversation

kosuke55
Copy link
Contributor

@kosuke55 kosuke55 commented Jun 29, 2022

Description

  • add plan_from_ego and max_plan_from_ego_length params
    • disabled defaultly
  • plan_from_ego is enabled when
    • trajectory length is shorter than max_plan_from_ego_length
    • stopped
  • remove adjustment of error_weight_ratio when plan_from_ego
    • constexpr double obstacle_avoid_error_weight_ratio = 1 / 100.0;

Related links

launch : tier4/autoware_launch#371

Tests performed

Checked that plan_from_ego is enabled when following conditions are true with psim

  • trajectory length is shorter than max_plan_from_ego_length
  • stopped

(defaultly disabled but if enabled)
These are TIER IV internal test results but I share them for your information.
both branches are based on v0.31

Notes for reviewers

Pre-review checklist for the PR author

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

In-review checklist for the PR reviewers

The PR 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

The 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 write access can merge the PR.

@kosuke55
Copy link
Contributor Author

send PR for launch tier4/autoware_launch#371

@codecov
Copy link

codecov bot commented Jun 29, 2022

Codecov Report

Merging #1191 (8a03c11) into main (6831afa) will decrease coverage by 0.07%.
The diff coverage is 0.00%.

@@           Coverage Diff            @@
##            main   #1191      +/-   ##
========================================
- Coverage   9.58%   9.51%   -0.08%     
========================================
  Files       1042    1042              
  Lines      71837   72416     +579     
  Branches   15590   15590              
========================================
  Hits        6889    6889              
- Misses     58978   59557     +579     
  Partials    5970    5970              
Flag Coverage Δ *Carryforward flag
differential 0.00% <0.00%> (?)
total 9.57% <0.00%> (ø) Carriedforward from 0c3e240

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

Impacted Files Coverage Δ
...lude/obstacle_avoidance_planner/common_structs.hpp 0.00% <ø> (ø)
...g/obstacle_avoidance_planner/src/mpt_optimizer.cpp 0.00% <0.00%> (ø)
planning/obstacle_avoidance_planner/src/node.cpp 0.00% <0.00%> (ø)

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 6831afa...8a03c11. Read the comment docs.

Copy link
Contributor

@takayuki5168 takayuki5168 left a comment

Choose a reason for hiding this comment

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

LGTM

@kosuke55 kosuke55 merged commit 613a002 into autowarefoundation:main Jul 4, 2022
@kosuke55 kosuke55 deleted the feature/plan_from_ego branch July 4, 2022 05:44
miursh pushed a commit to miursh/autoware.universe that referenced this pull request Jul 12, 2022
* release v0.4.0

* Change localization diag namespace (autowarefoundation#718)

* Change default value of output_diagnostics_topic

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

* Remove localization_diagnostic.js from web_controller

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

* Integrate localization diag to diagnostic_aggregator

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

* Delete old and unused publisher

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

* remove ROS1 packages temporarily

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

* Revert "remove ROS1 packages temporarily"

This reverts commit 63dc7f4e1defe5fd908eeefc7a2cdfac7cb47022.

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: autoware_error_monitor (autowarefoundation#42)

* Temporary add the autoware_error_monitor package for conversion

* Renaming to adhere to convention
 - Modify CMakeList to compile using ROS2
 - TODO: fix FMT import

* Replace node implementation with ROS2 version
 - Rename core
 - Fix FMT library linking and ROS-related compilation erros
 - Add Readme
 - Add publisher and subscribers
 - Add timer

* Launch configurationse
 - Add ROS2 launch file
 - Modify config file with ROS2 conventions
 - Convert package.xml
 - Fix CMakelist
 - Bug fixes
   - Launch file correct indentation
   - Fix param.yaml to not use nested lists
   - Use as_string_array() when getting string array parameters

* Remove old files

* Fix cmake and package xml
 - Use ament cmake auto

* Fix parameters
 - Use dots as delimiters for nested parameter names
 - Move parameter declaration to constructor initialization list where possible
 - Update parameter file
 - Update launch files

* Fix launch and param files
 - Aggregator node doesn't appear to be working as expected with the launch files...
 - Fix cmake
 - Aggregator doesn't seem to allow multiple top level diagnostics

* Fix config

* Add rqt_robot_monitor to exec depends in package.xml

* Update rate should be converted to a period

Co-authored-by: Ryohsuke Mitsudome <[email protected]>

* Address PR comment:
 - Change top level namespace to autoware

* Remove commented out code

* Address PR comment:
 - Fix root for keys
 - Correct update rate

Co-authored-by: Ryohsuke Mitsudome <[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 linter tests (autowarefoundation#204)

* Ros2 v0.8.0 autoware error monitor (autowarefoundation#281)

* 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]>

* 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 autoware error monitor (autowarefoundation#362)

* Remove cpu_load_average

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

* Disable resource monitoring in planning_simulator

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

* Fix diagnostic_aggregator's params

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

* Apply format

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

* [Update v0.9.0] system monitor (autowarefoundation#365)

* Disable CPU Load Average warning. (autowarefoundation#1147)

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

* Fix cpu_monitor respawning forever. (autowarefoundation#1150)

* Disable cpu_temperature in planning simulation (autowarefoundation#1151)

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

* Net Monitor: Handle as an error if specified device not exist. (autowarefoundation#1152)

* Handled as an error if specified device not exist.

* Disable network diags in simulation

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

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

* apply ament_uncrustify

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

* Disable resource monitoring in planning_simulator (autowarefoundation#1172)

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

* Treat logging errors as safe faults (autowarefoundation#1164)

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

* Fix test code of system_monitor (autowarefoundation#1178)

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

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

* Import v0.9.1 (autowarefoundation#431)

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

* Add obstacle_crush diagnostic (autowarefoundation#1186)

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

* Fix diagnostics api (autowarefoundation#1185)

* Fix diagnostics api

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

* Don't overwrite level

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

* Overwrite level of No Fault diagnostics

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

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

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

* Filter hazard_status (autowarefoundation#1191)

* Filter hazard_status

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

* Filter leaf diagnostics

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

* Fix wrong calculation of available memory. (autowarefoundation#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. (autowarefoundation#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 (autowarefoundation#1190)

* fix yaw-smoothing bug (autowarefoundation#1198)

* Fix lint

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

Co-authored-by: Taichi Higashide <[email protected]>
Co-authored-by: ito-san <[email protected]>
Co-authored-by: tkimura4 <[email protected]>

* Fix typo in system module (autowarefoundation#434)

* Fix typo in system module

* Change variable name

* Move comments

* Apply uncrustify

* add use_sim-time option (autowarefoundation#454)

* Treat NTP offset error as safe fault (autowarefoundation#1220)

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

* 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]>

* Fix/fix porting miss (autowarefoundation#1254)

* Fix porting miss of vehicle_cmd_gate

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

* Fix mistake of autoware_error_monitor.yaml

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

* Remove use_sim_time for set_parameter (autowarefoundation#1260)

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

* error monitor for foa controller (autowarefoundation#1369)

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

* Add diagnostics config for ros2_socketcan (autowarefoundation#1447)

* 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 typo (autowarefoundation#1711)

* 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]>

* enable autonomous recovery (autowarefoundation#1904)

* add aggregator config at planing error monitor (autowarefoundation#1955) (autowarefoundation#1963)

* add trajectory monitoring setting (autowarefoundation#2018)

* Fix typo `obstacle_crush` to `obstacle_crash` (autowarefoundation#2031)

* 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

* Sync rc v1.5.0 (autowarefoundation#2058)

* Cleanup autoware_error_monitor launch (autowarefoundation#2143)

* Improve diagnostic tree for future extensions (autowarefoundation#2153)

* change resource monitoring group

* implement diagnostic tree proposal

* rename v2x param file

* add v2x to launch

* add dummy analyzer to avoid format error

* modify external control

* rename vehicle_ecu_errors

* fixup

* remove num_items

* fix error

* add heartbeat to external command selector

* Restore sensing/node_alive_monitoring

* Update system/autoware_error_monitor/config/diagnostic_aggregator/sensing.param.yaml

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

* add sensor_kit arg for diagnostic_agg

* change sensor_kit's default value

* add _ prefix to hide parameter file

* delete dummy parameter

* change to use update_functions

* add extra_agg_config_file_vehicle

* change initializer

* remove line

* Update system/autoware_error_monitor/config/diagnostic_aggregator/system.param.yaml

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

* change hearbeat diag

* add clock group

* update sensing diag

* Remove discard and v2x

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

* Fix heartbeat name

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

* Add remote_external_control

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

* Add external_control

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

* Rename remote_control to external_control

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

* Rename command_gate to control_command_gate

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

* Simplify resource monitoring

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

* Remove sensing from autoware_error_monitor.param.yaml

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

* Remove trajectory_deviation

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

* Remove vehicle specific settings

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

* Add blank lines

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

* Ignore matching_score error

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

* Remove debug_data_logger

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

* Add trajectory_validation

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

* Specify children for performance_monitoring

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

* Comment out route_validation

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

* Revert "Remove trajectory_deviation"

This reverts commit 199132f1a6c7083440f0ef9a956b0663d45f4531.

* Remove control_command_topic_status

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

* Disable some diagnostics for planning simulator

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

* Add TODO comment

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

* Enable /autoware/vehicle/node_alive_monitoring in planning simulator

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

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

* Change autoware_error_monitor config format (autowarefoundation#2244)

* Change autoware_error_monitor config file

use automatically_declare_parameters_from_overrides

Change yaml format

replace default value

move nodeoption to core

simplify parameter splitting code

use set

fix to use at function

merge for loop

add explanation for new format

fix default value

replace DiagLevel

Update system/autoware_error_monitor/src/autoware_error_monitor_core.cpp

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

Update system/autoware_error_monitor/src/autoware_error_monitor_core.cpp

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

use fmt

change to use uniform initialization

* Change autoware_error_monitor config file

* Fix format

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

Co-authored-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]>

* Add COLCON_IGNORE (autowarefoundation#500)

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

* support .auto message (autowarefoundation#529)

* 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]>

* Fix autoware monitors readme (autowarefoundation#629)

* Fix readme of autoware_state_monitor

* Fix readme of autoware_error_monitor

Co-authored-by: mitsudome-r <[email protected]>
Co-authored-by: Kenji Miyake <[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: Daisuke Nishimatsu <[email protected]>
Co-authored-by: ito-san <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Taichi Higashide <[email protected]>
Co-authored-by: Kazuki Miyahara <[email protected]>
Co-authored-by: s-murakami-esol <[email protected]>
Co-authored-by: Hiroki OTA <[email protected]>
Co-authored-by: Takamasa Horibe <[email protected]>
Co-authored-by: Keisuke Shima <[email protected]>
Co-authored-by: taikitanaka3 <[email protected]>
Co-authored-by: Takagi, Isamu <[email protected]>
Co-authored-by: Takeshi Miura <[email protected]>
miursh added a commit to miursh/autoware.universe that referenced this pull request Jul 12, 2022
* release v0.4.0

* Change localization diag namespace (autowarefoundation#718)

* Change default value of output_diagnostics_topic

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

* Remove localization_diagnostic.js from web_controller

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

* Integrate localization diag to diagnostic_aggregator

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

* Delete old and unused publisher

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

* Avoid setting CMAKE_BUILD_TYPE=Release in each CMakeLists.txt (autowarefoundation#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 <[email protected]>

* remove ROS1 packages temporarily

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

* Revert "remove ROS1 packages temporarily"

This reverts commit 3b7a7a3379c45f7736db7093e593317a970f7e94.

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 ndt_pcl_modified to ROS2 (autowarefoundation#21)

* Port ndt_pcl_modified to ROS2

* Newline

* Better CMakeLists.txt

* Add ament_cmake

* Update CMakeLists.txt yet again

* ament_auto

* Revert "ament_auto"

This reverts commit 53b785ef1d7f1d8f84c0c4a4a168c5c1c9a91a4a.

* Port ndt_omp to ROS2 (autowarefoundation#20)

* Remove COLCON_IGNORE

* CMakeLists.txt & package.xml

* Compiles

* Remove rclcpp

* Cleanup

* Fix package.xml

* Better CMakeLists.txt

* Update CMakeLists.txt again

* Update CMakeLists.txt

* Update CMakeLists.txt yet again

* Simplify CMakeLists.txt

* Last (?) CMakeLists.txt change

* Port ndt to ROS2 (autowarefoundation#29)

* Port ndt to ROS2

* Forgot COLCON_IGNORE

* package.xml

* Newline

* Update CMakeLists.txt

* Use ament_auto

* Revert "Use ament_auto"

This reverts commit 8007d92f6de20ba1128cda83476abe039d597374.

* Use explicit targets

* Port ndt_scan_matcher package to ROS2 (autowarefoundation#34)

* Initial commit

* Use rclcpp::Time

* Use autoware_debug_msgs

* Use ament_cmake_auto

* Remove unused includes and commented out code, remove timeout

* Port launch file

Co-authored-by: Jilada Eccleston <[email protected]>

* ported matching_score from ROS1 to ROS2 (autowarefoundation#105)

* 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

* Added arch check in ndt_omp (autowarefoundation#140)

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

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

* Run uncrustify on the entire Pilot.Auto codebase

* Exclude open PRs

* fixing trasient_local in ROS2 packages (autowarefoundation#160)

* adding linters to ndt_scan_matcher (autowarefoundation#191)

* adding linters to ndt_pcl_modified (autowarefoundation#190)

* adding linters to ndt_omp (autowarefoundation#189)

* adding linters to matching_score (autowarefoundation#223)

* adding linters to ndt (autowarefoundation#188)

* adding linters to ndt

* fixed clang-tidy errors in ndt package

* fixing clang-tidy errors in ndt_scan_matcher (autowarefoundation#231)

* apply env_var to  use_sim_time (autowarefoundation#222)

* Ros2 v0.8.0 ndt scan matcher (autowarefoundation#266)

* restore file name for v0.8.0 update

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

* delete std::cout (autowarefoundation#998)

Signed-off-by: Yamato Ando <[email protected]>

* Add ndt_scan_matcher.yaml (autowarefoundation#1122)

Signed-off-by: Yuma Nihei <[email protected]>

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

This reverts commit 38869185b4f423a2656f18f71a18de30d1a83730.

Co-authored-by: YamatoAndo <[email protected]>
Co-authored-by: Yuma Nihei <[email protected]>

* Ros2 v0.8.0 ndt omp (autowarefoundation#264)

* add upstream license file (autowarefoundation#994)

Signed-off-by: Yamato Ando <[email protected]>

* delete std::cout (autowarefoundation#998)

Signed-off-by: Yamato Ando <[email protected]>

Co-authored-by: YamatoAndo <[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]>

* Sensor data qos (autowarefoundation#407)

* Use sensor data qos for pointcloud preprocessor

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

* Use sensor data qos for pointcloud

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

* Fix lint

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

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

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

* Fix lint

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

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

* Import v0.9.1 (autowarefoundation#431)

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

* Add obstacle_crush diagnostic (autowarefoundation#1186)

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

* Fix diagnostics api (autowarefoundation#1185)

* Fix diagnostics api

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

* Don't overwrite level

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

* Overwrite level of No Fault diagnostics

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

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

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

* Filter hazard_status (autowarefoundation#1191)

* Filter hazard_status

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

* Filter leaf diagnostics

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

* Fix wrong calculation of available memory. (autowarefoundation#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. (autowarefoundation#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 (autowarefoundation#1190)

* fix yaw-smoothing bug (autowarefoundation#1198)

* Fix lint

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

Co-authored-by: Taichi Higashide <[email protected]>
Co-authored-by: ito-san <[email protected]>
Co-authored-by: tkimura4 <[email protected]>

* Ros2 fix ndt align srv (autowarefoundation#442)

* Add success field to ndt align srv response

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

* Apply change of ndt align srv

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

* Apply change of ndt align srv

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

* Fix lint

Signed-off-by: Takagi, Isamu <[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]>

* 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]>

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

* Refine BSD license name (autowarefoundation#1244)

* Remove use_sim_time for set_parameter (autowarefoundation#1260)

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

* Ndt omp vendor (autowarefoundation#1365)

* Use ndt omp vendor

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

* Add ndt omp into repos for ci

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

* Update build_depends.repos

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

* Add ndt_base_frame param (autowarefoundation#1632)

Signed-off-by: kosuke55 <[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]>

* suppress warnings for ndt scan matcher (autowarefoundation#1772)

* add Werror

* fix -Werror=unused-variable

* Fix input pointcloud queue size in scan matcher (autowarefoundation#1774)

Signed-off-by: wep21 <[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 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]>

* 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 a function to calculate norm between geometry_msg's points (autowarefoundation#2001)

* Use 'autoware_utils::createQuaternion' to make rotation objects (autowarefoundation#2002)

* Use forward declarations to speed up compilation (autowarefoundation#2004)

* Add include guards (autowarefoundation#2003)

* Revert pull request 2004 (autowarefoundation#2010)

* 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

* Use forward declarations to speed up compilation (autowarefoundation#2004)

This reverts commit 84812b9d7516cdecfadad8b6e55c8acc4eb0da5c.

* Remove commented parts (autowarefoundation#2190)

* Use 'autoware_utils::pose2transform' to convert Pose to Transform (autowarefoundation#2191)

* Use Eigen::Map to represent the covariance matrix  (autowarefoundation#2198)

* Add a function to get NDT based on the flag argument  (autowarefoundation#2224)

* Add a transform function (autowarefoundation#2245)

* Add a transform function that wraps 'tf2::doTransform'

* fix always max threads (autowarefoundation#2254)

* fix initial pose queue bug (autowarefoundation#2333)

* 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 under localization (autowarefoundation#553)

* remove matching score package (autowarefoundation#557)

* add ndt_pcl_modified readme (autowarefoundation#599)

* add ndt_pcl_modified readme

* Update localization/pose_estimator/ndt_scan_matcher/ndt_pcl_modified/README.md

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

* Update localization/pose_estimator/ndt_scan_matcher/ndt_pcl_modified/README.md

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

* apply pre-commit

* modify readme

* modify readme

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

* Create README.md (autowarefoundation#601)

* add ndt_scan_matcher readme (autowarefoundation#690)

* add ndt_scan_matcher readme

* Update localization/pose_estimator/ndt_scan_matcher/ndt_scan_matcher/README.md

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

* Update localization/pose_estimator/ndt_scan_matcher/ndt_scan_matcher/README.md

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

* update readme

* update readme

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

* move autoware_localization_srvs package (autowarefoundation#689)

* move autoware_localization_srvs package

* apply pre-commit

* rename pose_with_cov to pose_with_covariance

* apply pre-commit

* 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]>

Co-authored-by: mitsudome-r <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Daichi Murakami <[email protected]>
Co-authored-by: Nikolai Morin <[email protected]>
Co-authored-by: Jilada Eccleston <[email protected]>
Co-authored-by: nik-tier4 <[email protected]>
Co-authored-by: Servando <[email protected]>
Co-authored-by: Kosuke Murakami <[email protected]>
Co-authored-by: Daisuke Nishimatsu <[email protected]>
Co-authored-by: YamatoAndo <[email protected]>
Co-authored-by: Yuma Nihei <[email protected]>
Co-authored-by: Autoware <[email protected]>
Co-authored-by: Taichi Higashide <[email protected]>
Co-authored-by: ito-san <[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: Kosuke Takeuchi <[email protected]>
Co-authored-by: Keisuke Shima <[email protected]>
Co-authored-by: pre-commit <[email protected]>
Co-authored-by: Hiroki OTA <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Takeshi Ishita <[email protected]>
Co-authored-by: RyuYamamoto <[email protected]>
Co-authored-by: Yukihiro Saito <[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: Satoshi OTA <[email protected]>
Co-authored-by: Makoto Kurihara <[email protected]>
Co-authored-by: purewater0901 <[email protected]>
Co-authored-by: Fumiya Watanabe <[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]>
miursh added a commit to miursh/autoware.universe that referenced this pull request Jul 12, 2022
* release v0.4.0

* add convertToXYZCloud (#706)

* Fix/concat mutex bug (#711)

* modify defautl value

Signed-off-by: Yamato Ando <[email protected]>

* fix bug

Signed-off-by: Yamato Ando <[email protected]>

* fix mutex bug

Signed-off-by: Yamato Ando <[email protected]>

* bug fix and reduce calc cost (#708)

* bug fix and reduce calc cost

Signed-off-by: Yukihiro Saito <[email protected]>

* fixed bug

Signed-off-by: Yukihiro Saito <[email protected]>

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

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

* fix bug, and check azimuth

Signed-off-by: Yamato Ando <[email protected]>

* reduce calc cost

Signed-off-by: Yukihiro Saito <[email protected]>

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

* Fix/ring outlier filter bug (#762)

* fix bug, and check azimuth

Signed-off-by: Yamato Ando <[email protected]>

* reduce calc cost

Signed-off-by: Yukihiro Saito <[email protected]>

* fix bug

Signed-off-by: Yukihiro Saito <[email protected]>

* change default param

Signed-off-by: Yukihiro Saito <[email protected]>

Co-authored-by: Yamato Ando <[email protected]>

* remove ROS1 packages temporarily

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

* Revert "remove ROS1 packages temporarily"

This reverts commit bcab06f1790bbe6d2441ad18a6430fde31ca483e.

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

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

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

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

* add crop box filter

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

* arrange make order

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

* port voxel grid downsample filter

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

* port pointcloud accumulator

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

* port compare map filters

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

* port outlier filters

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

* port passthrough filters

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

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

* add parameter service callback (port dynamic reconfigure)

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

* remove unused file

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

* fix: add missing return

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

* add input/output_frame parameter service callback in Filter class

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

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

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

* fix pcl::getPointCloudDifference deprecate

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

* add License

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

* fix cmake compile options

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

* fix warning

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

* move init & subscribe functions to constructor

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

* port ring_passthrough_filter.launch.xml

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

* fix component register plugin name

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

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

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

* add default value for concat_data args

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

* add preprocessor.launch.py

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

* remove old file

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

* add ros parameter initialization

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

* remove unused files

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

* apply clang format

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

* replace _exe to _node for executable

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

* remove unused main.cpp

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

* minor fix: change param name

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

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

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

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

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

* fix tf (#232)

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

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

Co-authored-by: Taichi Higashide <[email protected]>

* Add livox_tag_filter (#368)

* Add livox_tag_filter (#1140)

* Add livox_tag_filter

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

* Remove dependency of livox_ros_driver

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

[livox_tag_filter] port to ROS2

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

* fix test failures

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

* Move livox_tag_filter under livox/ directory

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

* address review comments

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

* fix lint test error

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

* make livox_tag_filter_node to component

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

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

* Add tier4_pcl_extensions (#1162) (#377)

* Add tier4_pcl_extensions (#1162)

* Add tier4_pcl_extensions

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

* Move to sensing/preprocessor/pointcloud

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

port to ROS2

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

* fix lint errors

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

* fix include brackets

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

* add dependency to pcl

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

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

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

* 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 <[email protected]>
Co-authored-by: taikitanaka3 <[email protected]>

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

* Fix concatenate data (#396)

* Remove std msgs from concatenate data

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

* Adaptive timer

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

* Fix lint

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

* Sensor data qos (#407)

* Use sensor data qos for pointcloud preprocessor

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

* Use sensor data qos for pointcloud

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

* Fix lint

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

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

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

* Fix lint

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

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

* Fix topic name in pointcloud preprocessor (#422)

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

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

* Fix diagnostics api (#1185)

* Fix diagnostics api

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

* Don't overwrite level

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

* Overwrite level of No Fault diagnostics

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

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

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

* Filter hazard_status (#1191)

* Filter hazard_status

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

* Filter leaf diagnostics

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

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

Co-authored-by: Taichi Higashide <[email protected]>
Co-authored-by: ito-san <[email protected]>
Co-authored-by: tkimura4 <[email protected]>

* add use_sim-time option (#454)

* Format launch files (#1219)

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

* Fix for rolling (#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]>

* Use unique ptr publish in filters (#1240)

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

* Remove invalid warning of concatenate data (#1245)

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

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

* Remove use_sim_time for set_parameter (#1260)

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

* Porting small fix (#1288)

* Delete unused code (#1183)

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

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

* Add comments for livox tag (#1188)

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

* Clear return value (#1193)

* Change tracker model of unknown object (#1204)

* treat polygon points as relative (#1205)

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

* 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 <[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 lint errors (#1378)

* Fix lint errors

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

* Fix variable names

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

* Use transient_local sub for compare_map_filter (#1437)

* Use transient_local sub for compare_map_filter

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

* Rename nn_dists

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

* Remove pointcloud_to_laserscan (#1508)

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

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

* Remove unnecessary depends

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

* Use ament_cmake_auto

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

* Add concatenate_date diagnostic (#1808)

* Add concatenate_date diagnostic

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

* Fix spell transed -> transformed

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

* Remove unused functions

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

* Fix output topic name

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

* Remove pub_concat_status

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

* Remove concat_num and not_subscribed_topic_names publisher

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

* 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 <[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 (#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 vector_map_filter downsample (#1847)

* Fix vector_map_filter downsample

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

* Fix spell

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

* Reserve centralized_cloud

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

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

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

* 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 <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>

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

* Add message_filters unsubscribe

* Use filter unsubscribe for compare_elevation_map (#2049)

* Use filter unsubscribe for compare_elevation_map

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

* Use override instead of virtual

* Add including header for clang-tidy

* Add missing dependencies of diagnostic_updater (#2242)

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

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

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

* Fix typo

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

* Fix file name in README

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

* pre-commit fixes

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

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

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

* pre-commit fixes

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

* Update build_depend.repos

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

* Fix message type in readme

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

* Fix topic name in readme

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

* Fix lint

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

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

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

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

* Fix lint

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

Co-authored-by: Shunsuke Miura <[email protected]>
Co-authored-by: Yukihiro Saito <[email protected]>

* Fix build warning (#1745)

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

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

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

Co-authored-by: Maxime CLEMENT <[email protected]>

* Rename files

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

* Porting to ros2

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

* pre-commit fixes

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

* Fix typo

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

* Fix launch namespace

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

* Fix parameter type

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

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

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

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

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

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

Fix -Wunused-private-field

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

Fix -Wunused-lambda-capture

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

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

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

Fix -Wrange-loop-construct

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

Ignore lint error

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

* Feature/distortion corrector (#1782)

* Fix/preprocessor format (#1921)

* Enable uncrustify

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

* Apply uncrustify

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

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

Fix cpplint

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

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

* 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 <[email protected]>
Co-authored-by: Shinnosuke Hirakawa <[email protected]>

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

* cosmetic change

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

* 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 <[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 (#500)

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

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

* 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 <[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 (#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 <[email protected]>
Co-authored-by: taikitanaka <[email protected]>

* fix topic name (#2266)

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

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

* [motion_velocity_smoother] ignore debug print (#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 (#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 (#2295)

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

* [mpc_follower] remove stop distance condition from stopState decision (#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 (#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 <[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 (#2281)

* Fix side shift planner (#2171) (#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 (#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 <[email protected]>

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

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

* [hotfix] 1 path point exception after resampling (#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 (#2211)

* Fix lane ids

* Prevent acceleration on avoidance (#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 (#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 <[email protected]>

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

* 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 <[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 (#2305) (#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 (#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 <[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  (#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 <[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  (#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 (#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 (#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 <[email protected]>

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

* add offset param

* clang-format

Co-authored-by: Akihito OHSATO <[email protected]>

* Feature/add doc for keep braking function at driving state (#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 (#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 (#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 <[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]>

Co-authored-by: mitsudome-r <[email protected]>
Co-authored-by: Taichi Higashide <[email protected]>
Co-authored-by: YamatoAndo <[email protected]>
Co-authored-by: Yukihiro Saito <[email protected]>
Co-authored-by: Daichi Murakami <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Nikolai Morin <[email protected]>
Co-authored-by: Takamasa Horibe <[email protected]>
Co-authored-by: Frederik Beaujean <[email protected]>
Co-authored-by: Jilada Eccleston <[email protected]>
Co-authored-by: Ryohsuke Mitsudome <[email protected]>
Co-authored-by: Autoware <[email protected]>
Co-authored-by: Kosuke Murakami <[email protected]>
Co-authored-by: Daisuke Nishimatsu <[email protected]>
Co-authored-by: taikitanaka3 <[email protected]>
Co-authored-by: RyuYamamoto <[email protected]>
Co-authored-by: Kazuki Miyahara <[email protected]>
Co-authored-by: ito-san <[email protected]>
Co-authored-by: tkimura4 <[email protected]>
Co-authored-by: s-azumi <[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: Kosuke Takeuchi <[email protected]>
Co-authored-by: Takeshi Ishita <[email protected]>
Co-authored-by: Keisuke Shima <[email protected]>
Co-authored-by: Shunsuke Miura <[email protected]>
Co-authored-by: Maxime CLEMENT <[email protected]>
Co-authored-by: davidw <[email protected]>
Co-authored-by: Shinnosuke Hirakawa <[email protected]>
Co-authored-by: Satoshi OTA <[email protected]>
Co-authored-by: Takayuki Murooka <[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: taikitanaka <[email protected]>
Co-authored-by: Makoto Kurihara <[email protected]>
Co-authored-by: purewater0901 <[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: Akihito OHSATO <[email protected]>
miursh pushed a commit to miursh/autoware.universe that referenced this pull request Jul 12, 2022
* release v0.4.0

* Fixed uninitialized variable. (autowarefoundation#763)

* Fixed various bugs. (autowarefoundation#768)

* Fixed various bugs.

* Fixed wrong status report of NIC.

* Added the mode of CPU Usage to check statistics calculated as averages among all processors by default. (autowarefoundation#788)

* fix uninitialized variables (autowarefoundation#816)

* remove ROS1 packages temporarily

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

* Revert "remove ROS1 packages temporarily"

This reverts commit a9436882d50dc09fa5b8d6c0a151a10def76b242.

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 system monitor to ros2 (autowarefoundation#71)

* Implement a utility function that spins and updates a monitor node.

* Port cpu monitor

* Port hdd monitor.

* Port mem_monitor to ROS2

* Port  net_monitor to ROS2

* Port  ntp_monitor to ROS2

* Port  process_monitor to ROS2

* Port GPU_monitor to ROS2

* Port msr_reader and hdd_reader to ROS2

* Clean up the build and launch files:

* Clean up and comment on CMake and package files.
* Port the launch file to ROS2

* 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: system_monitor (autowarefoundation#207)

* Add linters

* Fix clang-tidy error in util.hpp

* Ros2 v0.8.0 system monitor (autowarefoundation#276)

* fix dependency of system_monitor

Signed-off-by: Takagi, Isamu <[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]>

* Exclude SwPowerCap as an error. (autowarefoundation#1146) (autowarefoundation#364)

Co-authored-by: ito-san <[email protected]>

* [Update v0.9.0] system monitor (autowarefoundation#365)

* Disable CPU Load Average warning. (autowarefoundation#1147)

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

* Fix cpu_monitor respawning forever. (autowarefoundation#1150)

* Disable cpu_temperature in planning simulation (autowarefoundation#1151)

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

* Net Monitor: Handle as an error if specified device not exist. (autowarefoundation#1152)

* Handled as an error if specified device not exist.

* Disable network diags in simulation

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

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

* apply ament_uncrustify

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

* Disable resource monitoring in planning_simulator (autowarefoundation#1172)

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

* Treat logging errors as safe faults (autowarefoundation#1164)

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

* Fix test code of system_monitor (autowarefoundation#1178)

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

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

* Use thread for ntpdate. (autowarefoundation#1160) (autowarefoundation#375)

* Use thread for ntpdate. (autowarefoundation#1160)

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

* removed unused variable

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

* Import v0.9.1 (autowarefoundation#431)

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

* Add obstacle_crush diagnostic (autowarefoundation#1186)

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

* Fix diagnostics api (autowarefoundation#1185)

* Fix diagnostics api

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

* Don't overwrite level

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

* Overwrite level of No Fault diagnostics

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

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

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

* Filter hazard_status (autowarefoundation#1191)

* Filter hazard_status

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

* Filter leaf diagnostics

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

* Fix wrong calculation of available memory. (autowarefoundation#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. (autowarefoundation#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 (autowarefoundation#1190)

* fix yaw-smoothing bug (autowarefoundation#1198)

* Fix lint

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

Co-authored-by: Taichi Higashide <[email protected]>
Co-authored-by: ito-san <[email protected]>
Co-authored-by: tkimura4 <[email protected]>

* Fix typo in system module (autowarefoundation#434)

* Fix typo in system module

* Change variable name

* Move comments

* Apply uncrustify

* Split system_monitor config (autowarefoundation#452)

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

* Remove unnecessary diagnostic update. (autowarefoundation#455)

* add use_sim-time option (autowarefoundation#454)

* 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]>

* Fix issues in gpu_monitor (autowarefoundation#1248)

* Fix issues in gpu_monitor
* Fix uninitialized variables
* Use range-based for loop
* Fix compile errors of tegra_gpu_monitor
* Replace C-style to C++-style

* Make iterators const

* Fix fmt::format() usage error

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

* Remove use_sim_time for set_parameter (autowarefoundation#1260)

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

* [system_monitor] change some nodes into components (autowarefoundation#1234)

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

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

* add system_monitor.launch.py (autowarefoundation#1238)

* add system_monitor.launch.py

* refactor system_monitor.launch.py

* fix launch bug

* fix typo

* fix launch py

* fix param loading

* format code

* fix system monitor executor to publish diagnostics asynclonously (autowarefoundation#1283)

* 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 kernel CPU usage. (autowarefoundation#1465)

* Add kernel CPU usage.

* Change CPU x: usage to CPU x: total.

* Changed variable name.

* 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 system monitor (autowarefoundation#1723)

* fix for hdd_monitor

* fix no initialization and warning

* change command for ntp_monitor (autowarefoundation#1705)

* [EVT4-403] change command for ntp_monitor

* [EVT4-403] fixed CI build error

* [EVT4-403] fixed cpplint error

* delete executeChronyc thread, fix error topic and log output code

* fix cpplint error and code style divergence

* fix cpplint error(missing correction)

* Fix MD029 (autowarefoundation#1813)

Signed-off-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]>

* add gpu usage per process (autowarefoundation#1798)

* add gpu usage per process

* change illegal usage(4294967295%) to 0%, and fix CI running errors

* Replace gettimeofday with rclcpp::Node::now().

* Fix uncrustify error.

* Replace rclcpp::Node::now() with rclcpp::Clock(RCL_SYSTEM_TIME).

Co-authored-by: ito-san <[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]>

* suppress warnings for system directory autowarefoundation#2046

* 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 execution time logging. (autowarefoundation#2066)

* 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]>

* 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)

Co-authored-by: mitsudome-r <[email protected]>
Co-authored-by: ito-san <[email protected]>
Co-authored-by: Kazuki Miyahara <[email protected]>
Co-authored-by: Nikolai Morin <[email protected]>
Co-authored-by: Yunus Emre Çalışkan <[email protected]>
Co-authored-by: Jilada Eccleston <[email protected]>
Co-authored-by: Daisuke Nishimatsu <[email protected]>
Co-authored-by: Takagi, Isamu <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Ryohsuke Mitsudome <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Taichi Higashide <[email protected]>
Co-authored-by: Takamasa Horibe <[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: Takeshi Miura <[email protected]>
Co-authored-by: Takeshi Miura <[email protected]>
Co-authored-by: wep21 <[email protected]>
Co-authored-by: Hiroki OTA <[email protected]>
Co-authored-by: v-kitahara8153 <[email protected]>
Co-authored-by: ito-san <[email protected]>
Co-authored-by: Keisuke Shima <[email protected]>
Co-authored-by: taikitanaka3 <[email protected]>
miursh pushed a commit to miursh/autoware.universe that referenced this pull request Jul 12, 2022
* Feature/awapi awiv adapter first pr (autowarefoundation#685)

* add base file of awapi_awiv_adapter

* publish autoware status

* update readme

* fix readme

* rename file

* add relay topic

* change msg name

* publish autoware status

* update readme

* add new message

* add lane change topic, obstacle avoidance topic

* update readme

* fix readme

* add namespace

* rename lane change available

* fix readme

* change pub hz

* change topic name

* change control mode and add gate_mode

* fix readme

* update readme

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

* fix typo (autowarefoundation#687)

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

* move msg file to autoware_api_msgs (autowarefoundation#693)

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

* Fix/awapi awiv adapter (autowarefoundation#698)

* subscribe global rpt

* update readme

* update readme

* add warning

* fix readme

* update readme

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

* add check mark for awapi readme (autowarefoundation#723)

* add check mark for awapi readme

* add blank

* add blank

* add blank

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

* Feature/stop reason api (autowarefoundation#729)

* fix indent of readme

* add mock of stop reason aggregator

* add constptr to stop reason

* aggregate message

* add empty handling

* add nullptr handling

* fix bug

* update readme

* fix bug

* remove unused ifdef

* unify same reason msg to stop factor

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

* modify put/goal -> put/route (autowarefoundation#736)

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

* Feature/add goal api (autowarefoundation#734)

* add  goal api

* add msg

* update readme

* add  const auto

* clean code

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

* Feature/extract leaf diag info (autowarefoundation#741)

* add mock function of extract leaf diag

* remove parent diag

* change method of isLeaf

* clean code

* change varibale/function name

* remove string predefine

* update readme

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

* update awapi readme (autowarefoundation#747)

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

* Feature/change output awapi (autowarefoundation#782)

* change ouput of awapi

* change error output to warn

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

* Feature/add battery to awapi (autowarefoundation#804)

* implement battery fuel

* update readme

* add getGearInfo

* fix message name

* set default value:nan to battery

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

* remove ROS1 packages temporarily

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

* Revert "remove ROS1 packages temporarily"

This reverts commit c85c1d6789b1a1e63c6b4e60fa4f3296dfb12e74.

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

* add COLCON_IGNORE to ros1 packages

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

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

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

* Port awapi_awiv_adapter to ROS2 (autowarefoundation#51)

* Port autoware_api_msgs to ROS2

* Integrate topic_tools

* Don't inherit from Node, convert to milliseconds

* Remove _node suffix from non-node loggers

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

* Rename h files to hpp (autowarefoundation#142)

* Change includes

* Rename files

* Adjustments to make things compile

* Other packages

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

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

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

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

* Use quotes for includes where appropriate

* Fix lint tests

* Make tests pass hopefully

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

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

* Run uncrustify on the entire Pilot.Auto codebase

* Exclude open PRs

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

* Add linters (autowarefoundation#227)

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

* Ros2 v0.8.0 awapi awiv adapter (autowarefoundation#282)

Signed-off-by: tanaka3 <[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]>
Signed-off-by: tanaka3 <[email protected]>

* Ros2 v0.8.0 remove std msgs awapi (autowarefoundation#348)

* [autoware_vehicle_msgs] add BatteryStatus msg

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

* [autoware_planning_msgs] add ExpandStopRange and StopSpeedExceeded messages

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

* [autoware_api_msgs] add DoorControlCommand, StopCommand, and VelocityLimit messages

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

* remove std_msgs related to autoware_awaiv_adapter node

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

* apply ament_uncrustify

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

* fix build failure

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

* fix test failures

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

* address review commends

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

* Awapi update v0.9.0 (autowarefoundation#350)

* Feature/add current maxvel to awapi (autowarefoundation#1142)

* add current max vel to awapi

* add readme

* apply format

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

* fix build error

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

* Add missing return (autowarefoundation#1170)

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

* fix cast type

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

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

* [awapi_awiv_adapter] fix bug in the launch file (autowarefoundation#391)

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

* modify pose_initialize for foa  (autowarefoundation#382)

* pose_initialize for foa (autowarefoundation#1171)

* pose_initialize for foa

Signed-off-by: Yamato ANDO <[email protected]>

* rename topic

Signed-off-by: Yamato ANDO <[email protected]>

* fix topic name

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

* fix topic name (autowarefoundation#404)

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

* [awapi_awiv_adapter] fix qos for some of the topics in awapi_awiv_adapter (autowarefoundation#413)

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

* Fix transform (autowarefoundation#420)

* Replace rclcpp::Time(0) by tf2::TimePointZero() in lookupTransform

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

* Fix canTransform

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

* Fix test

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

* Fix typo in awapi module (autowarefoundation#438)

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

* Import v0.9.1 (autowarefoundation#431)

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

* Add obstacle_crush diagnostic (autowarefoundation#1186)

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

* Fix diagnostics api (autowarefoundation#1185)

* Fix diagnostics api

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

* Don't overwrite level

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

* Overwrite level of No Fault diagnostics

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

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

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

* Filter hazard_status (autowarefoundation#1191)

* Filter hazard_status

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

* Filter leaf diagnostics

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

* Fix wrong calculation of available memory. (autowarefoundation#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. (autowarefoundation#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 (autowarefoundation#1190)

* fix yaw-smoothing bug (autowarefoundation#1198)

* Fix lint

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

Co-authored-by: Taichi Higashide <[email protected]>
Co-authored-by: ito-san <[email protected]>
Co-authored-by: tkimura4 <[email protected]>
Signed-off-by: tanaka3 <[email protected]>

* add tl overwriter relay in awapi (autowarefoundation#451)

* add tl overwriter relay in awapi

* add missed topic type

* fix typo of topic name

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

* add use_sim-time option (autowarefoundation#454)

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

* Format launch files (autowarefoundation#1219)

Signed-off-by: Kenji Miyake <[email protected]>
Signed-off-by: tanaka3 <[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]>
Signed-off-by: tanaka3 <[email protected]>

* Awapi relay component (autowarefoundation#1237)

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

* Refine BSD license name (autowarefoundation#1244)

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]>

* Clear hazard level when ignored (autowarefoundation#1200) (autowarefoundation#1289)

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

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

* fix flake8 (autowarefoundation#1306)

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

* Add perception traffic light state output (autowarefoundation#1302)

* Add perception traffic light state output

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

* Modify message type

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

* Apply message type to relay

Signed-off-by: Takagi, Isamu <[email protected]>
Signed-off-by: tanaka3 <[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]>
Signed-off-by: tanaka3 <[email protected]>

* change msg type looking traffic light state (autowarefoundation#1494)

* change msg type looking traffic light state (autowarefoundation#1455)

* change msg type looking traffic light state

* fix msg name

* using namespace

* change function name

* fix typo

* add readme

* Update awapi/awapi_awiv_adapter/Readme.md

fix typo

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

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

* Remove deprecated message include

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

* Fix lint

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

Co-authored-by: tkimura4 <[email protected]>
Co-authored-by: Yukihiro Saito <[email protected]>
Signed-off-by: tanaka3 <[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]>
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]>

* 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]>
Signed-off-by: tanaka3 <[email protected]>

* Add autoware api (autowarefoundation#1979)

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

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

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

* Move launch file of external_cmd_selector (autowarefoundation#2017)

* Move launch file of external_cmd_selector

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

* Add copyright

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

* Use DeclareLaunchArgument

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

* Fix external command api name

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

* Move common parameters

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

* Fix format

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

* Fix format

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

* 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]>
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 awapi_autoware_state_publisher (autowarefoundation#2085)

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

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

* Add behavior path planner pkg with Lane Change (autowarefoundation#1525)

* add lanelet extension funcs

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

* add planning msgs for FOA

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

* add behavior_path_planner pkg

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

* apply clang format

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

* add error handling for config load failure

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

* replace word: foa with remote control

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

* add readme

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

* use pointer for return value of path

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

* fix hz

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

* remove debug print

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

* remove shide-shift & avoidance related files

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

* Clip path by goal

* add build depend for behavior tree cpp

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

* temporally disable lint test in lanelet2_extension

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

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

* Add avoidance module in behavior_path_planner (autowarefoundation#1528)

* Revert "remove shide-shift & avoidance related files"

This reverts commit d819ea0291fca251012e4b9ffd16de3896830aa2.

* refactor findNewShiftPoint func

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

* remove duplicated decleration

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

* fix barkward length issue
 - add clipPathLenght func in avoidance

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

* refactor:
 - translate english
 - minor modification for traffic distance

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

* support debug marker in behavior_path_planner

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

* clean up side shift module

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

* change topic name

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

* remove japanese

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

* Update planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/include/behavior_path_planner/scene_module/side_shift/side_shift_module.hpp

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

* fix typo

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

* remove unused var

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

* adress reviewer comments:
 - add const for variables
 - add comment
 - fix typo

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

* fix typo

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

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

* Replace behavior_path utilities with autoware_utils (autowarefoundation#1532)

* replace calcDistance

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

* replace arange

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

* replave convertToEigenPt with autoware_utils::fromMsg

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

* replace normalizeRadian

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

* cosmetic change

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

* import autowarefoundation#1526 into behavior path planner (autowarefoundation#1531)

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

* Fix/behavior path empty path output guard (autowarefoundation#1536)

* add guard

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

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

* fix lateral jerk calculation (autowarefoundation#1549)

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

* fix: error handling on exception in behavior_path_planner (autowarefoundation#1551)

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

* Fix ignore too steep avoidance path (autowarefoundation#1550)

* ignore too steep path

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

* parametrize lateral jerk limit

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

* Update planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/include/behavior_path_planner/scene_module/avoidance/avoidance_module.hpp

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

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

* use offsetNoThrow and add error log (autowarefoundation#1615)

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

* Ignore object ahead goal for avoidance (autowarefoundation#1618)

* Ignore object ahead goal for avoidance

* Add flag

* Fix position of definition of goal_pose

* Fix arclength calculation

* Fix position of definition of goal_pose

* fix intersection stop line (autowarefoundation#1636)

* fix intersection stop line

* fix typo

* add document (autowarefoundation#1635)

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

* Port behavior path planner to ros2

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

* Apply lint

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

* Fix typo

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

* Fix map qos

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

* 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]>

* Address review: Fix config file name

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

* pre-commit fixes

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

* Fix redeclaring parameters

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

* Add missing tf2 geometry function

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

* Apply lint

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

* Fix rclcpp Time initialization

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

* Use now() instead of msg stamp

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

* Use throttle output in getExpandedLanelet

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

* Add missing const

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

* Fix lint

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

Co-authored-by: Takamasa Horibe <[email protected]>
Co-authored-by: rej55 <[email protected]>
Co-authored-by: Yukihiro Saito <[email protected]>
Co-authored-by: tkimura4 <[email protected]>
Co-authored-by: Takayuki Murooka <[email protected]>
Signed-off-by: tanaka3 <[email protected]>

* 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]>
Signed-off-by: tanaka3 <[email protected]>

* Fix/update max velocity topic name (autowarefoundation#2236)

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 awapi awiv adapter to .auto (autowarefoundation#554)

* Remove COLCON_IGNORE

* Change AutowareState

* Change EmergencyState

* Change HazardStatus

* Split file for convert function

* Change Path

* Change Trajectory

* Change ControlMode

* Change Shift

* Change TurnSignal and move converter

* Change Steering

* Change VehicleCommand

* Fix EmergencyState

* Fix for pre-commit

* Move autoware state converter

* Fix control comand

* Change TwistStamped

* Remove unused header

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

* Use pacmod3 msgs (autowarefoundation#610)

* Migration to pacmod3 msgs

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

* Fix action for pacmod

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

* Run pre-commit

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

* fix package.xml (autowarefoundation#630)

Co-authored-by: Takayuki Murooka <[email protected]>
Signed-off-by: tanaka3 <[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

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

* fix awapi topics (autowarefoundation#685)

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

* fix mixed route topic (autowarefoundation#695)

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

* Fix/psim topics emergency handler awapi (autowarefoundation#702)

* fix emergency handler

* fix awapi

* remove unused topic

* remove duplecated vehicle cmd

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

* Fix topic type of awapi relay (autowarefoundation#701)

* Fix topic type of awapi relay

* Fix

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

* fix door cmd topic (autowarefoundation#711)

* fix door cmd topic

* fix topic

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

* Update traffic light topic name (autowarefoundation#729)

* Update traffic light topic name

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

* Update traffic light topic name in perception

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

* Update twist topic name (autowarefoundation#736)

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

* fix: refactor readme

Co-authored-by: Takeshi Miura <[email protected]>

Co-authored-by: tkimura4 <[email protected]>
Co-authored-by: hiroyuki obinata <[email protected]>
Co-authored-by: mitsudome-r <[email protected]>
Co-authored-by: Nikolai Morin <[email protected]>
Co-authored-by: Jilada Eccleston <[email protected]>
Co-authored-by: Daisuke Nishimatsu <[email protected]>
Co-authored-by: Ryohsuke Mitsudome <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Kazuki Miyahara <[email protected]>
Co-authored-by: Taichi Higashide <[email protected]>
Co-authored-by: ito-san <[email protected]>
Co-authored-by: Shigeki Kobayashi <[email protected]>
Co-authored-by: Keisuke Shima <[email protected]>
Co-authored-by: Takagi, Isamu <[email protected]>
Co-authored-by: Yukihiro Saito <[email protected]>
Co-authored-by: Hiroki OTA <[email protected]>
Co-authored-by: Keisuke Shima <[email protected]>
Co-authored-by: k-obitsu <[email protected]>
Co-authored-by: Takamasa Horibe <[email protected]>
Co-authored-by: rej55 <[email protected]>
Co-authored-by: Takayuki Murooka <[email protected]>
Co-authored-by: yutaka <[email protected]>
Co-authored-by: purewater0901 <[email protected]>
Co-authored-by: pre-commit <[email protected]>
Co-authored-by: Satoshi OTA <[email protected]>
Co-authored-by: Takayuki Murooka <[email protected]>
Co-authored-by: Takeshi Miura <[email protected]>
boyali referenced this pull request in boyali/autoware.universe Sep 28, 2022
…4#1191)

* feat(obstacle_avoidance_planner): add options for plan_from_ego

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

* Remove adjust weight when planning from ego

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

* Readd near_kinematic_state_while_planning_from_ego as comment

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

* Use calcArcLength

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

* Remove max_plan_from_ego_length from ReferecncePoint

Signed-off-by: kosuke55 <[email protected]>
boyali referenced this pull request in boyali/autoware.universe Oct 3, 2022
…4#1191)

* feat(obstacle_avoidance_planner): add options for plan_from_ego

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

* Remove adjust weight when planning from ego

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

* Readd near_kinematic_state_while_planning_from_ego as comment

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

* Use calcArcLength

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

* Remove max_plan_from_ego_length from ReferecncePoint

Signed-off-by: kosuke55 <[email protected]>
boyali referenced this pull request in boyali/autoware.universe Oct 3, 2022
…4#1191)

* feat(obstacle_avoidance_planner): add options for plan_from_ego

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

* Remove adjust weight when planning from ego

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

* Readd near_kinematic_state_while_planning_from_ego as comment

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

* Use calcArcLength

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

* Remove max_plan_from_ego_length from ReferecncePoint

Signed-off-by: kosuke55 <[email protected]>
yukke42 pushed a commit to tzhong518/autoware.universe that referenced this pull request Oct 14, 2022
…warefoundation#1191)

* feat(obstacle_avoidance_planner): add options for plan_from_ego

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

* Remove adjust weight when planning from ego

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

* Readd near_kinematic_state_while_planning_from_ego as comment

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

* Use calcArcLength

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

* Remove max_plan_from_ego_length from ReferecncePoint

Signed-off-by: kosuke55 <[email protected]>
boyali referenced this pull request in boyali/autoware.universe Oct 19, 2022
…4#1191)

* feat(obstacle_avoidance_planner): add options for plan_from_ego

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

* Remove adjust weight when planning from ego

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

* Readd near_kinematic_state_while_planning_from_ego as comment

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

* Use calcArcLength

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

* Remove max_plan_from_ego_length from ReferecncePoint

Signed-off-by: kosuke55 <[email protected]>
saka1-s pushed a commit to saka1-s/autoware.universe that referenced this pull request Apr 8, 2024
…cicle_pedestrian_prediction_issue

feat: fix lv4 bicycle pedestrian prediction issue
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