Skip to content
New issue

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

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

Already on GitHub? Sign in to your account

feat(trajectory_follower): add min_prediction_length to mpc #1171

Merged

Conversation

kosuke55
Copy link
Contributor

@kosuke55 kosuke55 commented Jun 26, 2022

Description

  • When stopped and given a curve trajectory, the steer command value of mpc can not be large enough.
    • This is because precition_length is obtained from the distance traveled in a certain time with the speeds.
  • Therefore, min_prediction_length was added to look some distance ahead even when stopped.

example where the steer command is not large enough and the vehicle cannot follow the trajectory

pull_over_steer-2022-05-26_18.03.43_cut.mp4

Related links

Tests performed

checked that the vehicle can follow curve trajectory(like video above) with psim and real vehicle.

Notes for reviewers

Pre-review checklist for the PR author

The PR author must check the checkboxes below when creating the PR.

In-review checklist for the PR reviewers

The PR reviewers must check the checkboxes below before approval.

  • The PR follows the pull request guidelines.
  • The PR has been properly tested.
  • The PR has been reviewed by the code owners.

Post-review checklist for the PR author

The PR author must check the checkboxes below before merging.

  • There are no open discussions or they are tracked via tickets.
  • The PR is ready for merge.

After all checkboxes are checked, anyone who has write access can merge the PR.

@kosuke55 kosuke55 force-pushed the feature/mpc_min_prediction_length branch 2 times, most recently from f6f1499 to 40790d4 Compare June 26, 2022 06:53
@kosuke55 kosuke55 changed the title feat(trajectory_follower): min_prediction_length in mpc feat(trajectory_follower): Add min_prediction_length to mpc Jun 26, 2022
@kosuke55 kosuke55 force-pushed the feature/mpc_min_prediction_length branch from 40790d4 to ad40475 Compare June 26, 2022 09:46
@codecov
Copy link

codecov bot commented Jun 26, 2022

Codecov Report

Attention: Patch coverage is 58.18182% with 23 lines in your changes missing coverage. Please review.

Project coverage is 9.93%. Comparing base (54eca59) to head (d1eea82).
Report is 5753 commits behind head on main.

Files Patch % Lines
control/trajectory_follower/src/mpc.cpp 58.82% 4 Missing and 17 partials ⚠️
...trajectory_follower/src/mpc_lateral_controller.cpp 33.33% 0 Missing and 2 partials ⚠️
Additional details and impacted files
@@           Coverage Diff            @@
##            main   #1171      +/-   ##
========================================
+ Coverage   9.64%   9.93%   +0.28%     
========================================
  Files       1056    1054       -2     
  Lines      72744   72960     +216     
  Branches   15819   16048     +229     
========================================
+ Hits        7019    7246     +227     
+ Misses     59404   59319      -85     
- Partials    6321    6395      +74     
Flag Coverage Δ *Carryforward flag
differential 43.03% <63.41%> (?)
total 9.64% <29.62%> (+0.01%) ⬆️ Carriedforward from b190ea7

*This pull request uses carry forward flags. Click here to find out more.

☔ View full report in Codecov by Sentry.
📢 Have feedback on the report? Share it here.

