ci: fix remove-docs workflow #159
Merged
Conversation
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
kenji-miyake
force-pushed
the
fix-remove-docs-ci
branch
2 times, most recently
from
a5679cb
to
725b93a
Compare
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
kenji-miyake
force-pushed
the
fix-remove-docs-ci
branch
from
725b93a
to
00febde
Compare
taikitanaka3
pushed a commit
to taikitanaka3/autoware.universe
that referenced
this pull request
Jan 11, 2022
…n#159) * Enable lints in behavior_velocity_planner * Fix package.xml Signed-off-by: tanaka3 <ttatcoder@outlook.jp>
taikitanaka3
pushed a commit
to taikitanaka3/autoware.universe
that referenced
this pull request
Jan 13, 2022
…n#159) * Enable lints in behavior_velocity_planner * Fix package.xml
kosuke55
pushed a commit
to kosuke55/autoware.universe
that referenced
this pull request
Jan 27, 2022
…n#159) * Enable lints in behavior_velocity_planner * Fix package.xml
badai-nguyen
pushed a commit
to badai-nguyen/autoware.universe
that referenced
this pull request
Feb 4, 2022
* release v0.4.0
* Fix typo (#700)
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix detection area (#701)
* Replace calcDistance with calcSignedDistance
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Add STOP state
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* intersection: change detection area length parameter from 100m to 200m (#702)
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* intersection: fix stuck vehicle behavior (#695)
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* Feature/intersection use spline interpolation library (#710)
* Use spline_interpolation module
* Remove debug messages
* Feature/stop reason (#712)
* add stop reason msg
* add mock of stop resaon publisher
* change namespace of stop reason
* update stop reason msg
* add toRosPoint
* implement stop reason publisher of blind stop
* implement stop reason publisher of crosswalk
* implement stop reason publisher of intersection
* implement stop reason publisher of stop line
* implement stop reason publisher of trafficlight
* implement stop reason publisher of detection area
* fix bug
* remove unnecessary process
* add remained stop factor
* clean code
* fix bug
* not punlish stop reason if array size is 0
* add stop reason to stuck object in intersection
* add stop factor of obstacle stop planner
* add stop reason of surround_obstacle checker
* Apply review
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* fix message type
* delete unused message from cmake
* remove stopReasonStamped
* change topic name of stop reasons
Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix/stop reason (#724)
* input stop reason of traffic light
* add comment
* add empty traffic light handling
* change calculation method of traffic light position
* avoid 0 position output
* Fix/spline interpolation in intersection module (#726)
* Remove duplicating sample points
* Change isValidInput
* Apply clang-format
* Fix convergence check in PCG
* fix clac signed distance bug (#733)
* intersection: ignore stop plane when path[0] is in detection area (#739)
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* Publish tl states stamped (#744)
* Add TrafficLightStateStamped.msg
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Use msg instead of struct
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Publish traffic light state
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Check if lamp state is empty
Signed-off-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp>
* Apply clang-format
Signed-off-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp>
* Cosmetic change
Signed-off-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp>
* update visualization marker (#759)
* fix stack area (#758)
* dont check pointcloud (#765)
Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com>
* fix stop factor of merge_from_private_area (#749)
* Revert "Publish tl states stamped (#744)" (#771)
This reverts commit 35a7e29e987afb29d9348b5f64866a584a65f753.
* fix intersection bug (#773)
* fix bug
* fix bug
* change uid of marker (#775)
* Fix/publish tl state stamped (#772)
* Publish tl states stamped (#744)
* Add TrafficLightStateStamped.msg
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Use msg instead of struct
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Publish traffic light state
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Check if lamp state is empty
Signed-off-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp>
* Apply clang-format
Signed-off-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp>
* Cosmetic change
Signed-off-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp>
* Use dynamic pointer cast
Signed-off-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp>
* Fix blind spot areas and logic for creating a stop line (#732)
* Fix blind spot areas
Signed-off-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp>
* Change logic for creating a stop line
Signed-off-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp>
* Do not add marker when marker is empty
Signed-off-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp>
* Cosmetic change
Signed-off-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp>
* Return boost optional for first conflict point
Signed-off-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp>
* Return boost optional for intersection start point
Signed-off-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp>
* Apply clang
Signed-off-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp>
* Fix/intersection stuck detect area (#764)
* fix stuck-vehicle detection area in intersection module
* separate vehicle param
* change the way ouf start idx count
* change param
* avoid to input -1 index (#777)
* add dead line and pass through when over dead line (#784)
* Add arg for input tl topic name (#783)
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* change margin to 1.0m (#790)
Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com>
* fix insert target point bug (#798)
* fix typo stop_liine to stop_line (#799)
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* traffic light scene module : fix bug and change param (#800)
* fix bug (passs judge line)
Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com>
* bug fix
Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com>
* change param
Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com>
* Intersection add debug comment (#803)
* blind spot : modify debug comment
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* merge from private road : modify debug comment
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* intersection : modify debug comment
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* intersection util: modify generateStopLine() for debug
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* add comment
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* Fix intersection preceeding lane query (#807)
* modified interseciton module to add lanelets in intersection to objective lanelets due to change in getPreceedingLaneletSequences()
Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>
* update comment
Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>
* Fix blind spot area (#806)
* Fix blind spot area
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Use range based for
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Use std::unique to remove adjacent duplicates
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Use generateFineCenterline
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Fix detection area start point
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Revert "Use generateFineCenterline"
This reverts commit 9d4f46bf65d7296b9286b30dfeed217a566a815c.
* Fix centerline of half lanelet
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Fix area start point
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Revert "fix insert target point bug (#798)" (#815)
This reverts commit 12eac2023538531e28a85a8914305cb534499f29.
* Fix/traffic light state (#801)
* fix bug (passs judge line)
Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com>
* bug fix
Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com>
* change param
Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com>
* bug fix : remove stop state
Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com>
* add lower limit
Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com>
* change param (#821)
Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com>
* stopline: parametrize check distance (#825)
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* Check if lanelets are sequential (#823)
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* fix uninitialized variables (#816)
* Parameterization for calculating judge line distance (#831)
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* remove ROS1 packages temporarily
Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>
* Revert "remove ROS1 packages temporarily"
This reverts commit 96b63e981899f79f2f5c6a6377e9600cc278e233.
Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>
* add COLCON_IGNORE to ros1 packages
Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>
* Rename launch files to launch.xml (#28)
* Port behavior_velocity_planner to ROS2 (#80)
* Revert "Add geometry2 to repos (#76)"
This reverts commit 6d2270476aaafdf1a8098d700d52a508525ea04b.
* Automatic parts of the package port
* Interesting part
* Fix typo in package.xml
* Review comments
* Child logger names
* Document logging duration
Co-authored-by: Ryohsuke Mitsudome <43976834+mitsudome-r@users.noreply.github.com>
* [ROS2] Fix behavior velocity planner (#110)
* install launch and config folders
Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>
* port launch file
Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>
* fix config files
Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>
* improve vehicle_info_utils to enable multiple declaration of VehicleInfo objects
Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>
* fix sementation fault
Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>
* Convert calls of Duration to Duration::from_seconds where appropriate (#131)
* 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
* fixing trasient_local in ROS2 packages (#160)
* Enable cppcheck lints in behavior_velocity_planner (#159)
* Enable lints in behavior_velocity_planner
* Fix package.xml
* Make launch files load vehicle model params dependent on argument (#228)
* Make vehicle_model configurable in behavior_velocity_planner
* Make vehicle_model configurable in vehicle_cmd_gate
* change from vehicle_model to vehicle_param_file (#242)
Signed-off-by: kosuke murakami <kosuke.murakami@tier4.jp>
* Ros2 v0.8 fix typo of "preceding" (#323)
* Fix typo of getPrecedingLaneletSequences
* Fix comment
* 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 <kenji.miyake@tier4.jp>
* Keep stopping after going over dead-line in STOP state
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Clear state after obstacle disappears
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Parameterize and change conditions
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Refactor
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* add elapsed time checker
* Refactor
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Ignore inserting point if points are too close
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Rename NORMAL to GO
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Revert "Ignore inserting point if points are too close"
This reverts commit 91c8d620ea11e703611945cb9a50877d175f4ff6.
* Fix small bug
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
Co-authored-by: taichiH <azumade.30@gmail.com>
* 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 <kenji.miyake@tier4.jp>
Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix task registration of detection area module (#856)
* Fix task registration of detection area module
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix id of factor_text marker
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* 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 <border_goldenmarket@yahoo.co.jp>
* Fix wrong format
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Fix flag order in judge condition
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* 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 <border_goldenmarket@yahoo.co.jp>
* 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 <yukky.saito@gmail.com>
* 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 <horibe.takamasa@gmail.com>
* intersection: consider ego-vehicle length when calculate stuck vehicle detection area
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* intersection: change param stuck_vehicle_ignore_dist: 5.0 -> 7.0
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* intersection: use vehicle_info/vehicle_length
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* fix implement miss
* fix target pedestrian (#927)
Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com>
* fix insert backward point (#953)
* fix insert backward point
* add comment
Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp>
* remove unnecessary if
Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp>
* Add stop line referred from road marking (#968)
* Add stop line referred from road marking
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Add stop line for walkway
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* 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 <kenji.miyake@tier4.jp>
* Fix/blind spot insert point (#1027)
* Copy insert point from previous point
* Reset path unless state is stop
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* 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 <border_goldenmarket@yahoo.co.jp>
* Make refer id same
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* fix getObjectivePolygons() so that intersecting lanelet is added to objective lanelets even when there is no preceeding lanelets (#1010)
Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>
* 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 <border_goldenmarket@yahoo.co.jp>
* Apply clang format
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Shrink conflicting area
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* 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 <kenji.miyake@tier4.jp>
* Add const
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Add correspondence marker of detection_area and stop_line
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Add obstacle marker
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fixup
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Add id marker
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Clear state when time rollback found
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix typo
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* change stop to polygon line
* apply clang format
* fix code
* fix bug
Co-authored-by: taichiH <azumade.30@gmail.com>
* Fix pass judge idx (#1090)
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* 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 <kenji.miyake@tier4.jp>
* Remove unnecessary pose
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Don't insert point if duplicated point exists
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix condition of duplicated points
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* seperate stop distance param (#1137)
* seperate stop distance param
Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp>
* apply param for automotically generated stop line
Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp>
* shift slow down line
Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp>
* add param in yaml file
Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp>
* 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 <tomoya.kimura@tier4.jp>
Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com>
Co-authored-by: taichiH <azumade.30@gmail.com>
Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp>
Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com>
Co-authored-by: Daisuke Nishimatsu <42202095+wep21@users.noreply.github.com>
Co-authored-by: Kazuki Miyahara <kmiya@outlook.com>
Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com>
Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com>
Co-authored-by: Kosuke Murakami <kosuke.murakami@tier4.jp>
Co-authored-by: Ryohsuke Mitsudome <43976834+mitsudome-r@users.noreply.github.com>
* Rename ROS-related .yaml to .param.yaml (#352)
* Rename ROS-related .yaml to .param.yaml
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Remove prefix 'default_' of yaml files
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Rename vehicle_info.yaml to vehicle_info.param.yaml
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Rename diagnostic_aggregator's param files
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix overlooked parameters
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* [behavior_velocity_planner]: Fix missing ros2 porting (#392)
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Fix error handling of tf lookupTransform (#405)
Co-authored-by: autoware <autoware@example.com>
* rm_std_msgs (#402)
* Sensor data qos (#407)
* Use sensor data qos for pointcloud preprocessor
Signed-off-by: Autoware <autoware@tier4.jp>
* Use sensor data qos for pointcloud
Signed-off-by: Autoware <autoware@tier4.jp>
* Fix lint
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Use sensor data qos for livox tag filter and vector map filter
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Fix lint
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
Co-authored-by: Autoware <autoware@tier4.jp>
* Ros2 fix topic name part1 (#408)
* Fix topic name of lane_departure_checker debug
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix topic name of mpc_follower debug
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix topic name of velocity_controller debug
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix topic name of motion_velocity_optimizer debug
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix topic name of lane_change_planner debug
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix topic name of behavior_velocity_planner debug
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix topic name of obstacle_avoidance_planner debug
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix topic name of behavior_velocity_planner
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix topic name of motion_velocity_optimizer
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix topic name of lane_departure_checker
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix topic name of mpc_follower
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix topic name of behavior_velocity_planner
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix topic name of velocity_controller
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix topic name of lane_change_planner
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix topic name of obstacle_avoidance_planner
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix topic name of obstacle_stop_planner
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix topic name of costmap_generator
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix topic name of freespace_planner
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix topic name of surround_obstacle_checker
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix topic name of costmap_generator
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix topic name of emergency_handler
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix lint errors
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix typo
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix typo in planning module (#432)
* Fix typo in planning module
* Fix remaining errors
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Apply cpplint and uncrustify.
Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp>
* fix traffic light module (#458)
* change log type (#459)
* add use_sim-time option (#454)
* Fix rolling build errors (#1225)
* Add missing include files
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Replace rclcpp::Duration
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Use reference for exceptions
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Use from_seconds
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Sync public repo (#1228)
* [simple_planning_simulator] add readme (#424)
* add readme of simple_planning_simulator
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* Update simulator/simple_planning_simulator/README.md
* set transit_margin_time to intersect. planner (#460)
* Fix pose2twist (#462)
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Ros2 vehicle info param server (#447)
* add vehicle_info_param_server
* update vehicle info
* apply format
* fix bug
* skip unnecessary search
* delete vehicle param file
* fix bug
* Ros2 fix topic name part2 (#425)
* Fix topic name of traffic_light_classifier
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix topic name of traffic_light_visualization
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix topic name of traffic_light_ssd_fine_detector
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix topic name of traffic_light_map_based_detector
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix lint traffic_light_recognition
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix lint traffic_light_ssd_fine_detector
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix lint traffic_light_classifier
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix lint traffic_light_classifier
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix lint traffic_light_ssd_fine_detector
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix issues in hdd_reader (#466)
* Fix some issues detected by Coverity Scan and Clang-Tidy
* Update launch command
* Add more `close(new_sock)`
* Simplify the definitions of struct
* fix: re-construct laneletMapLayer for reindex RTree (#463)
* Rviz overlay render fix (#461)
* Moved painiting in SteeringAngle plugin to update()
Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai>
* super class now back to MFD
Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai>
* uncrustified
Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai>
* acquire data in mutex
Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai>
* back to RTD as superclass
Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai>
* Rviz overlay render in update (#465)
* Moved painiting in SteeringAngle plugin to update()
Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai>
* super class now back to MFD
Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai>
* uncrustified
Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai>
* acquire data in mutex
Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai>
* removed unnecessary includes and some dead code
Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai>
* Adepted remaining vehicle plugin classes to render-in-update concept. Returned to MFD superclass
Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai>
* restored RTD superclass
Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai>
Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com>
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
Co-authored-by: Takagi, Isamu <43976882+isamu-takagi@users.noreply.github.com>
Co-authored-by: Kazuki Miyahara <kmiya@outlook.com>
Co-authored-by: Makoto Tokunaga <vios-fish@users.noreply.github.com>
Co-authored-by: Adam Dąbrowski <adam.dabrowski@robotec.ai>
* Unify Apache-2.0 license name (#1242)
* Make planning modules components (#1263)
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Remove use_sim_time for set_parameter (#1260)
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Refactor vehicle info util (#1305)
* Update license
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Refactor vehicle_info_util
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Rename and split files
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix interfaces
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix bug and add error handling
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Add "// namespace"
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Add missing include
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* fix slow/stop marker color & stop reason (#1347) (#1354)
Co-authored-by: satoshi-ota <satoshi.ota@gmail.com>
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com>
Co-authored-by: satoshi-ota <satoshi.ota@gmail.com>
* fix intersection stop line (#1272) (#1349)
* fix intersection stop line (#1272)
* fix intersection stop line
* fix comment
* Fix typo
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
* Avoid passing empty lanelets to getPolygonFromArcLength (#1371)
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Add perception traffic light state output (#1302)
* Add perception traffic light state output
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Modify message type
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Apply message type to relay
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Feature/consider jerk limit in passjudge (#1339) (#1351)
* Feature/consider jerk limit in passjudge (#1339)
* make new branch for behavior velocity planner
* update implementation for considering accel & jerk limit
* refactoring
* change default params
* change default params
* change minimum velocity which decides to conduct pass judge
* remove ROS_DEBUG_COND()
* remove unnecessary variables
* fix lowpass filter implementation
* calc acceleration in planner_data_
Co-authored-by: satoshi-ota <satoshi.ota@gmail.com>
* Fix typo
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com>
Co-authored-by: satoshi-ota <satoshi.ota@gmail.com>
* Feature/refactor stop line module (#1343) (#1359)
* Refactor stop_line planner module
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Add document
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix English
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com>
* Feature/add stop duration ros2 (#1380)
* Feature/add stop duration (#1367)
* Add stop_duration to behavior_velocity_planner
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* parameterize stop duration sec
* Use stop_duration in Stop Line module
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
Co-authored-by: Hiroki OTA <hiroki.ota@tier4.jp>
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Change default value
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com>
Co-authored-by: Hiroki OTA <hiroki.ota@tier4.jp>
Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix topic name of external traffic light input (#1412)
* publish perception and external tl_state for mlops (#1350) (#1375)
* publish perception and external tl_state for mlops
* fix tl_state time stamp
Co-authored-by: satoshi-ota <satoshi.ota@gmail.com>
Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com>
Co-authored-by: satoshi-ota <satoshi.ota@gmail.com>
* Fix/traffic light planning module (#1424) (#1487)
* Fix/traffic light planning module (#1424)
* bug fix
* refactor
* refactor
* cosmetic change
* fix typo
* cosmetic change
* refactor
* remove unused func
* enable restart
* cosmetic change
* fix typo
* refactor
* bug fix
* cosmetic change
* modify debug_data
* Apply lint
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Remove unnecesarry comment
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Fix bug
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com>
* change msg type looking traffic light state (#1494)
* change msg type looking traffic light state (#1455)
* change msg type looking traffic light state
* fix msg name
* using namespace
* change function name
* fix typo
* add readme
* Update awapi/awapi_awiv_adapter/Readme.md
fix typo
Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com>
Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com>
* Remove deprecated message include
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Fix lint
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com>
* Add namespace to behavior_velocity_planner (#1542)
* Add namespace to behavior_velocity_planner
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix typo
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Avoid passing uninitialized index (#1609)
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* suppress warnings for behavior_velocity_planner (#1733)
* add Werror
* suppress warnings for stopline module
* fix for crosswalk
* fix for traffic light
* fix for detection area
* fix style
* use {}
* use auto
* Fix -Wunused-parameter (#1836)
* Fix -Wunused-parameter
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix mistake
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* fix spell
* Fix lint issues
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Ignore flake8 warnings
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
Co-authored-by: Hiroki OTA <hiroki.ota@tier4.jp>
* Fix compiler warnings (#1837)
* Fix -Wunused-private-field
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix -Wunused-variable
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix -Wformat-security
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix -Winvalid-constexpr
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix -Wdelete-non-abstract-non-virtual-dtor
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix -Wdelete-abstract-non-virtual-dtor
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix -Winconsistent-missing-override
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix -Wrange-loop-construct
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix "invalid application of 'sizeof' to an incomplete type"
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Ignore -Wgnu-anonymous-struct and -Wnested-anon-types
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix lint
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Ignore -Wno-deprecated-declarations in CUDA-related packages
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix mistake
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix -Wunused-parameter
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Add autoware api (#1979)
* Feature/add virtual traffic light planner (#1588)
* 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
* remove spline_interpolation, and create interpolation package that ha… (#2114)
* remove spline_interpolation and add interpolation package
* fix bugs and add simple test
* modify application for interpolation package
* add some tests and fix ci test
* add some tests
* add -Werror
* move functions to anonymous
* fix reviews
* fix typo
* fix review and lint
* add tests
* resolve TODOs
* add README.md
* Update common/math/interpolation/test/src/test_interpolation_utils.cpp
Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com>
* Update common/math/interpolation/test/src/test_interpolation_utils.cpp
Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com>
* Update common/math/interpolation/test/src/test_interpolation_utils.cpp
Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com>
* fix README.md
* dealt with reviews
* update README.md
* update README.md
* Update common/math/interpolation/README.md
* fix some bugs
* fix typo
* update README.md
* Update common/math/interpolation/README.md
Co-authored-by: Kazuki Miyahara <kmiya@outlook.com>
* fix test
* Update common/math/interpolation/README.md
Co-authored-by: Kazuki Miyahara <kmiya@outlook.com>
* fix cdots
* fix README.md
* Update common/math/interpolation/README.md
Co-authored-by: Kazuki Miyahara <kmiya@outlook.com>
Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com>
Co-authored-by: Kazuki Miyahara <kmiya@outlook.com>
* Sync develop/fix interpolation and speed up calculation (#2290)
* debug slope calculation in behavior (#1566) (#1727)
* debug slope calculation in behavior (#1566)
* update
* update
* revert change of autoware_utils
* define getPose in behavior_path_planner
* update
* update
* update
* update
* interpolate z in obstacle_avoidance_planner
* update velocity controller
* fix detection area and scene
* Update planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/src/utilities.cpp
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
* update comment in velocity controller
* remove debug print
* update
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Fix typo
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Fix variable names
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix uncrustify
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix mistake
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
Co-authored-by: Takayuki Murooka <takayuki5168@gmail.com>
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp>
* add underscore to marker namespace (#1785)
Co-authored-by: satoshi-ota <satoshi.ota@gmail.com>
* [obstacle_avoidance_planner] remove useless get nearest idx (#1851)
* modify velocity insertion in obstacle_avoidance_planner
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* [obstacle_avoidance_planner] reduce calculation cost in relative/absolute transformation (#1844)
* implement relative/absolute transformation without yaw but directly sin/cos of yaw
* rename: relative_p to absolute_p
* assigin point.z to rel/abs_z
* fix cpp-lint error
Co-authored-by: Daisuke Nishimatsu <42202095+wep21@users.noreply.github.com>
Co-authored-by: Takayuki Murooka <takayuki5168@gmail.com>
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp>
Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com>
Co-authored-by: satoshi-ota <satoshi.ota@gmail.com>
Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* fix argument order (#1502) (#1622)
Co-authored-by: satoshi-ota <satoshi.ota@gmail.com>
Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com>
Co-authored-by: satoshi-ota <satoshi.ota@gmail.com>
* Change param (#1559) (#1677)
Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com>
* Feature/use spline module in behavior velocity planner (#1457) (#1495)
* Feature/use spline module in behavior velocity planner (#1457)
* Use spline_interpolation module
* Remove unused function
* Remove unused include
* Use autoware_utils
* Remove unused function
* Remove cubic_spline.hpp
* Fix error handling
* Fix interpolation of velocity
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* change warning threshold (#1539)
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* Apply lint
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com>
Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* Feature/porting behavior path planner (#1645)
* Add behavior path planner pkg with Lane Change (#1525)
* add lanelet extension funcs
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* add planning msgs for FOA
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* add behavior_path_planner pkg
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* apply clang format
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* add error handling for config load failure
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* replace word: foa with remote control
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* add readme
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* use pointer for return value of path
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* fix hz
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* remove debug print
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* remove shide-shift & avoidance related files
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* Clip path by goal
* add build depend for behavior tree cpp
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* temporally disable lint test in lanelet2_extension
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
Co-authored-by: rej55 <rej55.g@gmail.com>
* Add avoidance module in behavior_path_planner (#1528)
* Revert "remove shide-shift & avoidance related files"
This reverts commit d819ea0291fca251012e4b9ffd16de3896830aa2.
* refactor findNewShiftPoint func
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* remove duplicated decleration
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* fix barkward length issue
- add clipPathLenght func in avoidance
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* refactor:
- translate english
- minor modification for traffic distance
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* support debug marker in behavior_path_planner
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* clean up side shift module
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* change topic name
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* remove japanese
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* Update planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/include/behavior_path_planner/scene_module/side_shift/side_shift_module.hpp
Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com>
* fix typo
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* remove unused var
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* adress reviewer comments:
- add const for variables
- add comment
- fix typo
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* fix typo
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com>
* Replace behavior_path utilities with autoware_utils (#1532)
* replace calcDistance
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* replace arange
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* replave convertToEigenPt with autoware_utils::fromMsg
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* replace normalizeRadian
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* cosmetic change
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* import #1526 into behavior path planner (#1531)
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* Fix/behavior path empty path output guard (#1536)
* add guard
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* Update planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/src/behavior_path_planner.cpp
* fix lateral jerk calculation (#1549)
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* fix: error handling on exception in behavior_path_planner (#1551)
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* Fix ignore too steep avoidance path (#1550)
* ignore too steep path
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* Update planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/src/scene_module/avoidance/avoidance_module.cpp
* parametrize lateral jerk limit
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* Update planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/include/behavior_path_planner/scene_module/avoidance/avoidance_module.hpp
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
* use offsetNoThrow and add error log (#1615)
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* Ignore object ahead goal for avoidance (#1618)
* Ignore object ahead goal for avoidance
* Add flag
* Fix position of definition of goal_pose
* Fix arclength calculation
* Fix position of definition of goal_pose
* fix intersection stop line (#1636)
* fix intersection stop line
* fix typo
* add document (#1635)
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* Port behavior path planner to ros2
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Apply lint
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Fix typo
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Fix map qos
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* debug slope calculation in behavior (#1566)
* update
* update
* revert change of autoware_utils
* define getPose in behavior_path_planner
* update
* update
* update
* update
* interpolate z in obstacle_avoidance_planner
* update velocity controller
* fix detection area and scene
* Update planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/src/utilities.cpp
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
* update comment in velocity controller
* remove debug print
* update
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
* Address review: Fix config file name
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* pre-commit fixes
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Fix redeclaring parameters
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Add missing tf2 geometry function
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Apply lint
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Fix rclcpp Time initialization
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Use now() instead of msg stamp
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Use throttle output in getExpandedLanelet
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Add missing const
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Fix lint
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com>
Co-authored-by: rej55 <rej55.g@gmail.com>
Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com>
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
Co-authored-by: Takayuki Murooka <takayuki5168@gmail.com>
* Fix/generate intersection stop (#1590) (#1679)
* Fix/generate intersection stop (#1590)
* fix bug of conflicting polygons
* clean code
* Fix lint
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
* Fix/stop margin time ros2 (#1683)
* Add stop margin time in walkway and merge_from_private_area (#1613)
* Add stop margin time in walkway, merge_from_private_area
* Fix param name
* Fix bug
* Apply lint
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com>
* Feature/change stop lines handling to support parking car avoidance p… (#1676)
* Feature/change stop lines handling to support parking car avoidance path (#1464)
* support parking car avoidance
* change log level
* apply clang-format
* add extendLine function
* clean up & apply clang-format
* change implementation getStopPoseFromMap()
* remove unuse comment line
Co-authored-by: satoshi-ota <satoshi.ota@gmail.com>
* fix argument order (#1580)
Co-authored-by: satoshi-ota <satoshi.ota@gmail.com>
Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com>
Co-authored-by: satoshi-ota <satoshi.ota@gmail.com>
* Feature/porting occlusion spot (#1740)
* Feature/occlusion_spot safety planner public road (#1594)
* add blind spot safety planner public road
* remove duplicated procesing
* remove unused private param
* renaming fix typo add comments
* fix spell check
* velocity -> relative velocity
* calc2d, To param, simplify search, To original
* add the num possible collision gurd
* computational cost reduction
* Cosmetic change for PossibleCollisionInfo
* add interpolation to possible collision value
* refactor codes
* fix details
* invalid point gurd
* To Param
* refacotor to occlusion spot util
* cosmetic change
* clean up blindspot
* To Occlusion Spot
* revise readme
* refactor drawing
* for better explanation
* fix velocity profile
* clean up details
* cosmetic change for debug marker
* use max velocity in obstacle info instead
* add gtest for Too Many Possible Collision case
* change case
* refactor readme
* minor fix
* add more occlusion spot explanation
* replace svg
* add gtest build path lanelet
* hotfix lateral distance and searching method
* update g test for lateral distance
* use faster search
* set more realistic param
* add lanelet subtype highway
* cosmetic change of reviews
* add occlusion spot module in private area (#1640)
* add occlusion spot in private
* For debugging change
* add spline interpolation to path
* add review changes
* adding minor change
* cosmetic change
* Vector to retval
* Blindspot To OcclusionSpot1
* To Occlusion Spot 2
* To Occlusions spot3
* update gtest with unified anchor
* remove anchor
* add test slice
* simplify interpolation
* Too Occlusion spot4
* add test buffer
* To Occlusion spot
* namespace gurd
* correct slice and add interpolation first
* handle self crossing with check for invation
* to ros debug stream
* removed unused interpolation
* add readme to plant uml
* cosmetic change
* minor change
* update readme
* review change
* change occlusion spot text color
* To Offset no Throw
* better debug marker
* catch only inversion error
* skip return in case of inversion
* for better grid
* simplify path lanelet at first
* remove std::cout
* for better path
* limit ego path inside target lanelet location
* remove last points
* cosmetic change for markers
* apply module for limited scene
* fix interpolation gurd
* for better params
* do not includes path behind
* remove dummy perception publisher
* Revert "remove dummy perception publisher"
This reverts commit 4acad985fe31dd9befaa21a16631495de6c3a117.
* replace hard coded occupancy grid option in psim
* remove respawn
* add arg to params and remove redundunt launch
* fix spell check
* fix default value
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
* Feature/occlusion spot private slice size param (#1703)
* add min slice size
* for a bit narrow lateral distance
* Update planning/scenario_planning/lane_driving/behavior_planning/behavior_velocity_planner/config/occlusion_spot_param.yaml
Co-authored-by: Maxime CLEMENT <78338830+maxime-clem@users.noreply.github.com>
Co-authored-by: Maxime CLEMENT <78338830+maxime-clem@users.noreply.github.com>
* Rename files
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Porting to ros2
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* pre-commit fixes
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Fix typo
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Fix launch namespace
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
* Fix parameter type
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
* Update planning/scenario_planning/lane_driving/behavior_planning/behavior_velocity_planner/src/scene_module/occlusion_spot/scene_occlusion_spot_in_private_road.cpp
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com>
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
Co-authored-by: Maxime CLEMENT <78338830+maxime-clem@users.noreply.github.com>
* fix function name and condition for detection area (#1758)
* Fix build warning for occlusion spot (#1766)
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Fix passing uninitialized index (#1792)
* Fix passing uninitialized index
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Apply uncrustify
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Fix return value
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Fix/intersection bug (#1787)
* fix insert point function
* apply format
* separate insertPoint and hasDuplicatedPoint
* clean code
* fix bug
* replace velocity if collision point is too close to original path point (#1799)
* replace velocity if collision point is too close to original path point
* fix comment
* Fix compile warnings (#1852)
Fix -Wunused-parameter
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
Fix -Wunused-private-field
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
Fix -Wunused-lambda-capture
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
Fix -Wdelete-non-abstract-non-virtual-dtor
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
Fix -Wrange-loop-construct
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
Ignore lint error
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Document / behavior velocity planner (#1767)
update document
Co-authored-by: Kazuki Miyahara <kmiya@outlook.com>
* fix occlusion spot insert velocity ros2 (#1821)
* Fix/occlusion spot offset (#1824)
* merge calcCollisionFunction
* ConsiderSignedOffset
* add extractRoadTargetAndSignedOffset
* apply signed offset and fix longitudinal distance
* fix unapplied param
* update gtest
* consider offset until target road
* refactor for proper variable name
* fix typo
* remove unused first index
* fix closest
* fix diff
* fix velocity and height
* tune distance thershold
* fix colcon test
* apply param at the experiment
* fix unused and param
* Fix/current acc initialize (#1899)
* use boost::optional
* null guard
* fix typo
* Feature/improve intersection detection area (#1958)
* exclude ego_lanes from detection_area
* add empty handling
* remove unused function
* Fix for uncrustify
Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com>
* [behavior_velocity_planner] remove unnecessary graph search to reduce computational cost (#1980)
* remote unnecessary graph search
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* add var for graph id
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* remove unused stopline search for computational cost reduction
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* restore lane_ids iteration as it was
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* sort sidewalk slice by arc length (#1967)
* sort sidewalk slice by arc length
* handle invalid index
* divide offset to ego to closest to and closest to target
* fix cartesian distance to arc lane distance
* consider ego to target to ignore length
* Update planning/scenario_planning/lane_driving/behavior_planning/behavior_velocity_planner/src/scene_module/occlusion_spot/occlusion_spot_utils.cpp
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
* Fix/merge from private area (#2005)
* fix insert pos. of merge from private area
* exclude entrance of private road from path
* extract exit of private road
* Feature/intersection module detect obstacle (#1990)
* change the way to detect target objects in detection area
* check the angle of deteced objects
* ignore predicted path with low confidence
* Update planning/scenario_planning/lane_driving/behavior_planning/behavior_velocity_planner/include/scene_module/intersection/scene_intersection.hpp
Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com>
* Update planning/scenario_planning/lane_driving/behavior_planning/behavior_velocity_planner/include/scene_module/intersection/scene_intersection.hpp
Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com>
* Update planning/scenario_planning/lane_driving/behavior_planning/behavior_velocity_planner/README.md
Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com>
* Update planning/scenario_planning/lane_driving/behavior_planning/behavior_velocity_planner/include/scene_module/intersection/scene_intersection.hpp
Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com>
* fix format
* fix object position judge
* change function
* apply format
Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com>
* occlusion spot lower min ego velocity (#2140)
Co-authored-by: taikitanaka3 <taiki.tanaka@tier4.jp>
* 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
* use interpolation::slerp (#2161)
* Update traffic light state if ref stop point is ahead of previous one (#2197) (#2240)
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
Co-authored-by: Daisuke Nishimatsu <42202095+wep21@users.noreply.github.com>
* Change formatter to clang-format and black (#2332)
* Revert "Temporarily comment out pre-commit hooks"
This reverts commit 748e9cdb145ce12f8b520bcbd97f5ff899fc28a3.
* Replace ament_lint_common with autoware_lint_common
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Remove ament_cmake_uncrustify and ament_clang_format
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Apply Black
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Apply clang-format
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix build errors
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix for cpplint
* Fix include double quotes to angle brackets
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Apply clang-format
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix build errors
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Add COLCON_IGNORE (#500)
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* rename topic name twist -> odometry (#568)
Co-authored-by: Takayuki Murooka <takayuki.murooka@tier4.jp>
* Auto/behavior velocity (#605)
* port except for traffic light
* fix test
* update traffic light
* fix errors
* rename traffic message: final -> result
* fix package.xml
* twist -> odometry
* use confidence
* rename topic name of dynamic objects
* remove TODOs
* deal with probabilistic test failure
* deal with probabilistic test failure2
Co-authored-by: Takayuki Murooka <takayuki.murooka@tier4.jp>
* Sync .auto branch with the latest branch in internal repository (#691)
* add trajectory point offset in rviz plugin (#2270)
* sync rc rc/v0.23.0 (#2258)
* fix interpolation for insert point (#2228)
* fix interpolation for insert point
* to prev interpolation pkg
* Revert "to prev interpolation pkg"
This reverts commit 9eb145b5d36e297186015fb17c267ccd5b3c21ef.
Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com>
Co-authored-by: taikitanaka <ttatcoder@outlook.jp>
* fix topic name (#2266)
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* Add namespace to diag for dual_return_filter (#2269)
* Add a function to make 'geometry_msgs::msg::TransformStamped' (#2250)
* Add a function to make 'geometry_msgs::msg::TransformStamped'
* Add 'child_frame_id' as an argument of 'pose2transform'
* Simplify marker scale initialization (#2286)
* Fix/crosswalk polygon (#2279)
* extend crosswalk polygon
* improve readability
* fix polygon shape
* Add warning when decel distance calculation fails (#2289)
Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com>
* [motion_velocity_smoother] ignore debug print (#2292)
* cosmetic change
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* cahnge severity from WARN to DEBUG for debug info
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* use util for stop_watch
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* fix map based prediction (#2200)
* fix map based prediction
* fix format
* change map based prediction
* fix spells
* fix spells in comments
* fix for cpplint
* fix some problems
* fix format and code for clang-tidy
* fix space for cpplint
* Update Readme.md
* Update perception/object_recognition/prediction/map_based_prediction/Readme.md
* Update perception/object_recognition/prediction/map_based_prediction/Readme.md
* Update perception/object_recognition/prediction/map_based_prediction/Readme.md
* Update perception/object_recognition/prediction/map_based_prediction/Readme.md
* Update perception/object_recognition/prediction/map_based_prediction/Readme.md
* Update perception/object_recognition/prediction/map_based_prediction/Readme.md
* fix vector access method
* fix readme format
* add parameter
* Update perception/object_recognition/prediction/map_based_prediction/Readme.md
Co-authored-by: Kazuki Miyahara <kmiya@outlook.com>
* Update perception/object_recognition/prediction/map_based_prediction/Readme.md
Co-authored-by: Kazuki Miyahara <kmiya@out…
badai-nguyen
pushed a commit
to badai-nguyen/autoware.universe
that referenced
this pull request
Feb 4, 2022
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
badai-nguyen
pushed a commit
to badai-nguyen/autoware.universe
that referenced
this pull request
Feb 4, 2022
* release v0.4.0
* Fix typo (#700)
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix detection area (#701)
* Replace calcDistance with calcSignedDistance
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Add STOP state
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* intersection: change detection area length parameter from 100m to 200m (#702)
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* intersection: fix stuck vehicle behavior (#695)
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* Feature/intersection use spline interpolation library (#710)
* Use spline_interpolation module
* Remove debug messages
* Feature/stop reason (#712)
* add stop reason msg
* add mock of stop resaon publisher
* change namespace of stop reason
* update stop reason msg
* add toRosPoint
* implement stop reason publisher of blind stop
* implement stop reason publisher of crosswalk
* implement stop reason publisher of intersection
* implement stop reason publisher of stop line
* implement stop reason publisher of trafficlight
* implement stop reason publisher of detection area
* fix bug
* remove unnecessary process
* add remained stop factor
* clean code
* fix bug
* not punlish stop reason if array size is 0
* add stop reason to stuck object in intersection
* add stop factor of obstacle stop planner
* add stop reason of surround_obstacle checker
* Apply review
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* fix message type
* delete unused message from cmake
* remove stopReasonStamped
* change topic name of stop reasons
Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix/stop reason (#724)
* input stop reason of traffic light
* add comment
* add empty traffic light handling
* change calculation method of traffic light position
* avoid 0 position output
* Fix/spline interpolation in intersection module (#726)
* Remove duplicating sample points
* Change isValidInput
* Apply clang-format
* Fix convergence check in PCG
* fix clac signed distance bug (#733)
* intersection: ignore stop plane when path[0] is in detection area (#739)
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* Publish tl states stamped (#744)
* Add TrafficLightStateStamped.msg
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Use msg instead of struct
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Publish traffic light state
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Check if lamp state is empty
Signed-off-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp>
* Apply clang-format
Signed-off-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp>
* Cosmetic change
Signed-off-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp>
* update visualization marker (#759)
* fix stack area (#758)
* dont check pointcloud (#765)
Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com>
* fix stop factor of merge_from_private_area (#749)
* Revert "Publish tl states stamped (#744)" (#771)
This reverts commit 35a7e29e987afb29d9348b5f64866a584a65f753.
* fix intersection bug (#773)
* fix bug
* fix bug
* change uid of marker (#775)
* Fix/publish tl state stamped (#772)
* Publish tl states stamped (#744)
* Add TrafficLightStateStamped.msg
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Use msg instead of struct
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Publish traffic light state
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Check if lamp state is empty
Signed-off-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp>
* Apply clang-format
Signed-off-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp>
* Cosmetic change
Signed-off-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp>
* Use dynamic pointer cast
Signed-off-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp>
* Fix blind spot areas and logic for creating a stop line (#732)
* Fix blind spot areas
Signed-off-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp>
* Change logic for creating a stop line
Signed-off-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp>
* Do not add marker when marker is empty
Signed-off-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp>
* Cosmetic change
Signed-off-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp>
* Return boost optional for first conflict point
Signed-off-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp>
* Return boost optional for intersection start point
Signed-off-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp>
* Apply clang
Signed-off-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp>
* Fix/intersection stuck detect area (#764)
* fix stuck-vehicle detection area in intersection module
* separate vehicle param
* change the way ouf start idx count
* change param
* avoid to input -1 index (#777)
* add dead line and pass through when over dead line (#784)
* Add arg for input tl topic name (#783)
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* change margin to 1.0m (#790)
Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com>
* fix insert target point bug (#798)
* fix typo stop_liine to stop_line (#799)
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* traffic light scene module : fix bug and change param (#800)
* fix bug (passs judge line)
Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com>
* bug fix
Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com>
* change param
Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com>
* Intersection add debug comment (#803)
* blind spot : modify debug comment
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* merge from private road : modify debug comment
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* intersection : modify debug comment
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* intersection util: modify generateStopLine() for debug
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* add comment
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* Fix intersection preceeding lane query (#807)
* modified interseciton module to add lanelets in intersection to objective lanelets due to change in getPreceedingLaneletSequences()
Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>
* update comment
Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>
* Fix blind spot area (#806)
* Fix blind spot area
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Use range based for
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Use std::unique to remove adjacent duplicates
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Use generateFineCenterline
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Fix detection area start point
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Revert "Use generateFineCenterline"
This reverts commit 9d4f46bf65d7296b9286b30dfeed217a566a815c.
* Fix centerline of half lanelet
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Fix area start point
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Revert "fix insert target point bug (#798)" (#815)
This reverts commit 12eac2023538531e28a85a8914305cb534499f29.
* Fix/traffic light state (#801)
* fix bug (passs judge line)
Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com>
* bug fix
Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com>
* change param
Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com>
* bug fix : remove stop state
Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com>
* add lower limit
Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com>
* change param (#821)
Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com>
* stopline: parametrize check distance (#825)
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* Check if lanelets are sequential (#823)
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* fix uninitialized variables (#816)
* Parameterization for calculating judge line distance (#831)
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* remove ROS1 packages temporarily
Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>
* Revert "remove ROS1 packages temporarily"
This reverts commit 96b63e981899f79f2f5c6a6377e9600cc278e233.
Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>
* add COLCON_IGNORE to ros1 packages
Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>
* Rename launch files to launch.xml (#28)
* Port behavior_velocity_planner to ROS2 (#80)
* Revert "Add geometry2 to repos (#76)"
This reverts commit 6d2270476aaafdf1a8098d700d52a508525ea04b.
* Automatic parts of the package port
* Interesting part
* Fix typo in package.xml
* Review comments
* Child logger names
* Document logging duration
Co-authored-by: Ryohsuke Mitsudome <43976834+mitsudome-r@users.noreply.github.com>
* [ROS2] Fix behavior velocity planner (#110)
* install launch and config folders
Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>
* port launch file
Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>
* fix config files
Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>
* improve vehicle_info_utils to enable multiple declaration of VehicleInfo objects
Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>
* fix sementation fault
Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>
* Convert calls of Duration to Duration::from_seconds where appropriate (#131)
* 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
* fixing trasient_local in ROS2 packages (#160)
* Enable cppcheck lints in behavior_velocity_planner (#159)
* Enable lints in behavior_velocity_planner
* Fix package.xml
* Make launch files load vehicle model params dependent on argument (#228)
* Make vehicle_model configurable in behavior_velocity_planner
* Make vehicle_model configurable in vehicle_cmd_gate
* change from vehicle_model to vehicle_param_file (#242)
Signed-off-by: kosuke murakami <kosuke.murakami@tier4.jp>
* Ros2 v0.8 fix typo of "preceding" (#323)
* Fix typo of getPrecedingLaneletSequences
* Fix comment
* 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 <kenji.miyake@tier4.jp>
* Keep stopping after going over dead-line in STOP state
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Clear state after obstacle disappears
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Parameterize and change conditions
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Refactor
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* add elapsed time checker
* Refactor
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Ignore inserting point if points are too close
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Rename NORMAL to GO
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Revert "Ignore inserting point if points are too close"
This reverts commit 91c8d620ea11e703611945cb9a50877d175f4ff6.
* Fix small bug
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
Co-authored-by: taichiH <azumade.30@gmail.com>
* 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 <kenji.miyake@tier4.jp>
Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix task registration of detection area module (#856)
* Fix task registration of detection area module
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix id of factor_text marker
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* 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 <border_goldenmarket@yahoo.co.jp>
* Fix wrong format
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Fix flag order in judge condition
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* 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 <border_goldenmarket@yahoo.co.jp>
* 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 <yukky.saito@gmail.com>
* 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 <horibe.takamasa@gmail.com>
* intersection: consider ego-vehicle length when calculate stuck vehicle detection area
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* intersection: change param stuck_vehicle_ignore_dist: 5.0 -> 7.0
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* intersection: use vehicle_info/vehicle_length
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* fix implement miss
* fix target pedestrian (#927)
Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com>
* fix insert backward point (#953)
* fix insert backward point
* add comment
Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp>
* remove unnecessary if
Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp>
* Add stop line referred from road marking (#968)
* Add stop line referred from road marking
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Add stop line for walkway
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* 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 <kenji.miyake@tier4.jp>
* Fix/blind spot insert point (#1027)
* Copy insert point from previous point
* Reset path unless state is stop
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* 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 <border_goldenmarket@yahoo.co.jp>
* Make refer id same
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* fix getObjectivePolygons() so that intersecting lanelet is added to objective lanelets even when there is no preceeding lanelets (#1010)
Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>
* 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 <border_goldenmarket@yahoo.co.jp>
* Apply clang format
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Shrink conflicting area
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* 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 <kenji.miyake@tier4.jp>
* Add const
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Add correspondence marker of detection_area and stop_line
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Add obstacle marker
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fixup
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Add id marker
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Clear state when time rollback found
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix typo
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* change stop to polygon line
* apply clang format
* fix code
* fix bug
Co-authored-by: taichiH <azumade.30@gmail.com>
* Fix pass judge idx (#1090)
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* 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 <kenji.miyake@tier4.jp>
* Remove unnecessary pose
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Don't insert point if duplicated point exists
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix condition of duplicated points
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* seperate stop distance param (#1137)
* seperate stop distance param
Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp>
* apply param for automotically generated stop line
Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp>
* shift slow down line
Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp>
* add param in yaml file
Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp>
* 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 <tomoya.kimura@tier4.jp>
Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com>
Co-authored-by: taichiH <azumade.30@gmail.com>
Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp>
Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com>
Co-authored-by: Daisuke Nishimatsu <42202095+wep21@users.noreply.github.com>
Co-authored-by: Kazuki Miyahara <kmiya@outlook.com>
Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com>
Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com>
Co-authored-by: Kosuke Murakami <kosuke.murakami@tier4.jp>
Co-authored-by: Ryohsuke Mitsudome <43976834+mitsudome-r@users.noreply.github.com>
* Rename ROS-related .yaml to .param.yaml (#352)
* Rename ROS-related .yaml to .param.yaml
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Remove prefix 'default_' of yaml files
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Rename vehicle_info.yaml to vehicle_info.param.yaml
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Rename diagnostic_aggregator's param files
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix overlooked parameters
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* [behavior_velocity_planner]: Fix missing ros2 porting (#392)
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Fix error handling of tf lookupTransform (#405)
Co-authored-by: autoware <autoware@example.com>
* rm_std_msgs (#402)
* Sensor data qos (#407)
* Use sensor data qos for pointcloud preprocessor
Signed-off-by: Autoware <autoware@tier4.jp>
* Use sensor data qos for pointcloud
Signed-off-by: Autoware <autoware@tier4.jp>
* Fix lint
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Use sensor data qos for livox tag filter and vector map filter
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Fix lint
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
Co-authored-by: Autoware <autoware@tier4.jp>
* Ros2 fix topic name part1 (#408)
* Fix topic name of lane_departure_checker debug
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix topic name of mpc_follower debug
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix topic name of velocity_controller debug
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix topic name of motion_velocity_optimizer debug
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix topic name of lane_change_planner debug
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix topic name of behavior_velocity_planner debug
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix topic name of obstacle_avoidance_planner debug
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix topic name of behavior_velocity_planner
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix topic name of motion_velocity_optimizer
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix topic name of lane_departure_checker
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix topic name of mpc_follower
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix topic name of behavior_velocity_planner
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix topic name of velocity_controller
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix topic name of lane_change_planner
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix topic name of obstacle_avoidance_planner
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix topic name of obstacle_stop_planner
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix topic name of costmap_generator
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix topic name of freespace_planner
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix topic name of surround_obstacle_checker
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix topic name of costmap_generator
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix topic name of emergency_handler
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix lint errors
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix typo
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix typo in planning module (#432)
* Fix typo in planning module
* Fix remaining errors
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Apply cpplint and uncrustify.
Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp>
* fix traffic light module (#458)
* change log type (#459)
* add use_sim-time option (#454)
* Fix rolling build errors (#1225)
* Add missing include files
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Replace rclcpp::Duration
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Use reference for exceptions
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Use from_seconds
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Sync public repo (#1228)
* [simple_planning_simulator] add readme (#424)
* add readme of simple_planning_simulator
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* Update simulator/simple_planning_simulator/README.md
* set transit_margin_time to intersect. planner (#460)
* Fix pose2twist (#462)
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Ros2 vehicle info param server (#447)
* add vehicle_info_param_server
* update vehicle info
* apply format
* fix bug
* skip unnecessary search
* delete vehicle param file
* fix bug
* Ros2 fix topic name part2 (#425)
* Fix topic name of traffic_light_classifier
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix topic name of traffic_light_visualization
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix topic name of traffic_light_ssd_fine_detector
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix topic name of traffic_light_map_based_detector
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix lint traffic_light_recognition
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix lint traffic_light_ssd_fine_detector
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix lint traffic_light_classifier
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix lint traffic_light_classifier
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix lint traffic_light_ssd_fine_detector
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Fix issues in hdd_reader (#466)
* Fix some issues detected by Coverity Scan and Clang-Tidy
* Update launch command
* Add more `close(new_sock)`
* Simplify the definitions of struct
* fix: re-construct laneletMapLayer for reindex RTree (#463)
* Rviz overlay render fix (#461)
* Moved painiting in SteeringAngle plugin to update()
Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai>
* super class now back to MFD
Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai>
* uncrustified
Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai>
* acquire data in mutex
Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai>
* back to RTD as superclass
Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai>
* Rviz overlay render in update (#465)
* Moved painiting in SteeringAngle plugin to update()
Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai>
* super class now back to MFD
Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai>
* uncrustified
Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai>
* acquire data in mutex
Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai>
* removed unnecessary includes and some dead code
Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai>
* Adepted remaining vehicle plugin classes to render-in-update concept. Returned to MFD superclass
Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai>
* restored RTD superclass
Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai>
Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com>
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
Co-authored-by: Takagi, Isamu <43976882+isamu-takagi@users.noreply.github.com>
Co-authored-by: Kazuki Miyahara <kmiya@outlook.com>
Co-authored-by: Makoto Tokunaga <vios-fish@users.noreply.github.com>
Co-authored-by: Adam Dąbrowski <adam.dabrowski@robotec.ai>
* Unify Apache-2.0 license name (#1242)
* Make planning modules components (#1263)
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Remove use_sim_time for set_parameter (#1260)
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Refactor vehicle info util (#1305)
* Update license
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Refactor vehicle_info_util
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Rename and split files
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix interfaces
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix bug and add error handling
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Add "// namespace"
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Add missing include
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* fix slow/stop marker color & stop reason (#1347) (#1354)
Co-authored-by: satoshi-ota <satoshi.ota@gmail.com>
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com>
Co-authored-by: satoshi-ota <satoshi.ota@gmail.com>
* fix intersection stop line (#1272) (#1349)
* fix intersection stop line (#1272)
* fix intersection stop line
* fix comment
* Fix typo
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
* Avoid passing empty lanelets to getPolygonFromArcLength (#1371)
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Add perception traffic light state output (#1302)
* Add perception traffic light state output
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Modify message type
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Apply message type to relay
Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Feature/consider jerk limit in passjudge (#1339) (#1351)
* Feature/consider jerk limit in passjudge (#1339)
* make new branch for behavior velocity planner
* update implementation for considering accel & jerk limit
* refactoring
* change default params
* change default params
* change minimum velocity which decides to conduct pass judge
* remove ROS_DEBUG_COND()
* remove unnecessary variables
* fix lowpass filter implementation
* calc acceleration in planner_data_
Co-authored-by: satoshi-ota <satoshi.ota@gmail.com>
* Fix typo
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com>
Co-authored-by: satoshi-ota <satoshi.ota@gmail.com>
* Feature/refactor stop line module (#1343) (#1359)
* Refactor stop_line planner module
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Add document
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix English
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com>
* Feature/add stop duration ros2 (#1380)
* Feature/add stop duration (#1367)
* Add stop_duration to behavior_velocity_planner
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* parameterize stop duration sec
* Use stop_duration in Stop Line module
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
Co-authored-by: Hiroki OTA <hiroki.ota@tier4.jp>
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Change default value
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com>
Co-authored-by: Hiroki OTA <hiroki.ota@tier4.jp>
Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix topic name of external traffic light input (#1412)
* publish perception and external tl_state for mlops (#1350) (#1375)
* publish perception and external tl_state for mlops
* fix tl_state time stamp
Co-authored-by: satoshi-ota <satoshi.ota@gmail.com>
Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com>
Co-authored-by: satoshi-ota <satoshi.ota@gmail.com>
* Fix/traffic light planning module (#1424) (#1487)
* Fix/traffic light planning module (#1424)
* bug fix
* refactor
* refactor
* cosmetic change
* fix typo
* cosmetic change
* refactor
* remove unused func
* enable restart
* cosmetic change
* fix typo
* refactor
* bug fix
* cosmetic change
* modify debug_data
* Apply lint
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Remove unnecesarry comment
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Fix bug
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com>
* change msg type looking traffic light state (#1494)
* change msg type looking traffic light state (#1455)
* change msg type looking traffic light state
* fix msg name
* using namespace
* change function name
* fix typo
* add readme
* Update awapi/awapi_awiv_adapter/Readme.md
fix typo
Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com>
Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com>
* Remove deprecated message include
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Fix lint
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com>
* Add namespace to behavior_velocity_planner (#1542)
* Add namespace to behavior_velocity_planner
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix typo
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Avoid passing uninitialized index (#1609)
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* suppress warnings for behavior_velocity_planner (#1733)
* add Werror
* suppress warnings for stopline module
* fix for crosswalk
* fix for traffic light
* fix for detection area
* fix style
* use {}
* use auto
* Fix -Wunused-parameter (#1836)
* Fix -Wunused-parameter
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix mistake
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* fix spell
* Fix lint issues
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Ignore flake8 warnings
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
Co-authored-by: Hiroki OTA <hiroki.ota@tier4.jp>
* Fix compiler warnings (#1837)
* Fix -Wunused-private-field
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix -Wunused-variable
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix -Wformat-security
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix -Winvalid-constexpr
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix -Wdelete-non-abstract-non-virtual-dtor
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix -Wdelete-abstract-non-virtual-dtor
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix -Winconsistent-missing-override
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix -Wrange-loop-construct
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix "invalid application of 'sizeof' to an incomplete type"
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Ignore -Wgnu-anonymous-struct and -Wnested-anon-types
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix lint
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Ignore -Wno-deprecated-declarations in CUDA-related packages
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix mistake
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix -Wunused-parameter
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Add autoware api (#1979)
* Feature/add virtual traffic light planner (#1588)
* 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
* remove spline_interpolation, and create interpolation package that ha… (#2114)
* remove spline_interpolation and add interpolation package
* fix bugs and add simple test
* modify application for interpolation package
* add some tests and fix ci test
* add some tests
* add -Werror
* move functions to anonymous
* fix reviews
* fix typo
* fix review and lint
* add tests
* resolve TODOs
* add README.md
* Update common/math/interpolation/test/src/test_interpolation_utils.cpp
Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com>
* Update common/math/interpolation/test/src/test_interpolation_utils.cpp
Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com>
* Update common/math/interpolation/test/src/test_interpolation_utils.cpp
Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com>
* fix README.md
* dealt with reviews
* update README.md
* update README.md
* Update common/math/interpolation/README.md
* fix some bugs
* fix typo
* update README.md
* Update common/math/interpolation/README.md
Co-authored-by: Kazuki Miyahara <kmiya@outlook.com>
* fix test
* Update common/math/interpolation/README.md
Co-authored-by: Kazuki Miyahara <kmiya@outlook.com>
* fix cdots
* fix README.md
* Update common/math/interpolation/README.md
Co-authored-by: Kazuki Miyahara <kmiya@outlook.com>
Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com>
Co-authored-by: Kazuki Miyahara <kmiya@outlook.com>
* Sync develop/fix interpolation and speed up calculation (#2290)
* debug slope calculation in behavior (#1566) (#1727)
* debug slope calculation in behavior (#1566)
* update
* update
* revert change of autoware_utils
* define getPose in behavior_path_planner
* update
* update
* update
* update
* interpolate z in obstacle_avoidance_planner
* update velocity controller
* fix detection area and scene
* Update planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/src/utilities.cpp
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
* update comment in velocity controller
* remove debug print
* update
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Fix typo
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Fix variable names
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix uncrustify
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix mistake
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
Co-authored-by: Takayuki Murooka <takayuki5168@gmail.com>
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp>
* add underscore to marker namespace (#1785)
Co-authored-by: satoshi-ota <satoshi.ota@gmail.com>
* [obstacle_avoidance_planner] remove useless get nearest idx (#1851)
* modify velocity insertion in obstacle_avoidance_planner
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* [obstacle_avoidance_planner] reduce calculation cost in relative/absolute transformation (#1844)
* implement relative/absolute transformation without yaw but directly sin/cos of yaw
* rename: relative_p to absolute_p
* assigin point.z to rel/abs_z
* fix cpp-lint error
Co-authored-by: Daisuke Nishimatsu <42202095+wep21@users.noreply.github.com>
Co-authored-by: Takayuki Murooka <takayuki5168@gmail.com>
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp>
Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com>
Co-authored-by: satoshi-ota <satoshi.ota@gmail.com>
Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* fix argument order (#1502) (#1622)
Co-authored-by: satoshi-ota <satoshi.ota@gmail.com>
Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com>
Co-authored-by: satoshi-ota <satoshi.ota@gmail.com>
* Change param (#1559) (#1677)
Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com>
* Feature/use spline module in behavior velocity planner (#1457) (#1495)
* Feature/use spline module in behavior velocity planner (#1457)
* Use spline_interpolation module
* Remove unused function
* Remove unused include
* Use autoware_utils
* Remove unused function
* Remove cubic_spline.hpp
* Fix error handling
* Fix interpolation of velocity
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* change warning threshold (#1539)
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* Apply lint
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com>
Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* Feature/porting behavior path planner (#1645)
* Add behavior path planner pkg with Lane Change (#1525)
* add lanelet extension funcs
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* add planning msgs for FOA
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* add behavior_path_planner pkg
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* apply clang format
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* add error handling for config load failure
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* replace word: foa with remote control
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* add readme
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* use pointer for return value of path
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* fix hz
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* remove debug print
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* remove shide-shift & avoidance related files
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* Clip path by goal
* add build depend for behavior tree cpp
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* temporally disable lint test in lanelet2_extension
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
Co-authored-by: rej55 <rej55.g@gmail.com>
* Add avoidance module in behavior_path_planner (#1528)
* Revert "remove shide-shift & avoidance related files"
This reverts commit d819ea0291fca251012e4b9ffd16de3896830aa2.
* refactor findNewShiftPoint func
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* remove duplicated decleration
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* fix barkward length issue
- add clipPathLenght func in avoidance
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* refactor:
- translate english
- minor modification for traffic distance
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* support debug marker in behavior_path_planner
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* clean up side shift module
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* change topic name
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* remove japanese
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* Update planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/include/behavior_path_planner/scene_module/side_shift/side_shift_module.hpp
Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com>
* fix typo
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* remove unused var
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* adress reviewer comments:
- add const for variables
- add comment
- fix typo
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* fix typo
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com>
* Replace behavior_path utilities with autoware_utils (#1532)
* replace calcDistance
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* replace arange
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* replave convertToEigenPt with autoware_utils::fromMsg
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* replace normalizeRadian
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* cosmetic change
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* import #1526 into behavior path planner (#1531)
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* Fix/behavior path empty path output guard (#1536)
* add guard
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* Update planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/src/behavior_path_planner.cpp
* fix lateral jerk calculation (#1549)
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* fix: error handling on exception in behavior_path_planner (#1551)
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* Fix ignore too steep avoidance path (#1550)
* ignore too steep path
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* Update planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/src/scene_module/avoidance/avoidance_module.cpp
* parametrize lateral jerk limit
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* Update planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/include/behavior_path_planner/scene_module/avoidance/avoidance_module.hpp
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
* use offsetNoThrow and add error log (#1615)
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* Ignore object ahead goal for avoidance (#1618)
* Ignore object ahead goal for avoidance
* Add flag
* Fix position of definition of goal_pose
* Fix arclength calculation
* Fix position of definition of goal_pose
* fix intersection stop line (#1636)
* fix intersection stop line
* fix typo
* add document (#1635)
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* Port behavior path planner to ros2
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Apply lint
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Fix typo
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Fix map qos
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* debug slope calculation in behavior (#1566)
* update
* update
* revert change of autoware_utils
* define getPose in behavior_path_planner
* update
* update
* update
* update
* interpolate z in obstacle_avoidance_planner
* update velocity controller
* fix detection area and scene
* Update planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/src/utilities.cpp
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
* update comment in velocity controller
* remove debug print
* update
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
* Address review: Fix config file name
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* pre-commit fixes
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Fix redeclaring parameters
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Add missing tf2 geometry function
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Apply lint
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Fix rclcpp Time initialization
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Use now() instead of msg stamp
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Use throttle output in getExpandedLanelet
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Add missing const
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Fix lint
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com>
Co-authored-by: rej55 <rej55.g@gmail.com>
Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com>
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
Co-authored-by: Takayuki Murooka <takayuki5168@gmail.com>
* Fix/generate intersection stop (#1590) (#1679)
* Fix/generate intersection stop (#1590)
* fix bug of conflicting polygons
* clean code
* Fix lint
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
* Fix/stop margin time ros2 (#1683)
* Add stop margin time in walkway and merge_from_private_area (#1613)
* Add stop margin time in walkway, merge_from_private_area
* Fix param name
* Fix bug
* Apply lint
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com>
* Feature/change stop lines handling to support parking car avoidance p… (#1676)
* Feature/change stop lines handling to support parking car avoidance path (#1464)
* support parking car avoidance
* change log level
* apply clang-format
* add extendLine function
* clean up & apply clang-format
* change implementation getStopPoseFromMap()
* remove unuse comment line
Co-authored-by: satoshi-ota <satoshi.ota@gmail.com>
* fix argument order (#1580)
Co-authored-by: satoshi-ota <satoshi.ota@gmail.com>
Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com>
Co-authored-by: satoshi-ota <satoshi.ota@gmail.com>
* Feature/porting occlusion spot (#1740)
* Feature/occlusion_spot safety planner public road (#1594)
* add blind spot safety planner public road
* remove duplicated procesing
* remove unused private param
* renaming fix typo add comments
* fix spell check
* velocity -> relative velocity
* calc2d, To param, simplify search, To original
* add the num possible collision gurd
* computational cost reduction
* Cosmetic change for PossibleCollisionInfo
* add interpolation to possible collision value
* refactor codes
* fix details
* invalid point gurd
* To Param
* refacotor to occlusion spot util
* cosmetic change
* clean up blindspot
* To Occlusion Spot
* revise readme
* refactor drawing
* for better explanation
* fix velocity profile
* clean up details
* cosmetic change for debug marker
* use max velocity in obstacle info instead
* add gtest for Too Many Possible Collision case
* change case
* refactor readme
* minor fix
* add more occlusion spot explanation
* replace svg
* add gtest build path lanelet
* hotfix lateral distance and searching method
* update g test for lateral distance
* use faster search
* set more realistic param
* add lanelet subtype highway
* cosmetic change of reviews
* add occlusion spot module in private area (#1640)
* add occlusion spot in private
* For debugging change
* add spline interpolation to path
* add review changes
* adding minor change
* cosmetic change
* Vector to retval
* Blindspot To OcclusionSpot1
* To Occlusion Spot 2
* To Occlusions spot3
* update gtest with unified anchor
* remove anchor
* add test slice
* simplify interpolation
* Too Occlusion spot4
* add test buffer
* To Occlusion spot
* namespace gurd
* correct slice and add interpolation first
* handle self crossing with check for invation
* to ros debug stream
* removed unused interpolation
* add readme to plant uml
* cosmetic change
* minor change
* update readme
* review change
* change occlusion spot text color
* To Offset no Throw
* better debug marker
* catch only inversion error
* skip return in case of inversion
* for better grid
* simplify path lanelet at first
* remove std::cout
* for better path
* limit ego path inside target lanelet location
* remove last points
* cosmetic change for markers
* apply module for limited scene
* fix interpolation gurd
* for better params
* do not includes path behind
* remove dummy perception publisher
* Revert "remove dummy perception publisher"
This reverts commit 4acad985fe31dd9befaa21a16631495de6c3a117.
* replace hard coded occupancy grid option in psim
* remove respawn
* add arg to params and remove redundunt launch
* fix spell check
* fix default value
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
* Feature/occlusion spot private slice size param (#1703)
* add min slice size
* for a bit narrow lateral distance
* Update planning/scenario_planning/lane_driving/behavior_planning/behavior_velocity_planner/config/occlusion_spot_param.yaml
Co-authored-by: Maxime CLEMENT <78338830+maxime-clem@users.noreply.github.com>
Co-authored-by: Maxime CLEMENT <78338830+maxime-clem@users.noreply.github.com>
* Rename files
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Porting to ros2
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* pre-commit fixes
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Fix typo
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Fix launch namespace
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
* Fix parameter type
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
* Update planning/scenario_planning/lane_driving/behavior_planning/behavior_velocity_planner/src/scene_module/occlusion_spot/scene_occlusion_spot_in_private_road.cpp
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com>
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
Co-authored-by: Maxime CLEMENT <78338830+maxime-clem@users.noreply.github.com>
* fix function name and condition for detection area (#1758)
* Fix build warning for occlusion spot (#1766)
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Fix passing uninitialized index (#1792)
* Fix passing uninitialized index
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Apply uncrustify
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Fix return value
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
* Fix/intersection bug (#1787)
* fix insert point function
* apply format
* separate insertPoint and hasDuplicatedPoint
* clean code
* fix bug
* replace velocity if collision point is too close to original path point (#1799)
* replace velocity if collision point is too close to original path point
* fix comment
* Fix compile warnings (#1852)
Fix -Wunused-parameter
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
Fix -Wunused-private-field
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
Fix -Wunused-lambda-capture
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
Fix -Wdelete-non-abstract-non-virtual-dtor
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
Fix -Wrange-loop-construct
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
Ignore lint error
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Document / behavior velocity planner (#1767)
update document
Co-authored-by: Kazuki Miyahara <kmiya@outlook.com>
* fix occlusion spot insert velocity ros2 (#1821)
* Fix/occlusion spot offset (#1824)
* merge calcCollisionFunction
* ConsiderSignedOffset
* add extractRoadTargetAndSignedOffset
* apply signed offset and fix longitudinal distance
* fix unapplied param
* update gtest
* consider offset until target road
* refactor for proper variable name
* fix typo
* remove unused first index
* fix closest
* fix diff
* fix velocity and height
* tune distance thershold
* fix colcon test
* apply param at the experiment
* fix unused and param
* Fix/current acc initialize (#1899)
* use boost::optional
* null guard
* fix typo
* Feature/improve intersection detection area (#1958)
* exclude ego_lanes from detection_area
* add empty handling
* remove unused function
* Fix for uncrustify
Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com>
* [behavior_velocity_planner] remove unnecessary graph search to reduce computational cost (#1980)
* remote unnecessary graph search
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* add var for graph id
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* remove unused stopline search for computational cost reduction
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* restore lane_ids iteration as it was
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* sort sidewalk slice by arc length (#1967)
* sort sidewalk slice by arc length
* handle invalid index
* divide offset to ego to closest to and closest to target
* fix cartesian distance to arc lane distance
* consider ego to target to ignore length
* Update planning/scenario_planning/lane_driving/behavior_planning/behavior_velocity_planner/src/scene_module/occlusion_spot/occlusion_spot_utils.cpp
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
* Fix/merge from private area (#2005)
* fix insert pos. of merge from private area
* exclude entrance of private road from path
* extract exit of private road
* Feature/intersection module detect obstacle (#1990)
* change the way to detect target objects in detection area
* check the angle of deteced objects
* ignore predicted path with low confidence
* Update planning/scenario_planning/lane_driving/behavior_planning/behavior_velocity_planner/include/scene_module/intersection/scene_intersection.hpp
Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com>
* Update planning/scenario_planning/lane_driving/behavior_planning/behavior_velocity_planner/include/scene_module/intersection/scene_intersection.hpp
Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com>
* Update planning/scenario_planning/lane_driving/behavior_planning/behavior_velocity_planner/README.md
Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com>
* Update planning/scenario_planning/lane_driving/behavior_planning/behavior_velocity_planner/include/scene_module/intersection/scene_intersection.hpp
Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com>
* fix format
* fix object position judge
* change function
* apply format
Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com>
* occlusion spot lower min ego velocity (#2140)
Co-authored-by: taikitanaka3 <taiki.tanaka@tier4.jp>
* 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
* use interpolation::slerp (#2161)
* Update traffic light state if ref stop point is ahead of previous one (#2197) (#2240)
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
Co-authored-by: Daisuke Nishimatsu <42202095+wep21@users.noreply.github.com>
* Change formatter to clang-format and black (#2332)
* Revert "Temporarily comment out pre-commit hooks"
This reverts commit 748e9cdb145ce12f8b520bcbd97f5ff899fc28a3.
* Replace ament_lint_common with autoware_lint_common
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Remove ament_cmake_uncrustify and ament_clang_format
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Apply Black
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Apply clang-format
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix build errors
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix for cpplint
* Fix include double quotes to angle brackets
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Apply clang-format
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Fix build errors
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Add COLCON_IGNORE (#500)
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* rename topic name twist -> odometry (#568)
Co-authored-by: Takayuki Murooka <takayuki.murooka@tier4.jp>
* Auto/behavior velocity (#605)
* port except for traffic light
* fix test
* update traffic light
* fix errors
* rename traffic message: final -> result
* fix package.xml
* twist -> odometry
* use confidence
* rename topic name of dynamic objects
* remove TODOs
* deal with probabilistic test failure
* deal with probabilistic test failure2
Co-authored-by: Takayuki Murooka <takayuki.murooka@tier4.jp>
* Sync .auto branch with the latest branch in internal repository (#691)
* add trajectory point offset in rviz plugin (#2270)
* sync rc rc/v0.23.0 (#2258)
* fix interpolation for insert point (#2228)
* fix interpolation for insert point
* to prev interpolation pkg
* Revert "to prev interpolation pkg"
This reverts commit 9eb145b5d36e297186015fb17c267ccd5b3c21ef.
Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com>
Co-authored-by: taikitanaka <ttatcoder@outlook.jp>
* fix topic name (#2266)
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* Add namespace to diag for dual_return_filter (#2269)
* Add a function to make 'geometry_msgs::msg::TransformStamped' (#2250)
* Add a function to make 'geometry_msgs::msg::TransformStamped'
* Add 'child_frame_id' as an argument of 'pose2transform'
* Simplify marker scale initialization (#2286)
* Fix/crosswalk polygon (#2279)
* extend crosswalk polygon
* improve readability
* fix polygon shape
* Add warning when decel distance calculation fails (#2289)
Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com>
* [motion_velocity_smoother] ignore debug print (#2292)
* cosmetic change
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* cahnge severity from WARN to DEBUG for debug info
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* use util for stop_watch
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* fix map based prediction (#2200)
* fix map based prediction
* fix format
* change map based prediction
* fix spells
* fix spells in comments
* fix for cpplint
* fix some problems
* fix format and code for clang-tidy
* fix space for cpplint
* Update Readme.md
* Update perception/object_recognition/prediction/map_based_prediction/Readme.md
* Update perception/object_recognition/prediction/map_based_prediction/Readme.md
* Update perception/object_recognition/prediction/map_based_prediction/Readme.md
* Update perception/object_recognition/prediction/map_based_prediction/Readme.md
* Update perception/object_recognition/prediction/map_based_prediction/Readme.md
* Update perception/object_recognition/prediction/map_based_prediction/Readme.md
* fix vector access method
* fix readme format
* add parameter
* Update perception/object_recognition/prediction/map_based_prediction/Readme.md
Co-authored-by: Kazuki Miyahara <kmiya@outlook.com>
* Update perception/object_recognition/prediction/map_based_prediction/Readme.md
Co-authored-by: Kazuki Miyahara <kmiya@out…
badai-nguyen
pushed a commit
to badai-nguyen/autoware.universe
that referenced
this pull request
Feb 4, 2022
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
TomohitoAndo
pushed a commit
to TomohitoAndo/autoware.universe
that referenced
this pull request
Oct 5, 2022
TomohitoAndo
pushed a commit
to TomohitoAndo/autoware.universe
that referenced
this pull request
Oct 5, 2022
TomohitoAndo
pushed a commit
to TomohitoAndo/autoware.universe
that referenced
this pull request
Oct 5, 2022
…r_centerpoint (autowarefoundation#159) * feat: add voxel_grid_downsample_filter before lidar_centerpoint Signed-off-by: yukke42 <yusuke.muramatsu@tier4.jp> * feat: use pointcloud_container Signed-off-by: yukke42 <yusuke.muramatsu@tier4.jp> * fix: small change Signed-off-by: yukke42 <yukke42@users.noreply.github.com>
keiota
pushed a commit
to keiota/autoware.universe
that referenced
this pull request
Aug 17, 2023
…utowarefoundation#159) * feat(autoware_launch): add new config params for fitting uniform circle Signed-off-by: Mehmet Dogru <42mehmetdogru42@gmail.com> * reformat Signed-off-by: Mehmet Dogru <42mehmetdogru42@gmail.com> Signed-off-by: Mehmet Dogru <42mehmetdogru42@gmail.com>
kyoichi-sugahara
pushed a commit
that referenced
this pull request
Sep 16, 2023
kyoichi-sugahara
pushed a commit
that referenced
this pull request
Sep 16, 2023
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
Sign up for free
to join this conversation on GitHub.
Already have an account?
Sign in to comment
Add this suggestion to a batch that can be applied as a single commit.
This suggestion is invalid because no changes were made to the code.
Suggestions cannot be applied while the pull request is closed.
Suggestions cannot be applied while viewing a subset of changes.
Only one suggestion per line can be applied in a batch.
Add this suggestion to a batch that can be applied as a single commit.
Applying suggestions on deleted lines is not supported.
You must change the existing code in this line in order to create a valid suggestion.
Outdated suggestions cannot be applied.
This suggestion has been applied or marked resolved.
Suggestions cannot be applied from pending reviews.
Suggestions cannot be applied on multi-line comments.
Suggestions cannot be applied while the pull request is queued to merge.
Suggestion cannot be applied right now. Please check back later.
No description provided.