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: add autoware_utils package #7

Merged

Conversation

tkimura4
Copy link
Contributor

Related Issue

#1

Related Link

This PR depends on #4

Description

Add autoware_utils packages from https://github.com/tier4/AutowareArchitectureProposal.iv

How to review

Check the following item

  • Readme

mitsudome-r and others added 30 commits November 30, 2021 13:37
Signed-off-by: mitsudome-r <[email protected]>
Signed-off-by: mitsudome-r <[email protected]>
This reverts commit aaf2f7d3908ee5f865105ea9094ed358ea9d3c75.

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

* Fix function name

* Fix buildtool_depend
* Change includes

* Rename files

* Adjustments to make things compile

* Other packages
* Use quotes for includes where appropriate

* Fix lint tests

* Make tests pass hopefully
)

* Run uncrustify on the entire Pilot.Auto codebase

* Exclude open PRs
* restore file name for v0.8.0 update

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

* Improve autoware utils (autowarefoundation#986)

* Refactor

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

* Add features to autoware_utils

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

* Add lane departure checker (autowarefoundation#928)

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

* Fix/remove duplicated point (autowarefoundation#1107)

* Split PoseDeviaiton functions

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

* Remove unnecessary pose

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

* Don't insert point if duplicated point exists

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

* Fix condition of duplicated points

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

* Rename file name for v0.8.0 update

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

* Add dependencies into package.xml

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

* [autoware_utils]: Fix CMakeLists.txt and package.xml for lint and testing

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

* [autoware_utils]: Fix lint

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

Co-authored-by: Kenji Miyake <[email protected]>
* Add lane departure checker (autowarefoundation#928)

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

* Fix bug of lane_departure_checker (autowarefoundation#1011)

* Fix bug of lane_departure_checker

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

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

* Fix typo

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

* Reduce computational cost of lane_departure_checker (autowarefoundation#1026)

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

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

* Fix typo (autowarefoundation#1062)

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

* [lane_departure_checker]: Port to ROS2

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

* [lane_departure_checker]: Fix lint

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

* [autoware_utils]: Publish autoware debug msgs

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

* [lane_departure_checker]: Use autoware_debug_msgs instead of std_msgs

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

* [goal_distance_calculator]: Use autoware_debug_msgs instead of std_msgs

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

* [autoware_utils]: Add namespace to debug traits

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

* [lane_departure_checker]: Fix lint

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

Co-authored-by: Kenji Miyake <[email protected]>
* restore behavior velocity planner files for v0.8.0 update

* Fix detection area (autowarefoundation#808)

* Remove PASS state

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

* Keep stopping after going over dead-line in STOP state

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

* Clear state after obstacle disappears

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

* Parameterize and change conditions

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

* Refactor

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

* add elapsed time checker

* Refactor

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

* Ignore inserting point if points are too close

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

* Rename NORMAL to GO

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

* Revert "Ignore inserting point if points are too close"

This reverts commit 91c8d620ea11e703611945cb9a50877d175f4ff6.

* Fix small bug

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

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

* fix timing of publish stop reason of stop_line (autowarefoundation#845)

* fix timing of publish stop reason of stop_line

* Fix formatting

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

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

* Fix task registration of detection area module (autowarefoundation#856)

* Fix task registration of detection area module

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

* Fix id of factor_text marker

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

* Do not interpolate if path size is 1 (autowarefoundation#865)

* Revert "restore behavior velocity planner files for v0.8.0 update"

This reverts commit ce07d3c2bfae562d56fec46c4f81d5351fd936a1.

* fix some implement miss

* restore behavior velocity planner files for v0.8.0 update

* change intersection param (autowarefoundation#861)

* Fix/intersection stop line (autowarefoundation#841)

* add trimmed path function

* fix typo

* avoid to insert stop line outside intersection

* Add pass judge flag (autowarefoundation#872)

* Add pass judge flag

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

* Fix wrong format

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

* Fix flag order in judge condition

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

* add ignore width with blind spot (autowarefoundation#864)

* add ignore width with blind spot

* remove unused function

* fix typo

* fix margin

* remove bicycle from intersection stuck vehicle (autowarefoundation#896)

* Revert "restore behavior velocity planner files for v0.8.0 update"

This reverts commit ff61ee56f2ce4728e53eb698836db60d68bf64b9.

* fix implement miss

* restore behavior velocity planner files for v0.8.0 update (fixed)

* Add external traffic light input (autowarefoundation#912)

* Add external traffic light input

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

* Update topic namespace

* Fix typos in planning modules (autowarefoundation#866)

* fix typos in planning

* fix corresponding typos in planning

* revert fixed typos temporarily due to its impact on launchers

* add exception handling to intersection module (autowarefoundation#920)

* add exception handling

* output input path

* prevent passthrough chattering (autowarefoundation#901)

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

* cosnider current_velocity to calculate intersection passing time (autowarefoundation#880)

* cosnider current_velocity to calculate intersection passing time

* add fabs to current velocity

* Improve stuck vehicle detect (autowarefoundation#824)

* intersection: modify stuck vehicle detect logic to consider the object shape

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

* intersection: consider ego-vehicle length when calculate stuck vehicle detection area

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

* intersection: change param stuck_vehicle_ignore_dist: 5.0 -> 7.0

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

* intersection: use vehicle_info/vehicle_length

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

* fix implement miss

* fix target pedestrian (autowarefoundation#927)

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

* fix insert backward point (autowarefoundation#953)

* fix insert backward point

* add comment

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

* remove unnecessary if

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

* Add stop line referred from road marking (autowarefoundation#968)

* Add stop line referred from road marking

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

* Add stop line for walkway

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

* Feature/external input (autowarefoundation#982)

* add external input msg

* impl external input(crosswalk, intersection)

* 🚮

* change to ++14

* fix bug

* fix bug

* cosmetic change

* Revert "restore behavior velocity planner files for v0.8.0 update"

This reverts commit ff61ee56f2ce4728e53eb698836db60d68bf64b9.

* Fix typo (autowarefoundation#1013)

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

* Fix/blind spot insert point (autowarefoundation#1027)

* Copy insert point from previous point

* Reset path unless state is stop

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

* change slow down speed (autowarefoundation#1030)

* restore behavior velocity planner files for v0.8.0 update (fixed)

* Fix/walkway stop judge range (autowarefoundation#1028)

* Fix walkway stop judge

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

* Make refer id same

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

* fix getObjectivePolygons() so that intersecting lanelet is added to objective lanelets even when there is no preceeding lanelets (autowarefoundation#1010)

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

* Revert "restore behavior velocity planner files for v0.8.0 update (fixed)"

This reverts commit 39231f23eb17e39a418f28f5ccfe1df55b3fb45c.

* fix implement miss for marker

* restore behavior velocity planner files for v0.8.0 update (fixed)

* Fix/blind spot polygon (autowarefoundation#1056)

* Fix detection area for blind spot

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

* Apply clang format

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

* Shrink conflicting area

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

* chane slowdown judgement (autowarefoundation#1066)

* chane slowdown judgement

* cosmetic change

* Revert "restore behavior velocity planner files for v0.8.0 update (fixed)"

This reverts commit 39231f23eb17e39a418f28f5ccfe1df55b3fb45c.

* fixed for ros2 style

* restore behavior velocity planner files for v0.8.0 update (fixed)

* Remove unused headers in behavior_velocity_planner (autowarefoundation#1072)

* publish walkway stop reason (autowarefoundation#1073)

* Revert "restore behavior velocity planner files for v0.8.0 update (fixed)"

This reverts commit 39231f23eb17e39a418f28f5ccfe1df55b3fb45c.

* restore behavior velocity planner files for v0.8.0 update (fixed)

* Add correspondence marker of detection_area and stop_line (autowarefoundation#1081)

* Fix comment

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

* Add const

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

* Add correspondence marker of detection_area and stop_line

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

* Add obstacle marker

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

* Fixup

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

* Add id marker

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

* Clear state when time rollback found

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

* Fix typo

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

* change stop to polygon line

* apply clang format

* fix code

* fix bug

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

* Fix pass judge idx (autowarefoundation#1090)

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

* fix bug (autowarefoundation#1087)

* Revert "restore behavior velocity planner files for v0.8.0 update (fixed)"

This reverts commit 39231f23eb17e39a418f28f5ccfe1df55b3fb45c.

* fix for ros2 style

* restore behavior velocity planner files for v0.8.0 update (fixed)

* Fix/remove duplicated point (autowarefoundation#1107)

* Split PoseDeviaiton functions

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

* Remove unnecessary pose

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

* Don't insert point if duplicated point exists

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

* Fix condition of duplicated points

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

* seperate stop distance param (autowarefoundation#1137)

* seperate stop distance param

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

* apply param for automotically generated stop line

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

* shift slow down line

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

* add param in yaml file

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

* fix prediction_time_margin bug (autowarefoundation#1148)

* Revert "restore behavior velocity planner files for v0.8.0 update (fixed)"

This reverts commit 39231f23eb17e39a418f28f5ccfe1df55b3fb45c.

* fix ros2 style

* remove deprecated

* reformat

* add test temporary launch

* cpp_lint_namespace_what_you_use

* lint_comment_line_length

* pass ament cpplint

* fixe commit

* fix code

* remove unneccesary

* fix param structure

* fix missng params

* fix throttle time

Co-authored-by: tomoya.kimura <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: taichiH <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Fumiya Watanabe <[email protected]>
Co-authored-by: Daisuke Nishimatsu <[email protected]>
Co-authored-by: Kazuki Miyahara <[email protected]>
Co-authored-by: Yukihiro Saito <[email protected]>
Co-authored-by: Takamasa Horibe <[email protected]>
Co-authored-by: Kosuke Murakami <[email protected]>
Co-authored-by: Ryohsuke Mitsudome <[email protected]>
* Fix/lane departure checker (autowarefoundation#1177)

* Add more processing time measurement

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

* Rename processing_time to processing_time_ms

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

* Refactor StopWatch class

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

* apply ament_uncrustify

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

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

* Apply format

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

* Add <memory>

Signed-off-by: Kenji Miyake <[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]>
* 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]>
* remove dependency on vehicle info in autoware_utils

* delete vehicle_info in autoware_utils
* Add missing namespace to autoware_utils

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

* Add createVehicleInfo

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

* Add rethrow

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

* Format package.xml

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

* Fix usage of autoware_utils

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

* Add missing namespace comment

Signed-off-by: Kenji Miyake <[email protected]>
…owarefoundation#1388) (autowarefoundation#1393)

* add curvature calculation function

* add two functions

* integrate 2 functions into 1 function by template function

* add unit test for curvature calculation

* modify spell

* Update common/util/autoware_utils/include/autoware_utils/math/curvature.h

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

* add modifications

* modify format

* update

* update

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

Co-authored-by: purewater0901 <[email protected]>
Co-authored-by: Kazuki Miyahara <[email protected]>
…utowarefoundation#1438)(autowarefoundation#1416)(autowarefoundation#1473)(autowarefoundation#1491) (autowarefoundation#1482)

* Add closest point index calculation function in autoware_utils (autowarefoundation#1410)

* add nearest point calculator

* update

* add template

* update

* update

* update

* update variables name

* update variables name

* remove redundant expression

* add unit test

* update test

* test has some errors

* update

* update name

* update name

* modify bug

* update

* update

* add new test cases

* add new function

* add get pose function

* delete unnecessary file

* update test

* delete namespace

* add emtpy handler

* remove redundant test

* remove template

* add necessary files to autoware_utils (autowarefoundation#1438)

* add necessary files

* Apply fix

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

* fix test

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

* Fix lint

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

* Fix build warning

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

* add some trajectory functions commonly used in planning/control (autowarefoundation#1416)

* add some trajectory functions commonly used in p/c

* minor fix with reviews

* refactor based on reviews

* minor changes

* refactor based on reviews

* minor changes

* minor changes

* refactor based on reviews

* use std::vector<T> and T in findClosestIndex

* fix bugs that I wrote wrong

* refactor

* refactor

* fix bug of including optional.hpp twice

* refactor

* refactor

* fix bug

* fix bugs

* update

* apply clang-format

* add blank line

* add test for searchZeroVelocityIndex

* update

* update

* update

* add some tests

* closest -> nearest

* add some test

* update test

* not to use optional if not necessary

* not unsigned

* add explanation of segment

* update

* 契約プログラミング

* add signed to variable of length

* update

* update

* update

* update test

* update

* update test

* update

* update test

* update

* update

* update

* update

* update

* update

* update

* Remove wrapper for autoware_plannig_msgs

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

* Fix test

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

* Change implementation of calcLongitudinalOffsetToSegment

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

* Set default value for trajectory velocity

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

* Remove unused function

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

* add 3 cases for curve trajectory

* update

* Revert "update"

This reverts commit 6d4f3ee25f49dcca146340c9a1ed3f4c1ac4f55c.

* Revert "add 3 cases for curve trajectory"

This reverts commit d3f4751851afcdac41e160fecbb6bee9ac9f60a2.

* Add test case

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

* Fix comment

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

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

* use template in geometry.hpp (autowarefoundation#1473)

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

* Fix include

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

* Fix errors

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

* Fix license

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

* Fix find nearest segment index (autowarefoundation#1491)

* add odd test case, and confirmed that the test don't pass

* fix findNearestSegmentIndex, and confirmed all the test passed

* use calcLongitudinalOffsetToSegment

* use vector in test

* add deleted comment

Co-authored-by: purewater0901 <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Takayuki Murooka <[email protected]>
Co-authored-by: Takamasa Horibe <[email protected]>
…ation#1513)(autowarefoundation#1522)(autowarefoundation#1463)(autowarefoundation#1503) (autowarefoundation#1544)

* generalize searchZeroVelocityIndex Function (autowarefoundation#1501)

* generalize searchZeroVelocityIndex Function

* update test

* fix test case

* update test case

* update terminal index in the test

* Fix/fix autoware utils geometry (autowarefoundation#1513)

* Revert geometry.cpp

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

* Add default implementations

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

* add constant gravity (autowarefoundation#1522)

* add arange & linspace in math util (autowarefoundation#1463)

* [WIP] add arange & linspace in math util

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

* add unittest cases of arange and linspace

* implement and test arange and linspace in util library

* fix issues found in review

* fix typos

* fix issue found in review

* fix typo

* fix issues found in review

* fix issues found in review

Co-authored-by: nisshan-x <[email protected]>

* extend findNearestIndex, and add tests (autowarefoundation#1503)

* extend findNearestIndex, and add tests

* apply clang-format

* update

* hoge_threshold -> max_hoge

* _min/_max -> min_/max_, and update

* update

* update

* update

* update

* update

* Fix warnings

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

* Add reserve for autoware_utils::arange

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

Co-authored-by: purewater0901 <[email protected]>
Co-authored-by: Takayuki Murooka <[email protected]>
Co-authored-by: Takamasa Horibe <[email protected]>
Co-authored-by: nisshan-x <[email protected]>
* Add update_param.hpp in autoware_utils

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

* Change to bool

Signed-off-by: Kenji Miyake <[email protected]>
@github-actions
Copy link

github-actions bot commented Dec 1, 2021

Documentation URL: https://autowarefoundation.github.io/autoware.universe/pr-7/
Modified files:

@taikitanaka3 taikitanaka3 enabled auto-merge (squash) December 1, 2021 07:02
@taikitanaka3 taikitanaka3 merged commit 00308c4 into autowarefoundation:tier4/proposal Dec 1, 2021
taikitanaka3 added a commit that referenced this pull request Dec 1, 2021
* release v0.4.0

* remove ROS1 packages temporarily

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

* add sample ros2 packages

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

* remove ROS1 packages

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

* Revert "remove ROS1 packages temporarily"

This reverts commit bcc60bdc82842e2ea4d1e844b4442fa613d80fdf.

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

* add COLCON_IGNORE to ros1 packages

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

* Port shift decider to ros2 (#7)

* Update package.xml and CMakeLists.txt to ros2

Code doesn't compile yet

* Code compiles

* Update launch file

* Add better timer

clang-format shift_decider

* 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

* Added linters to shift_decider (#167)

* Added linters to shift_decider

* Fix dependencies

* Use ament_cmake_cppcheck and ament_cmake_cpplint

* Fix linting errors

* add use_sim-time option (#454)

* Unify Apache-2.0 license name (#1242)

* Make control modules components (#1262)

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

* Remove use_sim_time for set_parameter (#1260)

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

* 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 shift decider (#485)

* port shift decider

* apply clang format

* delete colcon ignore

* change to ackermann control command

* remove VehicleStateReport/VehicleStateCommand/VehicleControlCommand (#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]>

* [shift decider] add README.md (#577)

* add readme to shift decider

* better expression

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

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

* Fix topic name (#673)

Co-authored-by: mitsudome-r <[email protected]>
Co-authored-by: Frederik Beaujean <[email protected]>
Co-authored-by: Nikolai Morin <[email protected]>
Co-authored-by: Esteve Fernandez <[email protected]>
Co-authored-by: tkimura4 <[email protected]>
Co-authored-by: Kazuki Miyahara <[email protected]>
Co-authored-by: Daisuke Nishimatsu <[email protected]>
Co-authored-by: Keisuke Shima <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Sugatyon <[email protected]>
Co-authored-by: taikitanaka3 <[email protected]>
Co-authored-by: Fumiya Watanabe <[email protected]>
tkimura4 pushed a commit to tkimura4/autoware.universe that referenced this pull request Dec 10, 2021
* port control launch

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

* fix license

Signed-off-by: Takamasa Horibe <[email protected]>
tkimura4 pushed a commit to tkimura4/autoware.universe that referenced this pull request Dec 10, 2021
* port control launch

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

* fix license

Signed-off-by: Takamasa Horibe <[email protected]>
taikitanaka3 added a commit that referenced this pull request Dec 13, 2021
* release v0.4.0

* load velocity_controller_param.yaml from launcher (#52)

Signed-off-by: Shinnosuke Hirakawa <[email protected]>

* Include enable_slope_compensation to yaml file (#61)

* Sync mpc param (#74)

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

* add stop dist param (#73)

* add stop dist param

* add keep stopping dist param

* removed ROS1 package

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

* Revert "removed ROS1 package"

This reverts commit 85eb34207aa7b90314d93a6eb370213e10fcd7bd.

* add COLCON_IGNORE file to all ROS1 packages

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

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

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

* port control launch (#7)

* port control launch

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

* fix license

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

* ROS2 Linting: control_launch (#29)

* Add linter tests and completepackage dependencies list

* Reorder alphabetically

* Comment out pure_pursuit dependency - not ported yet

* Add back pure_pursuit package post port

* Ros2 port autoware launch (#35)

* [autoware_launch] port CMakelists.txt and remove COLCON_IGNORE

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

* [autoware_launch] fix planning_simulator.launch.xml

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

* [autoware_launch] add rviz config

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

* [autoware_launch] first port of autoware_launch

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

* lanuch rviz with config file

Signed-off-by: kosuke murakami <[email protected]>

* modify launch file for making psim work

Signed-off-by: kosuke murakami <[email protected]>

* add vehicle model in launch

Signed-off-by: kosuke murakami <[email protected]>

* change from vehicle_model to vehicle_param_file

Signed-off-by: kosuke murakami <[email protected]>

* [autoware_launch] add autoware_web_controller and system launch

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

* add rosbrdige_suite to build_depends.repos

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

* Update rviz

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

* update autoware.rviz

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

* remove autoware_ros2.rviz

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

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

* Ros2 v0.8.0 control launch (#53)

* restore file name for v0.8.0 update

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

* Add use_emergency_handling arg to vehicle_cmd_gate.launch (#83)

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

* Add parameter for using steer prediction (#88)

* change stop dist param (#85)

* mpc: change param name steer_rate_lim_deg -> steer_rate_lim_dps (#79)

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

* add mpc parameter (#105)

* Add parameters for stop state (#126)

* Add parameters for stop state

* Change default value

* Add vehicle cmd gate config (#136)

* Add config_file of vehicle_cmd_gate

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

* Add use_emergency_stop

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

* Rename emergency_stop to external_emergency_stop

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

* Fix command_gate diag

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

* Add lane_departure_checker (#123)

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

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

This reverts commit 516b366819f7f9d69b9bc3e2de180d4523794bcd.

* fix control launch

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

* fix args

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

* fix param type

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

* fix lane departure checker

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

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

* [velocity controller]: Fix parameter type (#62)

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

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

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

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

* Add missing '--'

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

* Rename vehicle_info.yaml to vehicle_info.param.yaml

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

* Fix livox param name

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

* Ros2 update v0.9.0 (#67)

* Add pose history into rviz config

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

* add blocked by obstacle option (#164)

* fix tab name (#166)

* disenable ndt visualization (#169)

* disenable ndt visualization

* change alpha

* dont visualize position covariance

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

* change global frame to map (#171)

* add param (#156)

Co-authored-by: taikitanaka3 <[email protected]>
Co-authored-by: Taichi Higashide <[email protected]>
Co-authored-by: Yukihiro Saito <[email protected]>
Co-authored-by: tkimura4 <[email protected]>

* Fix typo in control launch (#91)

* Fix typo in control module

* change admissible_yaw_error -> admissible_yaw_error_rad

* Fix various typos in launch files (#97)

* add use_sim-time option (#99)

* Replace doc by description (#182)

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

* Sync public repo (#185)

* add tier4 usbcam (#104)

* add tier4 usbcam

* change version

* tier4/ros2

* Ros2 vehicle info param server (#96)

* add vehicle info param server

* delete vehicle param file

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

* Ros2 fix topic name part2 (#89)

* Fix topic name for traffic_light_classifier

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

* Fix topic name for traffic_light_visualization

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

* Fix topic name for traffic_light_ssd_fine_detector

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

Co-authored-by: taikitanaka3 <[email protected]>
Co-authored-by: tkimura4 <[email protected]>
Co-authored-by: taikitanaka <[email protected]>
Co-authored-by: Takagi, Isamu <[email protected]>

* Use set_parameter for use_sim_time (#198)

* Use set_parameter for use_sim_time

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

* Add default parameter for scenario simulator

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

* Add control composed launch (#201)

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

* Fix mistakes in control.launch.py (#209)

* Fix typo in control.launch.py

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

* Add remote_cmd_converter_component

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

* Feature/add external cmd selector (#206)

* Add remote_cmd_selector to control.launch (#172)

* Add remote_cmd_selector to control.launch

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

* Rename remote_cmd_selector to external_cmd_selector

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

* Change default external cmd source (#173)

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

* modify to use control.launch.xml

* add external_cmd_selector to control.launch.py

* Fix remapping in control.launch.py

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

* Fix remapping in control.launch.py again

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

Co-authored-by: Keisuke Shima <[email protected]>

* Format launch files (#228)

* Format launch files

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

* Format launch.py

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

* Fix lint

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

* add external commands (#210)

* add remote commands

* fix topic

* ToExternalCmd

* fix topic in remote cmd converter

* fix ament

* add description for control_launch (#330)

* add description

* fix sentence

* use of

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

* add md and svg

* fix typo

* fix typo

* fix word

* fix typo

* add lack of things

* Update README

* fix depending packages

* fix word

* Feature/expand footprint launcher (#318)

* fix typo in control.launch.py #363

* Fix description in control launch arg (#364)

* Add autoware api (#376)

* Add external api adaptor (#267)

* Add external api adaptor

* Add api adaptor to logging simulator

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

* Add engage status output

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

* Add internal api adaptor (#273)

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

* Add map hash generator (#319)

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

* Add autoware api launch (#326)

* Add autoware api launch

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

* Apply autoware api launch

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

* Add deprecated comment

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

* Remove unused parameter (#325)

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

* Add api parameter (#341)

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

* Add start request API (#321)

* Add use start request option

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

* Fix lint

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

* Feature external cmd selector heartbeat (#356)

* Rename external command topic

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

* Modify command topic name

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

* Fix topic name

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

* Rename remote_cmd_converter

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

* Remove gate mode from external command

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

* Fix latest external command name (#361)

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

* Fix merge conflict

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

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

* fix topic

* change internal topic name

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

* Move launch file of external_cmd_selector (#386)

* Move launch file of external_cmd_selector

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

* Add utility function to include launch.py

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

* Add missing parameter

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

* Use EmergencyState instead of deprecated EmergencyMode (#390)

* Use EmergencyState instead of deprecated EmergencyMode

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

* Update control.launch.py

* Add selected external command API  (#397)

* Fix pre-commit (#407)

* Fix pre-commit errors

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

* Fix package.xml

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

* Add emergency status API (#439)

* remove yaw-recalc param in mpc (#190) (#294)

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

* Master sync for velocity controller (#297)

* update velocity_controller_param.yaml for refactoring velocity_controller (#238)

* update velocity_controller_param.yaml (#247)

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

* Fix parameter type (#299)

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

* add smoothing_num parameter (#263) (#301)

* add smoothing_num parameter

* change param

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

* add stopped_jerk (#276) (#315)

* add stopped_jerk

* set stopped_jerk -5.0

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

* Rename param from smooth_stop_max_fast_vel to smooth_stop_min_fast_vel (#351)

* Feature/vehicle gate parametrize acc (#320)

* [vehicle_cmd_gate] add acc parameters

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

* fix typo

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

* Update control_launch/config/vehicle_cmd_gate/vehicle_cmd_gate.param.yaml

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

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

* Change formatter to black (#488)

* Update pre-commit settings

* Apply Black

* Replace ament_lint_common with autoware_lint_common

* Update build_depends.repos

* Fix build_depends

* twist -> odometry (#109)

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

* remove unused depend/launcher (#112)

* Auto/control psim (#113)

* succeeded in launching control nodes

* fix input/output of control_launch

* Remove multiple package

* Add newline

* Update control_launch/launch/control.launch.py

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

* Apply pre-commit

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

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

* Fix remappings

* Add comment

* Fix remappings (#116)

* fix topics

* add external hazard indicator

* add param (#126)

* fix yaml (#127)

* remove unused files

Signed-off-by: tomoya.kimura <[email protected]>

* add default parameter of vehicle information

Signed-off-by: tomoya.kimura <[email protected]>

* ci(pre-commit): autofix

Co-authored-by: mitsudome-r <[email protected]>
Co-authored-by: shin <[email protected]>
Co-authored-by: Fumiya Watanabe <[email protected]>
Co-authored-by: Daisuke Nishimatsu <[email protected]>
Co-authored-by: Takamasa Horibe <[email protected]>
Co-authored-by: Jilada Eccleston <[email protected]>
Co-authored-by: Ryohsuke Mitsudome <[email protected]>
Co-authored-by: kosuke murakami <[email protected]>
Co-authored-by: wep21 <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: taikitanaka3 <[email protected]>
Co-authored-by: Taichi Higashide <[email protected]>
Co-authored-by: Yukihiro Saito <[email protected]>
Co-authored-by: Kazuki Miyahara <[email protected]>
Co-authored-by: taikitanaka <[email protected]>
Co-authored-by: Takagi, Isamu <[email protected]>
Co-authored-by: Keisuke Shima <[email protected]>
Co-authored-by: Hiroki OTA <[email protected]>
Co-authored-by: yabuta <[email protected]>
Co-authored-by: Takayuki Murooka <[email protected]>
Co-authored-by: Maxime CLEMENT <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Takayuki Murooka <[email protected]>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>
Comment on lines +83 to +88
template <>
inline geometry_msgs::msg::Point getPoint(
const autoware_auto_planning_msgs::msg::PathPointWithLaneId & p)
{
return p.point.pose.position;
}
Copy link
Contributor

@kosuke55 kosuke55 Jan 25, 2022

Choose a reason for hiding this comment

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

@yukkysaito @tkimura4
I heard that we can't use pathWithLaneId in autoware_utils because it's not common message, did it ever become OK?
https://github.com/tier4/autoware.iv/pull/2435#issuecomment-1012247220

Copy link
Contributor

Choose a reason for hiding this comment

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

At first these seemed to have been moved to autoware_utils in https://github.com/tier4/autoware.iv/pull/2113

satoshi-ota referenced this pull request in satoshi-ota/autoware.universe Feb 2, 2022
* fix: point cloud conversion logic (autowarefoundation#308)

Signed-off-by: Shinnosuke Hirakawa <[email protected]>

* fix(web controller): remove rosbridge launch from web_controller launch file (autowarefoundation#318)

* remove rosbridge launch

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

* delete space

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

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

Co-authored-by: Shinnosuke Hirakawa <[email protected]>
Co-authored-by: yabuta <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
badai-nguyen referenced this pull request in badai-nguyen/autoware.universe Feb 4, 2022
* Add autoware api (autowarefoundation#22)

* Add engage, emergency, door service (#4)

* Add external engage and emergency service

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

* Fix api utils

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

* Add external door messages

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

* Fix lint

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

* Add service and client for logging

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

* Fix cppcheck

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

* Add error level

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

* Fix maintainer

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

* Fix package.xml

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

* Add response build functions

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

* Remove unnecessary explicit

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

* Add service result type alias

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

* Rename proxy class

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

* Change type name

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

* Add service call timeout

* Add CI for develop branch

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

* Fix CI

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

* Fix lint

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

* Use default argument

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

* Rename package

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

* Move response message

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

* Move autoware_api_utils

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

* Fix package.xml format

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

* Fix package.xml format

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

* Fix package name

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

* Rename response type

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

* Fix enum type

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

* Add version service (#6)

* Add diagnostics message (#7)

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

* Add route service (#8)

* Add goal and route service

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

* Fix service name

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

* Add route message

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

* Add clear route service (#10)

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

* Add stop and velocity type (#9)

* Add velocity service and message

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

* Add stop service

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

* Rename velocity limit service

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

* Rename pause driving service

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

* Add engage status message (#11)

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

* Add map info message (#13)

* Add map info message

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

* Rename message

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

* Add driver type (#12)

* Add driver type

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

* Modify variable size

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

* Modify message type

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

* Remove driver mode from observer

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

* Fix observer none mode

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

* Add initial pose service (#14)

* Add initial pose service

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

* Rename service type name

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

* Remove use gnss flag

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

* Add service mode (autowarefoundation#15)

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

* Add control command messages (autowarefoundation#20)

* Add control command messages

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

* Fix control command messages

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

* Add self package namespace (autowarefoundation#21)

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

* Add emergency status API (autowarefoundation#37)

* Add package version API (autowarefoundation#36)

* Add package version API

* Fix message type

* Fix message name

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

* Add lanelet XML API (autowarefoundation#39)

* develop -> main sync (autowarefoundation#41)

* Add vehicle status types (autowarefoundation#25)

* Add vehicle status types

* Trigger CI

* Add vehicle command types (autowarefoundation#30)

* Add fail safe state types

Co-authored-by: Takagi, Isamu <[email protected]>
Co-authored-by: Takagi, Isamu <[email protected]>

* fix: remove TODO comment

* ci(pre-commit): autofix

Co-authored-by: Takagi, Isamu <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Kosuke Takeuchi <[email protected]>
Co-authored-by: Takagi, Isamu <[email protected]>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>
Co-authored-by: taikitanaka3 <[email protected]>
badai-nguyen referenced this pull request in badai-nguyen/autoware.universe Feb 4, 2022
* release v0.4.0

* remove ROS1 packages temporarily

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

* add sample ros2 packages

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

* remove ROS1 packages

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

* Revert "remove ROS1 packages temporarily"

This reverts commit aaf2f7d3908ee5f865105ea9094ed358ea9d3c75.

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

* add COLCON_IGNORE to ros1 packages

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

* Port autoware_utils (#33)

* Port autoware_utils

* Fix function name

* Fix buildtool_depend

* 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 v0.8.0 autoware utils (#291)

* restore file name for v0.8.0 update

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

* Improve autoware utils (#986)

* Refactor

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

* Add features to autoware_utils

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

* Add lane departure checker (#928)

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

* Fix/remove duplicated point (#1107)

* Split PoseDeviaiton functions

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

* Remove unnecessary pose

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

* Don't insert point if duplicated point exists

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

* Fix condition of duplicated points

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

* Rename file name for v0.8.0 update

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

* Add dependencies into package.xml

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

* [autoware_utils]: Fix CMakeLists.txt and package.xml for lint and testing

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

* [autoware_utils]: Fix lint

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

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

* [autoware_utils]: fix traits (#326)

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

* Ros2 v0.8.0 lane departure checker (#327)

* Add lane departure checker (#928)

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

* Fix bug of lane_departure_checker (#1011)

* Fix bug of lane_departure_checker

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

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

* Fix typo

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

* Reduce computational cost of lane_departure_checker (#1026)

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

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

* Fix typo (#1062)

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

* [lane_departure_checker]: Port to ROS2

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

* [lane_departure_checker]: Fix lint

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

* [autoware_utils]: Publish autoware debug msgs

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

* [lane_departure_checker]: Use autoware_debug_msgs instead of std_msgs

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

* [goal_distance_calculator]: Use autoware_debug_msgs instead of std_msgs

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

* [autoware_utils]: Add namespace to debug traits

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

* [lane_departure_checker]: Fix lint

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

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

* Ros2 v0.8.0 behavior velocity planner (#332)

* restore behavior velocity planner files for v0.8.0 update

* Fix detection area (#808)

* Remove PASS state

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

* Keep stopping after going over dead-line in STOP state

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

* Clear state after obstacle disappears

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

* Parameterize and change conditions

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

* Refactor

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

* add elapsed time checker

* Refactor

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

* Ignore inserting point if points are too close

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

* Rename NORMAL to GO

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

* Revert "Ignore inserting point if points are too close"

This reverts commit 91c8d620ea11e703611945cb9a50877d175f4ff6.

* Fix small bug

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

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

* fix timing of publish stop reason of stop_line (#845)

* fix timing of publish stop reason of stop_line

* Fix formatting

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

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

* Fix task registration of detection area module (#856)

* Fix task registration of detection area module

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

* Fix id of factor_text marker

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

* Do not interpolate if path size is 1 (#865)

* Revert "restore behavior velocity planner files for v0.8.0 update"

This reverts commit ce07d3c2bfae562d56fec46c4f81d5351fd936a1.

* fix some implement miss

* restore behavior velocity planner files for v0.8.0 update

* change intersection param (#861)

* Fix/intersection stop line (#841)

* add trimmed path function

* fix typo

* avoid to insert stop line outside intersection

* Add pass judge flag (#872)

* Add pass judge flag

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

* Fix wrong format

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

* Fix flag order in judge condition

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

* add ignore width with blind spot (#864)

* add ignore width with blind spot

* remove unused function

* fix typo

* fix margin

* remove bicycle from intersection stuck vehicle (#896)

* Revert "restore behavior velocity planner files for v0.8.0 update"

This reverts commit ff61ee56f2ce4728e53eb698836db60d68bf64b9.

* fix implement miss

* restore behavior velocity planner files for v0.8.0 update (fixed)

* Add external traffic light input (#912)

* Add external traffic light input

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

* Update topic namespace

* Fix typos in planning modules (#866)

* fix typos in planning

* fix corresponding typos in planning

* revert fixed typos temporarily due to its impact on launchers

* add exception handling to intersection module (#920)

* add exception handling

* output input path

* prevent passthrough chattering (#901)

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

* cosnider current_velocity to calculate intersection passing time (#880)

* cosnider current_velocity to calculate intersection passing time

* add fabs to current velocity

* Improve stuck vehicle detect (#824)

* intersection: modify stuck vehicle detect logic to consider the object shape

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

* intersection: consider ego-vehicle length when calculate stuck vehicle detection area

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

* intersection: change param stuck_vehicle_ignore_dist: 5.0 -> 7.0

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

* intersection: use vehicle_info/vehicle_length

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

* fix implement miss

* fix target pedestrian (#927)

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

* fix insert backward point (#953)

* fix insert backward point

* add comment

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

* remove unnecessary if

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

* Add stop line referred from road marking (#968)

* Add stop line referred from road marking

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

* Add stop line for walkway

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

* Feature/external input (#982)

* add external input msg

* impl external input(crosswalk, intersection)

* :put_litter_in_its_place:

* change to ++14

* fix bug

* fix bug

* cosmetic change

* Revert "restore behavior velocity planner files for v0.8.0 update"

This reverts commit ff61ee56f2ce4728e53eb698836db60d68bf64b9.

* Fix typo (#1013)

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

* Fix/blind spot insert point (#1027)

* Copy insert point from previous point

* Reset path unless state is stop

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

* change slow down speed (#1030)

* restore behavior velocity planner files for v0.8.0 update (fixed)

* Fix/walkway stop judge range (#1028)

* Fix walkway stop judge

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

* Make refer id same

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

* fix getObjectivePolygons() so that intersecting lanelet is added to objective lanelets even when there is no preceeding lanelets (#1010)

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

* Revert "restore behavior velocity planner files for v0.8.0 update (fixed)"

This reverts commit 39231f23eb17e39a418f28f5ccfe1df55b3fb45c.

* fix implement miss for marker

* restore behavior velocity planner files for v0.8.0 update (fixed)

* Fix/blind spot polygon (#1056)

* Fix detection area for blind spot

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

* Apply clang format

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

* Shrink conflicting area

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

* chane slowdown judgement (#1066)

* chane slowdown judgement

* cosmetic change

* Revert "restore behavior velocity planner files for v0.8.0 update (fixed)"

This reverts commit 39231f23eb17e39a418f28f5ccfe1df55b3fb45c.

* fixed for ros2 style

* restore behavior velocity planner files for v0.8.0 update (fixed)

* Remove unused headers in behavior_velocity_planner (#1072)

* publish walkway stop reason (#1073)

* Revert "restore behavior velocity planner files for v0.8.0 update (fixed)"

This reverts commit 39231f23eb17e39a418f28f5ccfe1df55b3fb45c.

* restore behavior velocity planner files for v0.8.0 update (fixed)

* Add correspondence marker of detection_area and stop_line (#1081)

* Fix comment

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

* Add const

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

* Add correspondence marker of detection_area and stop_line

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

* Add obstacle marker

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

* Fixup

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

* Add id marker

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

* Clear state when time rollback found

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

* Fix typo

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

* change stop to polygon line

* apply clang format

* fix code

* fix bug

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

* Fix pass judge idx (#1090)

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

* fix bug (#1087)

* Revert "restore behavior velocity planner files for v0.8.0 update (fixed)"

This reverts commit 39231f23eb17e39a418f28f5ccfe1df55b3fb45c.

* fix for ros2 style

* restore behavior velocity planner files for v0.8.0 update (fixed)

* Fix/remove duplicated point (#1107)

* Split PoseDeviaiton functions

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

* Remove unnecessary pose

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

* Don't insert point if duplicated point exists

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

* Fix condition of duplicated points

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

* seperate stop distance param (#1137)

* seperate stop distance param

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

* apply param for automotically generated stop line

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

* shift slow down line

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

* add param in yaml file

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

* fix prediction_time_margin bug (#1148)

* Revert "restore behavior velocity planner files for v0.8.0 update (fixed)"

This reverts commit 39231f23eb17e39a418f28f5ccfe1df55b3fb45c.

* fix ros2 style

* remove deprecated

* reformat

* add test temporary launch

* cpp_lint_namespace_what_you_use

* lint_comment_line_length

* pass ament cpplint

* fixe commit

* fix code

* remove unneccesary

* fix param structure

* fix missng params

* fix throttle time

Co-authored-by: tomoya.kimura <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: taichiH <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Fumiya Watanabe <[email protected]>
Co-authored-by: Daisuke Nishimatsu <[email protected]>
Co-authored-by: Kazuki Miyahara <[email protected]>
Co-authored-by: Yukihiro Saito <[email protected]>
Co-authored-by: Takamasa Horibe <[email protected]>
Co-authored-by: Kosuke Murakami <[email protected]>
Co-authored-by: Ryohsuke Mitsudome <[email protected]>

* Fix/lane departure checker (#386)

* Fix/lane departure checker (#1177)

* Add more processing time measurement

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

* Rename processing_time to processing_time_ms

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

* Refactor StopWatch class

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

* apply ament_uncrustify

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

* Fix autoware_utils (#419)

* Fix autoware_utils

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

* Apply format

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

* Add <memory>

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

* Ros2 fix topic name part1 (#408)

* Fix topic name of lane_departure_checker debug

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

* Fix topic name of mpc_follower debug

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

* Fix topic name of velocity_controller debug

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

* Fix topic name of motion_velocity_optimizer debug

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

* Fix topic name of lane_change_planner debug

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

* Fix topic name of behavior_velocity_planner debug

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

* Fix topic name of obstacle_avoidance_planner debug

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

* Fix topic name of behavior_velocity_planner

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

* Fix topic name of motion_velocity_optimizer

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

* Fix topic name of lane_departure_checker

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

* Fix topic name of mpc_follower

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

* Fix topic name of behavior_velocity_planner

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

* Fix topic name of velocity_controller

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

* Fix topic name of lane_change_planner

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

* Fix topic name of obstacle_avoidance_planner

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

* Fix topic name of obstacle_stop_planner

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

* Fix topic name of costmap_generator

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

* Fix topic name of freespace_planner

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

* Fix topic name of surround_obstacle_checker

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

* Fix topic name of costmap_generator

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

* Fix topic name of emergency_handler

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

* Fix lint errors

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

* Fix typo

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

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

* Ros2 delete vehicle info (#1227)

* remove dependency on vehicle info in autoware_utils

* delete vehicle_info in autoware_utils

* Unify Apache-2.0 license name (#1242)

* Fix/fix utils (#1310)

* Add missing namespace to autoware_utils

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

* Add createVehicleInfo

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

* Add rethrow

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

* Format package.xml

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

* Fix usage of autoware_utils

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

* Add missing namespace comment

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

* Make a curvature calculation function in autoware_utils' library (#1388) (#1393)

* add curvature calculation function

* add two functions

* integrate 2 functions into 1 function by template function

* add unit test for curvature calculation

* modify spell

* Update common/util/autoware_utils/include/autoware_utils/math/curvature.h

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

* add modifications

* modify format

* update

* update

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

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

* rename function from calculateCUrvature to calcCurvature (#1461) (#1486)

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

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

* Add trajectory functions in autoware_utils (#1410)(#1438)(#1416)(#1473)(#1491) (#1482)

* Add closest point index calculation function in autoware_utils (#1410)

* add nearest point calculator

* update

* add template

* update

* update

* update

* update variables name

* update variables name

* remove redundant expression

* add unit test

* update test

* test has some errors

* update

* update name

* update name

* modify bug

* update

* update

* add new test cases

* add new function

* add get pose function

* delete unnecessary file

* update test

* delete namespace

* add emtpy handler

* remove redundant test

* remove template

* add necessary files to autoware_utils (#1438)

* add necessary files

* Apply fix

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

* fix test

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

* Fix lint

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

* Fix build warning

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

* add some trajectory functions commonly used in planning/control (#1416)

* add some trajectory functions commonly used in p/c

* minor fix with reviews

* refactor based on reviews

* minor changes

* refactor based on reviews

* minor changes

* minor changes

* refactor based on reviews

* use std::vector<T> and T in findClosestIndex

* fix bugs that I wrote wrong

* refactor

* refactor

* fix bug of including optional.hpp twice

* refactor

* refactor

* fix bug

* fix bugs

* update

* apply clang-format

* add blank line

* add test for searchZeroVelocityIndex

* update

* update

* update

* add some tests

* closest -> nearest

* add some test

* update test

* not to use optional if not necessary

* not unsigned

* add explanation of segment

* update

* 契約プログラミング

* add signed to variable of length

* update

* update

* update

* update test

* update

* update test

* update

* update test

* update

* update

* update

* update

* update

* update

* update

* Remove wrapper for autoware_plannig_msgs

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

* Fix test

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

* Change implementation of calcLongitudinalOffsetToSegment

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

* Set default value for trajectory velocity

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

* Remove unused function

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

* add 3 cases for curve trajectory

* update

* Revert "update"

This reverts commit 6d4f3ee25f49dcca146340c9a1ed3f4c1ac4f55c.

* Revert "add 3 cases for curve trajectory"

This reverts commit d3f4751851afcdac41e160fecbb6bee9ac9f60a2.

* Add test case

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

* Fix comment

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

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

* use template in geometry.hpp (#1473)

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

* Fix include

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

* Fix errors

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

* Fix license

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

* Fix find nearest segment index (#1491)

* add odd test case, and confirmed that the test don't pass

* fix findNearestSegmentIndex, and confirmed all the test passed

* use calcLongitudinalOffsetToSegment

* use vector in test

* add deleted comment

Co-authored-by: purewater0901 <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Takayuki Murooka <[email protected]>
Co-authored-by: Takamasa Horibe <[email protected]>

* Feature/update autoware utils (#1501)(#1513)(#1522)(#1463)(#1503) (#1544)

* generalize searchZeroVelocityIndex Function (#1501)

* generalize searchZeroVelocityIndex Function

* update test

* fix test case

* update test case

* update terminal index in the test

* Fix/fix autoware utils geometry (#1513)

* Revert geometry.cpp

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

* Add default implementations

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

* add constant gravity (#1522)

* add arange & linspace in math util (#1463)

* [WIP] add arange & linspace in math util

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

* add unittest cases of arange and linspace

* implement and test arange and linspace in util library

* fix issues found in review

* fix typos

* fix issue found in review

* fix typo

* fix issues found in review

* fix issues found in review

Co-authored-by: nisshan-x <[email protected]>

* extend findNearestIndex, and add tests (#1503)

* extend findNearestIndex, and add tests

* apply clang-format

* update

* hoge_threshold -> max_hoge

* _min/_max -> min_/max_, and update

* update

* update

* update

* update

* update

* Fix warnings

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

* Add reserve for autoware_utils::arange

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

Co-authored-by: purewater0901 <[email protected]>
Co-authored-by: Takayuki Murooka <[email protected]>
Co-authored-by: Takamasa Horibe <[email protected]>
Co-authored-by: nisshan-x <[email protected]>

* Add update_param.hpp in autoware_utils (#1556)

* Add update_param.hpp in autoware_utils

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

* Change to bool

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

* Remove unnecesarry file for test (#1605)

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

* Feature/update autoware_utils (#1576) (#1599) (#1603) (#1619) (#1631) (#1650)

* Add tests for autoware_utils::StopWatch (#1832)

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

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

* Autoware util squared dist main merge (#1853)

* autoware_utils: use calcSquaredDistance in calcClosest

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

* add test

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

* Fix clang warnings (#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 clang-tidy warnings of autoware_utils (#1854)

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

* Revive constructor of StopWatch class (#1882)

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

* enable autonomous recovery (#1904)

* add createQuaternionFromYaw (#2120)

* add createQuaternionFromYaw

* add test

* change return value type of createQuaternionFromRPY from tf2::quat to geomety_msgs::msg::quat

* use geometry_msgs::msg::Quaternion in createQuaternionFromRPY in application

* implement fast findNearestIndex with threshold (#2142)

* implement fast findNearestIndex with threshold

* fix reviews

* add calcLateralLength (#2226)

* add calcLateralLength

* rename length to offset

* imeplemet in ROS2 (#1868)

* add new get point function for posewithcovariancestamped (#2156)

* add new get point function for posewithcovariancestamped

* fix format

* add behavior velocity planner utils (#2113)

* add gtest utils

* add state machine as utils

* add arc lane utils

* remove empty file

* add gtest for offset segment

* use calcdist2d in autoware util

* apply get point

* fix uncrustify

* fix conflict getPoint in behavior path

* apply commit suggestion

* slower than ros1

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

* use autoware_auto_msgs (#489)

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

* remove COLCON_IGNORE (#502)

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

* Add trajectory converter (#512)

* Add trajectory converter

* Add comment

* Fix comment

* Fix comment

* Add TODO in comment

* Update common/util/autoware_utils/include/autoware_utils/trajectory/convert.hpp

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

* Fix comment

* Use doxygen style comment

* Fix function name

* Fix test code

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

* add README (#671)

* 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: Nikolai Morin <[email protected]>
Co-authored-by: Daisuke Nishimatsu <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: taikitanaka3 <[email protected]>
Co-authored-by: taichiH <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Fumiya Watanabe <[email protected]>
Co-authored-by: Kazuki Miyahara <[email protected]>
Co-authored-by: Yukihiro Saito <[email protected]>
Co-authored-by: Takamasa Horibe <[email protected]>
Co-authored-by: Kosuke Murakami <[email protected]>
Co-authored-by: Ryohsuke Mitsudome <[email protected]>
Co-authored-by: Takagi, Isamu <[email protected]>
Co-authored-by: purewater0901 <[email protected]>
Co-authored-by: Takayuki Murooka <[email protected]>
Co-authored-by: nisshan-x <[email protected]>
Co-authored-by: Satoshi OTA <[email protected]>
Co-authored-by: Hiroki OTA <[email protected]>
Co-authored-by: Taichi Higashide <[email protected]>
Co-authored-by: Takayuki Murooka <[email protected]>
Co-authored-by: Takeshi Miura <[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: Takeshi Ishita <[email protected]>
Co-authored-by: Makoto Kurihara <[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]>
badai-nguyen referenced this pull request in badai-nguyen/autoware.universe Feb 4, 2022
* release v0.4.0

* remove ROS1 packages temporarily

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

* add sample ros2 packages

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

* remove ROS1 packages

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

* Revert "remove ROS1 packages temporarily"

This reverts commit bcc60bdc82842e2ea4d1e844b4442fa613d80fdf.

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

* add COLCON_IGNORE to ros1 packages

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

* Port shift decider to ros2 (#7)

* Update package.xml and CMakeLists.txt to ros2

Code doesn't compile yet

* Code compiles

* Update launch file

* Add better timer

clang-format shift_decider

* 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

* Added linters to shift_decider (autowarefoundation#167)

* Added linters to shift_decider

* Fix dependencies

* Use ament_cmake_cppcheck and ament_cmake_cpplint

* Fix linting errors

* add use_sim-time option (autowarefoundation#454)

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

* Make control modules components (autowarefoundation#1262)

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

* Remove use_sim_time for set_parameter (autowarefoundation#1260)

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

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

* Revert "Temporarily comment out pre-commit hooks"

This reverts commit 748e9cdb145ce12f8b520bcbd97f5ff899fc28a3.

* Replace ament_lint_common with autoware_lint_common

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

* Remove ament_cmake_uncrustify and ament_clang_format

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

* Apply Black

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

* Apply clang-format

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

* Fix build errors

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

* Fix for cpplint

* Fix include double quotes to angle brackets

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

* Apply clang-format

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

* Fix build errors

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

* Add COLCON_IGNORE (autowarefoundation#500)

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

* port shift decider (autowarefoundation#485)

* port shift decider

* apply clang format

* delete colcon ignore

* change to ackermann control command

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

* [shift decider] add README.md (autowarefoundation#577)

* add readme to shift decider

* better expression

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

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

* Fix topic name (autowarefoundation#673)

Co-authored-by: mitsudome-r <[email protected]>
Co-authored-by: Frederik Beaujean <[email protected]>
Co-authored-by: Nikolai Morin <[email protected]>
Co-authored-by: Esteve Fernandez <[email protected]>
Co-authored-by: tkimura4 <[email protected]>
Co-authored-by: Kazuki Miyahara <[email protected]>
Co-authored-by: Daisuke Nishimatsu <[email protected]>
Co-authored-by: Keisuke Shima <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Sugatyon <[email protected]>
Co-authored-by: taikitanaka3 <[email protected]>
Co-authored-by: Fumiya Watanabe <[email protected]>
badai-nguyen referenced this pull request in badai-nguyen/autoware.universe Feb 4, 2022
* release v0.4.0

* load velocity_controller_param.yaml from launcher (autowarefoundation#52)

Signed-off-by: Shinnosuke Hirakawa <[email protected]>

* Include enable_slope_compensation to yaml file (autowarefoundation#61)

* Sync mpc param (autowarefoundation#74)

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

* add stop dist param (autowarefoundation#73)

* add stop dist param

* add keep stopping dist param

* removed ROS1 package

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

* Revert "removed ROS1 package"

This reverts commit 85eb34207aa7b90314d93a6eb370213e10fcd7bd.

* add COLCON_IGNORE file to all ROS1 packages

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

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

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

* port control launch (#7)

* port control launch

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

* fix license

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

* ROS2 Linting: control_launch (autowarefoundation#29)

* Add linter tests and completepackage dependencies list

* Reorder alphabetically

* Comment out pure_pursuit dependency - not ported yet

* Add back pure_pursuit package post port

* Ros2 port autoware launch (autowarefoundation#35)

* [autoware_launch] port CMakelists.txt and remove COLCON_IGNORE

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

* [autoware_launch] fix planning_simulator.launch.xml

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

* [autoware_launch] add rviz config

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

* [autoware_launch] first port of autoware_launch

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

* lanuch rviz with config file

Signed-off-by: kosuke murakami <[email protected]>

* modify launch file for making psim work

Signed-off-by: kosuke murakami <[email protected]>

* add vehicle model in launch

Signed-off-by: kosuke murakami <[email protected]>

* change from vehicle_model to vehicle_param_file

Signed-off-by: kosuke murakami <[email protected]>

* [autoware_launch] add autoware_web_controller and system launch

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

* add rosbrdige_suite to build_depends.repos

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

* Update rviz

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

* update autoware.rviz

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

* remove autoware_ros2.rviz

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

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

* Ros2 v0.8.0 control launch (autowarefoundation#53)

* restore file name for v0.8.0 update

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

* Add use_emergency_handling arg to vehicle_cmd_gate.launch (autowarefoundation#83)

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

* Add parameter for using steer prediction (autowarefoundation#88)

* change stop dist param (autowarefoundation#85)

* mpc: change param name steer_rate_lim_deg -> steer_rate_lim_dps (autowarefoundation#79)

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

* add mpc parameter (autowarefoundation#105)

* Add parameters for stop state (autowarefoundation#126)

* Add parameters for stop state

* Change default value

* Add vehicle cmd gate config (autowarefoundation#136)

* Add config_file of vehicle_cmd_gate

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

* Add use_emergency_stop

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

* Rename emergency_stop to external_emergency_stop

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

* Fix command_gate diag

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

* Add lane_departure_checker (autowarefoundation#123)

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

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

This reverts commit 516b366819f7f9d69b9bc3e2de180d4523794bcd.

* fix control launch

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

* fix args

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

* fix param type

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

* fix lane departure checker

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

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

* [velocity controller]: Fix parameter type (autowarefoundation#62)

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

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

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

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

* Add missing '--'

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

* Rename vehicle_info.yaml to vehicle_info.param.yaml

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

* Fix livox param name

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

* Ros2 update v0.9.0 (autowarefoundation#67)

* Add pose history into rviz config

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

* add blocked by obstacle option (autowarefoundation#164)

* fix tab name (autowarefoundation#166)

* disenable ndt visualization (autowarefoundation#169)

* disenable ndt visualization

* change alpha

* dont visualize position covariance

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

* change global frame to map (autowarefoundation#171)

* add param (autowarefoundation#156)

Co-authored-by: taikitanaka3 <[email protected]>
Co-authored-by: Taichi Higashide <[email protected]>
Co-authored-by: Yukihiro Saito <[email protected]>
Co-authored-by: tkimura4 <[email protected]>

* Fix typo in control launch (autowarefoundation#91)

* Fix typo in control module

* change admissible_yaw_error -> admissible_yaw_error_rad

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

* add use_sim-time option (autowarefoundation#99)

* Replace doc by description (autowarefoundation#182)

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

* Sync public repo (autowarefoundation#185)

* add tier4 usbcam (autowarefoundation#104)

* add tier4 usbcam

* change version

* tier4/ros2

* Ros2 vehicle info param server (autowarefoundation#96)

* add vehicle info param server

* delete vehicle param file

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

* Ros2 fix topic name part2 (autowarefoundation#89)

* Fix topic name for traffic_light_classifier

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

* Fix topic name for traffic_light_visualization

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

* Fix topic name for traffic_light_ssd_fine_detector

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

Co-authored-by: taikitanaka3 <[email protected]>
Co-authored-by: tkimura4 <[email protected]>
Co-authored-by: taikitanaka <[email protected]>
Co-authored-by: Takagi, Isamu <[email protected]>

* Use set_parameter for use_sim_time (autowarefoundation#198)

* Use set_parameter for use_sim_time

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

* Add default parameter for scenario simulator

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

* Add control composed launch (autowarefoundation#201)

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

* Fix mistakes in control.launch.py (autowarefoundation#209)

* Fix typo in control.launch.py

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

* Add remote_cmd_converter_component

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

* Feature/add external cmd selector (autowarefoundation#206)

* Add remote_cmd_selector to control.launch (autowarefoundation#172)

* Add remote_cmd_selector to control.launch

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

* Rename remote_cmd_selector to external_cmd_selector

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

* Change default external cmd source (autowarefoundation#173)

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

* modify to use control.launch.xml

* add external_cmd_selector to control.launch.py

* Fix remapping in control.launch.py

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

* Fix remapping in control.launch.py again

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

Co-authored-by: Keisuke Shima <[email protected]>

* Format launch files (autowarefoundation#228)

* Format launch files

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

* Format launch.py

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

* Fix lint

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

* add external commands (autowarefoundation#210)

* add remote commands

* fix topic

* ToExternalCmd

* fix topic in remote cmd converter

* fix ament

* add description for control_launch (autowarefoundation#330)

* add description

* fix sentence

* use of

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

* add md and svg

* fix typo

* fix typo

* fix word

* fix typo

* add lack of things

* Update README

* fix depending packages

* fix word

* Feature/expand footprint launcher (autowarefoundation#318)

* fix typo in control.launch.py autowarefoundation#363

* Fix description in control launch arg (autowarefoundation#364)

* Add autoware api (autowarefoundation#376)

* Add external api adaptor (autowarefoundation#267)

* Add external api adaptor

* Add api adaptor to logging simulator

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

* Add engage status output

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

* Add internal api adaptor (autowarefoundation#273)

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

* Add map hash generator (autowarefoundation#319)

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

* Add autoware api launch (autowarefoundation#326)

* Add autoware api launch

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

* Apply autoware api launch

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

* Add deprecated comment

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

* Remove unused parameter (autowarefoundation#325)

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

* Add api parameter (autowarefoundation#341)

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

* Add start request API (autowarefoundation#321)

* Add use start request option

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

* Fix lint

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

* Feature external cmd selector heartbeat (autowarefoundation#356)

* Rename external command topic

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

* Modify command topic name

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

* Fix topic name

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

* Rename remote_cmd_converter

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

* Remove gate mode from external command

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

* Fix latest external command name (autowarefoundation#361)

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

* Fix merge conflict

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

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

* fix topic

* change internal topic name

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

* Move launch file of external_cmd_selector (autowarefoundation#386)

* Move launch file of external_cmd_selector

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

* Add utility function to include launch.py

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

* Add missing parameter

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

* Use EmergencyState instead of deprecated EmergencyMode (autowarefoundation#390)

* Use EmergencyState instead of deprecated EmergencyMode

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

* Update control.launch.py

* Add selected external command API  (autowarefoundation#397)

* Fix pre-commit (autowarefoundation#407)

* Fix pre-commit errors

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

* Fix package.xml

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

* Add emergency status API (autowarefoundation#439)

* remove yaw-recalc param in mpc (autowarefoundation#190) (autowarefoundation#294)

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

* Master sync for velocity controller (autowarefoundation#297)

* update velocity_controller_param.yaml for refactoring velocity_controller (autowarefoundation#238)

* update velocity_controller_param.yaml (autowarefoundation#247)

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

* Fix parameter type (autowarefoundation#299)

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

* add smoothing_num parameter (autowarefoundation#263) (autowarefoundation#301)

* add smoothing_num parameter

* change param

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

* add stopped_jerk (autowarefoundation#276) (autowarefoundation#315)

* add stopped_jerk

* set stopped_jerk -5.0

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

* Rename param from smooth_stop_max_fast_vel to smooth_stop_min_fast_vel (autowarefoundation#351)

* Feature/vehicle gate parametrize acc (autowarefoundation#320)

* [vehicle_cmd_gate] add acc parameters

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

* fix typo

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

* Update control_launch/config/vehicle_cmd_gate/vehicle_cmd_gate.param.yaml

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

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

* Change formatter to black (autowarefoundation#488)

* Update pre-commit settings

* Apply Black

* Replace ament_lint_common with autoware_lint_common

* Update build_depends.repos

* Fix build_depends

* twist -> odometry (autowarefoundation#109)

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

* remove unused depend/launcher (autowarefoundation#112)

* Auto/control psim (autowarefoundation#113)

* succeeded in launching control nodes

* fix input/output of control_launch

* Remove multiple package

* Add newline

* Update control_launch/launch/control.launch.py

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

* Apply pre-commit

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

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

* Fix remappings

* Add comment

* Fix remappings (autowarefoundation#116)

* fix topics

* add external hazard indicator

* add param (autowarefoundation#126)

* fix yaml (autowarefoundation#127)

* remove unused files

Signed-off-by: tomoya.kimura <[email protected]>

* add default parameter of vehicle information

Signed-off-by: tomoya.kimura <[email protected]>

* ci(pre-commit): autofix

Co-authored-by: mitsudome-r <[email protected]>
Co-authored-by: shin <[email protected]>
Co-authored-by: Fumiya Watanabe <[email protected]>
Co-authored-by: Daisuke Nishimatsu <[email protected]>
Co-authored-by: Takamasa Horibe <[email protected]>
Co-authored-by: Jilada Eccleston <[email protected]>
Co-authored-by: Ryohsuke Mitsudome <[email protected]>
Co-authored-by: kosuke murakami <[email protected]>
Co-authored-by: wep21 <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: taikitanaka3 <[email protected]>
Co-authored-by: Taichi Higashide <[email protected]>
Co-authored-by: Yukihiro Saito <[email protected]>
Co-authored-by: Kazuki Miyahara <[email protected]>
Co-authored-by: taikitanaka <[email protected]>
Co-authored-by: Takagi, Isamu <[email protected]>
Co-authored-by: Keisuke Shima <[email protected]>
Co-authored-by: Hiroki OTA <[email protected]>
Co-authored-by: yabuta <[email protected]>
Co-authored-by: Takayuki Murooka <[email protected]>
Co-authored-by: Maxime CLEMENT <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Takayuki Murooka <[email protected]>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>
badai-nguyen referenced this pull request in badai-nguyen/autoware.universe Feb 4, 2022
* Add autoware api (autowarefoundation#22)

* Add engage, emergency, door service (#4)

* Add external engage and emergency service

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

* Fix api utils

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

* Add external door messages

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

* Fix lint

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

* Add service and client for logging

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

* Fix cppcheck

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

* Add error level

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

* Fix maintainer

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

* Fix package.xml

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

* Add response build functions

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

* Remove unnecessary explicit

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

* Add service result type alias

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

* Rename proxy class

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

* Change type name

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

* Add service call timeout

* Add CI for develop branch

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

* Fix CI

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

* Fix lint

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

* Use default argument

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

* Rename package

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

* Move response message

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

* Move autoware_api_utils

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

* Fix package.xml format

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

* Fix package.xml format

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

* Fix package name

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

* Rename response type

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

* Fix enum type

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

* Add version service (#6)

* Add diagnostics message (#7)

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

* Add route service (#8)

* Add goal and route service

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

* Fix service name

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

* Add route message

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

* Add clear route service (#10)

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

* Add stop and velocity type (#9)

* Add velocity service and message

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

* Add stop service

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

* Rename velocity limit service

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

* Rename pause driving service

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

* Add engage status message (#11)

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

* Add map info message (#13)

* Add map info message

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

* Rename message

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

* Add driver type (#12)

* Add driver type

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

* Modify variable size

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

* Modify message type

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

* Remove driver mode from observer

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

* Fix observer none mode

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

* Add initial pose service (#14)

* Add initial pose service

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

* Rename service type name

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

* Remove use gnss flag

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

* Add service mode (autowarefoundation#15)

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

* Add control command messages (autowarefoundation#20)

* Add control command messages

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

* Fix control command messages

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

* Add self package namespace (autowarefoundation#21)

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

* Add emergency status API (autowarefoundation#37)

* Add package version API (autowarefoundation#36)

* Add package version API

* Fix message type

* Fix message name

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

* Add lanelet XML API (autowarefoundation#39)

* develop -> main sync (autowarefoundation#41)

* Add vehicle status types (autowarefoundation#25)

* Add vehicle status types

* Trigger CI

* Add vehicle command types (autowarefoundation#30)

* Add fail safe state types

Co-authored-by: Takagi, Isamu <[email protected]>
Co-authored-by: Takagi, Isamu <[email protected]>

* fix: remove TODO comment

* ci(pre-commit): autofix

Co-authored-by: Takagi, Isamu <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Kosuke Takeuchi <[email protected]>
Co-authored-by: Takagi, Isamu <[email protected]>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>
Co-authored-by: taikitanaka3 <[email protected]>
badai-nguyen referenced this pull request in badai-nguyen/autoware.universe Feb 4, 2022
* release v0.4.0

* remove ROS1 packages temporarily

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

* add sample ros2 packages

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

* remove ROS1 packages

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

* Revert "remove ROS1 packages temporarily"

This reverts commit aaf2f7d3908ee5f865105ea9094ed358ea9d3c75.

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

* add COLCON_IGNORE to ros1 packages

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

* Port autoware_utils (#33)

* Port autoware_utils

* Fix function name

* Fix buildtool_depend

* 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 v0.8.0 autoware utils (#291)

* restore file name for v0.8.0 update

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

* Improve autoware utils (#986)

* Refactor

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

* Add features to autoware_utils

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

* Add lane departure checker (#928)

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

* Fix/remove duplicated point (#1107)

* Split PoseDeviaiton functions

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

* Remove unnecessary pose

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

* Don't insert point if duplicated point exists

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

* Fix condition of duplicated points

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

* Rename file name for v0.8.0 update

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

* Add dependencies into package.xml

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

* [autoware_utils]: Fix CMakeLists.txt and package.xml for lint and testing

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

* [autoware_utils]: Fix lint

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

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

* [autoware_utils]: fix traits (#326)

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

* Ros2 v0.8.0 lane departure checker (#327)

* Add lane departure checker (#928)

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

* Fix bug of lane_departure_checker (#1011)

* Fix bug of lane_departure_checker

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

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

* Fix typo

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

* Reduce computational cost of lane_departure_checker (#1026)

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

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

* Fix typo (#1062)

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

* [lane_departure_checker]: Port to ROS2

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

* [lane_departure_checker]: Fix lint

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

* [autoware_utils]: Publish autoware debug msgs

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

* [lane_departure_checker]: Use autoware_debug_msgs instead of std_msgs

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

* [goal_distance_calculator]: Use autoware_debug_msgs instead of std_msgs

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

* [autoware_utils]: Add namespace to debug traits

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

* [lane_departure_checker]: Fix lint

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

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

* Ros2 v0.8.0 behavior velocity planner (#332)

* restore behavior velocity planner files for v0.8.0 update

* Fix detection area (#808)

* Remove PASS state

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

* Keep stopping after going over dead-line in STOP state

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

* Clear state after obstacle disappears

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

* Parameterize and change conditions

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

* Refactor

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

* add elapsed time checker

* Refactor

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

* Ignore inserting point if points are too close

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

* Rename NORMAL to GO

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

* Revert "Ignore inserting point if points are too close"

This reverts commit 91c8d620ea11e703611945cb9a50877d175f4ff6.

* Fix small bug

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

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

* fix timing of publish stop reason of stop_line (#845)

* fix timing of publish stop reason of stop_line

* Fix formatting

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

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

* Fix task registration of detection area module (#856)

* Fix task registration of detection area module

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

* Fix id of factor_text marker

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

* Do not interpolate if path size is 1 (#865)

* Revert "restore behavior velocity planner files for v0.8.0 update"

This reverts commit ce07d3c2bfae562d56fec46c4f81d5351fd936a1.

* fix some implement miss

* restore behavior velocity planner files for v0.8.0 update

* change intersection param (#861)

* Fix/intersection stop line (#841)

* add trimmed path function

* fix typo

* avoid to insert stop line outside intersection

* Add pass judge flag (#872)

* Add pass judge flag

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

* Fix wrong format

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

* Fix flag order in judge condition

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

* add ignore width with blind spot (#864)

* add ignore width with blind spot

* remove unused function

* fix typo

* fix margin

* remove bicycle from intersection stuck vehicle (#896)

* Revert "restore behavior velocity planner files for v0.8.0 update"

This reverts commit ff61ee56f2ce4728e53eb698836db60d68bf64b9.

* fix implement miss

* restore behavior velocity planner files for v0.8.0 update (fixed)

* Add external traffic light input (#912)

* Add external traffic light input

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

* Update topic namespace

* Fix typos in planning modules (#866)

* fix typos in planning

* fix corresponding typos in planning

* revert fixed typos temporarily due to its impact on launchers

* add exception handling to intersection module (#920)

* add exception handling

* output input path

* prevent passthrough chattering (#901)

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

* cosnider current_velocity to calculate intersection passing time (#880)

* cosnider current_velocity to calculate intersection passing time

* add fabs to current velocity

* Improve stuck vehicle detect (#824)

* intersection: modify stuck vehicle detect logic to consider the object shape

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

* intersection: consider ego-vehicle length when calculate stuck vehicle detection area

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

* intersection: change param stuck_vehicle_ignore_dist: 5.0 -> 7.0

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

* intersection: use vehicle_info/vehicle_length

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

* fix implement miss

* fix target pedestrian (#927)

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

* fix insert backward point (#953)

* fix insert backward point

* add comment

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

* remove unnecessary if

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

* Add stop line referred from road marking (#968)

* Add stop line referred from road marking

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

* Add stop line for walkway

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

* Feature/external input (#982)

* add external input msg

* impl external input(crosswalk, intersection)

* :put_litter_in_its_place:

* change to ++14

* fix bug

* fix bug

* cosmetic change

* Revert "restore behavior velocity planner files for v0.8.0 update"

This reverts commit ff61ee56f2ce4728e53eb698836db60d68bf64b9.

* Fix typo (#1013)

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

* Fix/blind spot insert point (#1027)

* Copy insert point from previous point

* Reset path unless state is stop

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

* change slow down speed (#1030)

* restore behavior velocity planner files for v0.8.0 update (fixed)

* Fix/walkway stop judge range (#1028)

* Fix walkway stop judge

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

* Make refer id same

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

* fix getObjectivePolygons() so that intersecting lanelet is added to objective lanelets even when there is no preceeding lanelets (#1010)

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

* Revert "restore behavior velocity planner files for v0.8.0 update (fixed)"

This reverts commit 39231f23eb17e39a418f28f5ccfe1df55b3fb45c.

* fix implement miss for marker

* restore behavior velocity planner files for v0.8.0 update (fixed)

* Fix/blind spot polygon (#1056)

* Fix detection area for blind spot

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

* Apply clang format

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

* Shrink conflicting area

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

* chane slowdown judgement (#1066)

* chane slowdown judgement

* cosmetic change

* Revert "restore behavior velocity planner files for v0.8.0 update (fixed)"

This reverts commit 39231f23eb17e39a418f28f5ccfe1df55b3fb45c.

* fixed for ros2 style

* restore behavior velocity planner files for v0.8.0 update (fixed)

* Remove unused headers in behavior_velocity_planner (#1072)

* publish walkway stop reason (#1073)

* Revert "restore behavior velocity planner files for v0.8.0 update (fixed)"

This reverts commit 39231f23eb17e39a418f28f5ccfe1df55b3fb45c.

* restore behavior velocity planner files for v0.8.0 update (fixed)

* Add correspondence marker of detection_area and stop_line (#1081)

* Fix comment

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

* Add const

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

* Add correspondence marker of detection_area and stop_line

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

* Add obstacle marker

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

* Fixup

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

* Add id marker

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

* Clear state when time rollback found

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

* Fix typo

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

* change stop to polygon line

* apply clang format

* fix code

* fix bug

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

* Fix pass judge idx (#1090)

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

* fix bug (#1087)

* Revert "restore behavior velocity planner files for v0.8.0 update (fixed)"

This reverts commit 39231f23eb17e39a418f28f5ccfe1df55b3fb45c.

* fix for ros2 style

* restore behavior velocity planner files for v0.8.0 update (fixed)

* Fix/remove duplicated point (#1107)

* Split PoseDeviaiton functions

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

* Remove unnecessary pose

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

* Don't insert point if duplicated point exists

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

* Fix condition of duplicated points

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

* seperate stop distance param (#1137)

* seperate stop distance param

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

* apply param for automotically generated stop line

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

* shift slow down line

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

* add param in yaml file

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

* fix prediction_time_margin bug (#1148)

* Revert "restore behavior velocity planner files for v0.8.0 update (fixed)"

This reverts commit 39231f23eb17e39a418f28f5ccfe1df55b3fb45c.

* fix ros2 style

* remove deprecated

* reformat

* add test temporary launch

* cpp_lint_namespace_what_you_use

* lint_comment_line_length

* pass ament cpplint

* fixe commit

* fix code

* remove unneccesary

* fix param structure

* fix missng params

* fix throttle time

Co-authored-by: tomoya.kimura <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: taichiH <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Fumiya Watanabe <[email protected]>
Co-authored-by: Daisuke Nishimatsu <[email protected]>
Co-authored-by: Kazuki Miyahara <[email protected]>
Co-authored-by: Yukihiro Saito <[email protected]>
Co-authored-by: Takamasa Horibe <[email protected]>
Co-authored-by: Kosuke Murakami <[email protected]>
Co-authored-by: Ryohsuke Mitsudome <[email protected]>

* Fix/lane departure checker (#386)

* Fix/lane departure checker (#1177)

* Add more processing time measurement

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

* Rename processing_time to processing_time_ms

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

* Refactor StopWatch class

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

* apply ament_uncrustify

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

* Fix autoware_utils (#419)

* Fix autoware_utils

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

* Apply format

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

* Add <memory>

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

* Ros2 fix topic name part1 (#408)

* Fix topic name of lane_departure_checker debug

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

* Fix topic name of mpc_follower debug

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

* Fix topic name of velocity_controller debug

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

* Fix topic name of motion_velocity_optimizer debug

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

* Fix topic name of lane_change_planner debug

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

* Fix topic name of behavior_velocity_planner debug

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

* Fix topic name of obstacle_avoidance_planner debug

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

* Fix topic name of behavior_velocity_planner

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

* Fix topic name of motion_velocity_optimizer

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

* Fix topic name of lane_departure_checker

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

* Fix topic name of mpc_follower

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

* Fix topic name of behavior_velocity_planner

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

* Fix topic name of velocity_controller

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

* Fix topic name of lane_change_planner

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

* Fix topic name of obstacle_avoidance_planner

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

* Fix topic name of obstacle_stop_planner

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

* Fix topic name of costmap_generator

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

* Fix topic name of freespace_planner

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

* Fix topic name of surround_obstacle_checker

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

* Fix topic name of costmap_generator

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

* Fix topic name of emergency_handler

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

* Fix lint errors

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

* Fix typo

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

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

* Ros2 delete vehicle info (#1227)

* remove dependency on vehicle info in autoware_utils

* delete vehicle_info in autoware_utils

* Unify Apache-2.0 license name (#1242)

* Fix/fix utils (#1310)

* Add missing namespace to autoware_utils

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

* Add createVehicleInfo

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

* Add rethrow

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

* Format package.xml

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

* Fix usage of autoware_utils

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

* Add missing namespace comment

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

* Make a curvature calculation function in autoware_utils' library (#1388) (#1393)

* add curvature calculation function

* add two functions

* integrate 2 functions into 1 function by template function

* add unit test for curvature calculation

* modify spell

* Update common/util/autoware_utils/include/autoware_utils/math/curvature.h

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

* add modifications

* modify format

* update

* update

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

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

* rename function from calculateCUrvature to calcCurvature (#1461) (#1486)

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

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

* Add trajectory functions in autoware_utils (#1410)(#1438)(#1416)(#1473)(#1491) (#1482)

* Add closest point index calculation function in autoware_utils (#1410)

* add nearest point calculator

* update

* add template

* update

* update

* update

* update variables name

* update variables name

* remove redundant expression

* add unit test

* update test

* test has some errors

* update

* update name

* update name

* modify bug

* update

* update

* add new test cases

* add new function

* add get pose function

* delete unnecessary file

* update test

* delete namespace

* add emtpy handler

* remove redundant test

* remove template

* add necessary files to autoware_utils (#1438)

* add necessary files

* Apply fix

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

* fix test

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

* Fix lint

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

* Fix build warning

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

* add some trajectory functions commonly used in planning/control (#1416)

* add some trajectory functions commonly used in p/c

* minor fix with reviews

* refactor based on reviews

* minor changes

* refactor based on reviews

* minor changes

* minor changes

* refactor based on reviews

* use std::vector<T> and T in findClosestIndex

* fix bugs that I wrote wrong

* refactor

* refactor

* fix bug of including optional.hpp twice

* refactor

* refactor

* fix bug

* fix bugs

* update

* apply clang-format

* add blank line

* add test for searchZeroVelocityIndex

* update

* update

* update

* add some tests

* closest -> nearest

* add some test

* update test

* not to use optional if not necessary

* not unsigned

* add explanation of segment

* update

* 契約プログラミング

* add signed to variable of length

* update

* update

* update

* update test

* update

* update test

* update

* update test

* update

* update

* update

* update

* update

* update

* update

* Remove wrapper for autoware_plannig_msgs

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

* Fix test

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

* Change implementation of calcLongitudinalOffsetToSegment

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

* Set default value for trajectory velocity

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

* Remove unused function

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

* add 3 cases for curve trajectory

* update

* Revert "update"

This reverts commit 6d4f3ee25f49dcca146340c9a1ed3f4c1ac4f55c.

* Revert "add 3 cases for curve trajectory"

This reverts commit d3f4751851afcdac41e160fecbb6bee9ac9f60a2.

* Add test case

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

* Fix comment

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

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

* use template in geometry.hpp (#1473)

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

* Fix include

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

* Fix errors

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

* Fix license

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

* Fix find nearest segment index (#1491)

* add odd test case, and confirmed that the test don't pass

* fix findNearestSegmentIndex, and confirmed all the test passed

* use calcLongitudinalOffsetToSegment

* use vector in test

* add deleted comment

Co-authored-by: purewater0901 <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Takayuki Murooka <[email protected]>
Co-authored-by: Takamasa Horibe <[email protected]>

* Feature/update autoware utils (#1501)(#1513)(#1522)(#1463)(#1503) (#1544)

* generalize searchZeroVelocityIndex Function (#1501)

* generalize searchZeroVelocityIndex Function

* update test

* fix test case

* update test case

* update terminal index in the test

* Fix/fix autoware utils geometry (#1513)

* Revert geometry.cpp

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

* Add default implementations

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

* add constant gravity (#1522)

* add arange & linspace in math util (#1463)

* [WIP] add arange & linspace in math util

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

* add unittest cases of arange and linspace

* implement and test arange and linspace in util library

* fix issues found in review

* fix typos

* fix issue found in review

* fix typo

* fix issues found in review

* fix issues found in review

Co-authored-by: nisshan-x <[email protected]>

* extend findNearestIndex, and add tests (#1503)

* extend findNearestIndex, and add tests

* apply clang-format

* update

* hoge_threshold -> max_hoge

* _min/_max -> min_/max_, and update

* update

* update

* update

* update

* update

* Fix warnings

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

* Add reserve for autoware_utils::arange

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

Co-authored-by: purewater0901 <[email protected]>
Co-authored-by: Takayuki Murooka <[email protected]>
Co-authored-by: Takamasa Horibe <[email protected]>
Co-authored-by: nisshan-x <[email protected]>

* Add update_param.hpp in autoware_utils (#1556)

* Add update_param.hpp in autoware_utils

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

* Change to bool

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

* Remove unnecesarry file for test (#1605)

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

* Feature/update autoware_utils (#1576) (#1599) (#1603) (#1619) (#1631) (#1650)

* Add tests for autoware_utils::StopWatch (#1832)

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

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

* Autoware util squared dist main merge (#1853)

* autoware_utils: use calcSquaredDistance in calcClosest

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

* add test

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

* Fix clang warnings (#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 clang-tidy warnings of autoware_utils (#1854)

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

* Revive constructor of StopWatch class (#1882)

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

* enable autonomous recovery (#1904)

* add createQuaternionFromYaw (#2120)

* add createQuaternionFromYaw

* add test

* change return value type of createQuaternionFromRPY from tf2::quat to geomety_msgs::msg::quat

* use geometry_msgs::msg::Quaternion in createQuaternionFromRPY in application

* implement fast findNearestIndex with threshold (#2142)

* implement fast findNearestIndex with threshold

* fix reviews

* add calcLateralLength (#2226)

* add calcLateralLength

* rename length to offset

* imeplemet in ROS2 (#1868)

* add new get point function for posewithcovariancestamped (#2156)

* add new get point function for posewithcovariancestamped

* fix format

* add behavior velocity planner utils (#2113)

* add gtest utils

* add state machine as utils

* add arc lane utils

* remove empty file

* add gtest for offset segment

* use calcdist2d in autoware util

* apply get point

* fix uncrustify

* fix conflict getPoint in behavior path

* apply commit suggestion

* slower than ros1

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

* use autoware_auto_msgs (#489)

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

* remove COLCON_IGNORE (#502)

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

* Add trajectory converter (#512)

* Add trajectory converter

* Add comment

* Fix comment

* Fix comment

* Add TODO in comment

* Update common/util/autoware_utils/include/autoware_utils/trajectory/convert.hpp

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

* Fix comment

* Use doxygen style comment

* Fix function name

* Fix test code

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

* add README (#671)

* 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: Nikolai Morin <[email protected]>
Co-authored-by: Daisuke Nishimatsu <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: taikitanaka3 <[email protected]>
Co-authored-by: taichiH <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Fumiya Watanabe <[email protected]>
Co-authored-by: Kazuki Miyahara <[email protected]>
Co-authored-by: Yukihiro Saito <[email protected]>
Co-authored-by: Takamasa Horibe <[email protected]>
Co-authored-by: Kosuke Murakami <[email protected]>
Co-authored-by: Ryohsuke Mitsudome <[email protected]>
Co-authored-by: Takagi, Isamu <[email protected]>
Co-authored-by: purewater0901 <[email protected]>
Co-authored-by: Takayuki Murooka <[email protected]>
Co-authored-by: nisshan-x <[email protected]>
Co-authored-by: Satoshi OTA <[email protected]>
Co-authored-by: Hiroki OTA <[email protected]>
Co-authored-by: Taichi Higashide <[email protected]>
Co-authored-by: Takayuki Murooka <[email protected]>
Co-authored-by: Takeshi Miura <[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: Takeshi Ishita <[email protected]>
Co-authored-by: Makoto Kurihara <[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]>
badai-nguyen referenced this pull request in badai-nguyen/autoware.universe Feb 4, 2022
* release v0.4.0

* remove ROS1 packages temporarily

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

* add sample ros2 packages

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

* remove ROS1 packages

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

* Revert "remove ROS1 packages temporarily"

This reverts commit bcc60bdc82842e2ea4d1e844b4442fa613d80fdf.

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

* add COLCON_IGNORE to ros1 packages

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

* Port shift decider to ros2 (#7)

* Update package.xml and CMakeLists.txt to ros2

Code doesn't compile yet

* Code compiles

* Update launch file

* Add better timer

clang-format shift_decider

* 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

* Added linters to shift_decider (autowarefoundation#167)

* Added linters to shift_decider

* Fix dependencies

* Use ament_cmake_cppcheck and ament_cmake_cpplint

* Fix linting errors

* add use_sim-time option (autowarefoundation#454)

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

* Make control modules components (autowarefoundation#1262)

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

* Remove use_sim_time for set_parameter (autowarefoundation#1260)

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

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

* Revert "Temporarily comment out pre-commit hooks"

This reverts commit 748e9cdb145ce12f8b520bcbd97f5ff899fc28a3.

* Replace ament_lint_common with autoware_lint_common

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

* Remove ament_cmake_uncrustify and ament_clang_format

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

* Apply Black

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

* Apply clang-format

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

* Fix build errors

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

* Fix for cpplint

* Fix include double quotes to angle brackets

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

* Apply clang-format

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

* Fix build errors

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

* Add COLCON_IGNORE (autowarefoundation#500)

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

* port shift decider (autowarefoundation#485)

* port shift decider

* apply clang format

* delete colcon ignore

* change to ackermann control command

* 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]>

* [shift decider] add README.md (autowarefoundation#577)

* add readme to shift decider

* better expression

Co-authored-by: tkimura4 <[email protected]>

Co-authored-by: taikitanaka3 <[email protected]>
Co-authored-by: tkimura4 <[email protected]>

* Fix topic name (autowarefoundation#673)

Co-authored-by: mitsudome-r <[email protected]>
Co-authored-by: Frederik Beaujean <[email protected]>
Co-authored-by: Nikolai Morin <[email protected]>
Co-authored-by: Esteve Fernandez <[email protected]>
Co-authored-by: tkimura4 <[email protected]>
Co-authored-by: Kazuki Miyahara <[email protected]>
Co-authored-by: Daisuke Nishimatsu <[email protected]>
Co-authored-by: Keisuke Shima <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Sugatyon <[email protected]>
Co-authored-by: taikitanaka3 <[email protected]>
Co-authored-by: Fumiya Watanabe <[email protected]>
badai-nguyen referenced this pull request in badai-nguyen/autoware.universe Feb 4, 2022
* release v0.4.0

* load velocity_controller_param.yaml from launcher (autowarefoundation#52)

Signed-off-by: Shinnosuke Hirakawa <[email protected]>

* Include enable_slope_compensation to yaml file (autowarefoundation#61)

* Sync mpc param (autowarefoundation#74)

Signed-off-by: wep21 <[email protected]>

* add stop dist param (autowarefoundation#73)

* add stop dist param

* add keep stopping dist param

* removed ROS1 package

Signed-off-by: mitsudome-r <[email protected]>

* Revert "removed ROS1 package"

This reverts commit 85eb34207aa7b90314d93a6eb370213e10fcd7bd.

* add COLCON_IGNORE file to all ROS1 packages

Signed-off-by: mitsudome-r <[email protected]>

* rename *.launch files to *.launch.xml

Signed-off-by: mitsudome-r <[email protected]>

* port control launch (#7)

* port control launch

Signed-off-by: Takamasa Horibe <[email protected]>

* fix license

Signed-off-by: Takamasa Horibe <[email protected]>

* ROS2 Linting: control_launch (autowarefoundation#29)

* Add linter tests and completepackage dependencies list

* Reorder alphabetically

* Comment out pure_pursuit dependency - not ported yet

* Add back pure_pursuit package post port

* Ros2 port autoware launch (autowarefoundation#35)

* [autoware_launch] port CMakelists.txt and remove COLCON_IGNORE

Signed-off-by: mitsudome-r <[email protected]>

* [autoware_launch] fix planning_simulator.launch.xml

Signed-off-by: mitsudome-r <[email protected]>

* [autoware_launch] add rviz config

Signed-off-by: mitsudome-r <[email protected]>

* [autoware_launch] first port of autoware_launch

Signed-off-by: mitsudome-r <[email protected]>

* lanuch rviz with config file

Signed-off-by: kosuke murakami <[email protected]>

* modify launch file for making psim work

Signed-off-by: kosuke murakami <[email protected]>

* add vehicle model in launch

Signed-off-by: kosuke murakami <[email protected]>

* change from vehicle_model to vehicle_param_file

Signed-off-by: kosuke murakami <[email protected]>

* [autoware_launch] add autoware_web_controller and system launch

Signed-off-by: mitsudome-r <[email protected]>

* add rosbrdige_suite to build_depends.repos

Signed-off-by: mitsudome-r <[email protected]>

* Update rviz

Signed-off-by: wep21 <[email protected]>

* update autoware.rviz

Signed-off-by: mitsudome-r <[email protected]>

* remove autoware_ros2.rviz

Signed-off-by: mitsudome-r <[email protected]>

Co-authored-by: kosuke murakami <[email protected]>
Co-authored-by: wep21 <[email protected]>

* Ros2 v0.8.0 control launch (autowarefoundation#53)

* restore file name for v0.8.0 update

Signed-off-by: Takamasa Horibe <[email protected]>

* Add use_emergency_handling arg to vehicle_cmd_gate.launch (autowarefoundation#83)

Signed-off-by: Kenji Miyake <[email protected]>

* Add parameter for using steer prediction (autowarefoundation#88)

* change stop dist param (autowarefoundation#85)

* mpc: change param name steer_rate_lim_deg -> steer_rate_lim_dps (autowarefoundation#79)

Signed-off-by: Takamasa Horibe <[email protected]>

* add mpc parameter (autowarefoundation#105)

* Add parameters for stop state (autowarefoundation#126)

* Add parameters for stop state

* Change default value

* Add vehicle cmd gate config (autowarefoundation#136)

* Add config_file of vehicle_cmd_gate

Signed-off-by: Kenji Miyake <[email protected]>

* Add use_emergency_stop

Signed-off-by: Kenji Miyake <[email protected]>

* Rename emergency_stop to external_emergency_stop

Signed-off-by: Kenji Miyake <[email protected]>

* Fix command_gate diag

Signed-off-by: Kenji Miyake <[email protected]>

* Add lane_departure_checker (autowarefoundation#123)

Signed-off-by: Kenji Miyake <[email protected]>

* Revert "restore file name for v0.8.0 update"

This reverts commit 516b366819f7f9d69b9bc3e2de180d4523794bcd.

* fix control launch

Signed-off-by: Takamasa Horibe <[email protected]>

* fix args

Signed-off-by: Takamasa Horibe <[email protected]>

* fix param type

Signed-off-by: Takamasa Horibe <[email protected]>

* fix lane departure checker

Signed-off-by: Takamasa Horibe <[email protected]>

Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Fumiya Watanabe <[email protected]>
Co-authored-by: tkimura4 <[email protected]>

* [velocity controller]: Fix parameter type (autowarefoundation#62)

Signed-off-by: wep21 <[email protected]>

* Rename ROS-related .yaml to .param.yaml (autowarefoundation#65)

* Rename ROS-related .yaml to .param.yaml

Signed-off-by: Kenji Miyake <[email protected]>

* Add missing '--'

Signed-off-by: Kenji Miyake <[email protected]>

* Rename vehicle_info.yaml to vehicle_info.param.yaml

Signed-off-by: Kenji Miyake <[email protected]>

* Fix livox param name

Signed-off-by: Kenji Miyake <[email protected]>

* Ros2 update v0.9.0 (autowarefoundation#67)

* Add pose history into rviz config

Signed-off-by: wep21 <[email protected]>

* add blocked by obstacle option (autowarefoundation#164)

* fix tab name (autowarefoundation#166)

* disenable ndt visualization (autowarefoundation#169)

* disenable ndt visualization

* change alpha

* dont visualize position covariance

Signed-off-by: wep21 <[email protected]>

* change global frame to map (autowarefoundation#171)

* add param (autowarefoundation#156)

Co-authored-by: taikitanaka3 <[email protected]>
Co-authored-by: Taichi Higashide <[email protected]>
Co-authored-by: Yukihiro Saito <[email protected]>
Co-authored-by: tkimura4 <[email protected]>

* Fix typo in control launch (autowarefoundation#91)

* Fix typo in control module

* change admissible_yaw_error -> admissible_yaw_error_rad

* Fix various typos in launch files (autowarefoundation#97)

* add use_sim-time option (autowarefoundation#99)

* Replace doc by description (autowarefoundation#182)

Signed-off-by: Kenji Miyake <[email protected]>

* Sync public repo (autowarefoundation#185)

* add tier4 usbcam (autowarefoundation#104)

* add tier4 usbcam

* change version

* tier4/ros2

* Ros2 vehicle info param server (autowarefoundation#96)

* add vehicle info param server

* delete vehicle param file

Co-authored-by: taikitanaka <[email protected]>

* Ros2 fix topic name part2 (autowarefoundation#89)

* Fix topic name for traffic_light_classifier

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name for traffic_light_visualization

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name for traffic_light_ssd_fine_detector

Signed-off-by: Takagi, Isamu <[email protected]>

Co-authored-by: taikitanaka3 <[email protected]>
Co-authored-by: tkimura4 <[email protected]>
Co-authored-by: taikitanaka <[email protected]>
Co-authored-by: Takagi, Isamu <[email protected]>

* Use set_parameter for use_sim_time (autowarefoundation#198)

* Use set_parameter for use_sim_time

Signed-off-by: wep21 <[email protected]>

* Add default parameter for scenario simulator

Signed-off-by: wep21 <[email protected]>

* Add control composed launch (autowarefoundation#201)

Signed-off-by: wep21 <[email protected]>

* Fix mistakes in control.launch.py (autowarefoundation#209)

* Fix typo in control.launch.py

Signed-off-by: Kenji Miyake <[email protected]>

* Add remote_cmd_converter_component

Signed-off-by: Kenji Miyake <[email protected]>

* Feature/add external cmd selector (autowarefoundation#206)

* Add remote_cmd_selector to control.launch (autowarefoundation#172)

* Add remote_cmd_selector to control.launch

Signed-off-by: Kenji Miyake <[email protected]>

* Rename remote_cmd_selector to external_cmd_selector

Signed-off-by: Kenji Miyake <[email protected]>

* Change default external cmd source (autowarefoundation#173)

Signed-off-by: Kenji Miyake <[email protected]>

* modify to use control.launch.xml

* add external_cmd_selector to control.launch.py

* Fix remapping in control.launch.py

Signed-off-by: Kenji Miyake <[email protected]>

* Fix remapping in control.launch.py again

Signed-off-by: Kenji Miyake <[email protected]>

Co-authored-by: Keisuke Shima <[email protected]>

* Format launch files (autowarefoundation#228)

* Format launch files

Signed-off-by: Kenji Miyake <[email protected]>

* Format launch.py

Signed-off-by: Kenji Miyake <[email protected]>

* Fix lint

Signed-off-by: Kenji Miyake <[email protected]>

* add external commands (autowarefoundation#210)

* add remote commands

* fix topic

* ToExternalCmd

* fix topic in remote cmd converter

* fix ament

* add description for control_launch (autowarefoundation#330)

* add description

* fix sentence

* use of

* add README.md and svg files (autowarefoundation#328)

* add md and svg

* fix typo

* fix typo

* fix word

* fix typo

* add lack of things

* Update README

* fix depending packages

* fix word

* Feature/expand footprint launcher (autowarefoundation#318)

* fix typo in control.launch.py autowarefoundation#363

* Fix description in control launch arg (autowarefoundation#364)

* Add autoware api (autowarefoundation#376)

* Add external api adaptor (autowarefoundation#267)

* Add external api adaptor

* Add api adaptor to logging simulator

Signed-off-by: Takagi, Isamu <[email protected]>

* Add engage status output

Signed-off-by: Takagi, Isamu <[email protected]>

* Add internal api adaptor (autowarefoundation#273)

Signed-off-by: Takagi, Isamu <[email protected]>

* Add map hash generator (autowarefoundation#319)

Signed-off-by: Takagi, Isamu <[email protected]>

* Add autoware api launch (autowarefoundation#326)

* Add autoware api launch

Signed-off-by: Takagi, Isamu <[email protected]>

* Apply autoware api launch

Signed-off-by: Takagi, Isamu <[email protected]>

* Add deprecated comment

Signed-off-by: Takagi, Isamu <[email protected]>

* Remove unused parameter (autowarefoundation#325)

Signed-off-by: Takagi, Isamu <[email protected]>

* Add api parameter (autowarefoundation#341)

Signed-off-by: Takagi, Isamu <[email protected]>

* Add start request API (autowarefoundation#321)

* Add use start request option

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix lint

Signed-off-by: Takagi, Isamu <[email protected]>

* Feature external cmd selector heartbeat (autowarefoundation#356)

* Rename external command topic

Signed-off-by: Takagi, Isamu <[email protected]>

* Modify command topic name

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix topic name

Signed-off-by: Takagi, Isamu <[email protected]>

* Rename remote_cmd_converter

Signed-off-by: Takagi, Isamu <[email protected]>

* Remove gate mode from external command

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix latest external command name (autowarefoundation#361)

Signed-off-by: Takagi, Isamu <[email protected]>

* Fix merge conflict

Signed-off-by: Takagi, Isamu <[email protected]>

* change external traffic light topic name in behavior velocity planner (autowarefoundation#310)

* fix topic

* change internal topic name

Co-authored-by: yabuta <[email protected]>

* Move launch file of external_cmd_selector (autowarefoundation#386)

* Move launch file of external_cmd_selector

Signed-off-by: Takagi, Isamu <[email protected]>

* Add utility function to include launch.py

Signed-off-by: Takagi, Isamu <[email protected]>

* Add missing parameter

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]>

* Use EmergencyState instead of deprecated EmergencyMode (autowarefoundation#390)

* Use EmergencyState instead of deprecated EmergencyMode

Signed-off-by: Kenji Miyake <[email protected]>

* Update control.launch.py

* Add selected external command API  (autowarefoundation#397)

* Fix pre-commit (autowarefoundation#407)

* Fix pre-commit errors

Signed-off-by: Kenji Miyake <[email protected]>

* Fix package.xml

Signed-off-by: Kenji Miyake <[email protected]>

* Add emergency status API (autowarefoundation#439)

* remove yaw-recalc param in mpc (autowarefoundation#190) (autowarefoundation#294)

Co-authored-by: tkimura4 <[email protected]>

* Master sync for velocity controller (autowarefoundation#297)

* update velocity_controller_param.yaml for refactoring velocity_controller (autowarefoundation#238)

* update velocity_controller_param.yaml (autowarefoundation#247)

Co-authored-by: Takayuki Murooka <[email protected]>

* Fix parameter type (autowarefoundation#299)

Signed-off-by: wep21 <[email protected]>

* add smoothing_num parameter (autowarefoundation#263) (autowarefoundation#301)

* add smoothing_num parameter

* change param

Co-authored-by: tkimura4 <[email protected]>

* add stopped_jerk (autowarefoundation#276) (autowarefoundation#315)

* add stopped_jerk

* set stopped_jerk -5.0

Co-authored-by: Takayuki Murooka <[email protected]>

* Rename param from smooth_stop_max_fast_vel to smooth_stop_min_fast_vel (autowarefoundation#351)

* Feature/vehicle gate parametrize acc (autowarefoundation#320)

* [vehicle_cmd_gate] add acc parameters

Signed-off-by: TakaHoribe <[email protected]>

* fix typo

Signed-off-by: TakaHoribe <[email protected]>

* Update control_launch/config/vehicle_cmd_gate/vehicle_cmd_gate.param.yaml

Co-authored-by: tkimura4 <[email protected]>

Co-authored-by: Daisuke Nishimatsu <[email protected]>
Co-authored-by: tkimura4 <[email protected]>

* Change formatter to black (autowarefoundation#488)

* Update pre-commit settings

* Apply Black

* Replace ament_lint_common with autoware_lint_common

* Update build_depends.repos

* Fix build_depends

* twist -> odometry (autowarefoundation#109)

Co-authored-by: Takayuki Murooka <[email protected]>

* remove unused depend/launcher (autowarefoundation#112)

* Auto/control psim (autowarefoundation#113)

* succeeded in launching control nodes

* fix input/output of control_launch

* Remove multiple package

* Add newline

* Update control_launch/launch/control.launch.py

Co-authored-by: tkimura4 <[email protected]>

* Apply pre-commit

Co-authored-by: Takayuki Murooka <[email protected]>
Co-authored-by: tkimura4 <[email protected]>

* Fix remapping in control.launch.py (autowarefoundation#115)

* Fix remappings

* Add comment

* Fix remappings (autowarefoundation#116)

* fix topics

* add external hazard indicator

* add param (autowarefoundation#126)

* fix yaml (autowarefoundation#127)

* remove unused files

Signed-off-by: tomoya.kimura <[email protected]>

* add default parameter of vehicle information

Signed-off-by: tomoya.kimura <[email protected]>

* ci(pre-commit): autofix

Co-authored-by: mitsudome-r <[email protected]>
Co-authored-by: shin <[email protected]>
Co-authored-by: Fumiya Watanabe <[email protected]>
Co-authored-by: Daisuke Nishimatsu <[email protected]>
Co-authored-by: Takamasa Horibe <[email protected]>
Co-authored-by: Jilada Eccleston <[email protected]>
Co-authored-by: Ryohsuke Mitsudome <[email protected]>
Co-authored-by: kosuke murakami <[email protected]>
Co-authored-by: wep21 <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: taikitanaka3 <[email protected]>
Co-authored-by: Taichi Higashide <[email protected]>
Co-authored-by: Yukihiro Saito <[email protected]>
Co-authored-by: Kazuki Miyahara <[email protected]>
Co-authored-by: taikitanaka <[email protected]>
Co-authored-by: Takagi, Isamu <[email protected]>
Co-authored-by: Keisuke Shima <[email protected]>
Co-authored-by: Hiroki OTA <[email protected]>
Co-authored-by: yabuta <[email protected]>
Co-authored-by: Takayuki Murooka <[email protected]>
Co-authored-by: Maxime CLEMENT <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Takayuki Murooka <[email protected]>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>
@tkimura4 tkimura4 deleted the 1-add-autoware-utils branch March 1, 2022 10:15
KYabuuchi pushed a commit to KYabuuchi/autoware.universe that referenced this pull request Feb 16, 2023
* chore: add .gitignore

Signed-off-by: Kenji Miyake <[email protected]>

* feat: add autoware.repos

Signed-off-by: Kenji Miyake <[email protected]>

* ci: add vcs-import workflow

Signed-off-by: Kenji Miyake <[email protected]>

* feat: remove simulator repositories

Signed-off-by: Kenji Miyake <[email protected]>

* fix: add pacmod3_msgs for ARM build

Signed-off-by: Kenji Miyake <[email protected]>

* Revert "fix: add pacmod3_msgs for ARM build"

This reverts commit 7881201.

Signed-off-by: Kenji Miyake <[email protected]>
KYabuuchi added a commit to KYabuuchi/autoware.universe that referenced this pull request May 31, 2023
* WIP: add license description

Signed-off-by: Kento Yabuuchi <[email protected]>

* add license description

Signed-off-by: Kento Yabuuchi <[email protected]>

* add description about license in README

Signed-off-by: Kento Yabuuchi <[email protected]>

---------

Signed-off-by: Kento Yabuuchi <[email protected]>
KYabuuchi added a commit to KYabuuchi/autoware.universe that referenced this pull request Jun 6, 2023
* WIP: add license description

Signed-off-by: Kento Yabuuchi <[email protected]>

* add license description

Signed-off-by: Kento Yabuuchi <[email protected]>

* add description about license in README

Signed-off-by: Kento Yabuuchi <[email protected]>

---------

Signed-off-by: Kento Yabuuchi <[email protected]>
KYabuuchi added a commit to KYabuuchi/autoware.universe that referenced this pull request Jun 12, 2023
* WIP: add license description

Signed-off-by: Kento Yabuuchi <[email protected]>

* add license description

Signed-off-by: Kento Yabuuchi <[email protected]>

* add description about license in README

Signed-off-by: Kento Yabuuchi <[email protected]>

---------

Signed-off-by: Kento Yabuuchi <[email protected]>
KYabuuchi added a commit that referenced this pull request Jun 22, 2023
* adopt scane_case to undistort, segment_filter

Signed-off-by: Kento Yabuuchi <[email protected]>

* adopt scane_case to ground_server, ll2_decomposer

Signed-off-by: Kento Yabuuchi <[email protected]>

* adopt scane_case to twist_converter, twist_estimator

Signed-off-by: Kento Yabuuchi <[email protected]>

* adopt scane_case to validation packages

Signed-off-by: Kento Yabuuchi <[email protected]>

* adopt scane_case tomodularized_particle_filter

Signed-off-by: Kento Yabuuchi <[email protected]>

* adopt scane_case to gnss_particle_corrector

Signed-off-by: Kento Yabuuchi <[email protected]>

* adopt scane_case to camera_particle_corrector

Signed-off-by: Kento Yabuuchi <[email protected]>

* adopt scane_case to antishadow_corrector

Signed-off-by: Kento Yabuuchi <[email protected]>

* adopt scane_case to particle_initializer

Signed-off-by: Kento Yabuuchi <[email protected]>

* organize launch files

Signed-off-by: Kento Yabuuchi <[email protected]>

* add twist_visualizer to validate odometry performance

Signed-off-by: Kento Yabuuchi <[email protected]>

* use SE3::exp() to predict particles & modify linear noise model

Signed-off-by: Kento Yabuuchi <[email protected]>

* stop to use LL2 to rectify initialpose2d

Signed-off-by: Kento Yabuuchi <[email protected]>

* fix redundant computation in segment_accumulator

Signed-off-by: Kento Yabuuchi <[email protected]>

* improve gnss_particle_corrector

Signed-off-by: Kento Yabuuchi <[email protected]>

* fix segment_accumulator's bug

Signed-off-by: Kento Yabuuchi <[email protected]>

* add doppler_converter

Signed-off-by: Kento Yabuuchi <[email protected]>

* add xx2.launch.xml

Signed-off-by: Kento Yabuuchi <[email protected]>

* add hsv_extractor

Signed-off-by: Kento Yabuuchi <[email protected]>

* pickup other regions which have same color histogram

Signed-off-by: Kento Yabuuchi <[email protected]>

* use additional region to filt line-segments

Signed-off-by: Kento Yabuuchi <[email protected]>

* improve graph-segmentation

Signed-off-by: Kento Yabuuchi <[email protected]>

* remove `truncate_pixel_threshold`

Signed-off-by: Kento Yabuuchi <[email protected]>

* refactor graph_segmentator & segment_filter

Signed-off-by: Kento Yabuuchi <[email protected]>

* add mahalanobis_distance_threshold in GNSS particle corrector

Signed-off-by: Kento Yabuuchi <[email protected]>

* add extract_line_segments.hpp

Signed-off-by: Kento Yabuuchi <[email protected]>

* use pcl::transformCloudWithNormals instead of  transform_cloud

Signed-off-by: Kento Yabuuchi <[email protected]>

* filt accumulating segments by LL2

Signed-off-by: Kento Yabuuchi <[email protected]>

* move herarchical_cost_map to common

Signed-off-by: Kento Yabuuchi <[email protected]>

* apply positive feedback for accumulation

Signed-off-by: Kento Yabuuchi <[email protected]>

* move transform_linesegments() to common pkg

Signed-off-by: Kento Yabuuchi <[email protected]>

* refactor

Signed-off-by: Kento Yabuuchi <[email protected]>

* use all projected lines for camera corrector

Signed-off-by: Kento Yabuuchi <[email protected]>

* evaluate iffy linesegments

Signed-off-by: Kento Yabuuchi <[email protected]>

* complete to unify ll2-assisted lsd clasification

Signed-off-by: Kento Yabuuchi <[email protected]>

* add abs_cos2() which is more strict direction constraint

Signed-off-by: Kento Yabuuchi <[email protected]>

* fix orientation initialization bug

Signed-off-by: Kento Yabuuchi <[email protected]>

* publish doppler direction

Signed-off-by: Kento Yabuuchi <[email protected]>

* TMP: add disable/enable switch for camera corrector

Signed-off-by: Kento Yabuuchi <[email protected]>

* implement doppler orientation correction but it's disabled by default

Signed-off-by: Kento Yabuuchi <[email protected]>

* speed up camera corrector

Signed-off-by: Kento Yabuuchi <[email protected]>

* update ros params

Signed-off-by: Kento Yabuuchi <[email protected]>

* implement kalman filter for ground tilt estimation

Signed-off-by: Kento Yabuuchi <[email protected]>

* continuous height estimation works well?

Signed-off-by: Kento Yabuuchi <[email protected]>

* estimate height cotiniously

Signed-off-by: Kento Yabuuchi <[email protected]>

* use only linesegments which are at same height

Signed-off-by: Kento Yabuuchi <[email protected]>

* add static_gyro_bias parameter

Signed-off-by: Kento Yabuuchi <[email protected]>

* fix bug about overlay varidation

Signed-off-by: Kento Yabuuchi <[email protected]>

* increse ll2 height marging in cost map generation

Signed-off-by: Kento Yabuuchi <[email protected]>

* add static_gyro_bias in twist.launch.xml

Signed-off-by: Kento Yabuuchi <[email protected]>

* load pcdless_init_area from ll2

Signed-off-by: Kento Yabuuchi <[email protected]>

* add specified initialization area

Signed-off-by: Kento Yabuuchi <[email protected]>

* add corrector_manager node to disable/enable camera_corrector

Signed-off-by: Kento Yabuuchi <[email protected]>

* call service to disable camer_corrector from manager

Signed-off-by: Kento Yabuuchi <[email protected]>

* load corrector disable area

Signed-off-by: Kento Yabuuchi <[email protected]>

* overlay even if pose is not estiamted

Signed-off-by: Kento Yabuuchi <[email protected]>

* publish camera corrector's status as string

Signed-off-by: Kento Yabuuchi <[email protected]>

* add set_booL_panel for camera_corrector enable/disable

Signed-off-by: Kento Yabuuchi <[email protected]>

* load bounding box from lanelet2

Signed-off-by: Kento Yabuuchi <[email protected]>

* draw bounding box on cost map

Signed-off-by: Kento Yabuuchi <[email protected]>

* remove at2,at1 from cost map

Signed-off-by: Kento Yabuuchi <[email protected]>

* use cost_map::at() instread pf at2()

Signed-off-by: Kento Yabuuchi <[email protected]>

* move cost map library from common to camera corrector

Signed-off-by: Kento Yabuuchi <[email protected]>

* use logit for particle weighting but it does not work well

Signed-off-by: Kento Yabuuchi <[email protected]>

* prob_to_logit() requires non-intuitive parameters

Signed-off-by: Kento Yabuuchi <[email protected]>

* goodbye stupid parameters (max_raw_score & score_offset)

Signed-off-by: Kento Yabuuchi <[email protected]>

* publish two scored pointclouds as debug

Signed-off-by: Kento Yabuuchi <[email protected]>

* can handle unmapped areas

Signed-off-by: Kento Yabuuchi <[email protected]>

* remove obsolete packages

Signed-off-by: Kento Yabuuchi <[email protected]>

* update README.md

Signed-off-by: Kento Yabuuchi <[email protected]>

* Update README.md

* add image of how_to_launch

Signed-off-by: Kento Yabuuchi <[email protected]>

* add node diagram in readme

Signed-off-by: Kento Yabuuchi <[email protected]>

* add rviz_description.png in README

Signed-off-by: Kento Yabuuchi <[email protected]>

* subscribe pose_with_cov & disconnect base_link <-> particle_pose

Signed-off-by: Kento Yabuuchi <[email protected]>

* remove segment_accumulator & launch ekf_localizer from this project

Signed-off-by: Kento Yabuuchi <[email protected]>

* add gnss_ekf_corrector

Signed-off-by: Kento Yabuuchi <[email protected]>

* add camera_ekf_corrector package

Signed-off-by: Kento Yabuuchi <[email protected]>

* subscribe ekf prediction & synch pose data

Signed-off-by: Kento Yabuuchi <[email protected]>

* WIP: ready to implement UKF?

Signed-off-by: Kento Yabuuchi <[email protected]>

* estimate weighted averaging as pose_estimator

Signed-off-by: Kento Yabuuchi <[email protected]>

* basic algorithm is implemented but it does not work proparly

Signed-off-by: Kento Yabuuchi <[email protected]>

* apply after_cov_gain_

Signed-off-by: Kento Yabuuchi <[email protected]>

* ekf corrector works a little bit appropriately

Signed-off-by: Kento Yabuuchi <[email protected]>

* increase twist covariance for ekf

Signed-off-by: Kento Yabuuchi <[email protected]>

* test probability theory

Signed-off-by: Kento Yabuuchi <[email protected]>

* updat prob.py

Signed-off-by: Kento Yabuuchi <[email protected]>

* implement de-bayesing but it loooks ugly

Signed-off-by: Kento Yabuuchi <[email protected]>

* remove obsolete parameters

Signed-off-by: Kento Yabuuchi <[email protected]>

* skip measurement publishing if travel distance is so short

Signed-off-by: Kento Yabuuchi <[email protected]>

* use constant covariance because i dont understand what is correct

Signed-off-by: Kento Yabuuchi <[email protected]>

* add submodule sample_vehicle_launch

Signed-off-by: Kento Yabuuchi <[email protected]>

* TMP but it works

Signed-off-by: Kento Yabuuchi <[email protected]>

* add ekf_trigger in particle_initializer.hpp

Signed-off-by: Kento Yabuuchi <[email protected]>

* publish gnss markers & camera_est pubishes constant cov

Signed-off-by: Kento Yabuuchi <[email protected]>

* back to pcd-less only launcher

Signed-off-by: Kento Yabuuchi <[email protected]>

* add bayes_util package

Signed-off-by: Kento Yabuuchi <[email protected]>

* apply de-bayesing for camera_ekf

Signed-off-by: Kento Yabuuchi <[email protected]>

* some launch file update

Signed-off-by: Kento Yabuuchi <[email protected]>

* organize launch files. we can choice mode from ekf/pekf/pf

Signed-off-by: Kento Yabuuchi <[email protected]>

* organize particle_initializer

Signed-off-by: Kento Yabuuchi <[email protected]>

* add swap_mode_adaptor WIP

Signed-off-by: Kento Yabuuchi <[email protected]>

* use latest ekf in autoware & sample_vehicle

Signed-off-by: Kento Yabuuchi <[email protected]>

* fix bug of swap_adalptor

Signed-off-by: Kento Yabuuchi <[email protected]>

* fix FIX & FLOAT converter

Signed-off-by: Kento Yabuuchi <[email protected]>

* fix septentrio doppler converter

Signed-off-by: Kento Yabuuchi <[email protected]>

* move ekf packages to ekf directory

Signed-off-by: Kento Yabuuchi <[email protected]>

* ignore corrector_manager

Signed-off-by: Kento Yabuuchi <[email protected]>

* add standalone arg in launch files

Signed-off-by: Kento Yabuuchi <[email protected]>

* update semseg_node

Signed-off-by: Kento Yabuuchi <[email protected]>

* add camera_pose_initializer pkg

Signed-off-by: Kento Yabuuchi <[email protected]>

* subscribe camera_info&tf and prepare semantic projection

Signed-off-by: Kento Yabuuchi <[email protected]>

* project semantic image

Signed-off-by: Kento Yabuuchi <[email protected]>

* create vector map image from ll2

Signed-off-by: Kento Yabuuchi <[email protected]>

* create lane image from vector map

Signed-off-by: Kento Yabuuchi <[email protected]>

* search the most match angle by non-zero pixels

Signed-off-by: Kento Yabuuchi <[email protected]>

* camera based pose_initializer

Signed-off-by: Kento Yabuuchi <[email protected]>

* move ekf packages into unstable

Signed-off-by: Kento Yabuuchi <[email protected]>

* move ekf theory debugger

Signed-off-by: Kento Yabuuchi <[email protected]>

* add tier4_autoware_msgs as submodule

Signed-off-by: Kento Yabuuchi <[email protected]>

* move pose_initializer into initializer dir

Signed-off-by: Kento Yabuuchi <[email protected]>

* add semse_msgs pkg

Signed-off-by: Kento Yabuuchi <[email protected]>

* separate marker pub function

Signed-off-by: Kento Yabuuchi <[email protected]>

* separate projection functions

Signed-off-by: Kento Yabuuchi <[email protected]>

* add semseg_srv client

Signed-off-by: Kento Yabuuchi <[email protected]>

* move sem-seg directory

Signed-off-by: Kento Yabuuchi <[email protected]>

* camera pose initilizer works successfully

Signed-off-by: Kento Yabuuchi <[email protected]>

* rectify covariance along the orientation

Signed-off-by: Kento Yabuuchi <[email protected]>

* improve initialization parameters

Signed-off-by: Kento Yabuuchi <[email protected]>

* take into account covariance of request

Signed-off-by: Kento Yabuuchi <[email protected]>

* use lanelet direciton to compute init pose scores

Signed-off-by: Kento Yabuuchi <[email protected]>

* semseg download model automatically

Signed-off-by: Kento Yabuuchi <[email protected]>

* remove sample_vehicle_launch

Signed-off-by: Kento Yabuuchi <[email protected]>

* add autoware_msgs

Signed-off-by: Kento Yabuuchi <[email protected]>

* remove obsolete launch files

Signed-off-by: Kento Yabuuchi <[email protected]>

* add standalone mode for direct initialization

Signed-off-by: Kento Yabuuchi <[email protected]>

* fix fix_to_pose

Signed-off-by: Kento Yabuuchi <[email protected]>

* update launch files

Signed-off-by: Kento Yabuuchi <[email protected]>

* update rviz config

Signed-off-by: Kento Yabuuchi <[email protected]>

* remove lidar_particle_corrector

Signed-off-by: Kento Yabuuchi <[email protected]>

* remove Sophus from sunbmodule

Signed-off-by: Kento Yabuuchi <[email protected]>

* rename submodule directory

Signed-off-by: Kento Yabuuchi <[email protected]>

* update README and some sample images

Signed-off-by: Kento Yabuuchi <[email protected]>

* update README.md

Signed-off-by: Kento Yabuuchi <[email protected]>

* fix override_camera_frame_id bahaviors

Signed-off-by: Kento Yabuuchi <[email protected]>

* fix some bugs (#4)

Signed-off-by: kminoda <[email protected]>

* fix: use initialpose from Rviz (#6)

* use initialpose from Rviz to init

Signed-off-by: Kento Yabuuchi <[email protected]>

* add description about how-to-set-initialpose

Signed-off-by: Kento Yabuuchi <[email protected]>

---------

Signed-off-by: Kento Yabuuchi <[email protected]>

* misc: add license (#7)

* WIP: add license description

Signed-off-by: Kento Yabuuchi <[email protected]>

* add license description

Signed-off-by: Kento Yabuuchi <[email protected]>

* add description about license in README

Signed-off-by: Kento Yabuuchi <[email protected]>

---------

Signed-off-by: Kento Yabuuchi <[email protected]>

* add quick start demo (#8)

Signed-off-by: Kento Yabuuchi <[email protected]>

* refactor(launch) remove & update obsolete launch files (#9)

* delete obsolete launch files

Signed-off-by: Kento Yabuuchi <[email protected]>

* update documents

Signed-off-by: Kento Yabuuchi <[email protected]>

---------

Signed-off-by: Kento Yabuuchi <[email protected]>

* docs(readme): update architecture image (#10)

* replace architecture image in README

Signed-off-by: Kento Yabuuchi <[email protected]>

* update some images

Signed-off-by: Kento Yabuuchi <[email protected]>

---------

Signed-off-by: Kento Yabuuchi <[email protected]>

* refactor(pcdless_launc/scripts): remove unnecessary scripts (#11)

* remove not useful scripts

Signed-off-by: Kento Yabuuchi <[email protected]>

* rename scripts &  add descriptions

Signed-off-by: Kento Yabuuchi <[email protected]>

* little change

Signed-off-by: Kento Yabuuchi <[email protected]>

* remove odaiba.rviz

Signed-off-by: Kento Yabuuchi <[email protected]>

* grammer fix

Signed-off-by: Kento Yabuuchi <[email protected]>

---------

Signed-off-by: Kento Yabuuchi <[email protected]>

* fix(pcdless_launch): fix a build bug

Signed-off-by: kminoda <[email protected]>

* fix(twist_estimator): use velocity_report by default

Signed-off-by: kminoda <[email protected]>

* fix bug

Signed-off-by: kminoda <[email protected]>

* debugged, now works

Signed-off-by: kminoda <[email protected]>

* update sample rosbag link (#14)

Signed-off-by: Kento Yabuuchi <[email protected]>

* feature(graph_segment, gnss_particle_corrector): make some features switchable (#17)

* make additional-graph-segment-pickup disablable

Signed-off-by: Kento Yabuuchi <[email protected]>

* enlarge gnss_mahalanobis_distance_threshold in expressway.launch

Signed-off-by: Kento Yabuuchi <[email protected]>

---------

Signed-off-by: Kento Yabuuchi <[email protected]>

* fix: minor fix for multi camera support (#18)

* fix: minor fix for multi camera support

Signed-off-by: kminoda <[email protected]>

* update

Signed-off-by: kminoda <[email protected]>

* update

Signed-off-by: kminoda <[email protected]>

* fix typo

Signed-off-by: kminoda <[email protected]>

---------

Signed-off-by: kminoda <[email protected]>

* refactor(retroactive_resampler): more readable (#19)

* make Hisotry class

Signed-off-by: Kento Yabuuchi <[email protected]>

* use boost:adaptors::indexed()

Signed-off-by: Kento Yabuuchi <[email protected]>

* add many comment in resampling()

Signed-off-by: Kento Yabuuchi <[email protected]>

* does not use ConstSharedPtr

Signed-off-by: Kento Yabuuchi <[email protected]>

* rename interface of resampler

Signed-off-by: Kento Yabuuchi <[email protected]>

* circular_buffer is unnecessary

Signed-off-by: Kento Yabuuchi <[email protected]>

---------

Signed-off-by: Kento Yabuuchi <[email protected]>

* refactor(mpf::predictor) resampling interval control in out of resampler (#20)

* resampling interval management should be done out of resample()

Signed-off-by: Kento Yabuuchi <[email protected]>

* resampler class throw exeption rather than optional

Signed-off-by: Kento Yabuuchi <[email protected]>

* split files for resampling_history

Signed-off-by: Kento Yabuuchi <[email protected]>

* split files for experimental/suspention_adaptor

Signed-off-by: Kento Yabuuchi <[email protected]>

---------

Signed-off-by: Kento Yabuuchi <[email protected]>

* refactor(mpf::predictor): just refactoring (#21)

* remove obsolete functions

Signed-off-by: Kento Yabuuchi <[email protected]>

* remove test of predictor

Signed-off-by: Kento Yabuuchi <[email protected]>

* remove remapping in pf.launch.xml for suspension_adapator

Signed-off-by: Kento Yabuuchi <[email protected]>

* add some comments

Signed-off-by: Kento Yabuuchi <[email protected]>

---------

Signed-off-by: Kento Yabuuchi <[email protected]>

* fix(twist_estimator): remove stop filter for velocity (#23)

Signed-off-by: kminoda <[email protected]>

* feat(pcdless_launch): add multi camera launcher (#22)

* feat(pcdless_launch): add multi camera launcher

Signed-off-by: kminoda <[email protected]>

* minor fix

Signed-off-by: kminoda <[email protected]>

---------

Signed-off-by: kminoda <[email protected]>

* refactor(CMakeListx.txt): just refactoring (#24)

* refactor imgproc/*/CMakeListx.txt

Signed-off-by: Kento Yabuuchi <[email protected]>

* refactor initializer/*/CMakeListx.txt & add gnss_pose_initializer pkg

Signed-off-by: Kento Yabuuchi <[email protected]>

* rename some files in twist/ & refactor pf/*/cmakelist

Signed-off-by: Kento Yabuuchi <[email protected]>

* refactor validation/*/CMakeListx.txt

Signed-off-by: Kento Yabuuchi <[email protected]>

* fix some obsolete executor name

Signed-off-by: Kento Yabuuchi <[email protected]>

---------

Signed-off-by: Kento Yabuuchi <[email protected]>

* fix: rename lsd variables and files (#26)

Signed-off-by: kminoda <[email protected]>

* misc: reame pcdless to yabloc (#25)

* rename pcdless to yabloc

Signed-off-by: Kento Yabuuchi <[email protected]>

* fix conflict miss

Signed-off-by: Kento Yabuuchi <[email protected]>

---------

Signed-off-by: Kento Yabuuchi <[email protected]>

* visualize path (#28)

Signed-off-by: Kento Yabuuchi <[email protected]>

* docs: update readme about particle filter (#30)

* update mpf/README.md

Signed-off-by: Kento Yabuuchi <[email protected]>

* update gnss_corrector/README.md

Signed-off-by: Kento Yabuuchi <[email protected]>

* update camera_corrector/README.md

Signed-off-by: Kento Yabuuchi <[email protected]>

---------

Signed-off-by: Kento Yabuuchi <[email protected]>

* feat(segment_filter): publish images with lines and refactor (#29)

* feat(segment_filter): publish images with lines

Signed-off-by: kminoda <[email protected]>

* update validation

Signed-off-by: kminoda <[email protected]>

* update imgproc (reverted)

Signed-off-by: kminoda <[email protected]>

* large change inclding refactoring

Signed-off-by: kminoda <[email protected]>

* major update

Signed-off-by: kminoda <[email protected]>

* revert rviz config

Signed-off-by: kminoda <[email protected]>

* minor fix in name

Signed-off-by: kminoda <[email protected]>

* add validation option

Signed-off-by: kminoda <[email protected]>

* update architecture svg

Signed-off-by: kminoda <[email protected]>

* rename validation.launch to overlay.launch

Signed-off-by: Kento Yabuuchi <[email protected]>

* no throw runtime_error (unintentionaly applying format)

Signed-off-by: Kento Yabuuchi <[email protected]>

---------

Signed-off-by: kminoda <[email protected]>
Signed-off-by: Kento Yabuuchi <[email protected]>
Co-authored-by: Kento Yabuuchi <[email protected]>

* catch runtime_error when particle id is invalid (#31)

Signed-off-by: Kento Yabuuchi <[email protected]>

* return if info is nullopt (#32)

Signed-off-by: Kento Yabuuchi <[email protected]>

* pose_buffer is sometimes empty (#33)

Signed-off-by: Kento Yabuuchi <[email protected]>

* use_yaw_of_initialpose (#34)

Signed-off-by: Kento Yabuuchi <[email protected]>

* feat(interface):  remove incompatible interface (#35)

* not use ublox_msg when run as autoware

Signed-off-by: Kento Yabuuchi <[email protected]>

* remove twist/kalman/twist & use twist_estimator/twist_with_covariance

Signed-off-by: Kento Yabuuchi <[email protected]>

* update particle_array stamp even if the time stamp seems wrong

Signed-off-by: Kento Yabuuchi <[email protected]>

---------

Signed-off-by: Kento Yabuuchi <[email protected]>

* fix: suppress info/warn_stream (#37)

* does not stream undistortion time

Signed-off-by: Kento Yabuuchi <[email protected]>

* improve warn stream when skip particle weighting

Signed-off-by: Kento Yabuuchi <[email protected]>

* surpress frequency of  warnings during synchronized particle searching

Signed-off-by: Kento Yabuuchi <[email protected]>

* fix camera_pose_initializer

Signed-off-by: Kento Yabuuchi <[email protected]>

---------

Signed-off-by: Kento Yabuuchi <[email protected]>

* /switch must not be nice name (#39)

Signed-off-by: Kento Yabuuchi <[email protected]>

* misc(readme): update readme (#41)

* add youtube link and change thumbnail

Signed-off-by: Kento Yabuuchi <[email protected]>

* improve input/output topics

Signed-off-by: Kento Yabuuchi <[email protected]>

* quick start demo screen image

Signed-off-by: Kento Yabuuchi <[email protected]>

* add abstruct architecture and detail architecture

Signed-off-by: Kento Yabuuchi <[email protected]>

---------

Signed-off-by: Kento Yabuuchi <[email protected]>

* docs(rosdep): fix package.xml to ensure build success (#44)

* fix package.xml to success build

Signed-off-by: Kento Yabuuchi <[email protected]>

* add 'rosdep install' in how-to-build

Signed-off-by: Kento Yabuuchi <[email protected]>

---------

Signed-off-by: Kento Yabuuchi <[email protected]>

* add geographiclib in package.xml (#46)

Signed-off-by: Kento Yabuuchi <[email protected]>

* fix path search error in build stage (#45)

* fix path search error in build stage

* fix tier4/YabLoc#45 (comment)

* Feature/remove submodule (#47)

* remove submodules

Signed-off-by: Kento Yabuuchi <[email protected]>

* remove doppler converter

Signed-off-by: Kento Yabuuchi <[email protected]>

---------

Signed-off-by: Kento Yabuuchi <[email protected]>

* feature: change node namespace to /localization/yabloc/** from /localization/** (#48)

* change node namespace

Signed-off-by: Kento Yabuuchi <[email protected]>

* update namespace for autoware-mode

Signed-off-by: Kento Yabuuchi <[email protected]>

* update namespace in multi_camera.launch

Signed-off-by: Kento Yabuuchi <[email protected]>

---------

Signed-off-by: Kento Yabuuchi <[email protected]>

* removed unstable packages (#49)

Signed-off-by: Kento Yabuuchi <[email protected]>

* feature: add *.param.yaml to manage parameters (#50)

* make *.param.yaml in imgproc packages

Signed-off-by: Kento Yabuuchi <[email protected]>

* make *.param.yaml in initializer packages

Signed-off-by: Kento Yabuuchi <[email protected]>

* make *.param.yaml in map packages

Signed-off-by: Kento Yabuuchi <[email protected]>

* make *.param.yaml in pf packages

Signed-off-by: Kento Yabuuchi <[email protected]>

* make *.param.yaml in twist packages

Signed-off-by: Kento Yabuuchi <[email protected]>

* fix expressway parameter

Signed-off-by: Kento Yabuuchi <[email protected]>

* fix override_frame_id

Signed-off-by: Kento Yabuuchi <[email protected]>

* remove default parameters

Signed-off-by: Kento Yabuuchi <[email protected]>

* fix some remaining invalida parameters

Signed-off-by: Kento Yabuuchi <[email protected]>

---------

Signed-off-by: Kento Yabuuchi <[email protected]>

* does not estimate twist (#51)

Signed-off-by: Kento Yabuuchi <[email protected]>

* feat(particle_initializer): merge particle_initializer into mpf (#52)

* feat(particle_initializer): merge particle_initializer to modulalized_particle_filter

Signed-off-by: kminoda <[email protected]>

* remove particle_initializer

* remove debug message

Signed-off-by: kminoda <[email protected]>

* remove related parts

Signed-off-by: kminoda <[email protected]>

* update readme

Signed-off-by: kminoda <[email protected]>

* rename publishing topic

Signed-off-by: Kento Yabuuchi <[email protected]>

---------

Signed-off-by: kminoda <[email protected]>
Signed-off-by: Kento Yabuuchi <[email protected]>
Co-authored-by: Kento Yabuuchi <[email protected]>

* fix: remove ll2_transition_area (#54)

Signed-off-by: kminoda <[email protected]>

* feature(initializer): combine some initializer packages (#56)

* combine some package about initializer

Signed-off-by: Kento Yabuuchi <[email protected]>

* yabloc_pose_initializer works well

Signed-off-by: Kento Yabuuchi <[email protected]>

* remove old initializer packages

Signed-off-by: Kento Yabuuchi <[email protected]>

* semseg node can launch

Signed-off-by: Kento Yabuuchi <[email protected]>

* fix bug

Signed-off-by: Kento Yabuuchi <[email protected]>

* revert initializer mode

Signed-off-by: Kento Yabuuchi <[email protected]>

---------

Signed-off-by: Kento Yabuuchi <[email protected]>

* feature(imgproc): reudce imgproc packages (#57)

* combine some imgproc packages

Signed-off-by: Kento Yabuuchi <[email protected]>

* combine overlay monitors into imgproc

Signed-off-by: Kento Yabuuchi <[email protected]>

---------

Signed-off-by: Kento Yabuuchi <[email protected]>

* feature(validation): remove validation packages (#58)

* remove validation packages

Signed-off-by: Kento Yabuuchi <[email protected]>

* remove path visualization

Signed-off-by: Kento Yabuuchi <[email protected]>

---------

Signed-off-by: Kento Yabuuchi <[email protected]>

* feature(pf): combine some packages related to particle filter (#59)

* create yabloc_particle_filter

Signed-off-by: Kento Yabuuchi <[email protected]>

* combine gnss_particle_corrector

Signed-off-by: Kento Yabuuchi <[email protected]>

* combine ll2_cost_map

Signed-off-by: Kento Yabuuchi <[email protected]>

* combine camera_particle_corrector

Signed-off-by: Kento Yabuuchi <[email protected]>

* fix launch files

Signed-off-by: Kento Yabuuchi <[email protected]>

* split README & remove obsolete scripts

Signed-off-by: Kento Yabuuchi <[email protected]>

* fix config path of multi_camera mode

Signed-off-by: Kento Yabuuchi <[email protected]>

---------

Signed-off-by: Kento Yabuuchi <[email protected]>

* feature: combine map and twist packages (#60)

* removed some twist nodes & rename remains to yabloc_twist

Signed-off-by: Kento Yabuuchi <[email protected]>

* fix launch files for yabloc_twist

Signed-off-by: Kento Yabuuchi <[email protected]>

* move map packages to yabloc_common

Signed-off-by: Kento Yabuuchi <[email protected]>

* WIP: I think its impossible

Signed-off-by: Kento Yabuuchi <[email protected]>

* Revert "WIP: I think its impossible"

This reverts commit 49da507bbf9abe8fcebed4d4df44ea5f4075f6d1.

* remove map packages & fix some launch files

Signed-off-by: Kento Yabuuchi <[email protected]>

---------

Signed-off-by: Kento Yabuuchi <[email protected]>

* removed obsolete packages

Signed-off-by: Kento Yabuuchi <[email protected]>

* remove obsolete dot files

Signed-off-by: Kento Yabuuchi <[email protected]>

* use tier4_loc_launch instead of yabloc_loc_launch

Signed-off-by: Kento Yabuuchi <[email protected]>

* move launch files to each packages

Signed-off-by: Kento Yabuuchi <[email protected]>

* remove yabloc_localization_launch

Signed-off-by: Kento Yabuuchi <[email protected]>

* remove yabloc_launch

Signed-off-by: Kento Yabuuchi <[email protected]>

* modify yabloc/README.md

Signed-off-by: Kento Yabuuchi <[email protected]>

* update yabloc_common/README.md

Signed-off-by: Kento Yabuuchi <[email protected]>

* update yabloc_imgproc README

Signed-off-by: Kento Yabuuchi <[email protected]>

* update yabloc_particle_filter/README

Signed-off-by: Kento Yabuuchi <[email protected]>

* update yabloc_pose_initializer/README

Signed-off-by: Kento Yabuuchi <[email protected]>

* update README

Signed-off-by: Kento Yabuuchi <[email protected]>

* use native from_bin_msg

Signed-off-by: Kento Yabuuchi <[email protected]>

* use ifndef instead of pragma once in yabloc_common

Signed-off-by: Kento Yabuuchi <[email protected]>

* use ifndef instead of pragma once in yabloc_imgproc & yabloc_pf

Signed-off-by: Kento Yabuuchi <[email protected]>

* use ifndef instead of pragma once in yabloc_pose_initializer

Signed-off-by: Kento Yabuuchi <[email protected]>

* style(pre-commit): autofix

* use autoware_cmake & suppress build warning

Signed-off-by: Kento Yabuuchi <[email protected]>

* repalce yabloc::Timer with  tier4_autoware_utils::StopWatch

Signed-off-by: Kento Yabuuchi <[email protected]>

* replace 1.414 with std::sqrt(2)

Signed-off-by: Kento Yabuuchi <[email protected]>

* style(pre-commit): autofix

* removed redundant ament_cmake_auto

Signed-off-by: Kento Yabuuchi <[email protected]>

* removed yabloc_common/timer.hpp

Signed-off-by: Kento Yabuuchi <[email protected]>

* replaced low_pass_filter with autoware's lowpass_filter_1d

Signed-off-by: Kento Yabuuchi <[email protected]>

* style(pre-commit): autofix

* Squashed commit of the following:

Signed-off-by: Kento Yabuuchi <[email protected]>

commit cb08e290cca5c00315a58a973ec068e559c9e0a9
Author: Kento Yabuuchi <[email protected]>
Date:   Tue Jun 13 14:30:09 2023 +0900

    removed ublox_msgs in gnss_particle_corrector

    Signed-off-by: Kento Yabuuchi <[email protected]>

commit c158133f184a43914ec5f929645a7869ef8d03be
Author: Kento Yabuuchi <[email protected]>
Date:   Tue Jun 13 14:24:19 2023 +0900

    removed obsolete yabloc_multi_camera.launch

    Signed-off-by: Kento Yabuuchi <[email protected]>

commit 10f578945dc257ece936ede097544bf008e5f48d
Author: Kento Yabuuchi <[email protected]>
Date:   Tue Jun 13 14:22:14 2023 +0900

    removed ublox_msgs in yabloc_pose_initializer

    Signed-off-by: Kento Yabuuchi <[email protected]>

Signed-off-by: Kento Yabuuchi <[email protected]>

* style(pre-commit): autofix

* removed fix2mgrs & ublox_stamp

Signed-off-by: Kento Yabuuchi <[email protected]>

* added ~/ at the top of topic name

Signed-off-by: Kento Yabuuchi <[email protected]>

* removed use_sim_time in yabloc launch files

Signed-off-by: Kento Yabuuchi <[email protected]>

* add architecture diagram in README

Signed-off-by: Kento Yabuuchi <[email protected]>

* rename lsd_node to line_segment_detector

Signed-off-by: Kento Yabuuchi <[email protected]>

* style(pre-commit): autofix

* Update localization/yabloc/README.md

fix typo

Co-authored-by: Takagi, Isamu <[email protected]>

* removed obsolete debug code in similar_area_searcher

Signed-off-by: Kento Yabuuchi <[email protected]>

* removed suspension_adaptor which manages lifecycle of particle predictor

Signed-off-by: Kento Yabuuchi <[email protected]>

* style(pre-commit): autofix

* renamed semseg to SemanticSegmentation

Signed-off-by: Kento Yabuuchi <[email protected]>

* style(pre-commit): autofix

* fixed README.md to solve markdownlint

Signed-off-by: Kento Yabuuchi <[email protected]>

* WIP: reflected cpplint's suggestion

Signed-off-by: Kento Yabuuchi <[email protected]>

* reflected cpplint's suggestion

Signed-off-by: Kento Yabuuchi <[email protected]>

* rename AbstParaticleFilter in config files

Signed-off-by: Kento Yabuuchi <[email protected]>

* fixed typo

Signed-off-by: Kento Yabuuchi <[email protected]>

* used autoware_lint_common

Signed-off-by: Kento Yabuuchi <[email protected]>

* fixed miss git add

Signed-off-by: Kento Yabuuchi <[email protected]>

* style(pre-commit): autofix

* replaced lanelet_util by lanelet2_extension

Signed-off-by: Kento Yabuuchi <[email protected]>

* replaced fast_math by tie4_autoware_utils

Signed-off-by: Kento Yabuuchi <[email protected]>

* sort package.xml

Signed-off-by: Kento Yabuuchi <[email protected]>

* renamed yabloc_imgproc with yabloc_image_processing

Signed-off-by: Kento Yabuuchi <[email protected]>

* reflected some review comments

Signed-off-by: Kento Yabuuchi <[email protected]>

* resolved some TODO

Signed-off-by: Kento Yabuuchi <[email protected]>

* prioritize NDT if both NDT and YabLoc initializer enabled

Signed-off-by: Kento Yabuuchi <[email protected]>

* changed localization_mode option names

Signed-off-by: Kento Yabuuchi <[email protected]>

---------

Signed-off-by: Kento Yabuuchi <[email protected]>
Signed-off-by: kminoda <[email protected]>
Co-authored-by: kminoda <[email protected]>
Co-authored-by: kminoda <[email protected]>
Co-authored-by: Akihiro Komori <[email protected]>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>
Co-authored-by: Takagi, Isamu <[email protected]>
keiota pushed a commit to keiota/autoware.universe that referenced this pull request Aug 17, 2023
Bumps [actions/checkout](https://github.com/actions/checkout) from 2 to 3.
- [Release notes](https://github.com/actions/checkout/releases)
- [Changelog](https://github.com/actions/checkout/blob/main/CHANGELOG.md)
- [Commits](actions/checkout@v2...v3)

---
updated-dependencies:
- dependency-name: actions/checkout
  dependency-type: direct:production
  update-type: version-update:semver-major
...

Signed-off-by: dependabot[bot] <[email protected]>

Co-authored-by: dependabot[bot] <49699333+dependabot[bot]@users.noreply.github.com>
knzo25 pushed a commit to knzo25/autoware.universe that referenced this pull request May 17, 2024
* ci: add sync files (#2)

* ci: add sync files

Signed-off-by: wep21 <[email protected]>

* Update .github/sync-files.yaml

Co-authored-by: Kenji Miyake <[email protected]>

* Update .github/sync-files.yaml

Co-authored-by: Kenji Miyake <[email protected]>

* Update .github/sync-files.yaml

Co-authored-by: Kenji Miyake <[email protected]>

* Update .github/sync-files.yaml

Co-authored-by: Kenji Miyake <[email protected]>

* Update .github/sync-files.yaml

Co-authored-by: Kenji Miyake <[email protected]>

Co-authored-by: Kenji Miyake <[email protected]>

* chore: sync files (#3)

Signed-off-by: GitHub <[email protected]>

Co-authored-by: kenji-miyake <[email protected]>

* ci: update workflow (#1)

* ci: update ci config

Signed-off-by: wep21 <[email protected]>

* chore: apply pre-commit

Signed-off-by: wep21 <[email protected]>

* ci: update workflow

Signed-off-by: wep21 <[email protected]>

* Update .pre-commit-config.yaml

Co-authored-by: Kenji Miyake <[email protected]>

Co-authored-by: Kenji Miyake <[email protected]>

* chore: add empty repos (autowarefoundation#4)

Signed-off-by: wep21 <[email protected]>

* chore: sync files (autowarefoundation#5)

* chore: sync files

Signed-off-by: GitHub <[email protected]>

* Update sync-files.yaml

Co-authored-by: kenji-miyake <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>

* chore: sync files (autowarefoundation#6)

* chore: sync files

Signed-off-by: GitHub <[email protected]>

* Update sync-files.yaml

Co-authored-by: wep21 <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>

* chore: sync files (autowarefoundation#7)

Signed-off-by: GitHub <[email protected]>

Co-authored-by: kenji-miyake <[email protected]>

* chore: sync files (autowarefoundation#9)

Signed-off-by: GitHub <[email protected]>

Co-authored-by: kenji-miyake <[email protected]>

* chore: sync files (autowarefoundation#10)

* chore: sync files

Signed-off-by: GitHub <[email protected]>

* Update sync-files.yaml

Co-authored-by: wep21 <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>

* chore: sync files (autowarefoundation#11)

Signed-off-by: GitHub <[email protected]>

Co-authored-by: wep21 <[email protected]>

* chore: sync files (autowarefoundation#12)

Signed-off-by: GitHub <[email protected]>

Co-authored-by: wep21 <[email protected]>

* chore: sync files (autowarefoundation#13)

Signed-off-by: GitHub <[email protected]>

Co-authored-by: wep21 <[email protected]>

* chore: sync files (autowarefoundation#15)

Signed-off-by: GitHub <[email protected]>

Co-authored-by: wep21 <[email protected]>

* chore: sync files (autowarefoundation#16)

* chore: sync files

Signed-off-by: GitHub <[email protected]>

* Update sync-files.yaml

Co-authored-by: wep21 <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>

* chore: sync files (autowarefoundation#17)

Signed-off-by: GitHub <[email protected]>

Co-authored-by: wep21 <[email protected]>

* chore: sync files (autowarefoundation#18)

Signed-off-by: GitHub <[email protected]>

Co-authored-by: kenji-miyake <[email protected]>

* chore: sync files (autowarefoundation#19)

Signed-off-by: GitHub <[email protected]>

Co-authored-by: kenji-miyake <[email protected]>

* chore: sync files (autowarefoundation#20)

Signed-off-by: GitHub <[email protected]>

Co-authored-by: kenji-miyake <[email protected]>

* chore: sync files (autowarefoundation#21)

* chore: sync files

Signed-off-by: GitHub <[email protected]>

* Update sync-files.yaml

Co-authored-by: kenji-miyake <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>

* chore: sync files (autowarefoundation#22)

Signed-off-by: GitHub <[email protected]>

Co-authored-by: kenji-miyake <[email protected]>

* chore: sync files (autowarefoundation#23)

Signed-off-by: GitHub <[email protected]>

Co-authored-by: kenji-miyake <[email protected]>

* chore: sync files (autowarefoundation#24)

Signed-off-by: GitHub <[email protected]>

Co-authored-by: kenji-miyake <[email protected]>

* chore: sync files (autowarefoundation#25)

Signed-off-by: GitHub <[email protected]>

Co-authored-by: kenji-miyake <[email protected]>

* chore: sync files (autowarefoundation#27)

Signed-off-by: GitHub <[email protected]>

Co-authored-by: kenji-miyake <[email protected]>

* chore: sync files (autowarefoundation#28)

* chore: sync files

Signed-off-by: GitHub <[email protected]>

* Update sync-files.yaml

Signed-off-by: GitHub <[email protected]>
Co-authored-by: kenji-miyake <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>

* chore: sync files (autowarefoundation#29)

Signed-off-by: GitHub <[email protected]>

Signed-off-by: GitHub <[email protected]>
Co-authored-by: kenji-miyake <[email protected]>

* chore: sync files (autowarefoundation#30)

Signed-off-by: GitHub <[email protected]>
Co-authored-by: kenji-miyake <[email protected]>

* remove legacy ci

Signed-off-by: Daisuke Nishimatsu <[email protected]>

* update isort

Signed-off-by: Daisuke Nishimatsu <[email protected]>

---------

Signed-off-by: wep21 <[email protected]>
Signed-off-by: GitHub <[email protected]>
Signed-off-by: Daisuke Nishimatsu <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: tier4-autoware-bot[bot] <98652886+tier4-autoware-bot[bot]@users.noreply.github.com>
Co-authored-by: kenji-miyake <[email protected]>
Co-authored-by: tier4-autoware-public-bot[bot] <98652886+tier4-autoware-public-bot[bot]@users.noreply.github.com>
Co-authored-by: wep21 <[email protected]>
Co-authored-by: Daisuke Nishimatsu <[email protected]>
kosuke55 added a commit that referenced this pull request May 24, 2024
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.