yukkysaito added a commit to yukkysaito/autoware.universe that referenced this pull request Jun 29, 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 (autowarefoundation#12)

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>

* Feature/add virtual traffic light planner (autowarefoundation#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 (autowarefoundation#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 (autowarefoundation#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 (autowarefoundation#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>
yukkysaito pushed a commit to yukkysaito/autoware.universe that referenced this pull request Jun 29, 2022
* release v0.4.0

* Avoid setting CMAKE_BUILD_TYPE=Release in each CMakeLists.txt (autowarefoundation#720)

* remove set CMAKE_BUILD_TYPE Release in each CMakeLists.txt

* remove set CMAKE_BUILD_TYPE Release in ndt_pcl_modified

* set compile options for debug in ndt_omp

* Fix indent

* add warning if -DCMAKE_BUILD_TYPE=Release is not set in ndt_omp

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

* remove ROS1 packages temporarily

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>

* Port autoware_localization_srvs

* Add DEPENDENCIES

* Revert "remove ROS1 packages temporarily"

This reverts commit ee01a755ac5b22c61f4274ae2ee57b0a18150a78.

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>

* add COLCON_IGNORE to ros1 packages

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>

* Rename launch files to launch.xml (autowarefoundation#28)

* Port pose_initializer to ROS2 (autowarefoundation#11)

* CMakeLists.txt & package.xml

* Compiles

* Works

* Use callback instead

* Reviewer feedback

* Add sequence number check

* Review feedback

* Fix lint issues (autowarefoundation#128)

* Rename h files to hpp (autowarefoundation#142)

* Change includes

* Rename files

* Adjustments to make things compile

* Other packages

* Use quotes for includes where appropriate (autowarefoundation#144)

* Use quotes for includes where appropriate

* Fix lint tests

* Make tests pass hopefully

* fixing trasient_local in ROS2 packages (autowarefoundation#160)

* [ekf_localizer] [pose_initializer] fix topic message type (autowarefoundation#176)

Co-authored-by: Autoware <autoware@tier4.jp>
Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* ading linters to pose_initializer (autowarefoundation#186)

* adding linters to autoware_localization_srvs (autowarefoundation#185)

* Port initial-pose-button-panel (autowarefoundation#125)

* Port

Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org>

* Initialize button when request received

Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org>

* Amend buildtool

Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org>

* Fix license

Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org>

* apply env_var to  use_sim_time (autowarefoundation#222)

* retry gnss initialize (autowarefoundation#1043) (autowarefoundation#263)

Co-authored-by: YamatoAndo <yamato.ando@gmail.com>

* Ros2 v0.8.0 initial pose buttion panel (autowarefoundation#312)

* restore initial pose button panel files for v0.8.0 update

* fix typos in localization (autowarefoundation#890)

* Fix memory leak and remove unused properties (autowarefoundation#964)

* Revert "restore initial pose button panel files for v0.8.0 update"

This reverts commit 01281a2633636f80f241a788f9d35c517a2977e1.

* delete unused header

* add ament lint test

* apply ament_lint

* fix bug

Co-authored-by: Kazuki Miyahara <kmiya@outlook.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>

* Fix missing gnss subscriber (autowarefoundation#417)

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

* Ros2 fix ndt align srv (autowarefoundation#442)

* Add success field to ndt align srv response

Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>

* Apply change of ndt align srv

Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>

* Apply change of ndt align srv

Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>

* Fix lint

Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>

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

* Remove use_sim_time for set_parameter (autowarefoundation#1260)

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

* Fix dependency type of rosidl_default_generators (autowarefoundation#1801)

* Fix dependency type of rosidl_default_generators

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

* Remove unnecessary depends

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

* Use ament_cmake_auto

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

* Fix -Wunused-parameter (autowarefoundation#1836)

* Fix -Wunused-parameter

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

* Fix mistake

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

* fix spell

* Fix lint issues

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

* Ignore flake8 warnings

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

Co-authored-by: Hiroki OTA <hiroki.ota@tier4.jp>

* Add autoware api (autowarefoundation#1979)

* add sort-package-xml hook in pre-commit (autowarefoundation#1881)

* add sort xml hook in pre-commit

* change retval to exit_status

* rename

* add prettier plugin-xml

* use early return

* add license note

* add tier4 license

* restore prettier

* change license order

* move local hooks to public repo

* move prettier-xml to pre-commit-hooks-ros

* update version for bug-fix

* apply pre-commit

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

* Revert "Temporarily comment out pre-commit hooks"

This reverts commit 748e9cdb145ce12f8b520bcbd97f5ff899fc28a3.

* Replace ament_lint_common with autoware_lint_common

Signed-off-by: Kenji Miyake <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>

* Remove COLCON_IGNORE under localization (autowarefoundation#553)

* Remove 'pose_initializer/COLCON_IGNORE' (autowarefoundation#556)

* add README.md (autowarefoundation#623)

* add README.md

* fix typo

* minor fix

* Update localization/util/autoware_localization_rviz_plugin/initial_pose_button_panel/README.md

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

* Update localization/util/autoware_localization_rviz_plugin/initial_pose_button_panel/README.md

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

* Update localization/util/autoware_localization_rviz_plugin/initial_pose_button_panel/README.md

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

* add readme in pose initializer (autowarefoundation#636)

* add readme in pose initializer

Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp>

* modify doc

Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp>

* move autoware_localization_srvs package (autowarefoundation#689)

* move autoware_localization_srvs package

* apply pre-commit

* rename pose_with_cov to pose_with_covariance

* apply pre-commit

* fix: move initial_pose_button_panel directory

Co-authored-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>
Co-authored-by: Daichi Murakami <harihitode@gmail.com>
Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com>
Co-authored-by: Nikolai Morin <nikolai.morin@apex.ai>
Co-authored-by: Nikolai Morin <nnmmgit@gmail.com>
Co-authored-by: nik-tier4 <71747268+nik-tier4@users.noreply.github.com>
Co-authored-by: Ryohsuke Mitsudome <43976834+mitsudome-r@users.noreply.github.com>
Co-authored-by: Autoware <autoware@tier4.jp>
Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com>
Co-authored-by: Servando <43142004+sgermanserrano@users.noreply.github.com>
Co-authored-by: Kosuke Murakami <kosuke.murakami@tier4.jp>
Co-authored-by: Daisuke Nishimatsu <42202095+wep21@users.noreply.github.com>
Co-authored-by: YamatoAndo <yamato.ando@gmail.com>
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
Co-authored-by: Kazuki Miyahara <kmiya@outlook.com>
Co-authored-by: Takagi, Isamu <43976882+isamu-takagi@users.noreply.github.com>
Co-authored-by: Hiroki OTA <hiroki.ota@tier4.jp>
Co-authored-by: Keisuke Shima <19993104+KeisukeShima@users.noreply.github.com>
Co-authored-by: Takeshi Ishita <ishitah.takeshi@gmail.com>
Co-authored-by: Takayuki Murooka <takayuki5168@gmail.com>
Co-authored-by: Takayuki Murooka <takayuki.murooka@tier4.jp>
yukkysaito added a commit to yukkysaito/autoware.universe that referenced this pull request Jun 29, 2022
* Feature/awapi awiv adapter first pr (autowarefoundation#685)

* add base file of awapi_awiv_adapter

* publish autoware status

* update readme

* fix readme

* rename file

* add relay topic

* change msg name

* publish autoware status

* update readme

* add new message

* add lane change topic, obstacle avoidance topic

* update readme

* fix readme

* add namespace

* rename lane change available

* fix readme

* change pub hz

* change topic name

* change control mode and add gate_mode

* fix readme

* update readme

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* fix typo (autowarefoundation#687)

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* move msg file to autoware_api_msgs (autowarefoundation#693)

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* Fix/awapi awiv adapter (autowarefoundation#698)

* subscribe global rpt

* update readme

* update readme

* add warning

* fix readme

* update readme

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* add check mark for awapi readme (autowarefoundation#723)

* add check mark for awapi readme

* add blank

* add blank

* add blank

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* Feature/stop reason api (autowarefoundation#729)

* fix indent of readme

* add mock of stop reason aggregator

* add constptr to stop reason

* aggregate message

* add empty handling

* add nullptr handling

* fix bug

* update readme

* fix bug

* remove unused ifdef

* unify same reason msg to stop factor

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* modify put/goal -> put/route (autowarefoundation#736)

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* Feature/add goal api (autowarefoundation#734)

* add  goal api

* add msg

* update readme

* add  const auto

* clean code

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* Feature/extract leaf diag info (autowarefoundation#741)

* add mock function of extract leaf diag

* remove parent diag

* change method of isLeaf

* clean code

* change varibale/function name

* remove string predefine

* update readme

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* update awapi readme (autowarefoundation#747)

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* Feature/change output awapi (autowarefoundation#782)

* change ouput of awapi

* change error output to warn

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* Feature/add battery to awapi (autowarefoundation#804)

* implement battery fuel

* update readme

* add getGearInfo

* fix message name

* set default value:nan to battery

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* remove ROS1 packages temporarily

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>
Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* Revert "remove ROS1 packages temporarily"

This reverts commit c85c1d6789b1a1e63c6b4e60fa4f3296dfb12e74.

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>
Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* add COLCON_IGNORE to ros1 packages

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>
Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* Rename launch files to launch.xml (autowarefoundation#28)

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* Port awapi_awiv_adapter to ROS2 (autowarefoundation#51)

* Port autoware_api_msgs to ROS2

* Integrate topic_tools

* Don't inherit from Node, convert to milliseconds

* Remove _node suffix from non-node loggers

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* Rename h files to hpp (autowarefoundation#142)

* Change includes

* Rename files

* Adjustments to make things compile

* Other packages

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* Adjust copyright notice on 532 out of 699 source files (autowarefoundation#143)

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* Use quotes for includes where appropriate (autowarefoundation#144)

* Use quotes for includes where appropriate

* Fix lint tests

* Make tests pass hopefully

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* Run uncrustify on the entire Pilot.Auto codebase (autowarefoundation#151)

* Run uncrustify on the entire Pilot.Auto codebase

* Exclude open PRs

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* Add linters (autowarefoundation#227)

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* Ros2 v0.8.0 awapi awiv adapter (autowarefoundation#282)

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* 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>
Signed-off-by: tanaka3 <ttatcoder@outlook.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>
Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* Awapi update v0.9.0 (autowarefoundation#350)

* Feature/add current maxvel to awapi (autowarefoundation#1142)

* add current max vel to awapi

* add readme

* apply format

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>

* fix build error

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>

* Add missing return (autowarefoundation#1170)

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

* fix cast type

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>

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

* [awapi_awiv_adapter] fix bug in the launch file (autowarefoundation#391)

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>
Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* 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>
Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* fix topic name (autowarefoundation#404)

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* [awapi_awiv_adapter] fix qos for some of the topics in awapi_awiv_adapter (autowarefoundation#413)

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>
Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* Fix transform (autowarefoundation#420)

* Replace rclcpp::Time(0) by tf2::TimePointZero() in lookupTransform

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

* Fix canTransform

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

* Fix test

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

* Fix typo in awapi module (autowarefoundation#438)

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* Import v0.9.1 (autowarefoundation#431)

* add local optimal solution ocillation check to ndt_scan_matcher (autowarefoundation#1182)

* Add obstacle_crush diagnostic (autowarefoundation#1186)

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

* Fix diagnostics api (autowarefoundation#1185)

* Fix diagnostics api

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

* Don't overwrite level

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

* Overwrite level of No Fault diagnostics

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

* Add missing diag in autoware_error_monitor.yaml (autowarefoundation#1187)

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

* Filter hazard_status (autowarefoundation#1191)

* Filter hazard_status

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

* Filter leaf diagnostics

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

* Fix wrong calculation of available memory. (autowarefoundation#1168)

* Fixed wrong calculation of available memory.

* Added comments about output example of free -tb command.

* Change monitoring method to get HDD temperature and usage per specified device. (autowarefoundation#1195)

* Changed monitoring method to get temperature and usage per specified device.

* Fixed test codes.

* Removed unnecessary (void) parameter.

* return input pointcloud when ground plane not found (autowarefoundation#1190)

* fix yaw-smoothing bug (autowarefoundation#1198)

* Fix lint

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

Co-authored-by: Taichi Higashide <taichi.higashide@tier4.jp>
Co-authored-by: ito-san <57388357+ito-san@users.noreply.github.com>
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* add tl overwriter relay in awapi (autowarefoundation#451)

* add tl overwriter relay in awapi

* add missed topic type

* fix typo of topic name

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* add use_sim-time option (autowarefoundation#454)

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* Format launch files (autowarefoundation#1219)

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

* Fix rolling build errors (autowarefoundation#1225)

* Add missing include files

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

* Replace rclcpp::Duration

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

* Use reference for exceptions

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

* Use from_seconds

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

* Awapi relay component (autowarefoundation#1237)

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* Refine BSD license name (autowarefoundation#1244)

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* Remove use_sim_time for set_parameter (autowarefoundation#1260)

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

* Clear hazard level when ignored (autowarefoundation#1200) (autowarefoundation#1289)

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

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

* fix flake8 (autowarefoundation#1306)

Signed-off-by: tanaka3 <ttatcoder@outlook.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>
Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* Fix lint errors (autowarefoundation#1378)

* Fix lint errors

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

* Fix variable names

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

* change msg type looking traffic light state (autowarefoundation#1494)

* change msg type looking traffic light state (autowarefoundation#1455)

* change msg type looking traffic light state

* fix msg name

* using namespace

* change function name

* fix typo

* add readme

* Update awapi/awapi_awiv_adapter/Readme.md

fix typo

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

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

* Remove deprecated message include

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

* Fix lint

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

Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com>
Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* Add markdownlint and prettier (autowarefoundation#1661)

* Add markdownlint and prettier

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

* Ignore .param.yaml

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

* Apply format

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

* Fix -Wunused-parameter (autowarefoundation#1836)

* Fix -Wunused-parameter

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

* Fix mistake

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

* fix spell

* Fix lint issues

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

* Ignore flake8 warnings

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

Co-authored-by: Hiroki OTA <hiroki.ota@tier4.jp>
Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* Fix compiler warnings (autowarefoundation#1837)

* Fix -Wunused-private-field

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

* Fix -Wunused-variable

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

* Fix -Wformat-security

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

* Fix -Winvalid-constexpr

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

* Fix -Wdelete-non-abstract-non-virtual-dtor

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

* Fix -Wdelete-abstract-non-virtual-dtor

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

* Fix -Winconsistent-missing-override

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

* Fix -Wrange-loop-construct

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

* Fix "invalid application of 'sizeof' to an incomplete type"

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

* Ignore -Wgnu-anonymous-struct and -Wnested-anon-types

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

* Fix lint

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

* Ignore -Wno-deprecated-declarations in CUDA-related packages

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

* Fix mistake

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

* Fix -Wunused-parameter

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

* Add autoware api (autowarefoundation#1979)

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* Feature/add virtual traffic light planner (autowarefoundation#1588)

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* Move launch file of external_cmd_selector (autowarefoundation#2017)

* Move launch file of external_cmd_selector

Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>

* Add copyright

Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>

* Use DeclareLaunchArgument

Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>

* Fix external command api name

Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>

* Move common parameters

Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>

* Fix format

Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>

* Fix format

Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

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

* Use EmergencyState instead of deprecated EmergencyMode

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

* Use stamped type

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

* add sort-package-xml hook in pre-commit (autowarefoundation#1881)

* add sort xml hook in pre-commit

* change retval to exit_status

* rename

* add prettier plugin-xml

* use early return

* add license note

* add tier4 license

* restore prettier

* change license order

* move local hooks to public repo

* move prettier-xml to pre-commit-hooks-ros

* update version for bug-fix

* apply pre-commit

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* fix awapi_autoware_state_publisher (autowarefoundation#2085)

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* Feature/porting behavior path planner (autowarefoundation#1645)

* Add behavior path planner pkg with Lane Change (autowarefoundation#1525)

* add lanelet extension funcs

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

* add planning msgs for FOA

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

* add behavior_path_planner pkg

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

* apply clang format

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

* add error handling for config load failure

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

* replace word: foa with remote control

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

* add readme

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

* use pointer for return value of path

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

* fix hz

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

* remove debug print

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

* remove shide-shift & avoidance related files

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

* Clip path by goal

* add build depend for behavior tree cpp

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

* temporally disable lint test in lanelet2_extension

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

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

* Add avoidance module in behavior_path_planner (autowarefoundation#1528)

* Revert "remove shide-shift & avoidance related files"

This reverts commit d819ea0291fca251012e4b9ffd16de3896830aa2.

* refactor findNewShiftPoint func

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

* remove duplicated decleration

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

* fix barkward length issue
 - add clipPathLenght func in avoidance

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

* refactor:
 - translate english
 - minor modification for traffic distance

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

* support debug marker in behavior_path_planner

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

* clean up side shift module

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

* change topic name

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

* remove japanese

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

* Update planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/include/behavior_path_planner/scene_module/side_shift/side_shift_module.hpp

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

* fix typo

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

* remove unused var

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

* adress reviewer comments:
 - add const for variables
 - add comment
 - fix typo

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

* fix typo

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

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

* Replace behavior_path utilities with autoware_utils (autowarefoundation#1532)

* replace calcDistance

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

* replace arange

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

* replave convertToEigenPt with autoware_utils::fromMsg

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

* replace normalizeRadian

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

* cosmetic change

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

* import autowarefoundation#1526 into behavior path planner (autowarefoundation#1531)

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

* Fix/behavior path empty path output guard (autowarefoundation#1536)

* add guard

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

* Update planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/src/behavior_path_planner.cpp

* fix lateral jerk calculation (autowarefoundation#1549)

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

* fix: error handling on exception in behavior_path_planner (autowarefoundation#1551)

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

* Fix ignore too steep avoidance path (autowarefoundation#1550)

* ignore too steep path

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

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

* parametrize lateral jerk limit

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

* Update planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/include/behavior_path_planner/scene_module/avoidance/avoidance_module.hpp

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

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

* use offsetNoThrow and add error log (autowarefoundation#1615)

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

* Ignore object ahead goal for avoidance (autowarefoundation#1618)

* Ignore object ahead goal for avoidance

* Add flag

* Fix position of definition of goal_pose

* Fix arclength calculation

* Fix position of definition of goal_pose

* fix intersection stop line (autowarefoundation#1636)

* fix intersection stop line

* fix typo

* add document (autowarefoundation#1635)

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

* Port behavior path planner to ros2

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

* Apply lint

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

* Fix typo

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

* Fix map qos

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

* debug slope calculation in behavior (autowarefoundation#1566)

* update

* update

* revert change of autoware_utils

* define getPose in behavior_path_planner

* update

* update

* update

* update

* interpolate z in obstacle_avoidance_planner

* update velocity controller

* fix detection area and scene

* Update planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/src/utilities.cpp

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

* update comment in velocity controller

* remove debug print

* update

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

* Address review: Fix config file name

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

* pre-commit fixes

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

* Fix redeclaring parameters

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

* Add missing tf2 geometry function

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

* Apply lint

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

* Fix rclcpp Time initialization

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

* Use now() instead of msg stamp

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

* Use throttle output in getExpandedLanelet

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

* Add missing const

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

* Fix lint

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

Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com>
Co-authored-by: rej55 <rej55.g@gmail.com>
Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com>
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
Co-authored-by: Takayuki Murooka <takayuki5168@gmail.com>
Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* 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>
Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* Fix/update max velocity topic name (autowarefoundation#2236)

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* 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>
Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* Add COLCON_IGNORE (autowarefoundation#500)

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

* Port awapi awiv adapter to .auto (autowarefoundation#554)

* Remove COLCON_IGNORE

* Change AutowareState

* Change EmergencyState

* Change HazardStatus

* Split file for convert function

* Change Path

* Change Trajectory

* Change ControlMode

* Change Shift

* Change TurnSignal and move converter

* Change Steering

* Change VehicleCommand

* Fix EmergencyState

* Fix for pre-commit

* Move autoware state converter

* Fix control comand

* Change TwistStamped

* Remove unused header

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* Use pacmod3 msgs (autowarefoundation#610)

* Migration to pacmod3 msgs

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

* Fix action for pacmod

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

* Run pre-commit

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

* fix package.xml (autowarefoundation#630)

Co-authored-by: Takayuki Murooka <takayuki.murooka@tier4.jp>
Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* adapt to actuation cmd/status as control msg (autowarefoundation#646)

* adapt to actuation cmd/status as control msg

* fix readme

* fix topics

* fix remaing topics

* as to pacmod interface

* fix vehicle status

* add header to twist

* revert gyro_odometer_change

* revert twist topic change

* revert unchanged package

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* fix awapi topics (autowarefoundation#685)

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* fix mixed route topic (autowarefoundation#695)

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* Fix/psim topics emergency handler awapi (autowarefoundation#702)

* fix emergency handler

* fix awapi

* remove unused topic

* remove duplecated vehicle cmd

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* Fix topic type of awapi relay (autowarefoundation#701)

* Fix topic type of awapi relay

* Fix

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* fix door cmd topic (autowarefoundation#711)

* fix door cmd topic

* fix topic

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* Update traffic light topic name (autowarefoundation#729)

* Update traffic light topic name

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

* Update traffic light topic name in perception

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

* Update twist topic name (autowarefoundation#736)

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

* fix: refactor readme

Co-authored-by: Takeshi Miura <57553950+1222-takeshi@users.noreply.github.com>

Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
Co-authored-by: hiroyuki obinata <58019445+obi-t4@users.noreply.github.com>
Co-authored-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>
Co-authored-by: Nikolai Morin <nnmmgit@gmail.com>
Co-authored-by: Jilada Eccleston <jilada.eccleston@tier4.jp>
Co-authored-by: Daisuke Nishimatsu <42202095+wep21@users.noreply.github.com>
Co-authored-by: Ryohsuke Mitsudome <43976834+mitsudome-r@users.noreply.github.com>
Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com>
Co-authored-by: Kazuki Miyahara <kmiya@outlook.com>
Co-authored-by: Taichi Higashide <taichi.higashide@tier4.jp>
Co-authored-by: ito-san <57388357+ito-san@users.noreply.github.com>
Co-authored-by: Shigeki Kobayashi <32808802+sgk-000@users.noreply.github.com>
Co-authored-by: Keisuke Shima <keisuke.shima@tier4.jp>
Co-authored-by: Takagi, Isamu <43976882+isamu-takagi@users.noreply.github.com>
Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com>
Co-authored-by: Hiroki OTA <hiroki.ota@tier4.jp>
Co-authored-by: Keisuke Shima <19993104+KeisukeShima@users.noreply.github.com>
Co-authored-by: k-obitsu <56008637+k-obitsu@users.noreply.github.com>
Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com>
Co-authored-by: rej55 <rej55.g@gmail.com>
Co-authored-by: Takayuki Murooka <takayuki5168@gmail.com>
Co-authored-by: yutaka <purewater0901@gmail.com>
Co-authored-by: purewater0901 <43805014+purewater0901@users.noreply.github.com>
Co-authored-by: pre-commit <pre-commit@example.com>
Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com>
Co-authored-by: Takayuki Murooka <takayuki.murooka@tier4.jp>
Co-authored-by: Takeshi Miura <57553950+1222-takeshi@users.noreply.github.com>
@kosuke55 kosuke55 force-pushed the feature/mpc_min_prediction_length branch 2 times, most recently from 9abdf31 to 69c3aff Compare July 4, 2022 03:06
@kosuke55 kosuke55 marked this pull request as ready for review July 4, 2022 03:07
@kosuke55 kosuke55 force-pushed the feature/mpc_min_prediction_length branch from 69c3aff to 292174f Compare July 4, 2022 03:12
@kosuke55 kosuke55 changed the title feat(trajectory_follower): Add min_prediction_length to mpc feat(trajectory_follower): Add min prediction length to mpc Jul 4, 2022
@kosuke55 kosuke55 force-pushed the feature/mpc_min_prediction_length branch from 292174f to 8cc51fc Compare July 5, 2022 02:11
@kosuke55 kosuke55 changed the title feat(trajectory_follower): Add min prediction length to mpc feat(trajectory_follower): add min prediction length to mpc Jul 5, 2022
@kosuke55 kosuke55 changed the title feat(trajectory_follower): add min prediction length to mpc feat(trajectory_follower): add min_prediction_length to mpc Jul 5, 2022
Copy link
Contributor

@rej55 rej55 left a comment

Choose a reason for hiding this comment

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

I have some minor comments.
Could you check it?

Signed-off-by: kosuke55 <kosuke.tnp@gmail.com>
@kosuke55 kosuke55 force-pushed the feature/mpc_min_prediction_length branch 2 times, most recently from 217f395 to 821d602 Compare July 6, 2022 07:28
Signed-off-by: kosuke55 <kosuke.tnp@gmail.com>
@kosuke55 kosuke55 force-pushed the feature/mpc_min_prediction_length branch from 821d602 to d1eea82 Compare July 6, 2022 07:35
@rej55
Copy link
Contributor

rej55 commented Jul 7, 2022

@kosuke55
In my environment, with this change, trajectory follower nodes does not run in the planning_simulator.
How about your environment?

@kosuke55
Copy link
Contributor Author

kosuke55 commented Jul 7, 2022

@rej55
yes, It can run(I will check again). Could your share error message?
How about adding min_prediction_length your config or rebuild with upto options..?
(sorry for no launch PR, I will send it)

typo
mpc_min_prediction_length

@rej55
Copy link
Contributor

rej55 commented Jul 7, 2022

It runs with mpc_min_prediction_length.
Thank you for your comment!

Copy link
Contributor

@rej55 rej55 left a comment

Choose a reason for hiding this comment

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

LGTM

@kosuke55 kosuke55 merged commit 22ad993 into autowarefoundation:main Jul 7, 2022
esteve pushed a commit that referenced this pull request Jul 8, 2022
* feat(trajectory_follower): Add min_prediction_length to mpc

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

* refactor

Signed-off-by: kosuke55 <kosuke.tnp@gmail.com>
boyali referenced this pull request in boyali/autoware.universe Sep 28, 2022
* feat(trajectory_follower): Add min_prediction_length to mpc

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

* refactor

Signed-off-by: kosuke55 <kosuke.tnp@gmail.com>
boyali referenced this pull request in boyali/autoware.universe Oct 3, 2022
* feat(trajectory_follower): Add min_prediction_length to mpc

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

* refactor

Signed-off-by: kosuke55 <kosuke.tnp@gmail.com>
boyali referenced this pull request in boyali/autoware.universe Oct 3, 2022
* feat(trajectory_follower): Add min_prediction_length to mpc

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

* refactor

Signed-off-by: kosuke55 <kosuke.tnp@gmail.com>
yukke42 pushed a commit to tzhong518/autoware.universe that referenced this pull request Oct 14, 2022
…foundation#1171)

* feat(trajectory_follower): Add min_prediction_length to mpc

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

* refactor

Signed-off-by: kosuke55 <kosuke.tnp@gmail.com>
boyali referenced this pull request in boyali/autoware.universe Oct 19, 2022
* feat(trajectory_follower): Add min_prediction_length to mpc

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

* refactor

Signed-off-by: kosuke55 <kosuke.tnp@gmail.com>
TomohitoAndo added a commit to TomohitoAndo/autoware.universe that referenced this pull request Mar 21, 2024
autowarefoundation#1171)

feat(traffic_light): depend on is_simulation for scenario simulator (autowarefoundation#6498)

* feat(traffic_light): depend on is_simulation for scenario simulator



* fix comments



* fix



---------

Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com>
Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp>
Co-authored-by: Takayuki Murooka <takayuki5168@gmail.com>
saka1-s pushed a commit to saka1-s/autoware.universe that referenced this pull request May 23, 2024
autowarefoundation#1171)

feat(traffic_light): depend on is_simulation for scenario simulator (autowarefoundation#6498)

* feat(traffic_light): depend on is_simulation for scenario simulator

* fix comments

* fix

---------

Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com>
Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp>
Co-authored-by: Takayuki Murooka <takayuki5168@gmail.com>
@github-actions github-actions bot added component:control Vehicle control algorithms and mechanisms. (auto-assigned) component:launch Launch files, scripts and initialization tools. (auto-assigned) labels Aug 22, 2024
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Labels
component:control Vehicle control algorithms and mechanisms. (auto-assigned) component:launch Launch files, scripts and initialization tools. (auto-assigned)
Projects
None yet
Development

Successfully merging this pull request may close these issues.

2 participants