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

This reverts commit a78b36113cc2ea65f3fc1c3488a363651b679881.

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

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

* port freespace plannet to ros2

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

* fix from review : add buildtool dependence & change function name to camelCase

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

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

…autowarefoundation#131)

* Change includes

* Rename files

* Adjustments to make things compile

* Other packages

…ation#143)

* Use quotes for includes where appropriate

* Fix lint tests

* Make tests pass hopefully

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

…ation#275)

* fix typos in planning

* fix corresponding typos in planning

* revert fixed typos temporarily due to its impact on launchers

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

* Fix topic name of lane_departure_checker debug

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

* Fix topic name of mpc_follower debug

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

* Fix topic name of velocity_controller debug

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

* Fix topic name of motion_velocity_optimizer debug

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

* Fix topic name of lane_change_planner debug

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

* Fix topic name of behavior_velocity_planner debug

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

* Fix topic name of obstacle_avoidance_planner debug

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

* Fix topic name of behavior_velocity_planner

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

* Fix topic name of motion_velocity_optimizer

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

* Fix topic name of lane_departure_checker

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

* Fix topic name of mpc_follower

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

* Fix topic name of behavior_velocity_planner

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

* Fix topic name of velocity_controller

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

* Fix topic name of lane_change_planner

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

* Fix topic name of obstacle_avoidance_planner

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

* Fix topic name of obstacle_stop_planner

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

* Fix topic name of costmap_generator

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

* Fix topic name of freespace_planner

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

* Fix topic name of surround_obstacle_checker

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

* Fix topic name of costmap_generator

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

* Fix topic name of emergency_handler

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

* Fix lint errors

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

* Fix typo

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

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

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

* Rename AstarNavi

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

* uncrustify

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

* update HA* for multiple curvatures (autowarefoundation#1196)

* update HA* for multi-curvature planning

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

* restore param to old one

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

* cosmetic change

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

* Add todo for parameter name change

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

* add freespace planner config yaml (autowarefoundation#1207)

* add freespace planner config yaml

* fixed typo

* fixed comment

* Fix variable names

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

* Fix lint

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

Co-authored-by: Takamasa Horibe <[email protected]>
Co-authored-by: RyuYamamoto <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: wep21 <[email protected]>

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

* 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

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

* Reedsshepp distance as a heuristic function in hybrid A star  (autowarefoundation#1297)

* Use reeds sheep distance

* Use average radius

* Add standalone toy problem

* Cleanup standalone node

* Add plotter

* Add rostest

* Arrange directory

* Better test and plot settings

* Following PEP & small fix cpp

* Avoid repeted heap allocation

* Standalone reeds-shepp

* Licence notice

* Use struct instead of raw array

* Update license

* Removed comment

* Add how to use python visualizer

* Remove useless methods

* Apply clang-format

* Do not fully expose StateXYT

* Remove StateXYT->q[3] conversion

* Use StateXYZ & remove useless functions

* Add license in test

* Update planning/scenario_planning/parking/astar_search/include/astar_search/astar_search.h

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

* Update planning/scenario_planning/parking/astar_search/src/astar_search.cpp

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

* Install reeds-shepp

* Apply markdownlint

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

* Boost collision checking by pre-caching the collision indexes for all yaw angles  (autowarefoundation#1298)

* Precompute collision index for all theta to accelearte collision

* Add test condition that checks solution's feasibility

* Fix in response to the review

* Update planning/scenario_planning/parking/astar_search/include/astar_search/astar_search.h

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

* Use inline (autowarefoundation#1572)

* Modular planner (autowarefoundation#1492)

* Update

* Check working (NOTE somehow 2x faster than the original... why???)

* Split header and impl

* AstarWaypoint => PlannerWaypoint

* AstarParam => PlannerParam

* Change package name : astar_search => planning_algorithms

* Add override keyword for readability

* Apply clang-format & Add License

* Remove useless executable

* Rearange some functions and members

* Add include guard

* Remove unused node status

* Add virtual destructor

* Rename test names

* Removed duplicate transformPose

* Do not expose transformPose

* Compatible planning_algorithms

* Pointer to AbstractAlgorithm

* Apply clang-format

* Removed needless method declaration

* Renamed planning_algorithms => parking_planning_algorithms

* Add explicit

* Apply clang-format

* Split parameter into PlannerCommonParam and AstarParam

* Tweak

* Remove unused line

* Split rosparam into common_param and astar_param

* Fix package stuff reflect to the chagne of planning_algorithm pkg name

* Change class name

* Small fix (complied! and check running on Autoware)

* Add rosparam : planning_algorithm

* Fix comment and ros_info message

* Remove useless ;

* Add note

* Add namespace

* Fix typo

* Apply clang-format 10

* Remove array3d

* Avoid using std

* Rename: parking => freespace

* Avoid using namespace hoge

* Update readme of freesapce planner

* Apply clang-format

* Update readme for freesplace_planning_algorithms

* [freespace_planning_algorithms] apply aedd8626762121ad7

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

* fix inline definition

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

* rename directory

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

* rename function

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

* Fix bug yaw => index conversion

* modify package.xml: fix license, add author

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

* fix license

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

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

* Fix bug nearest_index must not be greater than the current target_index_  (autowarefoundation#1571)

* Fixbug

* Apply clang-format

* Compute neareset index in the partial trajectory

* extract partial_trajectory from current target trajectory

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

* add explicit guard

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

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

* Cleanup & modify readme freespace planner (autowarefoundation#1607)

* apply clang format

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

* align indent

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

* rename robot_shape -> vehicle_shape

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

* rename step -> distance for TODO

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

* modify include guard

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

* fix comparison warning

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

* update readme

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

* add namespace on ros-parameters

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

* use autoware_utils

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

* align indent

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

* fix comparison warning

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

* Rename files

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

* Remove boost constants

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

* Apply lint

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

* Add missing geometry2 apis

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

* Porting test code to ros2

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

* Apply lint

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

* Install test script

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

* Change file mode of test script

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

* Fix map info data type in test script

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

* Add namespace and message abbreviation

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

* Fix typo

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

* Fix lint

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

* Fix for pre-commit

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

* Fix tf initialization

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

Co-authored-by: Hirokazu Ishida <[email protected]>
Co-authored-by: Takamasa Horibe <[email protected]>
Co-authored-by: tkimura4 <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>

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

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

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

* Copy code of 'vehicle_constants_manager'

* Fix vehicle_constants_manager for ROS galactic

* Rm .iv costmap_generator freespace_planner freespace_planning_aglorihtms

* Add astar_search (from .Auto)

* Copy freespace_planner from .Auto

* Update freespace_planner for .IV

* Copy costmap_generator from .Auto

* Copy and update had_map_utils from .Auto

* Update costmap_generator

* Copy costmap_generator_nodes

* Update costmap_generator_nodes

* Comment out all tests

* Move vehicle_constant_managers to tmp_autoware_auto_dependencies

* ignore pre-commit for back-ported packages

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

* ignore testing

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

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

* Port costmap_generator

* Port freespace_planner