Skip to content
New issue

Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.

By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.

Already on GitHub? Sign in to your account

feat: add behavior_velocity_planner package #27

Conversation

tkimura4
Copy link
Contributor

@tkimura4 tkimura4 commented Nov 30, 2021

Related Issue

#1

This PR depends on

Description

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

How to review

Check the following item

  • Readme
  • Launch file

mitsudome-r and others added 30 commits November 30, 2021 16:08
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* 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>
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
…tion#710)

* Use spline_interpolation module

* Remove debug messages
* 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>
* input stop reason of traffic light

* add comment

* add empty traffic light handling

* change calculation method of traffic light position

* avoid 0 position output
* Remove duplicating sample points

* Change isValidInput

* Apply clang-format

* Fix convergence check in PCG
* 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>
Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com>
…foundation#771)

This reverts commit 35a7e29e987afb29d9348b5f64866a584a65f753.
* Publish tl states stamped (autowarefoundation#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>
…dation#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 stuck-vehicle detection area in intersection module

* separate vehicle param

* change the way ouf start idx count

* change param
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com>
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
…tion#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>
* 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>
takayuki5168 and others added 8 commits November 30, 2021 16:08
* 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>
…warefoundation#691)

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

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

* fix interpolation for insert point (autowarefoundation#2228)

* fix interpolation for insert point

* to prev interpolation pkg

* Revert "to prev interpolation pkg"

This reverts commit 9eb145b5d36e297186015fb17c267ccd5b3c21ef.

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

* fix topic name (autowarefoundation#2266)

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

* Add namespace to diag for dual_return_filter (autowarefoundation#2269)

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

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

* Simplify marker scale initialization (autowarefoundation#2286)

* Fix/crosswalk polygon (autowarefoundation#2279)

* extend crosswalk polygon

* improve readability

* fix polygon shape

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

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

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

* fix map based prediction

* fix format

* change map based prediction

* fix spells

* fix spells in comments

* fix for cpplint

* fix some problems

* fix format and code for clang-tidy

* fix space for cpplint

* Update Readme.md

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

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

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

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

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

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

* fix vector access method

* fix readme format

* add parameter

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

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

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

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

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

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

* Update Readme.md

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

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

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

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

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

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

* [mpc_follower] remove stop distance condition from stopState decision

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

* add invalid index handling

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

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

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

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

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

* Simplify iteration of initial poses (autowarefoundation#2310)

* Make a transform object const (autowarefoundation#2311)

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

* Feature/no stopping area (autowarefoundation#2163)

* add no stopping area module to behavior velocity planner

* apply utils

* add polygon interpolation module order stopline around area is considered

* devide jpass udge with stop line polygon

* update docs

* rename file name

* update to latest

* minor change for marker

* update license

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

* update license

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

* update license

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

* update license

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

* minor fix

* add parameter tuning at experiment

* update readme

* format doc

* apply comments

* add exception gurd

* cosmetic change

* fix ament

* fix typo and remove for statement

* & to " "

* better ns

* return pass judge param

* add missing stoppable condition

* add clear pass judge and stoppable flag

* add comment

* precommit fix

* cpplint

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

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

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

* add print debug

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

* remove forward shift points when adding new point

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

* remove debug print

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

* format

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

* Fix remove threshold

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

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

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

* delete unnecessary check

* fix condition of starting pull out

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

* Fix/mpc reset prev result (autowarefoundation#2185) (autowarefoundation#2195)

* reset prev result

* clean code

* reset only raw_steer_cmd

* Update control/mpc_follower/src/mpc_follower_core.cpp

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

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

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

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

* fix 1 path point exception after resampling

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

* Apply suggestions from code review

* Apply suggestions from code review

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

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

* [hotfix] Fix lane ids (autowarefoundation#2211)

* Fix lane ids

* Prevent acceleration on avoidance (autowarefoundation#2214)

* prevent acceleration on avoidance

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

* fix param name

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

* parametrize avoidance acc

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

* change param name

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

* fix typo

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

* Fix qos in roi cluster fusion (autowarefoundation#2218)

* fix confidence (autowarefoundation#2220)

* too high confidence (autowarefoundation#2229)

* Fix/obstacle stop 0.23.0 (autowarefoundation#2232)

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

* Fix/insert implementation (autowarefoundation#2186)

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

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

* Remove exception

* Fix clock

* Remove blank line

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

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

* fix interpolation for insert point (autowarefoundation#2228)

* fix interpolation for insert point

* to prev interpolation pkg

* fix index (autowarefoundation#2265)

* turn signal calculation (#2280)

* add turn signal funtion in path shifter

* add ros parameters

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

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

* fix return-from-ego shift point generation logic

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

* change param for trimSimilarGradShiftPoint

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

* add comment for issue

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

* update comment

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

* replace code with function (logic has not changed)

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

* move func to cpp

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

* add comment for issue

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

* fix typo

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

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

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

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

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

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

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

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

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

* fix object orientation

* fix function name

* add guard (autowarefoundation#2321)

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

* Add detail collision check (autowarefoundation#2274)

* Add detail collision check

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

* Remove unused function

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

* Fix arc length

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

* Seperate time margin

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

* Fix parameter name

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

* Update Readme

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

* Address review: Add comment for TimeDistanceArray

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

* Run pre-commit

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

* Fix cpplint

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

* Add return for empty polygon

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

* update CenterPoint  (autowarefoundation#2222)

* update to model trained by mmdet3d

* add vizualizer (debug)

* for multi-frame inputs

* chagne config

* use autoware_utils::pi

* project specific model and param

* rename vfe -> encoder

* rename general to common

* update download link

* update

* fix

* rename model_name

* change training toolbox link

* chage lint package

* fix test error

* commit suggestion

* Feature/lane change detection (autowarefoundation#2331)

* add old information deleter

* fix access bug

* change to deque

* update obstacle buffer

* fix some bugs

* add lane change detector

* make a update lanelet function

* fix code style

* parameterize essential values

* Update perception/object_recognition/prediction/map_based_prediction/src/map_based_prediction_ros.cpp

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

* fix slash position

* remove unnecessary lines

* fix format

* fix format

* change to new enum

* fix format

* fix typo and add guard

* change funciton name

* add lane change description

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

* Add Planning Evaluator  (autowarefoundation#2293)

* Add prototype planning evaluator

Produced data for dist between points, curvature, and relative angle

* Cleanup the code to make adding metrics easier

* Add remaining basic metrics (length, duration, vel, accel, jerk)

* Add motion_evaluator to evaluate the actual ego motion + code cleanup

* Add deviation metrics

* Add naive stability metric

* Handle invalid stat (TODO: fix the output file formatting)

* Add parameter file and cleanup

* Add basic obstacle metric (TTC not yet implemented) and fix output file format

* Add basic time to collision

* Add lateral-distance based stability metric

* Add check (at init time) that metrics' maps are complete

* Publish metrics as ParamaterDeclaration msg (for openscenario)

* Use lookahead and start from ego_pose when calculating stability metrics

* Code cleanup

* Fix lint

* Add tests

* Fix bug with Frechet dist and the last traj point

* Finish implementing tests

* Fix lint

* Code cleanup

* Update README.md

* Remove unused metric

* Change msg type of published metrics to DiagnosticArray

* fix format to fix pre-commit check

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

* fix yaml format to fix pre-commit check

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

* fix yaml format

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

* apply clang-format

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

* apply clang-format

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

* Update planning/planning_diagnostics/planning_evaluator/include/planning_evaluator/planning_evaluator_node.hpp

* Update planning/planning_diagnostics/planning_evaluator/test/test_planning_evaluator_node.cpp

* Update planning/planning_diagnostics/planning_evaluator/test/test_planning_evaluator_node.cpp

* change lint format to autoware_lint_common

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

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

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

* Add keep braking function at driving state

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

* Remove debug messages

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

* Fix format

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

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

* add cross judgement and common signal function (autowarefoundation#2319)

* merge branch turn_signal_common

* add turn signal function in signal decider

* add cross judge in path_utilities and delete from turn_signal_decider

* remove original signal calculation in lane change

* omit substitution

* replace turn signal decider in pull over function

* modify cross judge logic

* replace turn signal decider in avoidance

* add readme of turn signal

* update

* delete print debug

* update

* delete lane change decider in path shifter

* delete blank line

* fix indent

* fix typo

* fix typo

* decrease nest

* run pre commit

* Add 0 limit at forward jerk velocity filter (autowarefoundation#2340)

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

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

* add offset param

* clang-format

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

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

* Add the description of brake keeping

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

* Add the english document

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

* Improve description

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

* Add english description

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

* Fix include files (autowarefoundation#2339)

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

* fix behavior intersection module

* fix behavior no stopping area module

* fix planning_evaluator

* fix motion_velocity_smoother

* rename variable

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

This reverts commit ff4f0b5a844d1f835f1b93bd3b36a76747b0cd02.

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

This reverts commit f0478187db4c28bf6092c198723dcc5ec11a9c70.

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

This reverts commit 66de2f3924a479049fce2d5c5c6b579cacbd3e49.

* Fix orientation availability in centerpoint

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

* fix test_trajectory.cpp

* add target link libraries

* Use .auto msg in test code for planniing evaluator

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

* fix include

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

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

* add traffic light readme

* add other docs

* cosmetic change

* fix

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

* Update

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

* fix typo

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

* Update

* Update

* fix pre commit

* fix pre-commit

Co-authored-by: taikitanaka3 <taiki.tanaka@tier4.jp>
Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com>
Signed-off-by: j4tfwm6z <proj-jpntaxi@tier4.jp>

Co-authored-by: j4tfwm6z <proj-jpntaxi@tier4.jp>
* rename segmentation directory

* fix namespace: system stack

* fix namespace: planning

* fix namespace: control stack

* fix namespace: perception stack

* fix readme
taikitanaka3 referenced this pull request in taikitanaka3/autoware.universe Dec 1, 2021
* port velocity controller

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

* add paramater callback

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

* remove old reconfigure function

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

* move paramCallback from .h to .cpp

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

* modify reconfigure callback

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

* modify cmake, remove cfg, fix launch

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

* remove unused code

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

* remove unused

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

* minor fix from review

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

* fix launch

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

* add comment

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

* add .h files in add_executable in CMakelist

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

* fix include order

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

* minor update from review

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

* use waitForTransform with timeout

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

* remove sleep

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

* modify waitForTransform and updateParam

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

* modify waitForTransform

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

* fix waitForTransform

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

* remove unused arg

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

* fix rclcpp_info_throttle arg duration unit

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

* replace waitForTransform to canTransform & sleep

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

@1222-takeshi 1222-takeshi left a comment

Choose a reason for hiding this comment

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

LGTM

@1222-takeshi 1222-takeshi self-requested a review December 6, 2021 08:14
@tkimura4 tkimura4 merged commit b9e7df0 into autowarefoundation:tier4/proposal Dec 7, 2021
@tkimura4 tkimura4 deleted the 1-add-behavior-velocity-planner branch December 7, 2021 03:18
1222-takeshi added a commit to 1222-takeshi/autoware.universe that referenced this pull request Dec 8, 2021
* 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
* 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
* 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…
tkimura4 pushed a commit to tkimura4/autoware.universe that referenced this pull request Mar 28, 2022
keiota pushed a commit to keiota/autoware.universe that referenced this pull request Aug 17, 2023
Signed-off-by: GitHub <noreply@github.com>

Co-authored-by: kenji-miyake <kenji-miyake@users.noreply.github.com>
knzo25 pushed a commit to knzo25/autoware.universe that referenced this pull request May 17, 2024
* ci: add sync files (#2)

* ci: add sync files

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

* Update .github/sync-files.yaml

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

* Update .github/sync-files.yaml

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

* Update .github/sync-files.yaml

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

* Update .github/sync-files.yaml

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

* Update .github/sync-files.yaml

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

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

* chore: sync files (#3)

Signed-off-by: GitHub <noreply@github.com>

Co-authored-by: kenji-miyake <kenji-miyake@users.noreply.github.com>

* ci: update workflow (#1)

* ci: update ci config

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

* chore: apply pre-commit

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

* ci: update workflow

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

* Update .pre-commit-config.yaml

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

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

* chore: add empty repos (autowarefoundation#4)

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

* chore: sync files (autowarefoundation#5)

* chore: sync files

Signed-off-by: GitHub <noreply@github.com>

* Update sync-files.yaml

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

* chore: sync files (autowarefoundation#6)

* chore: sync files

Signed-off-by: GitHub <noreply@github.com>

* Update sync-files.yaml

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

* chore: sync files (autowarefoundation#7)

Signed-off-by: GitHub <noreply@github.com>

Co-authored-by: kenji-miyake <kenji-miyake@users.noreply.github.com>

* chore: sync files (autowarefoundation#9)

Signed-off-by: GitHub <noreply@github.com>

Co-authored-by: kenji-miyake <kenji-miyake@users.noreply.github.com>

* chore: sync files (autowarefoundation#10)

* chore: sync files

Signed-off-by: GitHub <noreply@github.com>

* Update sync-files.yaml

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

* chore: sync files (autowarefoundation#11)

Signed-off-by: GitHub <noreply@github.com>

Co-authored-by: wep21 <wep21@users.noreply.github.com>

* chore: sync files (autowarefoundation#12)

Signed-off-by: GitHub <noreply@github.com>

Co-authored-by: wep21 <wep21@users.noreply.github.com>

* chore: sync files (autowarefoundation#13)

Signed-off-by: GitHub <noreply@github.com>

Co-authored-by: wep21 <wep21@users.noreply.github.com>

* chore: sync files (autowarefoundation#15)

Signed-off-by: GitHub <noreply@github.com>

Co-authored-by: wep21 <wep21@users.noreply.github.com>

* chore: sync files (autowarefoundation#16)

* chore: sync files

Signed-off-by: GitHub <noreply@github.com>

* Update sync-files.yaml

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

* chore: sync files (autowarefoundation#17)

Signed-off-by: GitHub <noreply@github.com>

Co-authored-by: wep21 <wep21@users.noreply.github.com>

* chore: sync files (autowarefoundation#18)

Signed-off-by: GitHub <noreply@github.com>

Co-authored-by: kenji-miyake <kenji-miyake@users.noreply.github.com>

* chore: sync files (autowarefoundation#19)

Signed-off-by: GitHub <noreply@github.com>

Co-authored-by: kenji-miyake <kenji-miyake@users.noreply.github.com>

* chore: sync files (autowarefoundation#20)

Signed-off-by: GitHub <noreply@github.com>

Co-authored-by: kenji-miyake <kenji-miyake@users.noreply.github.com>

* chore: sync files (autowarefoundation#21)

* chore: sync files

Signed-off-by: GitHub <noreply@github.com>

* Update sync-files.yaml

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

* chore: sync files (autowarefoundation#22)

Signed-off-by: GitHub <noreply@github.com>

Co-authored-by: kenji-miyake <kenji-miyake@users.noreply.github.com>

* chore: sync files (autowarefoundation#23)

Signed-off-by: GitHub <noreply@github.com>

Co-authored-by: kenji-miyake <kenji-miyake@users.noreply.github.com>

* chore: sync files (autowarefoundation#24)

Signed-off-by: GitHub <noreply@github.com>

Co-authored-by: kenji-miyake <kenji-miyake@users.noreply.github.com>

* chore: sync files (autowarefoundation#25)

Signed-off-by: GitHub <noreply@github.com>

Co-authored-by: kenji-miyake <kenji-miyake@users.noreply.github.com>

* chore: sync files (autowarefoundation#27)

Signed-off-by: GitHub <noreply@github.com>

Co-authored-by: kenji-miyake <kenji-miyake@users.noreply.github.com>

* chore: sync files (autowarefoundation#28)

* chore: sync files

Signed-off-by: GitHub <noreply@github.com>

* Update sync-files.yaml

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

* chore: sync files (autowarefoundation#29)

Signed-off-by: GitHub <noreply@github.com>

Signed-off-by: GitHub <noreply@github.com>
Co-authored-by: kenji-miyake <kenji-miyake@users.noreply.github.com>

* chore: sync files (autowarefoundation#30)

Signed-off-by: GitHub <noreply@github.com>
Co-authored-by: kenji-miyake <kenji-miyake@users.noreply.github.com>

* remove legacy ci

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

* update isort

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

---------

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
Signed-off-by: GitHub <noreply@github.com>
Signed-off-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp>
Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com>
Co-authored-by: tier4-autoware-bot[bot] <98652886+tier4-autoware-bot[bot]@users.noreply.github.com>
Co-authored-by: kenji-miyake <kenji-miyake@users.noreply.github.com>
Co-authored-by: tier4-autoware-public-bot[bot] <98652886+tier4-autoware-public-bot[bot]@users.noreply.github.com>
Co-authored-by: wep21 <wep21@users.noreply.github.com>
Co-authored-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp>
knzo25 pushed a commit to knzo25/autoware.universe that referenced this pull request May 17, 2024
* first commit

* Add CI

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

* release livox driver(beta ver.) (#1)

* add colcon build env. (base code is 0624e)

* move some hpp files, add src folder in livox driver

* trivial modification

* Update README.md

* remove unneccesary files

* remove unneccesary header

* move third-party source files

* update code(20210630)

* Delete different test files.

* README.md add "4. running"

* README crlf

* HwInterface/udp_socket.hpp

* modify for ros2 run error

* Update README.md

* accumulate_count

* time_stamp

* struct LivoxPointXyzrtl packed

* GetEchoNumPerPoint()

* cloud.width 24000

* time_base -> time_stamp

* code fix

* cloud.width update

* code fix

* code fix

* StreamStart retry 30sec

* code fix

* rviz2

* fix format

* <br>

* format ros2wrapper

* frame_id

* frame_id

* Update README.md

* Update README.md

* discussion_r664993039

* typo typo brief and only English in the comments. and LivoxDataCallback delete

* PI -> M_PI

* Revert "PI -> M_PI"

This reverts commit c54bbe3b3c1954f82247d38570bdf71a3ddf38b6.

* PI -> M_PI 2nd

* thread pointer -> shared_ptr

* modify CMakelists.txt and package.xml to using ament_cmake_auto

* README.md

* default node name

* add composable node (#4)

* add composable node

* fix conflicts

* fix exec node

* change sensor name fix to variable

* fix can use ros2_wrapper_main.cpp

* README.md

* default node name

* change namespace

* add namespace to topic names

Co-authored-by: mitui.hide <h-mitsui@esol.co.jp>

* package.xml maintainer and README.md

* #discussion_r666683800

* #discussion_r666712110

* #discussion_r665125337

* #discussion_r664995104

* #discussion_r666078326

* #discussion_r665121366

* #discussion_r665121366 Expansion

* typedef enum -> enum

* typedef enum -> enum

* #discussion_r665121708

* #discussion_r665124279

* #discussion_r664995791

* typo #discussion_r670300391

* #discussion_r664987903

* Revert "#discussion_r664987903"

This reverts commit 97d78e64c13e5bb59b98bd1f17f1bfd527384852.

* #discussion_r664987903

* #discussion_r664988302

* #discussion_r664989270

* #discussion_r664989004

* CMakeList.txt remove(-g -O0)

* smart_pointers. #issuecomment-878771481

Co-authored-by: mitui.hide <h-mitsui@esol.co.jp>
Co-authored-by: v-nagai7872@esol.co.jp <v-nagai7872@esol.co.jp>
Co-authored-by: Takeshi Miura <57553950+1222-takeshi@users.noreply.github.com>

* fix for the issue with the termination process when powering off (#5)

* add colcon build env. (base code is 0624e)

* move some hpp files, add src folder in livox driver

* trivial modification

* Update README.md

* remove unneccesary files

* remove unneccesary header

* move third-party source files

* update code(20210630)

* Delete different test files.

* README.md add "4. running"

* README crlf

* HwInterface/udp_socket.hpp

* modify for ros2 run error

* Update README.md

* accumulate_count

* time_stamp

* struct LivoxPointXyzrtl packed

* GetEchoNumPerPoint()

* cloud.width 24000

* time_base -> time_stamp

* code fix

* cloud.width update

* code fix

* code fix

* StreamStart retry 30sec

* code fix

* rviz2

* fix format

* <br>

* format ros2wrapper

* frame_id

* frame_id

* Update README.md

* Update README.md

* discussion_r664993039

* typo typo brief and only English in the comments. and LivoxDataCallback delete

* PI -> M_PI

* Revert "PI -> M_PI"

This reverts commit c54bbe3b3c1954f82247d38570bdf71a3ddf38b6.

* PI -> M_PI 2nd

* thread pointer -> shared_ptr

* modify CMakelists.txt and package.xml to using ament_cmake_auto

* README.md

* default node name

* add composable node (#4)

* add composable node

* fix conflicts

* fix exec node

* change sensor name fix to variable

* fix can use ros2_wrapper_main.cpp

* README.md

* default node name

* change namespace

* add namespace to topic names

Co-authored-by: mitui.hide <h-mitsui@esol.co.jp>

* package.xml maintainer and README.md

* #discussion_r666683800

* #discussion_r666712110

* #discussion_r665125337

* #discussion_r664995104

* #discussion_r666078326

* #discussion_r665121366

* #discussion_r665121366 Expansion

* typedef enum -> enum

* typedef enum -> enum

* #discussion_r665121708

* #discussion_r665124279

* #discussion_r664995791

* esol_ReviewNo6

* esol_ReviewNo26

* esol_ReviewNo24

* Revert "esol_ReviewNo24"

This reverts commit 0e8f33341186d6fa4a905de45c8f9aa28b8d29cb.

* Revert "esol_ReviewNo24"

This reverts commit 0e8f33341186d6fa4a905de45c8f9aa28b8d29cb.

* esol_ReviewNo24

* esol_ReviewNo27

* esol_ReviewNo17

* format

* esol_ReviewNo21

* develop #1 6bae863876bfda52db848ed31e415a3b16a0b6a8

* tab -> space

* develop marge

* CMakeLists.txt remove(-g -O0)

* T4PUB-358 1st

* format and bug-fix

* 5#discussion_r677475332

* Add comment semaphore_

* 5#discussion_r678802453

Co-authored-by: mitui.hide <h-mitsui@esol.co.jp>
Co-authored-by: v-nagai7872@esol.co.jp <v-nagai7872@esol.co.jp>
Co-authored-by: Takeshi Miura <57553950+1222-takeshi@users.noreply.github.com>
Co-authored-by: h-mitsui-esol <57085544+h-mitsui-esol@users.noreply.github.com>

* Refactor 1st (#6)

* Refactor 1st

* pull/6#discussion_r681704754

* pull/6#discussion_r682172984

* pull/6#discussion_r681705368

* pull/6#discussion_r680921593 and pull/6#discussion_r680922194

* pull/6#discussion_r681711654

* 6#discussion_r682170555

* Use default qos for imu (#8)

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

* Fix/esol/livox driver utest (#9)

* Refactor 1st

* pull/6#discussion_r681704754

* pull/6#discussion_r682172984

* pull/6#discussion_r681705368

* pull/6#discussion_r680921593 and pull/6#discussion_r680922194

* pull/6#discussion_r681711654

* 6#discussion_r682170555

* livox_driver utest 1st

* T4PUB-437 bug fix.

* Fix merge failure 3371552e395f1817adb3a32ea9f95360d72019f8

* pull/9#discussion_r689167375 and pull/9#discussion_r689204716

* Livox Diagnostics (#10)

* Livox Diagnostics. Initial non working commit

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* clang. add tier4 format

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* gitignore. Add Tier4 ignore file

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* wip

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* wip 2

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* code adaptations to new main branch

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* wip 3 get device status from sensor

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* adaptations for diagnostics from eth packet

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* RosWrapper. parse and report Diagnostics

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* lidar_driver. fix getcommandid switch

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* ros2_driver_wrapper. fix switch indent

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* git workflow. test CI token

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* livox_command. Remove unused CommandPushAbnormalState struct

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* add fallthroughts

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* apply t4 formatting

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* livox_diagnostics. remove unnecessary code for boolean vars

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* ros2_driver_wrapper. clarify level comparison with enum

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* livox_diagnostics. remove unncessary comma at the end of enum

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* ros2_driver_wrapper. group diagnostics members

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* gitignore. remove aw related entries

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* ros2_driver_wrapper. simplify ros diagnostics string

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* revert fallthroughs on switch

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* replace shift logic for bit fields

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* add private keyword to clarify

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* separate diagnostics, remove static definition

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* add missing StatusCodeToLivoxMotorStatus

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* Separate diagnostics to multiple reports

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* update status from sensor

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* wrapper. remove the namespace from the diagnostic task

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* ros2_wrapper. remove unncessary lidar_identifier

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* nebula structure

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* nebula wip

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* remove transport driver

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* move livox, start nebula base

* reorganize pkg

* Initial POC Hesai driver structure

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* POC Hesai driver hw interface

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* initial 'working' version

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* restructuration

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* README

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* attempts at getting the UDP driver to work

* fix hw_interface

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* clang. update with t4 format

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* nebula. add missing headers

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* start of packet handling

* hesai_msgs. add jumbo message

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* hesai. add packet parsing and scan formation code

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* apply clang formatting

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* hesai_ros. reorder includes

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* hesai_ros. todo

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* initial working hesai udp driver

* apply clang format

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* ROS wrappers

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* add hesai_decoders base and implementations

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* Hesai initial full working version

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* small cleanup and standardization

* Velodyne Release

* GitLab CI YAML

* Update .gitlab-ci.yml

* Update README.md

* overflow bug fix

* Update .gitlab-ci.yml

* velodyne. add vlp16 launch

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* launch. add hdl32 launch file

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* launch. add vlp16hr

Signed-off-by: PE <abraham.monrroy@tier4.jp>

* pandar40 decoder. fix typo

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* nebula. v2. tcp/diag/monitoring

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* v2.1. PandarAT128 Dual only support

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* launch. add pandar128 sample launch

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* pandar at128. single last/strongest echo + ptp timestamp support

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* fix: prevent build error from logger parenthesis

* v2.1. hesai/velodyne setup single/dual at launch

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* Bump actions/checkout from 2 to 3.1.0

Bumps [actions/checkout](https://github.com/actions/checkout) from 2 to 3.1.0.
- [Release notes](https://github.com/actions/checkout/releases)
- [Changelog](https://github.com/actions/checkout/blob/main/CHANGELOG.md)
- [Commits](https://github.com/actions/checkout/compare/v2...v3.1.0)

---
updated-dependencies:
- dependency-name: actions/checkout
  dependency-type: direct:production
  update-type: version-update:semver-major
...

Signed-off-by: dependabot[bot] <support@github.com>

* fix: build error from Hesai hardware interface

* tcp depend, readme

* move to composable node

* .py launch for all sensors

* .py launch how-to

* deprecate esol driver

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* Bump streetsidesoftware/cspell-action from 1.1.1 to 2.15.0

Bumps [streetsidesoftware/cspell-action](https://github.com/streetsidesoftware/cspell-action) from 1.1.1 to 2.15.0.
- [Release notes](https://github.com/streetsidesoftware/cspell-action/releases)
- [Changelog](https://github.com/streetsidesoftware/cspell-action/blob/main/CHANGELOG.md)
- [Commits](https://github.com/streetsidesoftware/cspell-action/compare/v1.1.1...v2.15.0)

---
updated-dependencies:
- dependency-name: streetsidesoftware/cspell-action
  dependency-type: direct:production
  update-type: version-update:semver-major
...

Signed-off-by: dependabot[bot] <support@github.com>

* Bump actions/checkout from 3.1.0 to 3.2.0

Bumps [actions/checkout](https://github.com/actions/checkout) from 3.1.0 to 3.2.0.
- [Release notes](https://github.com/actions/checkout/releases)
- [Changelog](https://github.com/actions/checkout/blob/main/CHANGELOG.md)
- [Commits](https://github.com/actions/checkout/compare/v3.1.0...v3.2.0)

---
updated-dependencies:
- dependency-name: actions/checkout
  dependency-type: direct:production
  update-type: version-update:semver-minor
...

Signed-off-by: dependabot[bot] <support@github.com>

* Nebula decoder test pr (#12)

* Offline bug fix

* Extract pcd and bag for each pandar_packets

* initial test decorder code (hesai at128)

* Offline bug fix

* Extract pcd and bag for each pandar_packets

* initial test decorder code (hesai at128)

* testing decorder

* Changed package name back to pandar_msgs

* add_launch_test was tried, but it didn't work

* cleanup

* fix naming

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* messages. hesai cleanup

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* gtests. cmake cleanup

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* sample. fix warnings

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* messages. remove c++ tests from ROS messages

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* cleanup comments

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* code cleanup

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* offline_sample. remove dependencies

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* nebula. velodyne add missing dependency

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* nebula. add missing dependency

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* nebula oofline. add missing dependency

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>
Co-authored-by: Abraham Cano <abrahammonrroy@yahoo.com>

* Update build-and-test.yml

CI. adapt default branch name.

* Bump streetsidesoftware/cspell-action from 2.15.0 to 2.15.1 (#15)

Bumps [streetsidesoftware/cspell-action](https://github.com/streetsidesoftware/cspell-action) from 2.15.0 to 2.15.1.
- [Release notes](https://github.com/streetsidesoftware/cspell-action/releases)
- [Changelog](https://github.com/streetsidesoftware/cspell-action/blob/main/CHANGELOG.md)
- [Commits](https://github.com/streetsidesoftware/cspell-action/compare/v2.15.0...v2.15.1)

---
updated-dependencies:
- dependency-name: streetsidesoftware/cspell-action
  dependency-type: direct:production
  update-type: version-update:semver-patch
...

Signed-off-by: dependabot[bot] <support@github.com>

Signed-off-by: dependabot[bot] <support@github.com>
Co-authored-by: dependabot[bot] <49699333+dependabot[bot]@users.noreply.github.com>

* Testing decoder (AT128 & XT32M) (#14)

* Testing decoder (AT128 & XT32M)

* clang format. add clang format testing and formatting

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* .clang-format. remove file

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* tests. use relative path for tests

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* README. How to run tests

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CMakeLists. default to C++17

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* tests. code clean up

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* github actions. enable CI testing

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* repos.  replace dependency repository branch

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* tests. reset node at the end of the test exection

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>
Co-authored-by: Abraham Cano <abrahammonrroy@yahoo.com>

* launch. fix naming for composable nodes and simplify

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* bug. add missing streamstart for hw composable nodes

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* apply clang format

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* Github Actions. Run CI tests only for nebula packages

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* Testing decoder (40P, 64, QT64, XT32, VLP16) (#17)

* Testing decoder (AT128 & XT32M)

* velodyne_ros_offline_extract_pcd

* Add 40P, 64, QT64, XT32

* vlp16

* vlp16 fix

* velodyne_http. update api to transport drivers with beast requiring namespaces

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* Bump ros-tooling/setup-ros from 0.2 to 0.5 (#20)

Bumps [ros-tooling/setup-ros](https://github.com/ros-tooling/setup-ros) from 0.2 to 0.5.
- [Release notes](https://github.com/ros-tooling/setup-ros/releases)
- [Commits](https://github.com/ros-tooling/setup-ros/compare/v0.2...v0.5)

---
updated-dependencies:
- dependency-name: ros-tooling/setup-ros
  dependency-type: direct:production
  update-type: version-update:semver-minor
...

Signed-off-by: dependabot[bot] <support@github.com>
Co-authored-by: dependabot[bot] <49699333+dependabot[bot]@users.noreply.github.com>

* Bump streetsidesoftware/cspell-action from 2.15.1 to 2.16.0 (#18)

Bumps [streetsidesoftware/cspell-action](https://github.com/streetsidesoftware/cspell-action) from 2.15.1 to 2.16.0.
- [Release notes](https://github.com/streetsidesoftware/cspell-action/releases)
- [Changelog](https://github.com/streetsidesoftware/cspell-action/blob/main/CHANGELOG.md)
- [Commits](https://github.com/streetsidesoftware/cspell-action/compare/v2.15.1...v2.16.0)

---
updated-dependencies:
- dependency-name: streetsidesoftware/cspell-action
  dependency-type: direct:production
  update-type: version-update:semver-minor
...

Signed-off-by: dependabot[bot] <support@github.com>
Co-authored-by: dependabot[bot] <49699333+dependabot[bot]@users.noreply.github.com>

* Bump actions/checkout from 3.2.0 to 3.3.0 (#16)

Bumps [actions/checkout](https://github.com/actions/checkout) from 3.2.0 to 3.3.0.
- [Release notes](https://github.com/actions/checkout/releases)
- [Changelog](https://github.com/actions/checkout/blob/main/CHANGELOG.md)
- [Commits](https://github.com/actions/checkout/compare/v3.2.0...v3.3.0)

---
updated-dependencies:
- dependency-name: actions/checkout
  dependency-type: direct:production
  update-type: version-update:semver-minor
...

Signed-off-by: dependabot[bot] <support@github.com>
Co-authored-by: dependabot[bot] <49699333+dependabot[bot]@users.noreply.github.com>

* build_depends. update transport_drivers repo

* Testing VLS128 (#21)

* Testing VLS128

* transport_drivers. api

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* 312cd76's forgotten items...

* build_depends. switch to boost from asio on transport_drivers

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

---------

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>
Co-authored-by: Abraham Cano <abrahammonrroy@yahoo.com>

* Pandar OT 128E4X Initial support (#25)

* wip. pandar ot

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* wip. missing correction

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* pandar128e4x. add calibration file

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* pandar_ot. initial working version

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* pandar_ot. clean up

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* nebula. apply clang format

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

---------

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* Fix cpu (#27)

* fix decoders

* add declaration of dual_return_distance_threshold

* nebula_common. reorder return modes to match previous definition

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

---------

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>
Co-authored-by: tokuda99 <kosuke.tokuda@tier4.jp>

* Fix velodyne cpu (#28)

* fix declaration of descriptor.type and delete dual_return_distance_threshold of velodyne

* add dual_return_distance_threshold to paramCallback option and add it to launch file param

* clang-format

* Docs of nebula driver (#19)

* nebula common 1

* nebula common 2

* hesai, velodyne

* Bump streetsidesoftware/cspell-action from 2.16.0 to 2.20.0 (#26)

Bumps [streetsidesoftware/cspell-action](https://github.com/streetsidesoftware/cspell-action) from 2.16.0 to 2.20.0.
- [Release notes](https://github.com/streetsidesoftware/cspell-action/releases)
- [Changelog](https://github.com/streetsidesoftware/cspell-action/blob/main/CHANGELOG.md)
- [Commits](https://github.com/streetsidesoftware/cspell-action/compare/v2.16.0...v2.20.0)

---
updated-dependencies:
- dependency-name: streetsidesoftware/cspell-action
  dependency-type: direct:production
  update-type: version-update:semver-minor
...

Signed-off-by: dependabot[bot] <support@github.com>
Co-authored-by: dependabot[bot] <49699333+dependabot[bot]@users.noreply.github.com>

* Bump ros-tooling/setup-ros from 0.5 to 0.6 (#33)

Bumps [ros-tooling/setup-ros](https://github.com/ros-tooling/setup-ros) from 0.5 to 0.6.
- [Release notes](https://github.com/ros-tooling/setup-ros/releases)
- [Commits](https://github.com/ros-tooling/setup-ros/compare/v0.5...v0.6)

---
updated-dependencies:
- dependency-name: ros-tooling/setup-ros
  dependency-type: direct:production
  update-type: version-update:semver-minor
...

Signed-off-by: dependabot[bot] <support@github.com>
Co-authored-by: dependabot[bot] <49699333+dependabot[bot]@users.noreply.github.com>

* Bump streetsidesoftware/cspell-action from 2.20.0 to 2.22.0 (#32)

Bumps [streetsidesoftware/cspell-action](https://github.com/streetsidesoftware/cspell-action) from 2.20.0 to 2.22.0.
- [Release notes](https://github.com/streetsidesoftware/cspell-action/releases)
- [Changelog](https://github.com/streetsidesoftware/cspell-action/blob/main/CHANGELOG.md)
- [Commits](https://github.com/streetsidesoftware/cspell-action/compare/v2.20.0...v2.22.0)

---
updated-dependencies:
- dependency-name: streetsidesoftware/cspell-action
  dependency-type: direct:production
  update-type: version-update:semver-minor
...

Signed-off-by: dependabot[bot] <support@github.com>
Co-authored-by: dependabot[bot] <49699333+dependabot[bot]@users.noreply.github.com>

* Bump ros-tooling/action-ros-ci from 0.2 to 0.3 (#31)

Bumps [ros-tooling/action-ros-ci](https://github.com/ros-tooling/action-ros-ci) from 0.2 to 0.3.
- [Release notes](https://github.com/ros-tooling/action-ros-ci/releases)
- [Commits](https://github.com/ros-tooling/action-ros-ci/compare/v0.2...v0.3)

---
updated-dependencies:
- dependency-name: ros-tooling/action-ros-ci
  dependency-type: direct:production
  update-type: version-update:semver-minor
...

Signed-off-by: dependabot[bot] <support@github.com>
Co-authored-by: dependabot[bot] <49699333+dependabot[bot]@users.noreply.github.com>

* first commit

* Add CI

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

* release livox driver(beta ver.) (#1)

* add colcon build env. (base code is 0624e)

* move some hpp files, add src folder in livox driver

* trivial modification

* Update README.md

* remove unneccesary files

* remove unneccesary header

* move third-party source files

* update code(20210630)

* Delete different test files.

* README.md add "4. running"

* README crlf

* HwInterface/udp_socket.hpp

* modify for ros2 run error

* Update README.md

* accumulate_count

* time_stamp

* struct LivoxPointXyzrtl packed

* GetEchoNumPerPoint()

* cloud.width 24000

* time_base -> time_stamp

* code fix

* cloud.width update

* code fix

* code fix

* StreamStart retry 30sec

* code fix

* rviz2

* fix format

* <br>

* format ros2wrapper

* frame_id

* frame_id

* Update README.md

* Update README.md

* discussion_r664993039

* typo typo brief and only English in the comments. and LivoxDataCallback delete

* PI -> M_PI

* Revert "PI -> M_PI"

This reverts commit c54bbe3b3c1954f82247d38570bdf71a3ddf38b6.

* PI -> M_PI 2nd

* thread pointer -> shared_ptr

* modify CMakelists.txt and package.xml to using ament_cmake_auto

* README.md

* default node name

* add composable node (#4)

* add composable node

* fix conflicts

* fix exec node

* change sensor name fix to variable

* fix can use ros2_wrapper_main.cpp

* README.md

* default node name

* change namespace

* add namespace to topic names

Co-authored-by: mitui.hide <h-mitsui@esol.co.jp>

* package.xml maintainer and README.md

* #discussion_r666683800

* #discussion_r666712110

* #discussion_r665125337

* #discussion_r664995104

* #discussion_r666078326

* #discussion_r665121366

* #discussion_r665121366 Expansion

* typedef enum -> enum

* typedef enum -> enum

* #discussion_r665121708

* #discussion_r665124279

* #discussion_r664995791

* typo #discussion_r670300391

* #discussion_r664987903

* Revert "#discussion_r664987903"

This reverts commit 97d78e64c13e5bb59b98bd1f17f1bfd527384852.

* #discussion_r664987903

* #discussion_r664988302

* #discussion_r664989270

* #discussion_r664989004

* CMakeList.txt remove(-g -O0)

* smart_pointers. #issuecomment-878771481

Co-authored-by: mitui.hide <h-mitsui@esol.co.jp>
Co-authored-by: v-nagai7872@esol.co.jp <v-nagai7872@esol.co.jp>
Co-authored-by: Takeshi Miura <57553950+1222-takeshi@users.noreply.github.com>

* fix for the issue with the termination process when powering off (#5)

* add colcon build env. (base code is 0624e)

* move some hpp files, add src folder in livox driver

* trivial modification

* Update README.md

* remove unneccesary files

* remove unneccesary header

* move third-party source files

* update code(20210630)

* Delete different test files.

* README.md add "4. running"

* README crlf

* HwInterface/udp_socket.hpp

* modify for ros2 run error

* Update README.md

* accumulate_count

* time_stamp

* struct LivoxPointXyzrtl packed

* GetEchoNumPerPoint()

* cloud.width 24000

* time_base -> time_stamp

* code fix

* cloud.width update

* code fix

* code fix

* StreamStart retry 30sec

* code fix

* rviz2

* fix format

* <br>

* format ros2wrapper

* frame_id

* frame_id

* Update README.md

* Update README.md

* discussion_r664993039

* typo typo brief and only English in the comments. and LivoxDataCallback delete

* PI -> M_PI

* Revert "PI -> M_PI"

This reverts commit c54bbe3b3c1954f82247d38570bdf71a3ddf38b6.

* PI -> M_PI 2nd

* thread pointer -> shared_ptr

* modify CMakelists.txt and package.xml to using ament_cmake_auto

* README.md

* default node name

* add composable node (#4)

* add composable node

* fix conflicts

* fix exec node

* change sensor name fix to variable

* fix can use ros2_wrapper_main.cpp

* README.md

* default node name

* change namespace

* add namespace to topic names

Co-authored-by: mitui.hide <h-mitsui@esol.co.jp>

* package.xml maintainer and README.md

* #discussion_r666683800

* #discussion_r666712110

* #discussion_r665125337

* #discussion_r664995104

* #discussion_r666078326

* #discussion_r665121366

* #discussion_r665121366 Expansion

* typedef enum -> enum

* typedef enum -> enum

* #discussion_r665121708

* #discussion_r665124279

* #discussion_r664995791

* esol_ReviewNo6

* esol_ReviewNo26

* esol_ReviewNo24

* Revert "esol_ReviewNo24"

This reverts commit 0e8f33341186d6fa4a905de45c8f9aa28b8d29cb.

* Revert "esol_ReviewNo24"

This reverts commit 0e8f33341186d6fa4a905de45c8f9aa28b8d29cb.

* esol_ReviewNo24

* esol_ReviewNo27

* esol_ReviewNo17

* format

* esol_ReviewNo21

* develop #1 6bae863876bfda52db848ed31e415a3b16a0b6a8

* tab -> space

* develop marge

* CMakeLists.txt remove(-g -O0)

* T4PUB-358 1st

* format and bug-fix

* 5#discussion_r677475332

* Add comment semaphore_

* 5#discussion_r678802453

Co-authored-by: mitui.hide <h-mitsui@esol.co.jp>
Co-authored-by: v-nagai7872@esol.co.jp <v-nagai7872@esol.co.jp>
Co-authored-by: Takeshi Miura <57553950+1222-takeshi@users.noreply.github.com>
Co-authored-by: h-mitsui-esol <57085544+h-mitsui-esol@users.noreply.github.com>

* Refactor 1st (#6)

* Refactor 1st

* pull/6#discussion_r681704754

* pull/6#discussion_r682172984

* pull/6#discussion_r681705368

* pull/6#discussion_r680921593 and pull/6#discussion_r680922194

* pull/6#discussion_r681711654

* 6#discussion_r682170555

* Use default qos for imu (#8)

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

* Fix/esol/livox driver utest (#9)

* Refactor 1st

* pull/6#discussion_r681704754

* pull/6#discussion_r682172984

* pull/6#discussion_r681705368

* pull/6#discussion_r680921593 and pull/6#discussion_r680922194

* pull/6#discussion_r681711654

* 6#discussion_r682170555

* livox_driver utest 1st

* T4PUB-437 bug fix.

* Fix merge failure 3371552e395f1817adb3a32ea9f95360d72019f8

* pull/9#discussion_r689167375 and pull/9#discussion_r689204716

* Livox Diagnostics (#10)

* Livox Diagnostics. Initial non working commit

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* clang. add tier4 format

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* gitignore. Add Tier4 ignore file

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* wip

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* wip 2

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* code adaptations to new main branch

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* wip 3 get device status from sensor

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* adaptations for diagnostics from eth packet

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* RosWrapper. parse and report Diagnostics

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* lidar_driver. fix getcommandid switch

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* ros2_driver_wrapper. fix switch indent

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* git workflow. test CI token

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* livox_command. Remove unused CommandPushAbnormalState struct

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* add fallthroughts

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* apply t4 formatting

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* livox_diagnostics. remove unnecessary code for boolean vars

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* ros2_driver_wrapper. clarify level comparison with enum

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* livox_diagnostics. remove unncessary comma at the end of enum

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* ros2_driver_wrapper. group diagnostics members

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* gitignore. remove aw related entries

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* ros2_driver_wrapper. simplify ros diagnostics string

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* revert fallthroughs on switch

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* replace shift logic for bit fields

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* add private keyword to clarify

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* separate diagnostics, remove static definition

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* add missing StatusCodeToLivoxMotorStatus

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* Separate diagnostics to multiple reports

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* update status from sensor

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* wrapper. remove the namespace from the diagnostic task

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* ros2_wrapper. remove unncessary lidar_identifier

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* nebula structure

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* nebula wip

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* remove transport driver

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* move livox, start nebula base

* reorganize pkg

* Initial POC Hesai driver structure

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* POC Hesai driver hw interface

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* initial 'working' version

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* restructuration

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* README

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* attempts at getting the UDP driver to work

* fix hw_interface

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* nebula. add missing headers

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* start of packet handling

* hesai_msgs. add jumbo message

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* hesai. add packet parsing and scan formation code

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* apply clang formatting

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* hesai_ros. reorder includes

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* hesai_ros. todo

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* initial working hesai udp driver

* apply clang format

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* ROS wrappers

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* add hesai_decoders base and implementations

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* Hesai initial full working version

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* small cleanup and standardization

* Velodyne Release

* GitLab CI YAML

* Update .gitlab-ci.yml

* Update README.md

* overflow bug fix

* Update .gitlab-ci.yml

* velodyne. add vlp16 launch

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* launch. add hdl32 launch file

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* launch. add vlp16hr

Signed-off-by: PE <abraham.monrroy@tier4.jp>

* pandar40 decoder. fix typo

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* nebula. v2. tcp/diag/monitoring

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* v2.1. PandarAT128 Dual only support

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* launch. add pandar128 sample launch

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* pandar at128. single last/strongest echo + ptp timestamp support

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* fix: prevent build error from logger parenthesis

* v2.1. hesai/velodyne setup single/dual at launch

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* fix: build error from Hesai hardware interface

* tcp depend, readme

* move to composable node

* .py launch for all sensors

* .py launch how-to

* deprecate esol driver

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* Bump actions/checkout from 2 to 3.1.0

Bumps [actions/checkout](https://github.com/actions/checkout) from 2 to 3.1.0.
- [Release notes](https://github.com/actions/checkout/releases)
- [Changelog](https://github.com/actions/checkout/blob/main/CHANGELOG.md)
- [Commits](https://github.com/actions/checkout/compare/v2...v3.1.0)

---
updated-dependencies:
- dependency-name: actions/checkout
  dependency-type: direct:production
  update-type: version-update:semver-major
...

Signed-off-by: dependabot[bot] <support@github.com>

* Nebula decoder test pr (#12)

* Offline bug fix

* Extract pcd and bag for each pandar_packets

* initial test decorder code (hesai at128)

* Offline bug fix

* Extract pcd and bag for each pandar_packets

* initial test decorder code (hesai at128)

* testing decorder

* Changed package name back to pandar_msgs

* add_launch_test was tried, but it didn't work

* cleanup

* fix naming

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* messages. hesai cleanup

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* gtests. cmake cleanup

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* sample. fix warnings

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* messages. remove c++ tests from ROS messages

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* cleanup comments

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* code cleanup

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* offline_sample. remove dependencies

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* nebula. velodyne add missing dependency

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* nebula. add missing dependency

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* nebula oofline. add missing dependency

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>
Co-authored-by: Abraham Cano <abrahammonrroy@yahoo.com>

* Testing decoder (AT128 & XT32M) (#14)

* Testing decoder (AT128 & XT32M)

* clang format. add clang format testing and formatting

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* .clang-format. remove file

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* tests. use relative path for tests

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* README. How to run tests

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CMakeLists. default to C++17

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* tests. code clean up

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* github actions. enable CI testing

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* repos.  replace dependency repository branch

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* tests. reset node at the end of the test exection

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>
Co-authored-by: Abraham Cano <abrahammonrroy@yahoo.com>

* launch. fix naming for composable nodes and simplify

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* bug. add missing streamstart for hw composable nodes

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* apply clang format

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* Testing decoder (40P, 64, QT64, XT32, VLP16) (#17)

* Testing decoder (AT128 & XT32M)

* velodyne_ros_offline_extract_pcd

* Add 40P, 64, QT64, XT32

* vlp16

* vlp16 fix

* velodyne_http. update api to transport drivers with beast requiring namespaces

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* build_depends. update transport_drivers repo

* Testing VLS128 (#21)

* Testing VLS128

* transport_drivers. api

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* 312cd76's forgotten items...

* build_depends. switch to boost from asio on transport_drivers

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

---------

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>
Co-authored-by: Abraham Cano <abrahammonrroy@yahoo.com>

* style(pre-commit): autofix

* style(pre-commit): autofix

* Update build_depends.repos

* Bump streetsidesoftware/cspell-action from 2.22.0 to 2.24.0 (#35)

Bumps [streetsidesoftware/cspell-action](https://github.com/streetsidesoftware/cspell-action) from 2.22.0 to 2.24.0.
- [Release notes](https://github.com/streetsidesoftware/cspell-action/releases)
- [Changelog](https://github.com/streetsidesoftware/cspell-action/blob/main/CHANGELOG.md)
- [Commits](https://github.com/streetsidesoftware/cspell-action/compare/v2.22.0...v2.24.0)

---
updated-dependencies:
- dependency-name: streetsidesoftware/cspell-action
  dependency-type: direct:production
  update-type: version-update:semver-minor
...

Signed-off-by: dependabot[bot] <support@github.com>
Co-authored-by: dependabot[bot] <49699333+dependabot[bot]@users.noreply.github.com>

* Bump actions/checkout from 3.3.0 to 3.4.0 (#36)

Bumps [actions/checkout](https://github.com/actions/checkout) from 3.3.0 to 3.4.0.
- [Release notes](https://github.com/actions/checkout/releases)
- [Changelog](https://github.com/actions/checkout/blob/main/CHANGELOG.md)
- [Commits](https://github.com/actions/checkout/compare/v3.3.0...v3.4.0)

---
updated-dependencies:
- dependency-name: actions/checkout
  dependency-type: direct:production
  update-type: version-update:semver-minor
...

Signed-off-by: dependabot[bot] <support@github.com>
Co-authored-by: dependabot[bot] <49699333+dependabot[bot]@users.noreply.github.com>

* Add Documentation (#37)

* Documentation. Initial MkDocs+MkDoxy Generator

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* github actions. enable mkdocs

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* github actions. documentation add sudo

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* github actions. documentation add pip

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* github actions. documentation add pip

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* github actions. documentation add pip

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

---------

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>
Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* documentation. run only on succesful merge

* Bump actions/cache from 2 to 3 (#39)

Bumps [actions/cache](https://github.com/actions/cache) from 2 to 3.
- [Release notes](https://github.com/actions/cache/releases)
- [Changelog](https://github.com/actions/cache/blob/main/RELEASES.md)
- [Commits](https://github.com/actions/cache/compare/v2...v3)

---
updated-dependencies:
- dependency-name: actions/cache
  dependency-type: direct:production
  update-type: version-update:semver-major
...

Signed-off-by: dependabot[bot] <support@github.com>
Co-authored-by: dependabot[bot] <49699333+dependabot[bot]@users.noreply.github.com>

* Bump streetsidesoftware/cspell-action from 2.24.0 to 2.25.0 (#38)

Bumps [streetsidesoftware/cspell-action](https://github.com/streetsidesoftware/cspell-action) from 2.24.0 to 2.25.0.
- [Release notes](https://github.com/streetsidesoftware/cspell-action/releases)
- [Changelog](https://github.com/streetsidesoftware/cspell-action/blob/main/CHANGELOG.md)
- [Commits](https://github.com/streetsidesoftware/cspell-action/compare/v2.24.0...v2.25.0)

---
updated-dependencies:
- dependency-name: streetsidesoftware/cspell-action
  dependency-type: direct:production
  update-type: version-update:semver-minor
...

Signed-off-by: dependabot[bot] <support@github.com>
Co-authored-by: dependabot[bot] <49699333+dependabot[bot]@users.noreply.github.com>

* Bump streetsidesoftware/cspell-action from 2.25.0 to 2.26.0 (#40)

Bumps [streetsidesoftware/cspell-action](https://github.com/streetsidesoftware/cspell-action) from 2.25.0 to 2.26.0.
- [Release notes](https://github.com/streetsidesoftware/cspell-action/releases)
- [Changelog](https://github.com/streetsidesoftware/cspell-action/blob/main/CHANGELOG.md)
- [Commits](https://github.com/streetsidesoftware/cspell-action/compare/v2.25.0...v2.26.0)

---
updated-dependencies:
- dependency-name: streetsidesoftware/cspell-action
  dependency-type: direct:production
  update-type: version-update:semver-minor
...

Signed-off-by: dependabot[bot] <support@github.com>
Co-authored-by: dependabot[bot] <49699333+dependabot[bot]@users.noreply.github.com>

* Bump streetsidesoftware/cspell-action from 2.26.0 to 2.26.1 (#42)

Bumps [streetsidesoftware/cspell-action](https://github.com/streetsidesoftware/cspell-action) from 2.26.0 to 2.26.1.
- [Release notes](https://github.com/streetsidesoftware/cspell-action/releases)
- [Changelog](https://github.com/streetsidesoftware/cspell-action/blob/main/CHANGELOG.md)
- [Commits](https://github.com/streetsidesoftware/cspell-action/compare/v2.26.0...v2.26.1)

---
updated-dependencies:
- dependency-name: streetsidesoftware/cspell-action
  dependency-type: direct:production
  update-type: version-update:semver-patch
...

Signed-off-by: dependabot[bot] <support@github.com>
Co-authored-by: dependabot[bot] <49699333+dependabot[bot]@users.noreply.github.com>

* Point timestamp returntype update to match T4 requirements (#41)

* Add setup_sensor flag for hw drivers

* point timestamp, point.return_type

* Support QT128

* qt to qt64

* pandar128e4x. change point type

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* pandar128e4x. clean up

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* pandar128. reserve data

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* signed to unsigned, debug

* fixed

* QT128 Dual

* QT128 timestamp fixed

* Repository restructure

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* config. restructure files

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* driver. restructure

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* offline_sample. require nebula

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* Separate Nebula into multiple libraries

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* Apply clang format

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* nebula_common. rearrange return types

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* mkdocs. update generation to match new repository structure

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* Ament Bug. Component not installing binaries

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* hw_interface. do not fail when packet size is incorrect

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* hesai_status. PAndatAT128 support Dual only

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* at128 decoder. store the azimuth value

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* launch. add missing correction file param

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* cmake. fix velodyne missing export from nebula_common

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* return_type(VLP32)

* hesai_hw_interface. reduce verbosity

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* docs. add/update mkdocs

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* Load correction dat with resolution

* at128. cleanup

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* nebula_monitor. cleanup

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* return_type of hesai

* QT64 fix

* nebula all. apply clang format

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* nebula_decoders. cleanup decoders

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* velodyne_decoders. cleanup

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* nebula_decoders. clang format

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* Mkdocs. add how to add sensor

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* IDENTICAL in QT128

* Changed ReturnType from velodyne_scan_decoder to nebula_common

* code cleanup

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* wip. get calibration from sensor

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* get calib from sensor with callback

* README. update return modes

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* cleanup. remove comments

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* clang. apply clang

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* add syncGetLidarCalibration

* Remove livox_msgs

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* rename messages to nebula_messages

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* messages. rename to nebula_messages

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* add new point type

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* clang. apply

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* Create nebula_sensor_driver metapackage

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* Use local file if connect fails

* apply clang format

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* out pcd only xyz

* TEST using only a single PCD including only XYZ

* test. update ci testing

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* clean up. angle dependencies

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* README. include new point type

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* github. ci. dont updgrade base image to accelerate build

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* decoders. remove type warnings

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

---------

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>
Signed-off-by: amc-nu <abraham.monrroy@gmail.com>
Co-authored-by: Kyutoku <github@kyutoku.cloud>

* delete unecessary packages

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* Remove old doc files

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* package.xml remove unnecessary dependencies

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* remove deprecated packages

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* Add PointCloud conversion methods

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* Replace AT128's PCD file to fix testing (#43)

* replace AT128 pcd file for test

* apply clang format

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

---------

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>
Co-authored-by: Kyutoku <github@kyutoku.cloud>

* Cpu optimization (#44)

* Remove Boost warnings

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* Optimize Pandar40P

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* Pandar64 optimization

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* PointTypes. standardize point types

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* Add radian based elevation calculation Pandar40P,64

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* qt64. radian based coordinate calculation

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* xt32. radian based coordinate calculation

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* qt128. radian based coordinate calculation

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* qt128. radian based coordinate calculation

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* pandar40. precalculate sin/cos

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* pandarxt. precalculate te sin/cos

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* apply sin/cos optimization to all decoders

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* launch. fix python launch file

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* point_type. caetr SSE alignment optimization

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* hesai_hw. remove warning

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* point_types. add sse description for caetr

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* README. run tests only for nebula packages

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* clang. apply ament_clang reformat

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* Replace 40P, 64, QT64 and XT32s' PCD files to fix testing

* remove clang-format from tests

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* Local path check not required for online acquisition

* Adding timeouts to correction data acquisition

* Disable calibration query

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

---------

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>
Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>
Co-authored-by: Kyutoku <github@kyutoku.cloud>

* style(pre-commit): autofix

* style(pre-commit): autofix

* remove unnecesary dependency

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* velodyne. add monitor to velodyne

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* monitor. reduce reporting verbosity, frequency

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* style(pre-commit): autofix

---------

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
Signed-off-by: kosuke55 <kosuke.tnp@gmail.com>
Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>
Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>
Signed-off-by: PE <abraham.monrroy@tier4.jp>
Signed-off-by: dependabot[bot] <support@github.com>
Signed-off-by: amc-nu <abraham.monrroy@gmail.com>
Co-authored-by: h-mitsui-esol <h-mitsui@esol.co.jp>
Co-authored-by: wep21 <border_goldenmarket@yahoo.co.jp>
Co-authored-by: Daisuke Nishimatsu <42202095+wep21@users.noreply.github.com>
Co-authored-by: n-hamaike-esol <50005860+n-hamaike-esol@users.noreply.github.com>
Co-authored-by: v-nagai7872@esol.co.jp <v-nagai7872@esol.co.jp>
Co-authored-by: Takeshi Miura <57553950+1222-takeshi@users.noreply.github.com>
Co-authored-by: h-mitsui-esol <57085544+h-mitsui-esol@users.noreply.github.com>
Co-authored-by: Kosuke Takeuchi <kosuke.tnp@gmail.com>
Co-authored-by: Jacob Lambert <jacob.lambert@tier4.jp>
Co-authored-by: Jacob Lambert <yacob.lambert@gmail.com>
Co-authored-by: PE <abraham.monrroy@tier4.jp>
Co-authored-by: David Wong <david.wong@tier4.jp>
Co-authored-by: dependabot[bot] <49699333+dependabot[bot]@users.noreply.github.com>
Co-authored-by: Q <github@kyutoku.cloud>
Co-authored-by: tokuda99 <kosuke.tokuda@tier4.jp>
Co-authored-by: tokuda99 <110436081+tokuda99@users.noreply.github.com>
Co-authored-by: wep21 <wep21@users.noreply.github.com>
Co-authored-by: tier4-nebula-app[bot] <tier4-nebula-app[bot]@users.noreply.github.com>
Co-authored-by: amc-nu <amc-nu@users.noreply.github.com>
knzo25 pushed a commit to knzo25/autoware.universe that referenced this pull request May 17, 2024
* first commit

* Add CI

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

* release livox driver(beta ver.) (#1)

* add colcon build env. (base code is 0624e)

* move some hpp files, add src folder in livox driver

* trivial modification

* Update README.md

* remove unneccesary files

* remove unneccesary header

* move third-party source files

* update code(20210630)

* Delete different test files.

* README.md add "4. running"

* README crlf

* HwInterface/udp_socket.hpp

* modify for ros2 run error

* Update README.md

* accumulate_count

* time_stamp

* struct LivoxPointXyzrtl packed

* GetEchoNumPerPoint()

* cloud.width 24000

* time_base -> time_stamp

* code fix

* cloud.width update

* code fix

* code fix

* StreamStart retry 30sec

* code fix

* rviz2

* fix format

* <br>

* format ros2wrapper

* frame_id

* frame_id

* Update README.md

* Update README.md

* discussion_r664993039

* typo typo brief and only English in the comments. and LivoxDataCallback delete

* PI -> M_PI

* Revert "PI -> M_PI"

This reverts commit c54bbe3b3c1954f82247d38570bdf71a3ddf38b6.

* PI -> M_PI 2nd

* thread pointer -> shared_ptr

* modify CMakelists.txt and package.xml to using ament_cmake_auto

* README.md

* default node name

* add composable node (#4)

* add composable node

* fix conflicts

* fix exec node

* change sensor name fix to variable

* fix can use ros2_wrapper_main.cpp

* README.md

* default node name

* change namespace

* add namespace to topic names

Co-authored-by: mitui.hide <h-mitsui@esol.co.jp>

* package.xml maintainer and README.md

* #discussion_r666683800

* #discussion_r666712110

* #discussion_r665125337

* #discussion_r664995104

* #discussion_r666078326

* #discussion_r665121366

* #discussion_r665121366 Expansion

* typedef enum -> enum

* typedef enum -> enum

* #discussion_r665121708

* #discussion_r665124279

* #discussion_r664995791

* typo #discussion_r670300391

* #discussion_r664987903

* Revert "#discussion_r664987903"

This reverts commit 97d78e64c13e5bb59b98bd1f17f1bfd527384852.

* #discussion_r664987903

* #discussion_r664988302

* #discussion_r664989270

* #discussion_r664989004

* CMakeList.txt remove(-g -O0)

* smart_pointers. #issuecomment-878771481

Co-authored-by: mitui.hide <h-mitsui@esol.co.jp>
Co-authored-by: v-nagai7872@esol.co.jp <v-nagai7872@esol.co.jp>
Co-authored-by: Takeshi Miura <57553950+1222-takeshi@users.noreply.github.com>

* fix for the issue with the termination process when powering off (#5)

* add colcon build env. (base code is 0624e)

* move some hpp files, add src folder in livox driver

* trivial modification

* Update README.md

* remove unneccesary files

* remove unneccesary header

* move third-party source files

* update code(20210630)

* Delete different test files.

* README.md add "4. running"

* README crlf

* HwInterface/udp_socket.hpp

* modify for ros2 run error

* Update README.md

* accumulate_count

* time_stamp

* struct LivoxPointXyzrtl packed

* GetEchoNumPerPoint()

* cloud.width 24000

* time_base -> time_stamp

* code fix

* cloud.width update

* code fix

* code fix

* StreamStart retry 30sec

* code fix

* rviz2

* fix format

* <br>

* format ros2wrapper

* frame_id

* frame_id

* Update README.md

* Update README.md

* discussion_r664993039

* typo typo brief and only English in the comments. and LivoxDataCallback delete

* PI -> M_PI

* Revert "PI -> M_PI"

This reverts commit c54bbe3b3c1954f82247d38570bdf71a3ddf38b6.

* PI -> M_PI 2nd

* thread pointer -> shared_ptr

* modify CMakelists.txt and package.xml to using ament_cmake_auto

* README.md

* default node name

* add composable node (#4)

* add composable node

* fix conflicts

* fix exec node

* change sensor name fix to variable

* fix can use ros2_wrapper_main.cpp

* README.md

* default node name

* change namespace

* add namespace to topic names

Co-authored-by: mitui.hide <h-mitsui@esol.co.jp>

* package.xml maintainer and README.md

* #discussion_r666683800

* #discussion_r666712110

* #discussion_r665125337

* #discussion_r664995104

* #discussion_r666078326

* #discussion_r665121366

* #discussion_r665121366 Expansion

* typedef enum -> enum

* typedef enum -> enum

* #discussion_r665121708

* #discussion_r665124279

* #discussion_r664995791

* esol_ReviewNo6

* esol_ReviewNo26

* esol_ReviewNo24

* Revert "esol_ReviewNo24"

This reverts commit 0e8f33341186d6fa4a905de45c8f9aa28b8d29cb.

* Revert "esol_ReviewNo24"

This reverts commit 0e8f33341186d6fa4a905de45c8f9aa28b8d29cb.

* esol_ReviewNo24

* esol_ReviewNo27

* esol_ReviewNo17

* format

* esol_ReviewNo21

* develop #1 6bae863876bfda52db848ed31e415a3b16a0b6a8

* tab -> space

* develop marge

* CMakeLists.txt remove(-g -O0)

* T4PUB-358 1st

* format and bug-fix

* 5#discussion_r677475332

* Add comment semaphore_

* 5#discussion_r678802453

Co-authored-by: mitui.hide <h-mitsui@esol.co.jp>
Co-authored-by: v-nagai7872@esol.co.jp <v-nagai7872@esol.co.jp>
Co-authored-by: Takeshi Miura <57553950+1222-takeshi@users.noreply.github.com>
Co-authored-by: h-mitsui-esol <57085544+h-mitsui-esol@users.noreply.github.com>

* Refactor 1st (#6)

* Refactor 1st

* pull/6#discussion_r681704754

* pull/6#discussion_r682172984

* pull/6#discussion_r681705368

* pull/6#discussion_r680921593 and pull/6#discussion_r680922194

* pull/6#discussion_r681711654

* 6#discussion_r682170555

* Use default qos for imu (#8)

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

* Fix/esol/livox driver utest (#9)

* Refactor 1st

* pull/6#discussion_r681704754

* pull/6#discussion_r682172984

* pull/6#discussion_r681705368

* pull/6#discussion_r680921593 and pull/6#discussion_r680922194

* pull/6#discussion_r681711654

* 6#discussion_r682170555

* livox_driver utest 1st

* T4PUB-437 bug fix.

* Fix merge failure 3371552e395f1817adb3a32ea9f95360d72019f8

* pull/9#discussion_r689167375 and pull/9#discussion_r689204716

* Livox Diagnostics (#10)

* Livox Diagnostics. Initial non working commit

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* clang. add tier4 format

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* gitignore. Add Tier4 ignore file

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* wip

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* wip 2

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* code adaptations to new main branch

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* wip 3 get device status from sensor

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* adaptations for diagnostics from eth packet

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* RosWrapper. parse and report Diagnostics

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* lidar_driver. fix getcommandid switch

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* ros2_driver_wrapper. fix switch indent

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* git workflow. test CI token

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* livox_command. Remove unused CommandPushAbnormalState struct

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* add fallthroughts

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* apply t4 formatting

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* livox_diagnostics. remove unnecessary code for boolean vars

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* ros2_driver_wrapper. clarify level comparison with enum

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* livox_diagnostics. remove unncessary comma at the end of enum

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* ros2_driver_wrapper. group diagnostics members

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* gitignore. remove aw related entries

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* ros2_driver_wrapper. simplify ros diagnostics string

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* revert fallthroughs on switch

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* replace shift logic for bit fields

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* add private keyword to clarify

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* separate diagnostics, remove static definition

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* add missing StatusCodeToLivoxMotorStatus

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* Separate diagnostics to multiple reports

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* update status from sensor

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* wrapper. remove the namespace from the diagnostic task

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* ros2_wrapper. remove unncessary lidar_identifier

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* nebula structure

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* nebula wip

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* remove transport driver

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* move livox, start nebula base

* reorganize pkg

* Initial POC Hesai driver structure

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* POC Hesai driver hw interface

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* initial 'working' version

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* restructuration

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* README

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* attempts at getting the UDP driver to work

* fix hw_interface

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* clang. update with t4 format

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* nebula. add missing headers

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* start of packet handling

* hesai_msgs. add jumbo message

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* hesai. add packet parsing and scan formation code

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* apply clang formatting

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* hesai_ros. reorder includes

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* hesai_ros. todo

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* initial working hesai udp driver

* apply clang format

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* ROS wrappers

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* add hesai_decoders base and implementations

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* Hesai initial full working version

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* small cleanup and standardization

* Velodyne Release

* GitLab CI YAML

* Update .gitlab-ci.yml

* Update README.md

* overflow bug fix

* Update .gitlab-ci.yml

* velodyne. add vlp16 launch

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* launch. add hdl32 launch file

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* launch. add vlp16hr

Signed-off-by: PE <abraham.monrroy@tier4.jp>

* pandar40 decoder. fix typo

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* nebula. v2. tcp/diag/monitoring

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* v2.1. PandarAT128 Dual only support

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* launch. add pandar128 sample launch

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* pandar at128. single last/strongest echo + ptp timestamp support

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* fix: prevent build error from logger parenthesis

* v2.1. hesai/velodyne setup single/dual at launch

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* Bump actions/checkout from 2 to 3.1.0

Bumps [actions/checkout](https://github.com/actions/checkout) from 2 to 3.1.0.
- [Release notes](https://github.com/actions/checkout/releases)
- [Changelog](https://github.com/actions/checkout/blob/main/CHANGELOG.md)
- [Commits](https://github.com/actions/checkout/compare/v2...v3.1.0)

---
updated-dependencies:
- dependency-name: actions/checkout
  dependency-type: direct:production
  update-type: version-update:semver-major
...

Signed-off-by: dependabot[bot] <support@github.com>

* fix: build error from Hesai hardware interface

* tcp depend, readme

* move to composable node

* .py launch for all sensors

* .py launch how-to

* deprecate esol driver

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* Bump streetsidesoftware/cspell-action from 1.1.1 to 2.15.0

Bumps [streetsidesoftware/cspell-action](https://github.com/streetsidesoftware/cspell-action) from 1.1.1 to 2.15.0.
- [Release notes](https://github.com/streetsidesoftware/cspell-action/releases)
- [Changelog](https://github.com/streetsidesoftware/cspell-action/blob/main/CHANGELOG.md)
- [Commits](https://github.com/streetsidesoftware/cspell-action/compare/v1.1.1...v2.15.0)

---
updated-dependencies:
- dependency-name: streetsidesoftware/cspell-action
  dependency-type: direct:production
  update-type: version-update:semver-major
...

Signed-off-by: dependabot[bot] <support@github.com>

* Bump actions/checkout from 3.1.0 to 3.2.0

Bumps [actions/checkout](https://github.com/actions/checkout) from 3.1.0 to 3.2.0.
- [Release notes](https://github.com/actions/checkout/releases)
- [Changelog](https://github.com/actions/checkout/blob/main/CHANGELOG.md)
- [Commits](https://github.com/actions/checkout/compare/v3.1.0...v3.2.0)

---
updated-dependencies:
- dependency-name: actions/checkout
  dependency-type: direct:production
  update-type: version-update:semver-minor
...

Signed-off-by: dependabot[bot] <support@github.com>

* Nebula decoder test pr (#12)

* Offline bug fix

* Extract pcd and bag for each pandar_packets

* initial test decorder code (hesai at128)

* Offline bug fix

* Extract pcd and bag for each pandar_packets

* initial test decorder code (hesai at128)

* testing decorder

* Changed package name back to pandar_msgs

* add_launch_test was tried, but it didn't work

* cleanup

* fix naming

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* messages. hesai cleanup

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* gtests. cmake cleanup

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* sample. fix warnings

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* messages. remove c++ tests from ROS messages

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* cleanup comments

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* code cleanup

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* offline_sample. remove dependencies

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* nebula. velodyne add missing dependency

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* nebula. add missing dependency

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* nebula oofline. add missing dependency

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>
Co-authored-by: Abraham Cano <abrahammonrroy@yahoo.com>

* Update build-and-test.yml

CI. adapt default branch name.

* Bump streetsidesoftware/cspell-action from 2.15.0 to 2.15.1 (#15)

Bumps [streetsidesoftware/cspell-action](https://github.com/streetsidesoftware/cspell-action) from 2.15.0 to 2.15.1.
- [Release notes](https://github.com/streetsidesoftware/cspell-action/releases)
- [Changelog](https://github.com/streetsidesoftware/cspell-action/blob/main/CHANGELOG.md)
- [Commits](https://github.com/streetsidesoftware/cspell-action/compare/v2.15.0...v2.15.1)

---
updated-dependencies:
- dependency-name: streetsidesoftware/cspell-action
  dependency-type: direct:production
  update-type: version-update:semver-patch
...

Signed-off-by: dependabot[bot] <support@github.com>

Signed-off-by: dependabot[bot] <support@github.com>
Co-authored-by: dependabot[bot] <49699333+dependabot[bot]@users.noreply.github.com>

* Testing decoder (AT128 & XT32M) (#14)

* Testing decoder (AT128 & XT32M)

* clang format. add clang format testing and formatting

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* .clang-format. remove file

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* tests. use relative path for tests

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* README. How to run tests

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CMakeLists. default to C++17

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* tests. code clean up

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* github actions. enable CI testing

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* repos.  replace dependency repository branch

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* tests. reset node at the end of the test exection

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>
Co-authored-by: Abraham Cano <abrahammonrroy@yahoo.com>

* launch. fix naming for composable nodes and simplify

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* bug. add missing streamstart for hw composable nodes

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* apply clang format

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* Github Actions. Run CI tests only for nebula packages

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* Testing decoder (40P, 64, QT64, XT32, VLP16) (#17)

* Testing decoder (AT128 & XT32M)

* velodyne_ros_offline_extract_pcd

* Add 40P, 64, QT64, XT32

* vlp16

* vlp16 fix

* velodyne_http. update api to transport drivers with beast requiring namespaces

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* Bump ros-tooling/setup-ros from 0.2 to 0.5 (#20)

Bumps [ros-tooling/setup-ros](https://github.com/ros-tooling/setup-ros) from 0.2 to 0.5.
- [Release notes](https://github.com/ros-tooling/setup-ros/releases)
- [Commits](https://github.com/ros-tooling/setup-ros/compare/v0.2...v0.5)

---
updated-dependencies:
- dependency-name: ros-tooling/setup-ros
  dependency-type: direct:production
  update-type: version-update:semver-minor
...

Signed-off-by: dependabot[bot] <support@github.com>
Co-authored-by: dependabot[bot] <49699333+dependabot[bot]@users.noreply.github.com>

* Bump streetsidesoftware/cspell-action from 2.15.1 to 2.16.0 (#18)

Bumps [streetsidesoftware/cspell-action](https://github.com/streetsidesoftware/cspell-action) from 2.15.1 to 2.16.0.
- [Release notes](https://github.com/streetsidesoftware/cspell-action/releases)
- [Changelog](https://github.com/streetsidesoftware/cspell-action/blob/main/CHANGELOG.md)
- [Commits](https://github.com/streetsidesoftware/cspell-action/compare/v2.15.1...v2.16.0)

---
updated-dependencies:
- dependency-name: streetsidesoftware/cspell-action
  dependency-type: direct:production
  update-type: version-update:semver-minor
...

Signed-off-by: dependabot[bot] <support@github.com>
Co-authored-by: dependabot[bot] <49699333+dependabot[bot]@users.noreply.github.com>

* Bump actions/checkout from 3.2.0 to 3.3.0 (#16)

Bumps [actions/checkout](https://github.com/actions/checkout) from 3.2.0 to 3.3.0.
- [Release notes](https://github.com/actions/checkout/releases)
- [Changelog](https://github.com/actions/checkout/blob/main/CHANGELOG.md)
- [Commits](https://github.com/actions/checkout/compare/v3.2.0...v3.3.0)

---
updated-dependencies:
- dependency-name: actions/checkout
  dependency-type: direct:production
  update-type: version-update:semver-minor
...

Signed-off-by: dependabot[bot] <support@github.com>
Co-authored-by: dependabot[bot] <49699333+dependabot[bot]@users.noreply.github.com>

* build_depends. update transport_drivers repo

* Testing VLS128 (#21)

* Testing VLS128

* transport_drivers. api

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* 312cd76's forgotten items...

* build_depends. switch to boost from asio on transport_drivers

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

---------

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>
Co-authored-by: Abraham Cano <abrahammonrroy@yahoo.com>

* Pandar OT 128E4X Initial support (#25)

* wip. pandar ot

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* wip. missing correction

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* pandar128e4x. add calibration file

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* pandar_ot. initial working version

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* pandar_ot. clean up

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* nebula. apply clang format

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

---------

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* Fix cpu (#27)

* fix decoders

* add declaration of dual_return_distance_threshold

* nebula_common. reorder return modes to match previous definition

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

---------

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>
Co-authored-by: tokuda99 <kosuke.tokuda@tier4.jp>

* Fix velodyne cpu (#28)

* fix declaration of descriptor.type and delete dual_return_distance_threshold of velodyne

* add dual_return_distance_threshold to paramCallback option and add it to launch file param

* clang-format

* Docs of nebula driver (#19)

* nebula common 1

* nebula common 2

* hesai, velodyne

* Bump streetsidesoftware/cspell-action from 2.16.0 to 2.20.0 (#26)

Bumps [streetsidesoftware/cspell-action](https://github.com/streetsidesoftware/cspell-action) from 2.16.0 to 2.20.0.
- [Release notes](https://github.com/streetsidesoftware/cspell-action/releases)
- [Changelog](https://github.com/streetsidesoftware/cspell-action/blob/main/CHANGELOG.md)
- [Commits](https://github.com/streetsidesoftware/cspell-action/compare/v2.16.0...v2.20.0)

---
updated-dependencies:
- dependency-name: streetsidesoftware/cspell-action
  dependency-type: direct:production
  update-type: version-update:semver-minor
...

Signed-off-by: dependabot[bot] <support@github.com>
Co-authored-by: dependabot[bot] <49699333+dependabot[bot]@users.noreply.github.com>

* Bump ros-tooling/setup-ros from 0.5 to 0.6 (#33)

Bumps [ros-tooling/setup-ros](https://github.com/ros-tooling/setup-ros) from 0.5 to 0.6.
- [Release notes](https://github.com/ros-tooling/setup-ros/releases)
- [Commits](https://github.com/ros-tooling/setup-ros/compare/v0.5...v0.6)

---
updated-dependencies:
- dependency-name: ros-tooling/setup-ros
  dependency-type: direct:production
  update-type: version-update:semver-minor
...

Signed-off-by: dependabot[bot] <support@github.com>
Co-authored-by: dependabot[bot] <49699333+dependabot[bot]@users.noreply.github.com>

* Bump streetsidesoftware/cspell-action from 2.20.0 to 2.22.0 (#32)

Bumps [streetsidesoftware/cspell-action](https://github.com/streetsidesoftware/cspell-action) from 2.20.0 to 2.22.0.
- [Release notes](https://github.com/streetsidesoftware/cspell-action/releases)
- [Changelog](https://github.com/streetsidesoftware/cspell-action/blob/main/CHANGELOG.md)
- [Commits](https://github.com/streetsidesoftware/cspell-action/compare/v2.20.0...v2.22.0)

---
updated-dependencies:
- dependency-name: streetsidesoftware/cspell-action
  dependency-type: direct:production
  update-type: version-update:semver-minor
...

Signed-off-by: dependabot[bot] <support@github.com>
Co-authored-by: dependabot[bot] <49699333+dependabot[bot]@users.noreply.github.com>

* Bump ros-tooling/action-ros-ci from 0.2 to 0.3 (#31)

Bumps [ros-tooling/action-ros-ci](https://github.com/ros-tooling/action-ros-ci) from 0.2 to 0.3.
- [Release notes](https://github.com/ros-tooling/action-ros-ci/releases)
- [Commits](https://github.com/ros-tooling/action-ros-ci/compare/v0.2...v0.3)

---
updated-dependencies:
- dependency-name: ros-tooling/action-ros-ci
  dependency-type: direct:production
  update-type: version-update:semver-minor
...

Signed-off-by: dependabot[bot] <support@github.com>
Co-authored-by: dependabot[bot] <49699333+dependabot[bot]@users.noreply.github.com>

* first commit

* Add CI

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

* release livox driver(beta ver.) (#1)

* add colcon build env. (base code is 0624e)

* move some hpp files, add src folder in livox driver

* trivial modification

* Update README.md

* remove unneccesary files

* remove unneccesary header

* move third-party source files

* update code(20210630)

* Delete different test files.

* README.md add "4. running"

* README crlf

* HwInterface/udp_socket.hpp

* modify for ros2 run error

* Update README.md

* accumulate_count

* time_stamp

* struct LivoxPointXyzrtl packed

* GetEchoNumPerPoint()

* cloud.width 24000

* time_base -> time_stamp

* code fix

* cloud.width update

* code fix

* code fix

* StreamStart retry 30sec

* code fix

* rviz2

* fix format

* <br>

* format ros2wrapper

* frame_id

* frame_id

* Update README.md

* Update README.md

* discussion_r664993039

* typo typo brief and only English in the comments. and LivoxDataCallback delete

* PI -> M_PI

* Revert "PI -> M_PI"

This reverts commit c54bbe3b3c1954f82247d38570bdf71a3ddf38b6.

* PI -> M_PI 2nd

* thread pointer -> shared_ptr

* modify CMakelists.txt and package.xml to using ament_cmake_auto

* README.md

* default node name

* add composable node (#4)

* add composable node

* fix conflicts

* fix exec node

* change sensor name fix to variable

* fix can use ros2_wrapper_main.cpp

* README.md

* default node name

* change namespace

* add namespace to topic names

Co-authored-by: mitui.hide <h-mitsui@esol.co.jp>

* package.xml maintainer and README.md

* #discussion_r666683800

* #discussion_r666712110

* #discussion_r665125337

* #discussion_r664995104

* #discussion_r666078326

* #discussion_r665121366

* #discussion_r665121366 Expansion

* typedef enum -> enum

* typedef enum -> enum

* #discussion_r665121708

* #discussion_r665124279

* #discussion_r664995791

* typo #discussion_r670300391

* #discussion_r664987903

* Revert "#discussion_r664987903"

This reverts commit 97d78e64c13e5bb59b98bd1f17f1bfd527384852.

* #discussion_r664987903

* #discussion_r664988302

* #discussion_r664989270

* #discussion_r664989004

* CMakeList.txt remove(-g -O0)

* smart_pointers. #issuecomment-878771481

Co-authored-by: mitui.hide <h-mitsui@esol.co.jp>
Co-authored-by: v-nagai7872@esol.co.jp <v-nagai7872@esol.co.jp>
Co-authored-by: Takeshi Miura <57553950+1222-takeshi@users.noreply.github.com>

* fix for the issue with the termination process when powering off (#5)

* add colcon build env. (base code is 0624e)

* move some hpp files, add src folder in livox driver

* trivial modification

* Update README.md

* remove unneccesary files

* remove unneccesary header

* move third-party source files

* update code(20210630)

* Delete different test files.

* README.md add "4. running"

* README crlf

* HwInterface/udp_socket.hpp

* modify for ros2 run error

* Update README.md

* accumulate_count

* time_stamp

* struct LivoxPointXyzrtl packed

* GetEchoNumPerPoint()

* cloud.width 24000

* time_base -> time_stamp

* code fix

* cloud.width update

* code fix

* code fix

* StreamStart retry 30sec

* code fix

* rviz2

* fix format

* <br>

* format ros2wrapper

* frame_id

* frame_id

* Update README.md

* Update README.md

* discussion_r664993039

* typo typo brief and only English in the comments. and LivoxDataCallback delete

* PI -> M_PI

* Revert "PI -> M_PI"

This reverts commit c54bbe3b3c1954f82247d38570bdf71a3ddf38b6.

* PI -> M_PI 2nd

* thread pointer -> shared_ptr

* modify CMakelists.txt and package.xml to using ament_cmake_auto

* README.md

* default node name

* add composable node (#4)

* add composable node

* fix conflicts

* fix exec node

* change sensor name fix to variable

* fix can use ros2_wrapper_main.cpp

* README.md

* default node name

* change namespace

* add namespace to topic names

Co-authored-by: mitui.hide <h-mitsui@esol.co.jp>

* package.xml maintainer and README.md

* #discussion_r666683800

* #discussion_r666712110

* #discussion_r665125337

* #discussion_r664995104

* #discussion_r666078326

* #discussion_r665121366

* #discussion_r665121366 Expansion

* typedef enum -> enum

* typedef enum -> enum

* #discussion_r665121708

* #discussion_r665124279

* #discussion_r664995791

* esol_ReviewNo6

* esol_ReviewNo26

* esol_ReviewNo24

* Revert "esol_ReviewNo24"

This reverts commit 0e8f33341186d6fa4a905de45c8f9aa28b8d29cb.

* Revert "esol_ReviewNo24"

This reverts commit 0e8f33341186d6fa4a905de45c8f9aa28b8d29cb.

* esol_ReviewNo24

* esol_ReviewNo27

* esol_ReviewNo17

* format

* esol_ReviewNo21

* develop #1 6bae863876bfda52db848ed31e415a3b16a0b6a8

* tab -> space

* develop marge

* CMakeLists.txt remove(-g -O0)

* T4PUB-358 1st

* format and bug-fix

* 5#discussion_r677475332

* Add comment semaphore_

* 5#discussion_r678802453

Co-authored-by: mitui.hide <h-mitsui@esol.co.jp>
Co-authored-by: v-nagai7872@esol.co.jp <v-nagai7872@esol.co.jp>
Co-authored-by: Takeshi Miura <57553950+1222-takeshi@users.noreply.github.com>
Co-authored-by: h-mitsui-esol <57085544+h-mitsui-esol@users.noreply.github.com>

* Refactor 1st (#6)

* Refactor 1st

* pull/6#discussion_r681704754

* pull/6#discussion_r682172984

* pull/6#discussion_r681705368

* pull/6#discussion_r680921593 and pull/6#discussion_r680922194

* pull/6#discussion_r681711654

* 6#discussion_r682170555

* Use default qos for imu (#8)

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

* Fix/esol/livox driver utest (#9)

* Refactor 1st

* pull/6#discussion_r681704754

* pull/6#discussion_r682172984

* pull/6#discussion_r681705368

* pull/6#discussion_r680921593 and pull/6#discussion_r680922194

* pull/6#discussion_r681711654

* 6#discussion_r682170555

* livox_driver utest 1st

* T4PUB-437 bug fix.

* Fix merge failure 3371552e395f1817adb3a32ea9f95360d72019f8

* pull/9#discussion_r689167375 and pull/9#discussion_r689204716

* Livox Diagnostics (#10)

* Livox Diagnostics. Initial non working commit

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* clang. add tier4 format

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* gitignore. Add Tier4 ignore file

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* wip

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* wip 2

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* code adaptations to new main branch

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* wip 3 get device status from sensor

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* adaptations for diagnostics from eth packet

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* RosWrapper. parse and report Diagnostics

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* lidar_driver. fix getcommandid switch

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* ros2_driver_wrapper. fix switch indent

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* git workflow. test CI token

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* livox_command. Remove unused CommandPushAbnormalState struct

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* add fallthroughts

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* apply t4 formatting

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* livox_diagnostics. remove unnecessary code for boolean vars

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* ros2_driver_wrapper. clarify level comparison with enum

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* livox_diagnostics. remove unncessary comma at the end of enum

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* ros2_driver_wrapper. group diagnostics members

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* gitignore. remove aw related entries

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* ros2_driver_wrapper. simplify ros diagnostics string

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* revert fallthroughs on switch

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* replace shift logic for bit fields

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* add private keyword to clarify

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* separate diagnostics, remove static definition

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* add missing StatusCodeToLivoxMotorStatus

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* Separate diagnostics to multiple reports

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* update status from sensor

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* wrapper. remove the namespace from the diagnostic task

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* ros2_wrapper. remove unncessary lidar_identifier

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* nebula structure

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* nebula wip

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* remove transport driver

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* move livox, start nebula base

* reorganize pkg

* Initial POC Hesai driver structure

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* POC Hesai driver hw interface

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* initial 'working' version

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* restructuration

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* README

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* attempts at getting the UDP driver to work

* fix hw_interface

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* nebula. add missing headers

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* start of packet handling

* hesai_msgs. add jumbo message

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* hesai. add packet parsing and scan formation code

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* apply clang formatting

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* hesai_ros. reorder includes

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* hesai_ros. todo

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* initial working hesai udp driver

* apply clang format

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* ROS wrappers

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* add hesai_decoders base and implementations

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* Hesai initial full working version

Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>

* small cleanup and standardization

* Velodyne Release

* GitLab CI YAML

* Update .gitlab-ci.yml

* Update README.md

* overflow bug fix

* Update .gitlab-ci.yml

* velodyne. add vlp16 launch

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* launch. add hdl32 launch file

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* launch. add vlp16hr

Signed-off-by: PE <abraham.monrroy@tier4.jp>

* pandar40 decoder. fix typo

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* nebula. v2. tcp/diag/monitoring

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* v2.1. PandarAT128 Dual only support

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* launch. add pandar128 sample launch

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* pandar at128. single last/strongest echo + ptp timestamp support

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* fix: prevent build error from logger parenthesis

* v2.1. hesai/velodyne setup single/dual at launch

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* fix: build error from Hesai hardware interface

* tcp depend, readme

* move to composable node

* .py launch for all sensors

* .py launch how-to

* deprecate esol driver

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* Bump actions/checkout from 2 to 3.1.0

Bumps [actions/checkout](https://github.com/actions/checkout) from 2 to 3.1.0.
- [Release notes](https://github.com/actions/checkout/releases)
- [Changelog](https://github.com/actions/checkout/blob/main/CHANGELOG.md)
- [Commits](https://github.com/actions/checkout/compare/v2...v3.1.0)

---
updated-dependencies:
- dependency-name: actions/checkout
  dependency-type: direct:production
  update-type: version-update:semver-major
...

Signed-off-by: dependabot[bot] <support@github.com>

* Nebula decoder test pr (#12)

* Offline bug fix

* Extract pcd and bag for each pandar_packets

* initial test decorder code (hesai at128)

* Offline bug fix

* Extract pcd and bag for each pandar_packets

* initial test decorder code (hesai at128)

* testing decorder

* Changed package name back to pandar_msgs

* add_launch_test was tried, but it didn't work

* cleanup

* fix naming

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* messages. hesai cleanup

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* gtests. cmake cleanup

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* sample. fix warnings

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* messages. remove c++ tests from ROS messages

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* cleanup comments

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* code cleanup

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* offline_sample. remove dependencies

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* nebula. velodyne add missing dependency

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* nebula. add missing dependency

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* nebula oofline. add missing dependency

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CI. test

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>
Co-authored-by: Abraham Cano <abrahammonrroy@yahoo.com>

* Testing decoder (AT128 & XT32M) (#14)

* Testing decoder (AT128 & XT32M)

* clang format. add clang format testing and formatting

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* .clang-format. remove file

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* tests. use relative path for tests

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* README. How to run tests

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* CMakeLists. default to C++17

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* tests. code clean up

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* github actions. enable CI testing

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* repos.  replace dependency repository branch

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* tests. reset node at the end of the test exection

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>
Co-authored-by: Abraham Cano <abrahammonrroy@yahoo.com>

* launch. fix naming for composable nodes and simplify

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* bug. add missing streamstart for hw composable nodes

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* apply clang format

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* Testing decoder (40P, 64, QT64, XT32, VLP16) (#17)

* Testing decoder (AT128 & XT32M)

* velodyne_ros_offline_extract_pcd

* Add 40P, 64, QT64, XT32

* vlp16

* vlp16 fix

* velodyne_http. update api to transport drivers with beast requiring namespaces

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* build_depends. update transport_drivers repo

* Testing VLS128 (#21)

* Testing VLS128

* transport_drivers. api

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* 312cd76's forgotten items...

* build_depends. switch to boost from asio on transport_drivers

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

---------

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>
Co-authored-by: Abraham Cano <abrahammonrroy@yahoo.com>

* style(pre-commit): autofix

* style(pre-commit): autofix

* Update build_depends.repos

* Bump streetsidesoftware/cspell-action from 2.22.0 to 2.24.0 (#35)

Bumps [streetsidesoftware/cspell-action](https://github.com/streetsidesoftware/cspell-action) from 2.22.0 to 2.24.0.
- [Release notes](https://github.com/streetsidesoftware/cspell-action/releases)
- [Changelog](https://github.com/streetsidesoftware/cspell-action/blob/main/CHANGELOG.md)
- [Commits](https://github.com/streetsidesoftware/cspell-action/compare/v2.22.0...v2.24.0)

---
updated-dependencies:
- dependency-name: streetsidesoftware/cspell-action
  dependency-type: direct:production
  update-type: version-update:semver-minor
...

Signed-off-by: dependabot[bot] <support@github.com>
Co-authored-by: dependabot[bot] <49699333+dependabot[bot]@users.noreply.github.com>

* Bump actions/checkout from 3.3.0 to 3.4.0 (#36)

Bumps [actions/checkout](https://github.com/actions/checkout) from 3.3.0 to 3.4.0.
- [Release notes](https://github.com/actions/checkout/releases)
- [Changelog](https://github.com/actions/checkout/blob/main/CHANGELOG.md)
- [Commits](https://github.com/actions/checkout/compare/v3.3.0...v3.4.0)

---
updated-dependencies:
- dependency-name: actions/checkout
  dependency-type: direct:production
  update-type: version-update:semver-minor
...

Signed-off-by: dependabot[bot] <support@github.com>
Co-authored-by: dependabot[bot] <49699333+dependabot[bot]@users.noreply.github.com>

* Add Documentation (#37)

* Documentation. Initial MkDocs+MkDoxy Generator

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* github actions. enable mkdocs

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* github actions. documentation add sudo

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* github actions. documentation add pip

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* github actions. documentation add pip

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* github actions. documentation add pip

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

---------

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>
Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* documentation. run only on succesful merge

* Bump actions/cache from 2 to 3 (#39)

Bumps [actions/cache](https://github.com/actions/cache) from 2 to 3.
- [Release notes](https://github.com/actions/cache/releases)
- [Changelog](https://github.com/actions/cache/blob/main/RELEASES.md)
- [Commits](https://github.com/actions/cache/compare/v2...v3)

---
updated-dependencies:
- dependency-name: actions/cache
  dependency-type: direct:production
  update-type: version-update:semver-major
...

Signed-off-by: dependabot[bot] <support@github.com>
Co-authored-by: dependabot[bot] <49699333+dependabot[bot]@users.noreply.github.com>

* Bump streetsidesoftware/cspell-action from 2.24.0 to 2.25.0 (#38)

Bumps [streetsidesoftware/cspell-action](https://github.com/streetsidesoftware/cspell-action) from 2.24.0 to 2.25.0.
- [Release notes](https://github.com/streetsidesoftware/cspell-action/releases)
- [Changelog](https://github.com/streetsidesoftware/cspell-action/blob/main/CHANGELOG.md)
- [Commits](https://github.com/streetsidesoftware/cspell-action/compare/v2.24.0...v2.25.0)

---
updated-dependencies:
- dependency-name: streetsidesoftware/cspell-action
  dependency-type: direct:production
  update-type: version-update:semver-minor
...

Signed-off-by: dependabot[bot] <support@github.com>
Co-authored-by: dependabot[bot] <49699333+dependabot[bot]@users.noreply.github.com>

* Bump streetsidesoftware/cspell-action from 2.25.0 to 2.26.0 (#40)

Bumps [streetsidesoftware/cspell-action](https://github.com/streetsidesoftware/cspell-action) from 2.25.0 to 2.26.0.
- [Release notes](https://github.com/streetsidesoftware/cspell-action/releases)
- [Changelog](https://github.com/streetsidesoftware/cspell-action/blob/main/CHANGELOG.md)
- [Commits](https://github.com/streetsidesoftware/cspell-action/compare/v2.25.0...v2.26.0)

---
updated-dependencies:
- dependency-name: streetsidesoftware/cspell-action
  dependency-type: direct:production
  update-type: version-update:semver-minor
...

Signed-off-by: dependabot[bot] <support@github.com>
Co-authored-by: dependabot[bot] <49699333+dependabot[bot]@users.noreply.github.com>

* Bump streetsidesoftware/cspell-action from 2.26.0 to 2.26.1 (#42)

Bumps [streetsidesoftware/cspell-action](https://github.com/streetsidesoftware/cspell-action) from 2.26.0 to 2.26.1.
- [Release notes](https://github.com/streetsidesoftware/cspell-action/releases)
- [Changelog](https://github.com/streetsidesoftware/cspell-action/blob/main/CHANGELOG.md)
- [Commits](https://github.com/streetsidesoftware/cspell-action/compare/v2.26.0...v2.26.1)

---
updated-dependencies:
- dependency-name: streetsidesoftware/cspell-action
  dependency-type: direct:production
  update-type: version-update:semver-patch
...

Signed-off-by: dependabot[bot] <support@github.com>
Co-authored-by: dependabot[bot] <49699333+dependabot[bot]@users.noreply.github.com>

* Point timestamp returntype update to match T4 requirements (#41)

* Add setup_sensor flag for hw drivers

* point timestamp, point.return_type

* Support QT128

* qt to qt64

* pandar128e4x. change point type

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* pandar128e4x. clean up

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* pandar128. reserve data

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* signed to unsigned, debug

* fixed

* QT128 Dual

* QT128 timestamp fixed

* Repository restructure

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* config. restructure files

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* driver. restructure

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* offline_sample. require nebula

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* Separate Nebula into multiple libraries

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* Apply clang format

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* nebula_common. rearrange return types

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* mkdocs. update generation to match new repository structure

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* Ament Bug. Component not installing binaries

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* hw_interface. do not fail when packet size is incorrect

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* hesai_status. PAndatAT128 support Dual only

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* at128 decoder. store the azimuth value

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* launch. add missing correction file param

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* cmake. fix velodyne missing export from nebula_common

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* return_type(VLP32)

* hesai_hw_interface. reduce verbosity

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* docs. add/update mkdocs

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* Load correction dat with resolution

* at128. cleanup

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* nebula_monitor. cleanup

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* return_type of hesai

* QT64 fix

* nebula all. apply clang format

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* nebula_decoders. cleanup decoders

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* velodyne_decoders. cleanup

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* nebula_decoders. clang format

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* Mkdocs. add how to add sensor

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* IDENTICAL in QT128

* Changed ReturnType from velodyne_scan_decoder to nebula_common

* code cleanup

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* wip. get calibration from sensor

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* get calib from sensor with callback

* README. update return modes

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* cleanup. remove comments

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* clang. apply clang

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* add syncGetLidarCalibration

* Remove livox_msgs

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* rename messages to nebula_messages

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* messages. rename to nebula_messages

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* add new point type

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* clang. apply

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* Create nebula_sensor_driver metapackage

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* Use local file if connect fails

* apply clang format

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* out pcd only xyz

* TEST using only a single PCD including only XYZ

* test. update ci testing

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* clean up. angle dependencies

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* README. include new point type

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* github. ci. dont updgrade base image to accelerate build

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* decoders. remove type warnings

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

---------

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>
Signed-off-by: amc-nu <abraham.monrroy@gmail.com>
Co-authored-by: Kyutoku <github@kyutoku.cloud>

* delete unecessary packages

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* Remove old doc files

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* package.xml remove unnecessary dependencies

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* remove deprecated packages

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* Add PointCloud conversion methods

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* Replace AT128's PCD file to fix testing (#43)

* replace AT128 pcd file for test

* apply clang format

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

---------

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>
Co-authored-by: Kyutoku <github@kyutoku.cloud>

* Cpu optimization (#44)

* Remove Boost warnings

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* Optimize Pandar40P

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* Pandar64 optimization

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* PointTypes. standardize point types

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* Add radian based elevation calculation Pandar40P,64

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* qt64. radian based coordinate calculation

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* xt32. radian based coordinate calculation

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* qt128. radian based coordinate calculation

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* qt128. radian based coordinate calculation

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* pandar40. precalculate sin/cos

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* pandarxt. precalculate te sin/cos

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* apply sin/cos optimization to all decoders

Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>

* launch. fix python launch file

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* point_type. caetr SSE alignment optimization

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* hesai_hw. remove warning

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* point_types. add sse description for caetr

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* README. run tests only for nebula packages

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* clang. apply ament_clang reformat

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* Replace 40P, 64, QT64 and XT32s' PCD files to fix testing

* remove clang-format from tests

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* Local path check not required for online acquisition

* Adding timeouts to correction data acquisition

* Disable calibration query

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

---------

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>
Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>
Co-authored-by: Kyutoku <github@kyutoku.cloud>

* style(pre-commit): autofix

* style(pre-commit): autofix

* remove unnecesary dependency

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* velodyne. add monitor to velodyne

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* monitor. reduce reporting verbosity, frequency

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* style(pre-commit): autofix

* hesai_decoders. update timestamp calculation

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* hesai_decoders. update azimuth

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* fix point.azimuth of pandar64

* hesai_decoders. azimuth update

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* update timestamping

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* decoders. timing azimuth update

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* style(pre-commit): autofix

* nebula decoders. time distance update

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* nebula common. change point type

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* style(pre-commit): autofix

---------

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
Signed-off-by: kosuke55 <kosuke.tnp@gmail.com>
Signed-off-by: amc-nu <abrahammonrroy@yahoo.com>
Signed-off-by: Abraham Cano <abrahammonrroy@yahoo.com>
Signed-off-by: PE <abraham.monrroy@tier4.jp>
Signed-off-by: dependabot[bot] <support@github.com>
Signed-off-by: amc-nu <abraham.monrroy@gmail.com>
Co-authored-by: h-mitsui-esol <h-mitsui@esol.co.jp>
Co-authored-by: wep21 <border_goldenmarket@yahoo.co.jp>
Co-authored-by: Daisuke Nishimatsu <42202095+wep21@users.noreply.github.com>
Co-authored-by: n-hamaike-esol <50005860+n-hamaike-esol@users.noreply.github.com>
Co-authored-by: v-nagai7872@esol.co.jp <v-nagai7872@esol.co.jp>
Co-authored-by: Takeshi Miura <57553950+1222-takeshi@users.noreply.github.com>
Co-authored-by: h-mitsui-esol <57085544+h-mitsui-esol@users.noreply.github.com>
Co-authored-by: Kosuke Takeuchi <kosuke.tnp@gmail.com>
Co-authored-by: Jacob Lambert <jacob.lambert@tier4.jp>
Co-authored-by: Jacob Lambert <yacob.lambert@gmail.com>
Co-authored-by: PE <abraham.monrroy@tier4.jp>
Co-authored-by: David Wong <david.wong@tier4.jp>
Co-authored-by: dependabot[bot] <49699333+dependabot[bot]@users.noreply.github.com>
Co-authored-by: Q <github@kyutoku.cloud>
Co-authored-by: tokuda99 <kosuke.tokuda@tier4.jp>
Co-authored-by: tokuda99 <110436081+tokuda99@users.noreply.github.com>
Co-authored-by: wep21 <wep21@users.noreply.github.com>
Co-authored-by: tier4-nebula-app[bot] <tier4-nebula-app[bot]@users.noreply.github.com>
Co-authored-by: amc-nu <amc-nu@users.noreply.github.com>
knzo25 pushed a commit to knzo25/autoware.universe that referenced this pull request May 17, 2024
* nebula_common. add aw point type conversions

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* nebula_ros. add aw point type conversion/publishing

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>

* style(pre-commit): autofix

---------

Signed-off-by: amc-nu <abraham.monrroy@gmail.com>
Co-authored-by: amc-nu <amc-nu@users.noreply.github.com>
ryuichi-maeda pushed a commit to sensefield/autoware.universe that referenced this pull request Jan 10, 2025
NorahXiong pushed a commit to NorahXiong/autoware.universe that referenced this pull request Jan 24, 2025
Signed-off-by: GitHub <noreply@github.com>

Co-authored-by: kenji-miyake <kenji-miyake@users.noreply.github.com>
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Labels
None yet
Projects
None yet
Development

Successfully merging this pull request may close these issues.