feat: add motion_velocity_smoother package #48
Merged
Conversation
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
* Add motion_velocity_smoother (autowarefoundation#1333) * Refactor node and utilities * Fix utilities * Fix utilities * Fixing... * Runs with L2 smoother * Use boost::optional * Add Linf, JerkFiltered * JerkFiltered * Fix * Fix awapi * Fix bug * Add config files * Fix bug * Fix bug and apply clang-format * Remove unused variable * Fix bug * Change C-style cast to static_cast * Add destructors * Use smart pointers for members * Add test * Fix test code * Tmp: add L2 norm of jerk in objective function * Fix external velocity limit * Fix interpolate in velocity controller and remove prevent move to close stop line * add initial velocity and acceleration to the filter function * Fix index calculation * add new marge function * handle edge case * Tmp: skip osqp_interface build test * Revert get_modified_package.sh * Fix CI * Fix version of osqp * Fix * Add design docment (JPN) * Fix linear interpolation * Refactor node and utilities * Fix utilities * Fix utilities * Fixing... * Runs with L2 smoother * Use boost::optional * Add Linf, JerkFiltered * JerkFiltered * Fix * Fix awapi * Fix bug * Add config files * Fix bug * Fix bug and apply clang-format * Remove unused variable * Fix bug * Change C-style cast to static_cast * Add destructors * Use smart pointers for members * Add test * Fix test code * Tmp: add L2 norm of jerk in objective function * Fix external velocity limit * Fix interpolate in velocity controller and remove prevent move to close stop line * add initial velocity and acceleration to the filter function * Fix index calculation * add new marge function * handle edge case * Tmp: skip osqp_interface build test * Revert get_modified_package.sh * Fix CI * Fix version of osqp * Fix * Add design docment (JPN) * Fix linear interpolation * add new sample function * Fix * Revert velocity_controller * Reset motion_velocity_optimizer * Fix parameter setting * Refactor and fix bugs * Use autoware_utils * Fix doc and bug * Fix doc * Fix external velocity limit and parametrize margin and jerk weight * Fix typo * Fix typo and remove old readme * add stop point calculation and modify objective function * Add parameter handling functions and add namespace * Rename calcClosestTrajectoryPoint to calcInterpolatedTrajectoryPoint and remove unused function * Fix applyExternalVelocityLimit and fix comments * Fix variable name * Fix variable name * Fix yaml comment * Add const * Fix interpolaion * Remove run() and change type of prev_closest_point_ * Update planning/scenario_planning/common/motion_velocity_smoother/src/smoother/smoother_base.cpp Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> * fix stop point error * Fix linear interpolation and external velocity calculation * Remove debug code * Rename BaseParam * Remove unused func and fix misc * Fix package.xml, include, apply formatting * Fix external velocity limit * add debug calculation time * modify calculation time debugger * modify calculation time publisher * rescale the calculation time * Fix some problem * Update planning/scenario_planning/common/motion_velocity_smoother/launch/motion_velocity_smoother.launch Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> Co-authored-by: yutaka <purewater0901@gmail.com> Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> * Add Resample Procedure after the optimization in motion_velocity_smoother (autowarefoundation#1530) * do resample after the optimization * modify resample timing * add 0 at the end of the resampeld output trajectory * Manage parameters * Fix format * Fix format * Devide resample function in other file * Update default_motion_velocity_smoother.yaml * Update default_motion_velocity_smoother.yaml Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com> * Output debug trajectories in motion velocity smoother (autowarefoundation#1533) * add debug trajectory * add rqt_multiplot setting files * add calculation tiem visualization * guard emtpy output (autowarefoundation#1537) * Motion velocity smoother doc (autowarefoundation#1563) * Fix doc * Add english doc (tmp) * Add english file * Remove unused files * Fix * Fix typo * Modify 1-size trajectory handling & warning messages (autowarefoundation#1540) * add new guard to delete unnecessary message * change message * add warning messages * chnage message to warning * chnage to throttle * Fix jerk filter calculation (autowarefoundation#1593) * modify jerk filter calculation * remove unnecessary code * change the way of interp. of pose in smoother (autowarefoundation#1600) * Update smoother resampling (autowarefoundation#1595) * add new guard to delete unnecessary message * change message * add warning messages * chnage message to warning * chnage to throttle * modify jerk filter calculation * modify jerk filter calculation * separate resampling code * add new parameter * add new parameter to dynamic reconfigure * remove unnecessary code * add sampling before optimization * add const and blocker * change access to at * fix terminal length value * add comments * clean code * add comment * Fix/insert backward on reverse trajectory (autowarefoundation#1602) * remove unused code Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * move debug code Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix insert backward on reverse trajectory Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Porting motion velocity smoother to ros2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix launch and fix warning * pre-commit fixes * Remove unused argument * Comment out unused parameter Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Add distance threshold in motion_velocity_smoother (autowarefoundation#1659) * Add distance threshold * Remove parameters and use default value * Fix for pre-commit Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Support Non-zero Stop Point Acceleration (autowarefoundation#1651) * Support non-zero stop point acceleration * modify zero velocity id search function (autowarefoundation#1690) * modify zero velocity id search function * Fix resample function and error handling * Add comment Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com> * Apply lint Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * pre-commit fixes Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com> Co-authored-by: yutaka <purewater0901@gmail.com> Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> Co-authored-by: purewater0901 <43805014+purewater0901@users.noreply.github.com> Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com> Co-authored-by: pre-commit <pre-commit@example.com>
…ion_velocity_smoother (autowarefoundation#1820) * add trajectory_visualizer and closest_velocity_optimizer to motion_velocity_smoother. * Fix CMakeLists Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com>
* Port analytical jerk constrained smoother Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Fix parameters format Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Resolve warnings and remove unnecessary processing Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Change default parameters Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Change slash to dot for declare_parameter Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Fix debug messages Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Change pragma once to ifndef and endif Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Add #include vector, utility and string Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Remove extra white spaces Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Fix acceleration calculation at type 3 Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Apply clang-format Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Change copyright format Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Fix to be less than 100 characters per line Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Implement and remove TODO Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Add include to src Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Use static_cast Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Follow uncrustify Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Disable uncrustify at include guard Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Disable uncrustify at include Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Follow uncrustify Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Fix include order error Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Fix typo Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Change index type to size_t Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Fix size_t Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Add const Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Fix parameter namespace signs from slash to dot and add latacc one Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com>
* Update motion_velocity_smoother-design.ja.md * Update motion_velocity_smoother-design.md
* use external jerk/acc constraints * update VelocityLimit.msg
* add external velocity limit selector * add README.md * improve document * apply document template * update external velocity limit selector & use commot params * update smoother & use commot params * update launch file
…dation#2267) * add vehicle engage Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix format Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
…arefoundation#2297) * change condition for input trajectory validation chack Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * organize guard code into function Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
* 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>
Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
* Use autoware_auto_msgs * Fix bugs and apply clang-format * Remove COLCON_IGNORE * Rename TrajectoryPointArray to TrajectoryPoints, use conversion functions in autoware_utils * Apply clang-format * Use odometry * Fix document
* rename to README.md * dealt with new auto_msgs format Co-authored-by: Takayuki Murooka <takayuki.murooka@tier4.jp>
* update iv_msgs -> auto_msgs in planning readme * minor change * some fix * some fix Co-authored-by: Takayuki Murooka <takayuki.murooka@tier4.jp>
* Implement Lateral and Longitudinal Control Muxer * [autowarefoundation#570] Porting wf_simulator * [autowarefoundation#1189] Deactivate flaky test in 'trajectory_follower_nodes' * [autowarefoundation#1189] Fix flacky test in 'trajectory_follower_nodes/latlon_muxer' * [autowarefoundation#1057] Add osqp_interface package * [autowarefoundation#1057] Add library code for MPC-based lateral control * [autowarefoundation#1271] Use std::abs instead of abs * [autowarefoundation#1057] Implement Lateral Controller for Cargo ODD * [autowarefoundation#1246] Resolve "Test case names currently use snake_case but should be CamelCase" * [autowarefoundation#1325] Deactivate flaky smoke test in 'trajectory_follower_nodes' * [autowarefoundation#1058] Add library code of longitudinal controller * Fix build error for trajectory follower Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix build error for trajectory follower nodes Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * [autowarefoundation#1272] Add AckermannControlCommand support to simple_planning_simulator * [autowarefoundation#1058] Add Longitudinal Controller node * [autowarefoundation#1058] Rename velocity_controller -> longitudinal_controller * [autowarefoundation#1058] Update CMakeLists.txt for the longitudinal_controller_node * [autowarefoundation#1058] Add smoke test python launch file * [autowarefoundation#1058] Use LowPassFilter1d from trajectory_follower * [autowarefoundation#1058] Use autoware_auto_msgs * [autowarefoundation#1058] Changes for .auto (debug msg tmp fix, common func, tf listener) * [autowarefoundation#1058] Remove unused parameters * [autowarefoundation#1058] Fix ros test * [autowarefoundation#1058] Rm default params from declare_parameters + use autoware types * [autowarefoundation#1058] Use default param file to setup NodeOptions in the ros test * [autowarefoundation#1058] Fix docstring * [autowarefoundation#1058] Replace receiving a Twist with a VehicleKinematicState * [autowarefoundation#1058] Change class variables format to m_ prefix * [autowarefoundation#1058] Fix plugin name of LongitudinalController in CMakeLists.txt * [autowarefoundation#1058] Fix copyright dates * [autowarefoundation#1058] Reorder includes * [autowarefoundation#1058] Add some tests (~89% coverage without disabling flaky tests) * [autowarefoundation#1058] Add more tests (90+% coverage without disabling flaky tests) * [autowarefoundation#1058] Use Float32MultiArrayDiagnostic message for debug and slope * [autowarefoundation#1058] Calculate wheel_base value from vehicle parameters * [autowarefoundation#1058] Cleanup redundant logger setting in tests * [autowarefoundation#1058] Set ROS_DOMAIN_ID when running tests to prevent CI failures * [autowarefoundation#1058] Remove TF listener and use published vehicle state instead * [autowarefoundation#1058] Change smoke tests to use autoware_testing * [autowarefoundation#1058] Add plotjuggler cfg for both lateral and longitudinal control * [autowarefoundation#1058] Improve design documents * [autowarefoundation#1058] Disable flaky test * [autowarefoundation#1058] Properly transform vehicle state in longitudinal node * [autowarefoundation#1058] Fix TF buffer of lateral controller * [autowarefoundation#1058] Tuning of lateral controller for LGSVL * [autowarefoundation#1058] Fix formating * [autowarefoundation#1058] Fix /tf_static sub to be transient_local * [autowarefoundation#1058] Fix yaw recalculation of reverse trajs in the lateral controller * modify trajectory_follower for galactic build Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * [autowarefoundation#1379] Update trajectory_follower * [autowarefoundation#1379] Update simple_planning_simulator * [autowarefoundation#1379] Update trajectory_follower_nodes * apply trajectory msg modification in control Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * move directory Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * remote control/trajectory_follower level dorectpry Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * remove .iv trajectory follower Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * use .auto trajectory_follower Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * remove .iv simple_planning_simulator & osqp_interface Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * use .iv simple_planning_simulator & osqp_interface Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * add tmp_autoware_auto_dependencies Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * tmporally add autoware_auto_msgs Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * apply .auto message split Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix build depend Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix packages using osqp * fix autoware_auto_geometry * ignore lint of some packages * ignore ament_lint of some packages * ignore lint/pre-commit of trajectory_follower_nodes * disable unit tests of some packages Co-authored-by: Maxime CLEMENT <maxime.clement@tier4.jp> Co-authored-by: Joshua Whitley <josh.whitley@autoware.org> Co-authored-by: Igor Bogoslavskyi <igor.bogoslavskyi@gmail.com> Co-authored-by: MIURA Yasuyuki <kokosabu@gmail.com> Co-authored-by: wep21 <border_goldenmarket@yahoo.co.jp> Co-authored-by: tomoya.kimura <tomoya.kimura@tier4.jp>
* fix topic name * remove angular z from LinearInterpolation in motion_velocity_smoother
* shift -> gear_status * twist -> velocity_status
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>
…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>
Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>
taikitanaka3
added a commit
that referenced
this pull request
Dec 1, 2021
* Initial commit * release v0.4.0 * 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> * Support error in autoware state (#728) * Support Error in autoware_state_monitor Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Refactor autoware_state_monitor Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Wait after planning completed Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Integrate FailedToArriveGoal and Error into Emergency state Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * 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> * Revert "Publish tl states stamped (#744)" (#771) This reverts commit 35a7e29e987afb29d9348b5f64866a584a65f753. * 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> * Feature/add stop reason lane change (#769) * add stop reason of lane change planner * add stop factor of blocked by obstacle * delete typo * add const * delete unnecessary namespace * remove ROS1 packages temporarily Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * add sample ros2 packages Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * Add ros2 perception msgs Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix dependency issue in autoware_control_msgs (#22) Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * Port vehicle_cmd_gate to ROS2 (#3) * Port vehicle_cmd_gate to ROS2 * Sim-time-respecting timer * add autoware_debug_msg (#54) * add autoware_debug_msg Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * rename to *stamped Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Fix format version (#73) * port motion_velocity_optimizer (#77) * port motion_velocity_optimizer Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix for warning Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix blockUntilVehiclePositionAvailable() Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Port of obstacle avoidance planner to ROS2 (#83) * Port to ROS2 Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Removed ros/console include Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Added THROTTLE Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Changed numbers to floats Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Removed <double> from params Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Added new msg Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Use new msg Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Replaced dynamic reconfigure Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Added EnableAvoidance.msg Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Fixed parameter mismatch Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Port behavior_velocity_planner to ROS2 (#80) * Revert "Add geometry2 to repos (#76)" This reverts commit 6d22704. * 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 v0.8.0 awapi and system msgs (#274) * Ros2 v0.8.0 engage (#342) * [autoware_vehicle_msgs]: Add engage message Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * [as]: Update message Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * [awapi_awiv_adapter]: Update message Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * [web_controller]: Update message Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * [vehicle_cmd_gate]: Update message Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * [autoware_state_monitor]: Update message Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * [autoware_control_msgs]: Remove EngageMode message Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * [simple_planning_simulator]: Update message Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Ros2 v0.8.0 lane_change_planner (#322) * Remove lane_change_planner v0.5 Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Import lane_change_planner v0.8 (ROS1) Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Modify header files * Remove header disable * Modify msg namespace * Modify time type * Modify pub/sub class * Modify node handle, etc. * Modify ConstPtr * Modify entry point * Modify time and publisher * Modify parameter, timer, and subscription * Modify data manager * Modify route handler * Modify state machine * Modify utility * Fix arguments * Modify states part1 * Modify states part2 * Modify common function * Fix for lint * Fix for lint * Modify comment type * Add copyright * Use duration from_seconds * Use double quotes for non-system headers * Fix include order Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Replace std_msgs Bool Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix line length Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix latch topic subscription Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix stamp initialization and reference Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Add super class destructor and fix waitForData Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Ros2 v0.8.0 remove std msgs awapi (#348) * [autoware_vehicle_msgs] add BatteryStatus msg Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * [autoware_planning_msgs] add ExpandStopRange and StopSpeedExceeded messages Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * [autoware_api_msgs] add DoorControlCommand, StopCommand, and VelocityLimit messages Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * remove std_msgs related to autoware_awaiv_adapter node Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * apply ament_uncrustify Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * fix build failure Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * fix test failures Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * address review commends Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * Sync with Ros2 v0.8.0 beta (#393) * add nullptr check when publish concatenate data (#369) * Add warning msg when concat pointcloud is not published (#388) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * add timeout notification stamp msgs (#363) * add timeout notification stamp msgs * fix uncursify * delete timeout notification stamped * Revert "delete timeout notification stamped" This reverts commit 365d29209f6a7f5ec75eb80c5d8c2ef38daeae79. * fix message Co-authored-by: Taichi Higashide <taichi.higashide@tier4.jp> Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com> * modify pose_initialize for foa (#382) * pose_initialize for foa (#1171) * pose_initialize for foa Signed-off-by: Yamato ANDO <yamato.ando@gmail.com> * rename topic Signed-off-by: Yamato ANDO <yamato.ando@gmail.com> * fix topic name Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * Add autoware version node (#394) * Add autoware version node Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Remove todo Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Remove unused variable Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix node name Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * fix typo (#427) * Fix typo in common module (#433) * Unify Apache-2.0 license name (#1242) * Porting remote cmd selector (#1286) * Feature/add remote cmd selector (#1179) * Add in/out args of remote_cmd_converter.launch Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Change remote input topic of vehicle_cmd_gate Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add msgs for remote_cmd_selector Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add remote_cmd_selector Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Rename remote_cmd_selector to external_cmd_selector Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Remove VehicleCommand support in autoware_joy_controller Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Support external_cmd_source in autoware_joy_controller.launch (#1194) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix porting miss Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * fix missing function * modify xml format * fix include guard * add callback group * modify remap name * Revert "modify remap name" This reverts commit 169cc8d28442825b1d61b0439b9892c913304527. * change topic name * use rclcpp_component * Remove autoware_debug_msgs from autoware_joy_controller Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Change default mode of autoware_joy_controller Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> Co-authored-by: Kenji Miyake <kenji.miyake@tier4.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> * Fix msgs (#1379) * Fix msgs Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * [autoware_planning_rviz_plugin]: Fix lint Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> Co-authored-by: wep21 <border_goldenmarket@yahoo.co.jp> * Message refinement (#1381) * Message refinement * Simplify CMakeLists.txt with ament cmake auto * Add test Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * [autoware_planning_msgs]: Fix dependency Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix package.xml Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix package.xml Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix ament_cmake_auto Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp> * Ros2/create/external commands (#1299) * add remote message * add remote commands * fix topic * remove unnecessary topic * remove unused topic * add external cmd instead * ToExternalComd * fix topic in joy con * 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> * Add newlines Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add PR template (#3) * Add PR template Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Update PULL_REQUEST_TEMPLATE.md * Add CI (#4) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * change msg type looking traffic light state (#1455) (#6) * 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> Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com> * Fix dependency type of rosidl_default_generators (#15) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add auto-main-sync CI workflow for develop (#16) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * add autoware_api_msgs (#12) Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * Feature/add virtual traffic light planner (#9) * Add VIRTUAL_TRAFFIC_LIGHT to StopReason.msg Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add VirtualTrafficLightState msgs to autoware_system_msgs Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add InfrastructureCommand msgs to autoware_planning_msgs Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix msgs Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Move messages to autoware_v2x_msgs Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix dependency type of rosidl_default_generators Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix dependency type of rosidl_default_generators (#19) * Change CI docker images to setup-ros-docker (#20) * Change CI docker images to setup-ros-docker Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Replace foxy with galactic Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add DEBIAN_FRONTEND=noninteractive to rosdep install (#21) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Update colcon-package-selection in build_and_test_pr.yml (#22) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * add autoware_simulation_msgs (#13) * add autoware_simulation_msgs * update event name * Add autoware api (#29) * add autoware multimedia msgs Signed-off-by: tkhmy <tkh.my.p@gmail.com> * add newline Signed-off-by: tkhmy <tkh.my.p@gmail.com> * change name to autoware_hmi_msgs Signed-off-by: tkhmy <tkh.my.p@gmail.com> * Rename external select message (#8) * Rename external select message Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Add selector mode to unknown Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix selector mode constant Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix format Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Move control command messages to external api Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Add build dependency Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix CI Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> Co-authored-by: tkhmy <tkh.my.p@gmail.com> * Fix CI for develop branch (#31) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * add emergency_holding flag to HazardStatus (#25) * add EmergencyState.msg (#32) * Add new workflow `sync-public.yaml` to sync with `AutowareArchitectureProposal_msgs` (#35) * Add new workflow `sync-public.yaml` to sync with `AutowareArchitectureProposal_msgs` * Remove this workflow specific comments * Remove some this workflow specific comments * Rename `oss` to `public` * Replace branch name `main` to more generic description * Add line `fetch-depth: 0` (#36) * Add EmergencyStateStamped.msg (#38) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add sync-public-develop.yaml (#42) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Change proposal sync app ID (#44) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * add MultiArrayDimension/Layout, and update MultiArrayMsgs (#28) * add MultiArrayDimension/Layout, and update MultiArrayMsgs * add kind of license * Feature/vehicle interface improvements (#1361) (#48) * add vehicle msg * add pacmod interface * add eps controller * use each control commands instead of vehicle command * fixed details * fixed speell check * const * fixed brake status * publish cmd when recieving ctrl cmd * fix shift cmd ptr * remove unused function and set proper license * fix names * fix typo for pacmod * remove unnecessary waiting * use flags, limit, multiarray * remove accel brake dependency * fix retrun value * replace eps to steer * cosmetic change for namespace * fix segfo and retval * Use Enum instead of int * remove unused var * add const * rename to calcFFMap * prev time steer calc * add sample csv * add new line Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com> * remove EmergencyMode and DricingCapability (#33) * develop -> main sync (#53) * Add detected object with feature (#54) * Add detected object with feature Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * add autoware_auto_msgs Co-authored-by: wep21 <border_goldenmarket@yahoo.co.jp> * Revert "Add detected object with feature (#54)" (#57) This reverts commit 3fcfe9936361928256ed5ffa7d8a1ef4c978ca09. * Add detected object with feature (#54) (#59) (#4) * Add detected object with feature (#54) (#59) * Add detected object with feature Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * add autoware_auto_msgs Co-authored-by: wep21 <border_goldenmarket@yahoo.co.jp> Co-authored-by: wep21 <border_goldenmarket@yahoo.co.jp> * update build depends Co-authored-by: wep21 <border_goldenmarket@yahoo.co.jp> * Add message converter (#58) * Add message converter * Move autoware state converter * add VehicleEmergency (#55) * Add two convert method (#64) * add convert method from iv_shift to auto_gear Signed-off-by: kosuke murakami <kosuke.murakami@tier4.jp> * remove space Signed-off-by: kosuke murakami <kosuke.murakami@tier4.jp> * add convert method from for turn & hazard signal Signed-off-by: kosuke murakami <kosuke.murakami@tier4.jp> * fix dependency of iv_auto_msgs converter (#8) Co-authored-by: Takayuki Murooka <takayuki.murooka@tier4.jp> * move actuation msg (#66) * Revert "move actuation msg (#66)" This reverts commit d8e3ccdcabacab819360cf399442950cc162a648. * merge autoware_localization_srvs to autoware_localization_msgs * rename pose_with_cov to pose_with_covariance * add steering wheel status stamped * fix: remove workflow and PR_TEMPLATE * fix: remove autoware_api_msgs dependency * ci(pre-commit): autofix Co-authored-by: Takagi, Isamu <43976882+isamu-takagi@users.noreply.github.com> Co-authored-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp> Co-authored-by: Kenji Miyake <31987104+kenji-miyake@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: wep21 <border_goldenmarket@yahoo.co.jp> Co-authored-by: Ryohsuke Mitsudome <43976834+mitsudome-r@users.noreply.github.com> Co-authored-by: Nikolai Morin <nnmmgit@gmail.com> Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com> Co-authored-by: Esteve Fernandez <esteve@apache.org> Co-authored-by: Servando <43142004+sgermanserrano@users.noreply.github.com> Co-authored-by: Taichi Higashide <taichi.higashide@tier4.jp> Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com> Co-authored-by: Shigeki Kobayashi <32808802+sgk-000@users.noreply.github.com> Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> Co-authored-by: Keisuke Shima <keisuke.shima@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: Keisuke Shima <19993104+KeisukeShima@users.noreply.github.com> Co-authored-by: tkhmy <tkh.my.p@gmail.com> Co-authored-by: Tatsuya Yamasaki <httperror@404-notfound.jp> Co-authored-by: Takayuki Murooka <takayuki5168@gmail.com> Co-authored-by: Kah Hooi Tan <41041286+tkhmy@users.noreply.github.com> Co-authored-by: Kosuke Murakami <kosuke.murakami@tier4.jp> Co-authored-by: Takayuki Murooka <takayuki.murooka@tier4.jp> Co-authored-by: tanaka3 <ttatcoder@outlook.jp> Co-authored-by: YamatoAndo <yamato.ando@gmail.com> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>
tkimura4
changed the title
badai-nguyen
pushed a commit
to badai-nguyen/autoware.universe
that referenced
this pull request
Feb 4, 2022
* Initial commit * release v0.4.0 * Feature/stop reason (autowarefoundation#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> * Support error in autoware state (autowarefoundation#728) * Support Error in autoware_state_monitor Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Refactor autoware_state_monitor Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Wait after planning completed Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Integrate FailedToArriveGoal and Error into Emergency state Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * 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> * Revert "Publish tl states stamped (autowarefoundation#744)" (autowarefoundation#771) This reverts commit 35a7e29e987afb29d9348b5f64866a584a65f753. * Fix/publish tl state stamped (autowarefoundation#772) * 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> * Feature/add stop reason lane change (autowarefoundation#769) * add stop reason of lane change planner * add stop factor of blocked by obstacle * delete typo * add const * delete unnecessary namespace * remove ROS1 packages temporarily Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * add sample ros2 packages Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * Add ros2 perception msgs Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix dependency issue in autoware_control_msgs (autowarefoundation#22) Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * Port vehicle_cmd_gate to ROS2 (#3) * Port vehicle_cmd_gate to ROS2 * Sim-time-respecting timer * add autoware_debug_msg (autowarefoundation#54) * add autoware_debug_msg Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * rename to *stamped Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Fix format version (autowarefoundation#73) * port motion_velocity_optimizer (autowarefoundation#77) * port motion_velocity_optimizer Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix for warning Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix blockUntilVehiclePositionAvailable() Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Port of obstacle avoidance planner to ROS2 (autowarefoundation#83) * Port to ROS2 Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Removed ros/console include Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Added THROTTLE Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Changed numbers to floats Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Removed <double> from params Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Added new msg Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Use new msg Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Replaced dynamic reconfigure Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Added EnableAvoidance.msg Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Fixed parameter mismatch Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Port behavior_velocity_planner to ROS2 (autowarefoundation#80) * Revert "Add geometry2 to repos (autowarefoundation#76)" This reverts commit 6d22704. * 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 v0.8.0 awapi and system msgs (autowarefoundation#274) * Ros2 v0.8.0 engage (autowarefoundation#342) * [autoware_vehicle_msgs]: Add engage message Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * [as]: Update message Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * [awapi_awiv_adapter]: Update message Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * [web_controller]: Update message Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * [vehicle_cmd_gate]: Update message Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * [autoware_state_monitor]: Update message Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * [autoware_control_msgs]: Remove EngageMode message Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * [simple_planning_simulator]: Update message Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Ros2 v0.8.0 lane_change_planner (autowarefoundation#322) * Remove lane_change_planner v0.5 Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Import lane_change_planner v0.8 (ROS1) Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Modify header files * Remove header disable * Modify msg namespace * Modify time type * Modify pub/sub class * Modify node handle, etc. * Modify ConstPtr * Modify entry point * Modify time and publisher * Modify parameter, timer, and subscription * Modify data manager * Modify route handler * Modify state machine * Modify utility * Fix arguments * Modify states part1 * Modify states part2 * Modify common function * Fix for lint * Fix for lint * Modify comment type * Add copyright * Use duration from_seconds * Use double quotes for non-system headers * Fix include order Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Replace std_msgs Bool Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix line length Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix latch topic subscription Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix stamp initialization and reference Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Add super class destructor and fix waitForData Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Ros2 v0.8.0 remove std msgs awapi (autowarefoundation#348) * [autoware_vehicle_msgs] add BatteryStatus msg Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * [autoware_planning_msgs] add ExpandStopRange and StopSpeedExceeded messages Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * [autoware_api_msgs] add DoorControlCommand, StopCommand, and VelocityLimit messages Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * remove std_msgs related to autoware_awaiv_adapter node Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * apply ament_uncrustify Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * fix build failure Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * fix test failures Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * address review commends Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * Sync with Ros2 v0.8.0 beta (autowarefoundation#393) * add nullptr check when publish concatenate data (autowarefoundation#369) * Add warning msg when concat pointcloud is not published (autowarefoundation#388) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * add timeout notification stamp msgs (autowarefoundation#363) * add timeout notification stamp msgs * fix uncursify * delete timeout notification stamped * Revert "delete timeout notification stamped" This reverts commit 365d29209f6a7f5ec75eb80c5d8c2ef38daeae79. * fix message Co-authored-by: Taichi Higashide <taichi.higashide@tier4.jp> Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com> * modify pose_initialize for foa (autowarefoundation#382) * pose_initialize for foa (autowarefoundation#1171) * pose_initialize for foa Signed-off-by: Yamato ANDO <yamato.ando@gmail.com> * rename topic Signed-off-by: Yamato ANDO <yamato.ando@gmail.com> * fix topic name Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * Add autoware version node (autowarefoundation#394) * Add autoware version node Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Remove todo Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Remove unused variable Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix node name Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * fix typo (autowarefoundation#427) * Fix typo in common module (autowarefoundation#433) * Unify Apache-2.0 license name (autowarefoundation#1242) * Porting remote cmd selector (autowarefoundation#1286) * Feature/add remote cmd selector (autowarefoundation#1179) * Add in/out args of remote_cmd_converter.launch Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Change remote input topic of vehicle_cmd_gate Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add msgs for remote_cmd_selector Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add remote_cmd_selector Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Rename remote_cmd_selector to external_cmd_selector Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Remove VehicleCommand support in autoware_joy_controller Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Support external_cmd_source in autoware_joy_controller.launch (autowarefoundation#1194) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix porting miss Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * fix missing function * modify xml format * fix include guard * add callback group * modify remap name * Revert "modify remap name" This reverts commit 169cc8d28442825b1d61b0439b9892c913304527. * change topic name * use rclcpp_component * Remove autoware_debug_msgs from autoware_joy_controller Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Change default mode of autoware_joy_controller Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add perception traffic light state output (autowarefoundation#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> * Fix msgs (autowarefoundation#1379) * Fix msgs Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * [autoware_planning_rviz_plugin]: Fix lint Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> Co-authored-by: wep21 <border_goldenmarket@yahoo.co.jp> * Message refinement (autowarefoundation#1381) * Message refinement * Simplify CMakeLists.txt with ament cmake auto * Add test Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * [autoware_planning_msgs]: Fix dependency Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix package.xml Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix package.xml Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix ament_cmake_auto Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp> * Ros2/create/external commands (autowarefoundation#1299) * add remote message * add remote commands * fix topic * remove unnecessary topic * remove unused topic * add external cmd instead * ToExternalComd * fix topic in joy con * publish perception and external tl_state for mlops (autowarefoundation#1350) (autowarefoundation#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> * Add newlines Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add PR template (#3) * Add PR template Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Update PULL_REQUEST_TEMPLATE.md * Add CI (#4) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * change msg type looking traffic light state (autowarefoundation#1455) (#6) * 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> Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com> * Fix dependency type of rosidl_default_generators (autowarefoundation#15) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add auto-main-sync CI workflow for develop (autowarefoundation#16) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * add autoware_api_msgs (#12) Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * Feature/add virtual traffic light planner (#9) * Add VIRTUAL_TRAFFIC_LIGHT to StopReason.msg Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add VirtualTrafficLightState msgs to autoware_system_msgs Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add InfrastructureCommand msgs to autoware_planning_msgs Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix msgs Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Move messages to autoware_v2x_msgs Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix dependency type of rosidl_default_generators Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix dependency type of rosidl_default_generators (autowarefoundation#19) * Change CI docker images to setup-ros-docker (autowarefoundation#20) * Change CI docker images to setup-ros-docker Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Replace foxy with galactic Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add DEBIAN_FRONTEND=noninteractive to rosdep install (autowarefoundation#21) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Update colcon-package-selection in build_and_test_pr.yml (autowarefoundation#22) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * add autoware_simulation_msgs (#13) * add autoware_simulation_msgs * update event name * Add autoware api (autowarefoundation#29) * add autoware multimedia msgs Signed-off-by: tkhmy <tkh.my.p@gmail.com> * add newline Signed-off-by: tkhmy <tkh.my.p@gmail.com> * change name to autoware_hmi_msgs Signed-off-by: tkhmy <tkh.my.p@gmail.com> * Rename external select message (#8) * Rename external select message Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Add selector mode to unknown Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix selector mode constant Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix format Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Move control command messages to external api Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Add build dependency Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix CI Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> Co-authored-by: tkhmy <tkh.my.p@gmail.com> * Fix CI for develop branch (autowarefoundation#31) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * add emergency_holding flag to HazardStatus (autowarefoundation#25) * add EmergencyState.msg (autowarefoundation#32) * Add new workflow `sync-public.yaml` to sync with `AutowareArchitectureProposal_msgs` (autowarefoundation#35) * Add new workflow `sync-public.yaml` to sync with `AutowareArchitectureProposal_msgs` * Remove this workflow specific comments * Remove some this workflow specific comments * Rename `oss` to `public` * Replace branch name `main` to more generic description * Add line `fetch-depth: 0` (autowarefoundation#36) * Add EmergencyStateStamped.msg (autowarefoundation#38) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add sync-public-develop.yaml (autowarefoundation#42) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Change proposal sync app ID (autowarefoundation#44) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * add MultiArrayDimension/Layout, and update MultiArrayMsgs (autowarefoundation#28) * add MultiArrayDimension/Layout, and update MultiArrayMsgs * add kind of license * Feature/vehicle interface improvements (autowarefoundation#1361) (autowarefoundation#48) * add vehicle msg * add pacmod interface * add eps controller * use each control commands instead of vehicle command * fixed details * fixed speell check * const * fixed brake status * publish cmd when recieving ctrl cmd * fix shift cmd ptr * remove unused function and set proper license * fix names * fix typo for pacmod * remove unnecessary waiting * use flags, limit, multiarray * remove accel brake dependency * fix retrun value * replace eps to steer * cosmetic change for namespace * fix segfo and retval * Use Enum instead of int * remove unused var * add const * rename to calcFFMap * prev time steer calc * add sample csv * add new line Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com> * remove EmergencyMode and DricingCapability (autowarefoundation#33) * develop -> main sync (autowarefoundation#53) * Add detected object with feature (autowarefoundation#54) * Add detected object with feature Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * add autoware_auto_msgs Co-authored-by: wep21 <border_goldenmarket@yahoo.co.jp> * Revert "Add detected object with feature (autowarefoundation#54)" (autowarefoundation#57) This reverts commit 3fcfe9936361928256ed5ffa7d8a1ef4c978ca09. * Add detected object with feature (autowarefoundation#54) (autowarefoundation#59) (#4) * Add detected object with feature (autowarefoundation#54) (autowarefoundation#59) * Add detected object with feature Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * add autoware_auto_msgs Co-authored-by: wep21 <border_goldenmarket@yahoo.co.jp> Co-authored-by: wep21 <border_goldenmarket@yahoo.co.jp> * update build depends Co-authored-by: wep21 <border_goldenmarket@yahoo.co.jp> * Add message converter (autowarefoundation#58) * Add message converter * Move autoware state converter * add VehicleEmergency (autowarefoundation#55) * Add two convert method (autowarefoundation#64) * add convert method from iv_shift to auto_gear Signed-off-by: kosuke murakami <kosuke.murakami@tier4.jp> * remove space Signed-off-by: kosuke murakami <kosuke.murakami@tier4.jp> * add convert method from for turn & hazard signal Signed-off-by: kosuke murakami <kosuke.murakami@tier4.jp> * fix dependency of iv_auto_msgs converter (#8) Co-authored-by: Takayuki Murooka <takayuki.murooka@tier4.jp> * move actuation msg (autowarefoundation#66) * Revert "move actuation msg (autowarefoundation#66)" This reverts commit d8e3ccdcabacab819360cf399442950cc162a648. * merge autoware_localization_srvs to autoware_localization_msgs * rename pose_with_cov to pose_with_covariance * add steering wheel status stamped * fix: remove workflow and PR_TEMPLATE * fix: remove autoware_api_msgs dependency * ci(pre-commit): autofix Co-authored-by: Takagi, Isamu <43976882+isamu-takagi@users.noreply.github.com> Co-authored-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp> Co-authored-by: Kenji Miyake <31987104+kenji-miyake@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: wep21 <border_goldenmarket@yahoo.co.jp> Co-authored-by: Ryohsuke Mitsudome <43976834+mitsudome-r@users.noreply.github.com> Co-authored-by: Nikolai Morin <nnmmgit@gmail.com> Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com> Co-authored-by: Esteve Fernandez <esteve@apache.org> Co-authored-by: Servando <43142004+sgermanserrano@users.noreply.github.com> Co-authored-by: Taichi Higashide <taichi.higashide@tier4.jp> Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com> Co-authored-by: Shigeki Kobayashi <32808802+sgk-000@users.noreply.github.com> Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> Co-authored-by: Keisuke Shima <keisuke.shima@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: Keisuke Shima <19993104+KeisukeShima@users.noreply.github.com> Co-authored-by: tkhmy <tkh.my.p@gmail.com> Co-authored-by: Tatsuya Yamasaki <httperror@404-notfound.jp> Co-authored-by: Takayuki Murooka <takayuki5168@gmail.com> Co-authored-by: Kah Hooi Tan <41041286+tkhmy@users.noreply.github.com> Co-authored-by: Kosuke Murakami <kosuke.murakami@tier4.jp> Co-authored-by: Takayuki Murooka <takayuki.murooka@tier4.jp> Co-authored-by: tanaka3 <ttatcoder@outlook.jp> Co-authored-by: YamatoAndo <yamato.ando@gmail.com> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>
badai-nguyen
pushed a commit
to badai-nguyen/autoware.universe
that referenced
this pull request
Feb 4, 2022
* Feature/porting motion velocity smoother (autowarefoundation#1653) * Add motion_velocity_smoother (autowarefoundation#1333) * Refactor node and utilities * Fix utilities * Fix utilities * Fixing... * Runs with L2 smoother * Use boost::optional * Add Linf, JerkFiltered * JerkFiltered * Fix * Fix awapi * Fix bug * Add config files * Fix bug * Fix bug and apply clang-format * Remove unused variable * Fix bug * Change C-style cast to static_cast * Add destructors * Use smart pointers for members * Add test * Fix test code * Tmp: add L2 norm of jerk in objective function * Fix external velocity limit * Fix interpolate in velocity controller and remove prevent move to close stop line * add initial velocity and acceleration to the filter function * Fix index calculation * add new marge function * handle edge case * Tmp: skip osqp_interface build test * Revert get_modified_package.sh * Fix CI * Fix version of osqp * Fix * Add design docment (JPN) * Fix linear interpolation * Refactor node and utilities * Fix utilities * Fix utilities * Fixing... * Runs with L2 smoother * Use boost::optional * Add Linf, JerkFiltered * JerkFiltered * Fix * Fix awapi * Fix bug * Add config files * Fix bug * Fix bug and apply clang-format * Remove unused variable * Fix bug * Change C-style cast to static_cast * Add destructors * Use smart pointers for members * Add test * Fix test code * Tmp: add L2 norm of jerk in objective function * Fix external velocity limit * Fix interpolate in velocity controller and remove prevent move to close stop line * add initial velocity and acceleration to the filter function * Fix index calculation * add new marge function * handle edge case * Tmp: skip osqp_interface build test * Revert get_modified_package.sh * Fix CI * Fix version of osqp * Fix * Add design docment (JPN) * Fix linear interpolation * add new sample function * Fix * Revert velocity_controller * Reset motion_velocity_optimizer * Fix parameter setting * Refactor and fix bugs * Use autoware_utils * Fix doc and bug * Fix doc * Fix external velocity limit and parametrize margin and jerk weight * Fix typo * Fix typo and remove old readme * add stop point calculation and modify objective function * Add parameter handling functions and add namespace * Rename calcClosestTrajectoryPoint to calcInterpolatedTrajectoryPoint and remove unused function * Fix applyExternalVelocityLimit and fix comments * Fix variable name * Fix variable name * Fix yaml comment * Add const * Fix interpolaion * Remove run() and change type of prev_closest_point_ * Update planning/scenario_planning/common/motion_velocity_smoother/src/smoother/smoother_base.cpp Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> * fix stop point error * Fix linear interpolation and external velocity calculation * Remove debug code * Rename BaseParam * Remove unused func and fix misc * Fix package.xml, include, apply formatting * Fix external velocity limit * add debug calculation time * modify calculation time debugger * modify calculation time publisher * rescale the calculation time * Fix some problem * Update planning/scenario_planning/common/motion_velocity_smoother/launch/motion_velocity_smoother.launch Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> Co-authored-by: yutaka <purewater0901@gmail.com> Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> * Add Resample Procedure after the optimization in motion_velocity_smoother (autowarefoundation#1530) * do resample after the optimization * modify resample timing * add 0 at the end of the resampeld output trajectory * Manage parameters * Fix format * Fix format * Devide resample function in other file * Update default_motion_velocity_smoother.yaml * Update default_motion_velocity_smoother.yaml Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com> * Output debug trajectories in motion velocity smoother (autowarefoundation#1533) * add debug trajectory * add rqt_multiplot setting files * add calculation tiem visualization * guard emtpy output (autowarefoundation#1537) * Motion velocity smoother doc (autowarefoundation#1563) * Fix doc * Add english doc (tmp) * Add english file * Remove unused files * Fix * Fix typo * Modify 1-size trajectory handling & warning messages (autowarefoundation#1540) * add new guard to delete unnecessary message * change message * add warning messages * chnage message to warning * chnage to throttle * Fix jerk filter calculation (autowarefoundation#1593) * modify jerk filter calculation * remove unnecessary code * change the way of interp. of pose in smoother (autowarefoundation#1600) * Update smoother resampling (autowarefoundation#1595) * add new guard to delete unnecessary message * change message * add warning messages * chnage message to warning * chnage to throttle * modify jerk filter calculation * modify jerk filter calculation * separate resampling code * add new parameter * add new parameter to dynamic reconfigure * remove unnecessary code * add sampling before optimization * add const and blocker * change access to at * fix terminal length value * add comments * clean code * add comment * Fix/insert backward on reverse trajectory (autowarefoundation#1602) * remove unused code Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * move debug code Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix insert backward on reverse trajectory Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Porting motion velocity smoother to ros2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix launch and fix warning * pre-commit fixes * Remove unused argument * Comment out unused parameter Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Add distance threshold in motion_velocity_smoother (autowarefoundation#1659) * Add distance threshold * Remove parameters and use default value * Fix for pre-commit Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Support Non-zero Stop Point Acceleration (autowarefoundation#1651) * Support non-zero stop point acceleration * modify zero velocity id search function (autowarefoundation#1690) * modify zero velocity id search function * Fix resample function and error handling * Add comment Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com> * Apply lint Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * pre-commit fixes Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com> Co-authored-by: yutaka <purewater0901@gmail.com> Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> Co-authored-by: purewater0901 <43805014+purewater0901@users.noreply.github.com> Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com> Co-authored-by: pre-commit <pre-commit@example.com> * Feature/add trajectory_visualizer and closest_velocity_checker to motion_velocity_smoother (autowarefoundation#1820) * add trajectory_visualizer and closest_velocity_optimizer to motion_velocity_smoother. * Fix CMakeLists Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com> * Feature/port analytical smoother (autowarefoundation#1896) * Port analytical jerk constrained smoother Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Fix parameters format Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Resolve warnings and remove unnecessary processing Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Change default parameters Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Change slash to dot for declare_parameter Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Fix debug messages Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Change pragma once to ifndef and endif Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Add #include vector, utility and string Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Remove extra white spaces Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Fix acceleration calculation at type 3 Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Apply clang-format Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Change copyright format Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Fix to be less than 100 characters per line Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Implement and remove TODO Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Add include to src Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Use static_cast Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Follow uncrustify Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Disable uncrustify at include guard Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Disable uncrustify at include Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Follow uncrustify Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Fix include order error Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Fix typo Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Change index type to size_t Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Fix size_t Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Add const Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Fix parameter namespace signs from slash to dot and add latacc one Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * fix for createQuaternionFromRPY/Yaw (autowarefoundation#2154) * fix stop dist calc bug (autowarefoundation#2152) * use interpolation::slerp (autowarefoundation#2161) * Add post resampling explanations (autowarefoundation#2155) * Update motion_velocity_smoother-design.ja.md * Update motion_velocity_smoother-design.md * Feature/use external jerk/acc constraints (autowarefoundation#2130) * use external jerk/acc constraints * update VelocityLimit.msg * Feature/add external velocity limit selector (autowarefoundation#2217) * add external velocity limit selector * add README.md * improve document * apply document template * update external velocity limit selector & use commot params * update smoother & use commot params * update launch file * Fix/smoother params (autowarefoundation#2239) * Update velocity debug script (add vehicle engage check) (autowarefoundation#2267) * add vehicle engage Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix format Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * [motion_velocity_smoother] fix trajectory size guard condition (autowarefoundation#2297) * change condition for input trajectory validation chack Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * organize guard code into function Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Change formatter to clang-format and black (autowarefoundation#2332) * Revert "Temporarily comment out pre-commit hooks" This reverts commit 748e9cdb145ce12f8b520bcbd97f5ff899fc28a3. * Replace ament_lint_common with autoware_lint_common Signed-off-by: Kenji Miyake <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 (autowarefoundation#500) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * port motion velocity smoother (autowarefoundation#495) * Use autoware_auto_msgs * Fix bugs and apply clang-format * Remove COLCON_IGNORE * Rename TrajectoryPointArray to TrajectoryPoints, use conversion functions in autoware_utils * Apply clang-format * Use odometry * Fix document * rename to README.md (autowarefoundation#550) * rename to README.md * dealt with new auto_msgs format Co-authored-by: Takayuki Murooka <takayuki.murooka@tier4.jp> * update iv_msgs -> auto_msgs in planning readme (autowarefoundation#576) * update iv_msgs -> auto_msgs in planning readme * minor change * some fix * some fix Co-authored-by: Takayuki Murooka <takayuki.murooka@tier4.jp> * Back port .auto control packages (autowarefoundation#571) * Implement Lateral and Longitudinal Control Muxer * [autowarefoundation#570] Porting wf_simulator * [autowarefoundation#1189] Deactivate flaky test in 'trajectory_follower_nodes' * [autowarefoundation#1189] Fix flacky test in 'trajectory_follower_nodes/latlon_muxer' * [autowarefoundation#1057] Add osqp_interface package * [autowarefoundation#1057] Add library code for MPC-based lateral control * [autowarefoundation#1271] Use std::abs instead of abs * [autowarefoundation#1057] Implement Lateral Controller for Cargo ODD * [autowarefoundation#1246] Resolve "Test case names currently use snake_case but should be CamelCase" * [autowarefoundation#1325] Deactivate flaky smoke test in 'trajectory_follower_nodes' * [autowarefoundation#1058] Add library code of longitudinal controller * Fix build error for trajectory follower Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix build error for trajectory follower nodes Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * [autowarefoundation#1272] Add AckermannControlCommand support to simple_planning_simulator * [autowarefoundation#1058] Add Longitudinal Controller node * [autowarefoundation#1058] Rename velocity_controller -> longitudinal_controller * [autowarefoundation#1058] Update CMakeLists.txt for the longitudinal_controller_node * [autowarefoundation#1058] Add smoke test python launch file * [autowarefoundation#1058] Use LowPassFilter1d from trajectory_follower * [autowarefoundation#1058] Use autoware_auto_msgs * [autowarefoundation#1058] Changes for .auto (debug msg tmp fix, common func, tf listener) * [autowarefoundation#1058] Remove unused parameters * [autowarefoundation#1058] Fix ros test * [autowarefoundation#1058] Rm default params from declare_parameters + use autoware types * [autowarefoundation#1058] Use default param file to setup NodeOptions in the ros test * [autowarefoundation#1058] Fix docstring * [autowarefoundation#1058] Replace receiving a Twist with a VehicleKinematicState * [autowarefoundation#1058] Change class variables format to m_ prefix * [autowarefoundation#1058] Fix plugin name of LongitudinalController in CMakeLists.txt * [autowarefoundation#1058] Fix copyright dates * [autowarefoundation#1058] Reorder includes * [autowarefoundation#1058] Add some tests (~89% coverage without disabling flaky tests) * [autowarefoundation#1058] Add more tests (90+% coverage without disabling flaky tests) * [autowarefoundation#1058] Use Float32MultiArrayDiagnostic message for debug and slope * [autowarefoundation#1058] Calculate wheel_base value from vehicle parameters * [autowarefoundation#1058] Cleanup redundant logger setting in tests * [autowarefoundation#1058] Set ROS_DOMAIN_ID when running tests to prevent CI failures * [autowarefoundation#1058] Remove TF listener and use published vehicle state instead * [autowarefoundation#1058] Change smoke tests to use autoware_testing * [autowarefoundation#1058] Add plotjuggler cfg for both lateral and longitudinal control * [autowarefoundation#1058] Improve design documents * [autowarefoundation#1058] Disable flaky test * [autowarefoundation#1058] Properly transform vehicle state in longitudinal node * [autowarefoundation#1058] Fix TF buffer of lateral controller * [autowarefoundation#1058] Tuning of lateral controller for LGSVL * [autowarefoundation#1058] Fix formating * [autowarefoundation#1058] Fix /tf_static sub to be transient_local * [autowarefoundation#1058] Fix yaw recalculation of reverse trajs in the lateral controller * modify trajectory_follower for galactic build Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * [autowarefoundation#1379] Update trajectory_follower * [autowarefoundation#1379] Update simple_planning_simulator * [autowarefoundation#1379] Update trajectory_follower_nodes * apply trajectory msg modification in control Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * move directory Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * remote control/trajectory_follower level dorectpry Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * remove .iv trajectory follower Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * use .auto trajectory_follower Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * remove .iv simple_planning_simulator & osqp_interface Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * use .iv simple_planning_simulator & osqp_interface Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * add tmp_autoware_auto_dependencies Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * tmporally add autoware_auto_msgs Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * apply .auto message split Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix build depend Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix packages using osqp * fix autoware_auto_geometry * ignore lint of some packages * ignore ament_lint of some packages * ignore lint/pre-commit of trajectory_follower_nodes * disable unit tests of some packages Co-authored-by: Maxime CLEMENT <maxime.clement@tier4.jp> Co-authored-by: Joshua Whitley <josh.whitley@autoware.org> Co-authored-by: Igor Bogoslavskyi <igor.bogoslavskyi@gmail.com> Co-authored-by: MIURA Yasuyuki <kokosabu@gmail.com> Co-authored-by: wep21 <border_goldenmarket@yahoo.co.jp> Co-authored-by: tomoya.kimura <tomoya.kimura@tier4.jp> * [planning module]fix bug (autowarefoundation#643) * fix topic name * remove angular z from LinearInterpolation in motion_velocity_smoother * FIx vehicle status topic name/type (autowarefoundation#658) * shift -> gear_status * twist -> velocity_status * port closest velocity checker (autowarefoundation#672) Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * port trajectory visualizer (autowarefoundation#682) Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * add header for debug trajectories (autowarefoundation#681) Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Sync .auto branch with the latest branch in internal repository (autowarefoundation#691) * add trajectory point offset in rviz plugin (autowarefoundation#2270) * sync rc rc/v0.23.0 (autowarefoundation#2258) * fix interpolation for insert point (autowarefoundation#2228) * fix interpolation for insert point * to prev interpolation pkg * Revert "to prev interpolation pkg" This reverts commit 9eb145b5d36e297186015fb17c267ccd5b3c21ef. Co-authored-by: taikitanaka3 <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> * fix osqp link (autowarefoundation#700) * Update twist topic name (autowarefoundation#736) Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * rename readme.ja * add default parameter file Co-authored-by: Daisuke Nishimatsu <42202095+wep21@users.noreply.github.com> Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com> Co-authored-by: yutaka <purewater0901@gmail.com> Co-authored-by: purewater0901 <43805014+purewater0901@users.noreply.github.com> Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com> Co-authored-by: pre-commit <pre-commit@example.com> Co-authored-by: td12321 <85976747+td12321@users.noreply.github.com> Co-authored-by: Makoto Kurihara <mkuri8m@gmail.com> Co-authored-by: Takayuki Murooka <takayuki5168@gmail.com> Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com> Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> Co-authored-by: Takayuki Murooka <takayuki.murooka@tier4.jp> Co-authored-by: Maxime CLEMENT <maxime.clement@tier4.jp> Co-authored-by: Joshua Whitley <josh.whitley@autoware.org> Co-authored-by: Igor Bogoslavskyi <igor.bogoslavskyi@gmail.com> Co-authored-by: MIURA Yasuyuki <kokosabu@gmail.com> Co-authored-by: wep21 <border_goldenmarket@yahoo.co.jp> 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: Takeshi Miura <57553950+1222-takeshi@users.noreply.github.com> Co-authored-by: Takeshi Ishita <ishitah.takeshi@gmail.com> Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> Co-authored-by: Yukihiro Saito <yukky.saito@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> Co-authored-by: Kosuke Murakami <kosuke.murakami@tier4.jp>
badai-nguyen
pushed a commit
to badai-nguyen/autoware.universe
that referenced
this pull request
Feb 4, 2022
* Initial commit * release v0.4.0 * Feature/stop reason (autowarefoundation#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> * Support error in autoware state (autowarefoundation#728) * Support Error in autoware_state_monitor Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Refactor autoware_state_monitor Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Wait after planning completed Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Integrate FailedToArriveGoal and Error into Emergency state Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * 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> * Revert "Publish tl states stamped (autowarefoundation#744)" (autowarefoundation#771) This reverts commit 35a7e29e987afb29d9348b5f64866a584a65f753. * Fix/publish tl state stamped (autowarefoundation#772) * 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> * Feature/add stop reason lane change (autowarefoundation#769) * add stop reason of lane change planner * add stop factor of blocked by obstacle * delete typo * add const * delete unnecessary namespace * remove ROS1 packages temporarily Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * add sample ros2 packages Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * Add ros2 perception msgs Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix dependency issue in autoware_control_msgs (autowarefoundation#22) Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * Port vehicle_cmd_gate to ROS2 (#3) * Port vehicle_cmd_gate to ROS2 * Sim-time-respecting timer * add autoware_debug_msg (autowarefoundation#54) * add autoware_debug_msg Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * rename to *stamped Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Fix format version (autowarefoundation#73) * port motion_velocity_optimizer (autowarefoundation#77) * port motion_velocity_optimizer Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix for warning Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix blockUntilVehiclePositionAvailable() Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Port of obstacle avoidance planner to ROS2 (autowarefoundation#83) * Port to ROS2 Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Removed ros/console include Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Added THROTTLE Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Changed numbers to floats Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Removed <double> from params Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Added new msg Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Use new msg Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Replaced dynamic reconfigure Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Added EnableAvoidance.msg Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Fixed parameter mismatch Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Port behavior_velocity_planner to ROS2 (autowarefoundation#80) * Revert "Add geometry2 to repos (autowarefoundation#76)" This reverts commit 6d22704. * 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 v0.8.0 awapi and system msgs (autowarefoundation#274) * Ros2 v0.8.0 engage (autowarefoundation#342) * [autoware_vehicle_msgs]: Add engage message Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * [as]: Update message Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * [awapi_awiv_adapter]: Update message Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * [web_controller]: Update message Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * [vehicle_cmd_gate]: Update message Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * [autoware_state_monitor]: Update message Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * [autoware_control_msgs]: Remove EngageMode message Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * [simple_planning_simulator]: Update message Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Ros2 v0.8.0 lane_change_planner (autowarefoundation#322) * Remove lane_change_planner v0.5 Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Import lane_change_planner v0.8 (ROS1) Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Modify header files * Remove header disable * Modify msg namespace * Modify time type * Modify pub/sub class * Modify node handle, etc. * Modify ConstPtr * Modify entry point * Modify time and publisher * Modify parameter, timer, and subscription * Modify data manager * Modify route handler * Modify state machine * Modify utility * Fix arguments * Modify states part1 * Modify states part2 * Modify common function * Fix for lint * Fix for lint * Modify comment type * Add copyright * Use duration from_seconds * Use double quotes for non-system headers * Fix include order Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Replace std_msgs Bool Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix line length Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix latch topic subscription Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix stamp initialization and reference Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Add super class destructor and fix waitForData Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Ros2 v0.8.0 remove std msgs awapi (autowarefoundation#348) * [autoware_vehicle_msgs] add BatteryStatus msg Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * [autoware_planning_msgs] add ExpandStopRange and StopSpeedExceeded messages Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * [autoware_api_msgs] add DoorControlCommand, StopCommand, and VelocityLimit messages Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * remove std_msgs related to autoware_awaiv_adapter node Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * apply ament_uncrustify Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * fix build failure Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * fix test failures Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * address review commends Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * Sync with Ros2 v0.8.0 beta (autowarefoundation#393) * add nullptr check when publish concatenate data (autowarefoundation#369) * Add warning msg when concat pointcloud is not published (autowarefoundation#388) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * add timeout notification stamp msgs (autowarefoundation#363) * add timeout notification stamp msgs * fix uncursify * delete timeout notification stamped * Revert "delete timeout notification stamped" This reverts commit 365d29209f6a7f5ec75eb80c5d8c2ef38daeae79. * fix message Co-authored-by: Taichi Higashide <taichi.higashide@tier4.jp> Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com> * modify pose_initialize for foa (autowarefoundation#382) * pose_initialize for foa (autowarefoundation#1171) * pose_initialize for foa Signed-off-by: Yamato ANDO <yamato.ando@gmail.com> * rename topic Signed-off-by: Yamato ANDO <yamato.ando@gmail.com> * fix topic name Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * Add autoware version node (autowarefoundation#394) * Add autoware version node Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Remove todo Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Remove unused variable Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix node name Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * fix typo (autowarefoundation#427) * Fix typo in common module (autowarefoundation#433) * Unify Apache-2.0 license name (autowarefoundation#1242) * Porting remote cmd selector (autowarefoundation#1286) * Feature/add remote cmd selector (autowarefoundation#1179) * Add in/out args of remote_cmd_converter.launch Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Change remote input topic of vehicle_cmd_gate Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add msgs for remote_cmd_selector Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add remote_cmd_selector Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Rename remote_cmd_selector to external_cmd_selector Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Remove VehicleCommand support in autoware_joy_controller Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Support external_cmd_source in autoware_joy_controller.launch (autowarefoundation#1194) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix porting miss Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * fix missing function * modify xml format * fix include guard * add callback group * modify remap name * Revert "modify remap name" This reverts commit 169cc8d28442825b1d61b0439b9892c913304527. * change topic name * use rclcpp_component * Remove autoware_debug_msgs from autoware_joy_controller Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Change default mode of autoware_joy_controller Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add perception traffic light state output (autowarefoundation#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> * Fix msgs (autowarefoundation#1379) * Fix msgs Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * [autoware_planning_rviz_plugin]: Fix lint Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> Co-authored-by: wep21 <border_goldenmarket@yahoo.co.jp> * Message refinement (autowarefoundation#1381) * Message refinement * Simplify CMakeLists.txt with ament cmake auto * Add test Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * [autoware_planning_msgs]: Fix dependency Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix package.xml Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix package.xml Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix ament_cmake_auto Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp> * Ros2/create/external commands (autowarefoundation#1299) * add remote message * add remote commands * fix topic * remove unnecessary topic * remove unused topic * add external cmd instead * ToExternalComd * fix topic in joy con * publish perception and external tl_state for mlops (autowarefoundation#1350) (autowarefoundation#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> * Add newlines Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add PR template (#3) * Add PR template Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Update PULL_REQUEST_TEMPLATE.md * Add CI (#4) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * change msg type looking traffic light state (autowarefoundation#1455) (#6) * 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> Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com> * Fix dependency type of rosidl_default_generators (autowarefoundation#15) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add auto-main-sync CI workflow for develop (autowarefoundation#16) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * add autoware_api_msgs (#12) Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * Feature/add virtual traffic light planner (#9) * Add VIRTUAL_TRAFFIC_LIGHT to StopReason.msg Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add VirtualTrafficLightState msgs to autoware_system_msgs Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add InfrastructureCommand msgs to autoware_planning_msgs Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix msgs Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Move messages to autoware_v2x_msgs Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix dependency type of rosidl_default_generators Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix dependency type of rosidl_default_generators (autowarefoundation#19) * Change CI docker images to setup-ros-docker (autowarefoundation#20) * Change CI docker images to setup-ros-docker Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Replace foxy with galactic Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add DEBIAN_FRONTEND=noninteractive to rosdep install (autowarefoundation#21) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Update colcon-package-selection in build_and_test_pr.yml (autowarefoundation#22) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * add autoware_simulation_msgs (#13) * add autoware_simulation_msgs * update event name * Add autoware api (autowarefoundation#29) * add autoware multimedia msgs Signed-off-by: tkhmy <tkh.my.p@gmail.com> * add newline Signed-off-by: tkhmy <tkh.my.p@gmail.com> * change name to autoware_hmi_msgs Signed-off-by: tkhmy <tkh.my.p@gmail.com> * Rename external select message (#8) * Rename external select message Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Add selector mode to unknown Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix selector mode constant Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix format Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Move control command messages to external api Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Add build dependency Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix CI Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> Co-authored-by: tkhmy <tkh.my.p@gmail.com> * Fix CI for develop branch (autowarefoundation#31) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * add emergency_holding flag to HazardStatus (autowarefoundation#25) * add EmergencyState.msg (autowarefoundation#32) * Add new workflow `sync-public.yaml` to sync with `AutowareArchitectureProposal_msgs` (autowarefoundation#35) * Add new workflow `sync-public.yaml` to sync with `AutowareArchitectureProposal_msgs` * Remove this workflow specific comments * Remove some this workflow specific comments * Rename `oss` to `public` * Replace branch name `main` to more generic description * Add line `fetch-depth: 0` (autowarefoundation#36) * Add EmergencyStateStamped.msg (autowarefoundation#38) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add sync-public-develop.yaml (autowarefoundation#42) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Change proposal sync app ID (autowarefoundation#44) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * add MultiArrayDimension/Layout, and update MultiArrayMsgs (autowarefoundation#28) * add MultiArrayDimension/Layout, and update MultiArrayMsgs * add kind of license * Feature/vehicle interface improvements (autowarefoundation#1361) (autowarefoundation#48) * add vehicle msg * add pacmod interface * add eps controller * use each control commands instead of vehicle command * fixed details * fixed speell check * const * fixed brake status * publish cmd when recieving ctrl cmd * fix shift cmd ptr * remove unused function and set proper license * fix names * fix typo for pacmod * remove unnecessary waiting * use flags, limit, multiarray * remove accel brake dependency * fix retrun value * replace eps to steer * cosmetic change for namespace * fix segfo and retval * Use Enum instead of int * remove unused var * add const * rename to calcFFMap * prev time steer calc * add sample csv * add new line Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com> * remove EmergencyMode and DricingCapability (autowarefoundation#33) * develop -> main sync (autowarefoundation#53) * Add detected object with feature (autowarefoundation#54) * Add detected object with feature Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * add autoware_auto_msgs Co-authored-by: wep21 <border_goldenmarket@yahoo.co.jp> * Revert "Add detected object with feature (autowarefoundation#54)" (autowarefoundation#57) This reverts commit 3fcfe9936361928256ed5ffa7d8a1ef4c978ca09. * Add detected object with feature (autowarefoundation#54) (autowarefoundation#59) (#4) * Add detected object with feature (autowarefoundation#54) (autowarefoundation#59) * Add detected object with feature Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * add autoware_auto_msgs Co-authored-by: wep21 <border_goldenmarket@yahoo.co.jp> Co-authored-by: wep21 <border_goldenmarket@yahoo.co.jp> * update build depends Co-authored-by: wep21 <border_goldenmarket@yahoo.co.jp> * Add message converter (autowarefoundation#58) * Add message converter * Move autoware state converter * add VehicleEmergency (autowarefoundation#55) * Add two convert method (autowarefoundation#64) * add convert method from iv_shift to auto_gear Signed-off-by: kosuke murakami <kosuke.murakami@tier4.jp> * remove space Signed-off-by: kosuke murakami <kosuke.murakami@tier4.jp> * add convert method from for turn & hazard signal Signed-off-by: kosuke murakami <kosuke.murakami@tier4.jp> * fix dependency of iv_auto_msgs converter (#8) Co-authored-by: Takayuki Murooka <takayuki.murooka@tier4.jp> * move actuation msg (autowarefoundation#66) * Revert "move actuation msg (autowarefoundation#66)" This reverts commit d8e3ccdcabacab819360cf399442950cc162a648. * merge autoware_localization_srvs to autoware_localization_msgs * rename pose_with_cov to pose_with_covariance * add steering wheel status stamped * fix: remove workflow and PR_TEMPLATE * fix: remove autoware_api_msgs dependency * ci(pre-commit): autofix Co-authored-by: Takagi, Isamu <43976882+isamu-takagi@users.noreply.github.com> Co-authored-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp> Co-authored-by: Kenji Miyake <31987104+kenji-miyake@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: wep21 <border_goldenmarket@yahoo.co.jp> Co-authored-by: Ryohsuke Mitsudome <43976834+mitsudome-r@users.noreply.github.com> Co-authored-by: Nikolai Morin <nnmmgit@gmail.com> Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com> Co-authored-by: Esteve Fernandez <esteve@apache.org> Co-authored-by: Servando <43142004+sgermanserrano@users.noreply.github.com> Co-authored-by: Taichi Higashide <taichi.higashide@tier4.jp> Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com> Co-authored-by: Shigeki Kobayashi <32808802+sgk-000@users.noreply.github.com> Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> Co-authored-by: Keisuke Shima <keisuke.shima@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: Keisuke Shima <19993104+KeisukeShima@users.noreply.github.com> Co-authored-by: tkhmy <tkh.my.p@gmail.com> Co-authored-by: Tatsuya Yamasaki <httperror@404-notfound.jp> Co-authored-by: Takayuki Murooka <takayuki5168@gmail.com> Co-authored-by: Kah Hooi Tan <41041286+tkhmy@users.noreply.github.com> Co-authored-by: Kosuke Murakami <kosuke.murakami@tier4.jp> Co-authored-by: Takayuki Murooka <takayuki.murooka@tier4.jp> Co-authored-by: tanaka3 <ttatcoder@outlook.jp> Co-authored-by: YamatoAndo <yamato.ando@gmail.com> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>
badai-nguyen
pushed a commit
to badai-nguyen/autoware.universe
that referenced
this pull request
Feb 4, 2022
* Feature/porting motion velocity smoother (autowarefoundation#1653) * Add motion_velocity_smoother (autowarefoundation#1333) * Refactor node and utilities * Fix utilities * Fix utilities * Fixing... * Runs with L2 smoother * Use boost::optional * Add Linf, JerkFiltered * JerkFiltered * Fix * Fix awapi * Fix bug * Add config files * Fix bug * Fix bug and apply clang-format * Remove unused variable * Fix bug * Change C-style cast to static_cast * Add destructors * Use smart pointers for members * Add test * Fix test code * Tmp: add L2 norm of jerk in objective function * Fix external velocity limit * Fix interpolate in velocity controller and remove prevent move to close stop line * add initial velocity and acceleration to the filter function * Fix index calculation * add new marge function * handle edge case * Tmp: skip osqp_interface build test * Revert get_modified_package.sh * Fix CI * Fix version of osqp * Fix * Add design docment (JPN) * Fix linear interpolation * Refactor node and utilities * Fix utilities * Fix utilities * Fixing... * Runs with L2 smoother * Use boost::optional * Add Linf, JerkFiltered * JerkFiltered * Fix * Fix awapi * Fix bug * Add config files * Fix bug * Fix bug and apply clang-format * Remove unused variable * Fix bug * Change C-style cast to static_cast * Add destructors * Use smart pointers for members * Add test * Fix test code * Tmp: add L2 norm of jerk in objective function * Fix external velocity limit * Fix interpolate in velocity controller and remove prevent move to close stop line * add initial velocity and acceleration to the filter function * Fix index calculation * add new marge function * handle edge case * Tmp: skip osqp_interface build test * Revert get_modified_package.sh * Fix CI * Fix version of osqp * Fix * Add design docment (JPN) * Fix linear interpolation * add new sample function * Fix * Revert velocity_controller * Reset motion_velocity_optimizer * Fix parameter setting * Refactor and fix bugs * Use autoware_utils * Fix doc and bug * Fix doc * Fix external velocity limit and parametrize margin and jerk weight * Fix typo * Fix typo and remove old readme * add stop point calculation and modify objective function * Add parameter handling functions and add namespace * Rename calcClosestTrajectoryPoint to calcInterpolatedTrajectoryPoint and remove unused function * Fix applyExternalVelocityLimit and fix comments * Fix variable name * Fix variable name * Fix yaml comment * Add const * Fix interpolaion * Remove run() and change type of prev_closest_point_ * Update planning/scenario_planning/common/motion_velocity_smoother/src/smoother/smoother_base.cpp Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> * fix stop point error * Fix linear interpolation and external velocity calculation * Remove debug code * Rename BaseParam * Remove unused func and fix misc * Fix package.xml, include, apply formatting * Fix external velocity limit * add debug calculation time * modify calculation time debugger * modify calculation time publisher * rescale the calculation time * Fix some problem * Update planning/scenario_planning/common/motion_velocity_smoother/launch/motion_velocity_smoother.launch Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> Co-authored-by: yutaka <purewater0901@gmail.com> Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> * Add Resample Procedure after the optimization in motion_velocity_smoother (autowarefoundation#1530) * do resample after the optimization * modify resample timing * add 0 at the end of the resampeld output trajectory * Manage parameters * Fix format * Fix format * Devide resample function in other file * Update default_motion_velocity_smoother.yaml * Update default_motion_velocity_smoother.yaml Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com> * Output debug trajectories in motion velocity smoother (autowarefoundation#1533) * add debug trajectory * add rqt_multiplot setting files * add calculation tiem visualization * guard emtpy output (autowarefoundation#1537) * Motion velocity smoother doc (autowarefoundation#1563) * Fix doc * Add english doc (tmp) * Add english file * Remove unused files * Fix * Fix typo * Modify 1-size trajectory handling & warning messages (autowarefoundation#1540) * add new guard to delete unnecessary message * change message * add warning messages * chnage message to warning * chnage to throttle * Fix jerk filter calculation (autowarefoundation#1593) * modify jerk filter calculation * remove unnecessary code * change the way of interp. of pose in smoother (autowarefoundation#1600) * Update smoother resampling (autowarefoundation#1595) * add new guard to delete unnecessary message * change message * add warning messages * chnage message to warning * chnage to throttle * modify jerk filter calculation * modify jerk filter calculation * separate resampling code * add new parameter * add new parameter to dynamic reconfigure * remove unnecessary code * add sampling before optimization * add const and blocker * change access to at * fix terminal length value * add comments * clean code * add comment * Fix/insert backward on reverse trajectory (autowarefoundation#1602) * remove unused code Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * move debug code Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix insert backward on reverse trajectory Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Porting motion velocity smoother to ros2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix launch and fix warning * pre-commit fixes * Remove unused argument * Comment out unused parameter Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Add distance threshold in motion_velocity_smoother (autowarefoundation#1659) * Add distance threshold * Remove parameters and use default value * Fix for pre-commit Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Support Non-zero Stop Point Acceleration (autowarefoundation#1651) * Support non-zero stop point acceleration * modify zero velocity id search function (autowarefoundation#1690) * modify zero velocity id search function * Fix resample function and error handling * Add comment Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com> * Apply lint Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * pre-commit fixes Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com> Co-authored-by: yutaka <purewater0901@gmail.com> Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> Co-authored-by: purewater0901 <43805014+purewater0901@users.noreply.github.com> Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com> Co-authored-by: pre-commit <pre-commit@example.com> * Feature/add trajectory_visualizer and closest_velocity_checker to motion_velocity_smoother (autowarefoundation#1820) * add trajectory_visualizer and closest_velocity_optimizer to motion_velocity_smoother. * Fix CMakeLists Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com> * Feature/port analytical smoother (autowarefoundation#1896) * Port analytical jerk constrained smoother Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Fix parameters format Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Resolve warnings and remove unnecessary processing Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Change default parameters Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Change slash to dot for declare_parameter Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Fix debug messages Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Change pragma once to ifndef and endif Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Add #include vector, utility and string Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Remove extra white spaces Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Fix acceleration calculation at type 3 Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Apply clang-format Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Change copyright format Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Fix to be less than 100 characters per line Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Implement and remove TODO Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Add include to src Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Use static_cast Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Follow uncrustify Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Disable uncrustify at include guard Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Disable uncrustify at include Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Follow uncrustify Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Fix include order error Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Fix typo Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Change index type to size_t Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Fix size_t Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Add const Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Fix parameter namespace signs from slash to dot and add latacc one Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * fix for createQuaternionFromRPY/Yaw (autowarefoundation#2154) * fix stop dist calc bug (autowarefoundation#2152) * use interpolation::slerp (autowarefoundation#2161) * Add post resampling explanations (autowarefoundation#2155) * Update motion_velocity_smoother-design.ja.md * Update motion_velocity_smoother-design.md * Feature/use external jerk/acc constraints (autowarefoundation#2130) * use external jerk/acc constraints * update VelocityLimit.msg * Feature/add external velocity limit selector (autowarefoundation#2217) * add external velocity limit selector * add README.md * improve document * apply document template * update external velocity limit selector & use commot params * update smoother & use commot params * update launch file * Fix/smoother params (autowarefoundation#2239) * Update velocity debug script (add vehicle engage check) (autowarefoundation#2267) * add vehicle engage Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix format Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * [motion_velocity_smoother] fix trajectory size guard condition (autowarefoundation#2297) * change condition for input trajectory validation chack Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * organize guard code into function Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Change formatter to clang-format and black (autowarefoundation#2332) * Revert "Temporarily comment out pre-commit hooks" This reverts commit 748e9cdb145ce12f8b520bcbd97f5ff899fc28a3. * Replace ament_lint_common with autoware_lint_common Signed-off-by: Kenji Miyake <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 (autowarefoundation#500) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * port motion velocity smoother (autowarefoundation#495) * Use autoware_auto_msgs * Fix bugs and apply clang-format * Remove COLCON_IGNORE * Rename TrajectoryPointArray to TrajectoryPoints, use conversion functions in autoware_utils * Apply clang-format * Use odometry * Fix document * rename to README.md (autowarefoundation#550) * rename to README.md * dealt with new auto_msgs format Co-authored-by: Takayuki Murooka <takayuki.murooka@tier4.jp> * update iv_msgs -> auto_msgs in planning readme (autowarefoundation#576) * update iv_msgs -> auto_msgs in planning readme * minor change * some fix * some fix Co-authored-by: Takayuki Murooka <takayuki.murooka@tier4.jp> * Back port .auto control packages (autowarefoundation#571) * Implement Lateral and Longitudinal Control Muxer * [autowarefoundation#570] Porting wf_simulator * [autowarefoundation#1189] Deactivate flaky test in 'trajectory_follower_nodes' * [autowarefoundation#1189] Fix flacky test in 'trajectory_follower_nodes/latlon_muxer' * [autowarefoundation#1057] Add osqp_interface package * [autowarefoundation#1057] Add library code for MPC-based lateral control * [autowarefoundation#1271] Use std::abs instead of abs * [autowarefoundation#1057] Implement Lateral Controller for Cargo ODD * [autowarefoundation#1246] Resolve "Test case names currently use snake_case but should be CamelCase" * [autowarefoundation#1325] Deactivate flaky smoke test in 'trajectory_follower_nodes' * [autowarefoundation#1058] Add library code of longitudinal controller * Fix build error for trajectory follower Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix build error for trajectory follower nodes Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * [autowarefoundation#1272] Add AckermannControlCommand support to simple_planning_simulator * [autowarefoundation#1058] Add Longitudinal Controller node * [autowarefoundation#1058] Rename velocity_controller -> longitudinal_controller * [autowarefoundation#1058] Update CMakeLists.txt for the longitudinal_controller_node * [autowarefoundation#1058] Add smoke test python launch file * [autowarefoundation#1058] Use LowPassFilter1d from trajectory_follower * [autowarefoundation#1058] Use autoware_auto_msgs * [autowarefoundation#1058] Changes for .auto (debug msg tmp fix, common func, tf listener) * [autowarefoundation#1058] Remove unused parameters * [autowarefoundation#1058] Fix ros test * [autowarefoundation#1058] Rm default params from declare_parameters + use autoware types * [autowarefoundation#1058] Use default param file to setup NodeOptions in the ros test * [autowarefoundation#1058] Fix docstring * [autowarefoundation#1058] Replace receiving a Twist with a VehicleKinematicState * [autowarefoundation#1058] Change class variables format to m_ prefix * [autowarefoundation#1058] Fix plugin name of LongitudinalController in CMakeLists.txt * [autowarefoundation#1058] Fix copyright dates * [autowarefoundation#1058] Reorder includes * [autowarefoundation#1058] Add some tests (~89% coverage without disabling flaky tests) * [autowarefoundation#1058] Add more tests (90+% coverage without disabling flaky tests) * [autowarefoundation#1058] Use Float32MultiArrayDiagnostic message for debug and slope * [autowarefoundation#1058] Calculate wheel_base value from vehicle parameters * [autowarefoundation#1058] Cleanup redundant logger setting in tests * [autowarefoundation#1058] Set ROS_DOMAIN_ID when running tests to prevent CI failures * [autowarefoundation#1058] Remove TF listener and use published vehicle state instead * [autowarefoundation#1058] Change smoke tests to use autoware_testing * [autowarefoundation#1058] Add plotjuggler cfg for both lateral and longitudinal control * [autowarefoundation#1058] Improve design documents * [autowarefoundation#1058] Disable flaky test * [autowarefoundation#1058] Properly transform vehicle state in longitudinal node * [autowarefoundation#1058] Fix TF buffer of lateral controller * [autowarefoundation#1058] Tuning of lateral controller for LGSVL * [autowarefoundation#1058] Fix formating * [autowarefoundation#1058] Fix /tf_static sub to be transient_local * [autowarefoundation#1058] Fix yaw recalculation of reverse trajs in the lateral controller * modify trajectory_follower for galactic build Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * [autowarefoundation#1379] Update trajectory_follower * [autowarefoundation#1379] Update simple_planning_simulator * [autowarefoundation#1379] Update trajectory_follower_nodes * apply trajectory msg modification in control Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * move directory Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * remote control/trajectory_follower level dorectpry Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * remove .iv trajectory follower Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * use .auto trajectory_follower Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * remove .iv simple_planning_simulator & osqp_interface Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * use .iv simple_planning_simulator & osqp_interface Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * add tmp_autoware_auto_dependencies Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * tmporally add autoware_auto_msgs Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * apply .auto message split Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix build depend Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix packages using osqp * fix autoware_auto_geometry * ignore lint of some packages * ignore ament_lint of some packages * ignore lint/pre-commit of trajectory_follower_nodes * disable unit tests of some packages Co-authored-by: Maxime CLEMENT <maxime.clement@tier4.jp> Co-authored-by: Joshua Whitley <josh.whitley@autoware.org> Co-authored-by: Igor Bogoslavskyi <igor.bogoslavskyi@gmail.com> Co-authored-by: MIURA Yasuyuki <kokosabu@gmail.com> Co-authored-by: wep21 <border_goldenmarket@yahoo.co.jp> Co-authored-by: tomoya.kimura <tomoya.kimura@tier4.jp> * [planning module]fix bug (autowarefoundation#643) * fix topic name * remove angular z from LinearInterpolation in motion_velocity_smoother * FIx vehicle status topic name/type (autowarefoundation#658) * shift -> gear_status * twist -> velocity_status * port closest velocity checker (autowarefoundation#672) Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * port trajectory visualizer (autowarefoundation#682) Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * add header for debug trajectories (autowarefoundation#681) Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Sync .auto branch with the latest branch in internal repository (autowarefoundation#691) * add trajectory point offset in rviz plugin (autowarefoundation#2270) * sync rc rc/v0.23.0 (autowarefoundation#2258) * fix interpolation for insert point (autowarefoundation#2228) * fix interpolation for insert point * to prev interpolation pkg * Revert "to prev interpolation pkg" This reverts commit 9eb145b5d36e297186015fb17c267ccd5b3c21ef. Co-authored-by: taikitanaka3 <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> * fix osqp link (autowarefoundation#700) * Update twist topic name (autowarefoundation#736) Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * rename readme.ja * add default parameter file Co-authored-by: Daisuke Nishimatsu <42202095+wep21@users.noreply.github.com> Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com> Co-authored-by: yutaka <purewater0901@gmail.com> Co-authored-by: purewater0901 <43805014+purewater0901@users.noreply.github.com> Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com> Co-authored-by: pre-commit <pre-commit@example.com> Co-authored-by: td12321 <85976747+td12321@users.noreply.github.com> Co-authored-by: Makoto Kurihara <mkuri8m@gmail.com> Co-authored-by: Takayuki Murooka <takayuki5168@gmail.com> Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com> Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> Co-authored-by: Takayuki Murooka <takayuki.murooka@tier4.jp> Co-authored-by: Maxime CLEMENT <maxime.clement@tier4.jp> Co-authored-by: Joshua Whitley <josh.whitley@autoware.org> Co-authored-by: Igor Bogoslavskyi <igor.bogoslavskyi@gmail.com> Co-authored-by: MIURA Yasuyuki <kokosabu@gmail.com> Co-authored-by: wep21 <border_goldenmarket@yahoo.co.jp> 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: Takeshi Miura <57553950+1222-takeshi@users.noreply.github.com> Co-authored-by: Takeshi Ishita <ishitah.takeshi@gmail.com> Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> Co-authored-by: Yukihiro Saito <yukky.saito@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> Co-authored-by: Kosuke Murakami <kosuke.murakami@tier4.jp>
KYabuuchi
added a commit
to KYabuuchi/autoware.universe
that referenced
this pull request
May 31, 2023
…ization/** (autowarefoundation#48) * change node namespace Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * update namespace for autoware-mode Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * update namespace in multi_camera.launch Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> --------- Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>
KYabuuchi
added a commit
to KYabuuchi/autoware.universe
that referenced
this pull request
Jun 6, 2023
…ization/** (autowarefoundation#48) * change node namespace Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * update namespace for autoware-mode Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * update namespace in multi_camera.launch Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> --------- Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>
KYabuuchi
added a commit
to KYabuuchi/autoware.universe
that referenced
this pull request
Jun 12, 2023
…ization/** (autowarefoundation#48) * change node namespace Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * update namespace for autoware-mode Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * update namespace in multi_camera.launch Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> --------- Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>
KYabuuchi
added a commit
that referenced
this pull request
Jun 22, 2023
* adopt scane_case to undistort, segment_filter Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * adopt scane_case to ground_server, ll2_decomposer Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * adopt scane_case to twist_converter, twist_estimator Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * adopt scane_case to validation packages Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * adopt scane_case tomodularized_particle_filter Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * adopt scane_case to gnss_particle_corrector Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * adopt scane_case to camera_particle_corrector Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * adopt scane_case to antishadow_corrector Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * adopt scane_case to particle_initializer Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * organize launch files Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * add twist_visualizer to validate odometry performance Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * use SE3::exp() to predict particles & modify linear noise model Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * stop to use LL2 to rectify initialpose2d Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * fix redundant computation in segment_accumulator Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * improve gnss_particle_corrector Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * fix segment_accumulator's bug Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * add doppler_converter Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * add xx2.launch.xml Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * add hsv_extractor Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * pickup other regions which have same color histogram Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * use additional region to filt line-segments Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * improve graph-segmentation Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * remove `truncate_pixel_threshold` Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * refactor graph_segmentator & segment_filter Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * add mahalanobis_distance_threshold in GNSS particle corrector Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * add extract_line_segments.hpp Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * use pcl::transformCloudWithNormals instead of transform_cloud Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * filt accumulating segments by LL2 Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * move herarchical_cost_map to common Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * apply positive feedback for accumulation Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * move transform_linesegments() to common pkg Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * refactor Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * use all projected lines for camera corrector Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * evaluate iffy linesegments Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * complete to unify ll2-assisted lsd clasification Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * add abs_cos2() which is more strict direction constraint Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * fix orientation initialization bug Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * publish doppler direction Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * TMP: add disable/enable switch for camera corrector Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * implement doppler orientation correction but it's disabled by default Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * speed up camera corrector Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * update ros params Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * implement kalman filter for ground tilt estimation Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * continuous height estimation works well? Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * estimate height cotiniously Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * use only linesegments which are at same height Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * add static_gyro_bias parameter Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * fix bug about overlay varidation Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * increse ll2 height marging in cost map generation Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * add static_gyro_bias in twist.launch.xml Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * load pcdless_init_area from ll2 Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * add specified initialization area Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * add corrector_manager node to disable/enable camera_corrector Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * call service to disable camer_corrector from manager Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * load corrector disable area Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * overlay even if pose is not estiamted Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * publish camera corrector's status as string Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * add set_booL_panel for camera_corrector enable/disable Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * load bounding box from lanelet2 Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * draw bounding box on cost map Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * remove at2,at1 from cost map Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * use cost_map::at() instread pf at2() Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * move cost map library from common to camera corrector Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * use logit for particle weighting but it does not work well Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * prob_to_logit() requires non-intuitive parameters Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * goodbye stupid parameters (max_raw_score & score_offset) Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * publish two scored pointclouds as debug Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * can handle unmapped areas Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * remove obsolete packages Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * update README.md Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * Update README.md * add image of how_to_launch Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * add node diagram in readme Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * add rviz_description.png in README Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * subscribe pose_with_cov & disconnect base_link <-> particle_pose Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * remove segment_accumulator & launch ekf_localizer from this project Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * add gnss_ekf_corrector Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * add camera_ekf_corrector package Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * subscribe ekf prediction & synch pose data Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * WIP: ready to implement UKF? Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * estimate weighted averaging as pose_estimator Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * basic algorithm is implemented but it does not work proparly Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * apply after_cov_gain_ Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * ekf corrector works a little bit appropriately Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * increase twist covariance for ekf Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * test probability theory Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * updat prob.py Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * implement de-bayesing but it loooks ugly Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * remove obsolete parameters Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * skip measurement publishing if travel distance is so short Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * use constant covariance because i dont understand what is correct Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * add submodule sample_vehicle_launch Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * TMP but it works Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * add ekf_trigger in particle_initializer.hpp Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * publish gnss markers & camera_est pubishes constant cov Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * back to pcd-less only launcher Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * add bayes_util package Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * apply de-bayesing for camera_ekf Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * some launch file update Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * organize launch files. we can choice mode from ekf/pekf/pf Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * organize particle_initializer Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * add swap_mode_adaptor WIP Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * use latest ekf in autoware & sample_vehicle Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * fix bug of swap_adalptor Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * fix FIX & FLOAT converter Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * fix septentrio doppler converter Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * move ekf packages to ekf directory Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * ignore corrector_manager Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * add standalone arg in launch files Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * update semseg_node Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * add camera_pose_initializer pkg Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * subscribe camera_info&tf and prepare semantic projection Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * project semantic image Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * create vector map image from ll2 Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * create lane image from vector map Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * search the most match angle by non-zero pixels Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * camera based pose_initializer Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * move ekf packages into unstable Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * move ekf theory debugger Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * add tier4_autoware_msgs as submodule Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * move pose_initializer into initializer dir Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * add semse_msgs pkg Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * separate marker pub function Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * separate projection functions Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * add semseg_srv client Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * move sem-seg directory Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * camera pose initilizer works successfully Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * rectify covariance along the orientation Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * improve initialization parameters Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * take into account covariance of request Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * use lanelet direciton to compute init pose scores Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * semseg download model automatically Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * remove sample_vehicle_launch Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * add autoware_msgs Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * remove obsolete launch files Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * add standalone mode for direct initialization Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * fix fix_to_pose Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * update launch files Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * update rviz config Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * remove lidar_particle_corrector Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * remove Sophus from sunbmodule Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * rename submodule directory Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * update README and some sample images Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * update README.md Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * fix override_camera_frame_id bahaviors Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * fix some bugs (#4) Signed-off-by: kminoda <koji.minoda@tier4.jp> * fix: use initialpose from Rviz (#6) * use initialpose from Rviz to init Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * add description about how-to-set-initialpose Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> --------- Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * misc: add license (#7) * WIP: add license description Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * add license description Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * add description about license in README Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> --------- Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * add quick start demo (#8) Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * refactor(launch) remove & update obsolete launch files (#9) * delete obsolete launch files Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * update documents Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> --------- Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * docs(readme): update architecture image (#10) * replace architecture image in README Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * update some images Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> --------- Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * refactor(pcdless_launc/scripts): remove unnecessary scripts (#11) * remove not useful scripts Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * rename scripts & add descriptions Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * little change Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * remove odaiba.rviz Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * grammer fix Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> --------- Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * fix(pcdless_launch): fix a build bug Signed-off-by: kminoda <koji.minoda@tier4.jp> * fix(twist_estimator): use velocity_report by default Signed-off-by: kminoda <koji.minoda@tier4.jp> * fix bug Signed-off-by: kminoda <koji.minoda@tier4.jp> * debugged, now works Signed-off-by: kminoda <koji.minoda@tier4.jp> * update sample rosbag link (#14) Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * feature(graph_segment, gnss_particle_corrector): make some features switchable (#17) * make additional-graph-segment-pickup disablable Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * enlarge gnss_mahalanobis_distance_threshold in expressway.launch Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> --------- Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * fix: minor fix for multi camera support (#18) * fix: minor fix for multi camera support Signed-off-by: kminoda <koji.minoda@tier4.jp> * update Signed-off-by: kminoda <koji.minoda@tier4.jp> * update Signed-off-by: kminoda <koji.minoda@tier4.jp> * fix typo Signed-off-by: kminoda <koji.minoda@tier4.jp> --------- Signed-off-by: kminoda <koji.minoda@tier4.jp> * refactor(retroactive_resampler): more readable (#19) * make Hisotry class Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * use boost:adaptors::indexed() Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * add many comment in resampling() Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * does not use ConstSharedPtr Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * rename interface of resampler Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * circular_buffer is unnecessary Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> --------- Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * refactor(mpf::predictor) resampling interval control in out of resampler (#20) * resampling interval management should be done out of resample() Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * resampler class throw exeption rather than optional Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * split files for resampling_history Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * split files for experimental/suspention_adaptor Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> --------- Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * refactor(mpf::predictor): just refactoring (#21) * remove obsolete functions Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * remove test of predictor Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * remove remapping in pf.launch.xml for suspension_adapator Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * add some comments Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> --------- Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * fix(twist_estimator): remove stop filter for velocity (#23) Signed-off-by: kminoda <koji.minoda@tier4.jp> * feat(pcdless_launch): add multi camera launcher (#22) * feat(pcdless_launch): add multi camera launcher Signed-off-by: kminoda <koji.minoda@tier4.jp> * minor fix Signed-off-by: kminoda <koji.minoda@tier4.jp> --------- Signed-off-by: kminoda <koji.minoda@tier4.jp> * refactor(CMakeListx.txt): just refactoring (#24) * refactor imgproc/*/CMakeListx.txt Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * refactor initializer/*/CMakeListx.txt & add gnss_pose_initializer pkg Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * rename some files in twist/ & refactor pf/*/cmakelist Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * refactor validation/*/CMakeListx.txt Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * fix some obsolete executor name Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> --------- Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * fix: rename lsd variables and files (#26) Signed-off-by: kminoda <koji.minoda@tier4.jp> * misc: reame pcdless to yabloc (#25) * rename pcdless to yabloc Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * fix conflict miss Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> --------- Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * visualize path (#28) Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * docs: update readme about particle filter (#30) * update mpf/README.md Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * update gnss_corrector/README.md Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * update camera_corrector/README.md Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> --------- Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * feat(segment_filter): publish images with lines and refactor (#29) * feat(segment_filter): publish images with lines Signed-off-by: kminoda <koji.minoda@tier4.jp> * update validation Signed-off-by: kminoda <koji.minoda@tier4.jp> * update imgproc (reverted) Signed-off-by: kminoda <koji.minoda@tier4.jp> * large change inclding refactoring Signed-off-by: kminoda <koji.minoda@tier4.jp> * major update Signed-off-by: kminoda <koji.minoda@tier4.jp> * revert rviz config Signed-off-by: kminoda <koji.minoda@tier4.jp> * minor fix in name Signed-off-by: kminoda <koji.minoda@tier4.jp> * add validation option Signed-off-by: kminoda <koji.minoda@tier4.jp> * update architecture svg Signed-off-by: kminoda <koji.minoda@tier4.jp> * rename validation.launch to overlay.launch Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * no throw runtime_error (unintentionaly applying format) Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> --------- Signed-off-by: kminoda <koji.minoda@tier4.jp> Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> Co-authored-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * catch runtime_error when particle id is invalid (#31) Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * return if info is nullopt (#32) Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * pose_buffer is sometimes empty (#33) Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * use_yaw_of_initialpose (#34) Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * feat(interface): remove incompatible interface (#35) * not use ublox_msg when run as autoware Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * remove twist/kalman/twist & use twist_estimator/twist_with_covariance Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * update particle_array stamp even if the time stamp seems wrong Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> --------- Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * fix: suppress info/warn_stream (#37) * does not stream undistortion time Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * improve warn stream when skip particle weighting Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * surpress frequency of warnings during synchronized particle searching Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * fix camera_pose_initializer Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> --------- Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * /switch must not be nice name (#39) Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * misc(readme): update readme (#41) * add youtube link and change thumbnail Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * improve input/output topics Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * quick start demo screen image Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * add abstruct architecture and detail architecture Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> --------- Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * docs(rosdep): fix package.xml to ensure build success (#44) * fix package.xml to success build Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * add 'rosdep install' in how-to-build Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> --------- Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * add geographiclib in package.xml (#46) Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * fix path search error in build stage (#45) * fix path search error in build stage * fix tier4/YabLoc#45 (comment) * Feature/remove submodule (#47) * remove submodules Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * remove doppler converter Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> --------- Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * feature: change node namespace to /localization/yabloc/** from /localization/** (#48) * change node namespace Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * update namespace for autoware-mode Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * update namespace in multi_camera.launch Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> --------- Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * removed unstable packages (#49) Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * feature: add *.param.yaml to manage parameters (#50) * make *.param.yaml in imgproc packages Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * make *.param.yaml in initializer packages Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * make *.param.yaml in map packages Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * make *.param.yaml in pf packages Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * make *.param.yaml in twist packages Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * fix expressway parameter Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * fix override_frame_id Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * remove default parameters Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * fix some remaining invalida parameters Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> --------- Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * does not estimate twist (#51) Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * feat(particle_initializer): merge particle_initializer into mpf (#52) * feat(particle_initializer): merge particle_initializer to modulalized_particle_filter Signed-off-by: kminoda <koji.minoda@tier4.jp> * remove particle_initializer * remove debug message Signed-off-by: kminoda <koji.minoda@tier4.jp> * remove related parts Signed-off-by: kminoda <koji.minoda@tier4.jp> * update readme Signed-off-by: kminoda <koji.minoda@tier4.jp> * rename publishing topic Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> --------- Signed-off-by: kminoda <koji.minoda@tier4.jp> Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> Co-authored-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * fix: remove ll2_transition_area (#54) Signed-off-by: kminoda <koji.minoda@tier4.jp> * feature(initializer): combine some initializer packages (#56) * combine some package about initializer Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * yabloc_pose_initializer works well Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * remove old initializer packages Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * semseg node can launch Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * fix bug Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * revert initializer mode Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> --------- Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * feature(imgproc): reudce imgproc packages (#57) * combine some imgproc packages Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * combine overlay monitors into imgproc Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> --------- Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * feature(validation): remove validation packages (#58) * remove validation packages Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * remove path visualization Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> --------- Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * feature(pf): combine some packages related to particle filter (#59) * create yabloc_particle_filter Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * combine gnss_particle_corrector Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * combine ll2_cost_map Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * combine camera_particle_corrector Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * fix launch files Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * split README & remove obsolete scripts Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * fix config path of multi_camera mode Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> --------- Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * feature: combine map and twist packages (#60) * removed some twist nodes & rename remains to yabloc_twist Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * fix launch files for yabloc_twist Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * move map packages to yabloc_common Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * WIP: I think its impossible Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * Revert "WIP: I think its impossible" This reverts commit 49da507bbf9abe8fcebed4d4df44ea5f4075f6d1. * remove map packages & fix some launch files Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> --------- Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * removed obsolete packages Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * remove obsolete dot files Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * use tier4_loc_launch instead of yabloc_loc_launch Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * move launch files to each packages Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * remove yabloc_localization_launch Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * remove yabloc_launch Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * modify yabloc/README.md Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * update yabloc_common/README.md Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * update yabloc_imgproc README Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * update yabloc_particle_filter/README Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * update yabloc_pose_initializer/README Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * update README Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * use native from_bin_msg Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * use ifndef instead of pragma once in yabloc_common Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * use ifndef instead of pragma once in yabloc_imgproc & yabloc_pf Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * use ifndef instead of pragma once in yabloc_pose_initializer Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * style(pre-commit): autofix * use autoware_cmake & suppress build warning Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * repalce yabloc::Timer with tier4_autoware_utils::StopWatch Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * replace 1.414 with std::sqrt(2) Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * style(pre-commit): autofix * removed redundant ament_cmake_auto Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * removed yabloc_common/timer.hpp Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * replaced low_pass_filter with autoware's lowpass_filter_1d Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * style(pre-commit): autofix * Squashed commit of the following: Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> commit cb08e290cca5c00315a58a973ec068e559c9e0a9 Author: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> Date: Tue Jun 13 14:30:09 2023 +0900 removed ublox_msgs in gnss_particle_corrector Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> commit c158133f184a43914ec5f929645a7869ef8d03be Author: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> Date: Tue Jun 13 14:24:19 2023 +0900 removed obsolete yabloc_multi_camera.launch Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> commit 10f578945dc257ece936ede097544bf008e5f48d Author: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> Date: Tue Jun 13 14:22:14 2023 +0900 removed ublox_msgs in yabloc_pose_initializer Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * style(pre-commit): autofix * removed fix2mgrs & ublox_stamp Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * added ~/ at the top of topic name Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * removed use_sim_time in yabloc launch files Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * add architecture diagram in README Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * rename lsd_node to line_segment_detector Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * style(pre-commit): autofix * Update localization/yabloc/README.md fix typo Co-authored-by: Takagi, Isamu <43976882+isamu-takagi@users.noreply.github.com> * removed obsolete debug code in similar_area_searcher Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * removed suspension_adaptor which manages lifecycle of particle predictor Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * style(pre-commit): autofix * renamed semseg to SemanticSegmentation Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * style(pre-commit): autofix * fixed README.md to solve markdownlint Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * WIP: reflected cpplint's suggestion Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * reflected cpplint's suggestion Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * rename AbstParaticleFilter in config files Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * fixed typo Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * used autoware_lint_common Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * fixed miss git add Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * style(pre-commit): autofix * replaced lanelet_util by lanelet2_extension Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * replaced fast_math by tie4_autoware_utils Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * sort package.xml Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * renamed yabloc_imgproc with yabloc_image_processing Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * reflected some review comments Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * resolved some TODO Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * prioritize NDT if both NDT and YabLoc initializer enabled Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * changed localization_mode option names Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> --------- Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> Signed-off-by: kminoda <koji.minoda@tier4.jp> Co-authored-by: kminoda <44218668+kminoda@users.noreply.github.com> Co-authored-by: kminoda <koji.minoda@tier4.jp> Co-authored-by: Akihiro Komori <akihiro.komori@unity3d.com> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Co-authored-by: Takagi, Isamu <43976882+isamu-takagi@users.noreply.github.com>
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>
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: Kenji Miyake <kenji.miyake@tier4.jp> Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
Sign up for free
to join this conversation on GitHub.
Already have an account?
Sign in to comment
Add this suggestion to a batch that can be applied as a single commit.
This suggestion is invalid because no changes were made to the code.
Suggestions cannot be applied while the pull request is closed.
Suggestions cannot be applied while viewing a subset of changes.
Only one suggestion per line can be applied in a batch.
Add this suggestion to a batch that can be applied as a single commit.
Applying suggestions on deleted lines is not supported.
You must change the existing code in this line in order to create a valid suggestion.
Outdated suggestions cannot be applied.
This suggestion has been applied or marked resolved.
Suggestions cannot be applied from pending reviews.
Suggestions cannot be applied on multi-line comments.
Suggestions cannot be applied while the pull request is queued to merge.
Suggestion cannot be applied right now. Please check back later.
Related Issue
#1
Related Link
This PR depends on
Description
Add motion_velocity_smootherr packages from https://github.com/tier4/AutowareArchitectureProposal.iv
How to review
Check the following item