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(motion_velocity_smoother): add steering rate limit while planning velocity #1071

Conversation

brkay54
Copy link
Member

@brkay54 brkay54 commented Jun 9, 2022

Description

Closes #1023
Discussion
Related #567

Autoware do not depend the steering angle rate. In lateral controller, we can set steering_rate_limit (here). However, when lower steering_rate_limit is set, the states that are calculated by lateral_controller are seem good. But longitudinal controller can not handle, It should slow down the vehicle because of low steering_angle_rate but it is not. And vehicle could not turn over the high curvature paths.

To solve this problem, I added new function into motion_velocity_smoother in smoother_base called applySteeringRateLimit. This function runs in following order:

  • Resample trajectory
  • Calculate the desired steering tire angles with following equation:
    desired_steering_angle_eq
  • Calculate the desired velocities with respect to current velocity and desired steering angle

Related links

Tests performed

Notes for reviewers

You can change the steering tire rate limit with the param in lateral controller. Also, you should check the parameters in motion_velocity_smoother.param.yaml.
Please consider the min_curve_velocity parameter, if vehicle can not turn in the curves.

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.

@brkay54 brkay54 added the component:planning Route planning, decision-making, and navigation. (auto-assigned) label Jun 9, 2022
@brkay54 brkay54 self-assigned this Jun 9, 2022
@brkay54 brkay54 changed the title Add steer rate to motion velocity planner Add steer rate limit to motion velocity planner Jun 9, 2022
@brkay54 brkay54 force-pushed the add-steer-rate-to-motion-velocity-planner branch from 9085335 to 0f48b40 Compare June 9, 2022 14:20
@codecov
Copy link

codecov bot commented Jun 9, 2022

Codecov Report

Merging #1071 (cf17866) into main (c211845) will decrease coverage by 0.03%.
The diff coverage is 0.00%.

@@            Coverage Diff             @@
##             main    #1071      +/-   ##
==========================================
- Coverage   10.41%   10.37%   -0.04%     
==========================================
  Files        1218     1218              
  Lines       87494    87785     +291     
  Branches    20485    20528      +43     
==========================================
  Hits         9109     9109              
- Misses      68925    69216     +291     
  Partials     9460     9460              
Flag Coverage Δ *Carryforward flag
differential 3.57% <0.00%> (?)
total 10.39% <0.00%> (ø) Carriedforward from c211845

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

Impacted Files Coverage Δ
...ity_smoother/src/motion_velocity_smoother_node.cpp 0.00% <0.00%> (ø)
...n_velocity_smoother/src/smoother/smoother_base.cpp 0.00% <0.00%> (ø)

Help us with your feedback. Take ten seconds to tell us how you rate us. Have a feature suggestion? Share it here.

@brkay54 brkay54 force-pushed the add-steer-rate-to-motion-velocity-planner branch from ff61555 to 310146b Compare June 9, 2022 15:06
@brkay54 brkay54 changed the title Add steer rate limit to motion velocity planner feat(motion_velocity_smoother): Add steer rate limit to motion velocity planner Jun 9, 2022
@brkay54 brkay54 changed the title feat(motion_velocity_smoother): Add steer rate limit to motion velocity planner feat(motion_velocity_smoother): add steering rate limit while planning velocity Jun 9, 2022
brkay54 added a commit to brkay54/autoware.universe that referenced this pull request Jun 9, 2022
…g velocity (autowarefoundation#1071)

function added,


not turning


fix the always positive curvature problem


added lower velocity limit


added vehicle parameters


functions created

Signed-off-by: Berkay <[email protected]>
@brkay54 brkay54 force-pushed the add-steer-rate-to-motion-velocity-planner branch from a3fd7df to eb29786 Compare June 9, 2022 15:12
brkay54 added a commit to brkay54/autoware.universe that referenced this pull request Jun 27, 2022
…g velocity (autowarefoundation#1071)

function added,


not turning


fix the always positive curvature problem


added lower velocity limit


added vehicle parameters


functions created

Signed-off-by: Berkay <[email protected]>
@brkay54 brkay54 force-pushed the add-steer-rate-to-motion-velocity-planner branch from ab1ea8a to ec3cd8e Compare June 27, 2022 10:25
brkay54 added a commit to brkay54/autoware.universe that referenced this pull request Jun 27, 2022
…g velocity (autowarefoundation#1071)

function added,


not turning


fix the always positive curvature problem


added lower velocity limit


added vehicle parameters


functions created

Signed-off-by: Berkay <[email protected]>
@brkay54 brkay54 force-pushed the add-steer-rate-to-motion-velocity-planner branch from ec3cd8e to 32c0de3 Compare June 27, 2022 11:59
@brkay54 brkay54 marked this pull request as draft June 27, 2022 15:22
@brkay54 brkay54 force-pushed the add-steer-rate-to-motion-velocity-planner branch 2 times, most recently from c9ce0c3 to ccebd04 Compare June 28, 2022 13:12
@brkay54 brkay54 marked this pull request as ready for review June 28, 2022 13:15
yukkysaito added a commit to yukkysaito/autoware.universe that referenced this pull request Jun 29, 2022
* 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 <[email protected]>

* fix message type

* delete unused message from cmake

* remove stopReasonStamped

* change topic name of stop reasons

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

* Fix/stop reason (autowarefoundation#724)

* input stop reason of traffic light

* add comment

* add empty traffic light handling

* change calculation method of traffic light position

* avoid 0 position output

* add debug values of adaptive cruise control (autowarefoundation#742)

* add debug values of adaptive cruise control

* add rqt config file

* cosmetic change (autowarefoundation#738)

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

* Fix/acc same pointcloud (autowarefoundation#743)

* add handling with same pointcloud

* clean code

* add obstacle_stop_planner.yaml (autowarefoundation#766)

* add stop_planner.yaml

* change file name

* add explanation of the parameters

* fix wrong start index (autowarefoundation#745)

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

* Feature/smooth adaptive cruise (autowarefoundation#789)

* change param

* do not insert max velocity near the ego vehicle position

* Change min_slow_down_vel to 3kmph (autowarefoundation#796)

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

* Remove duplicated param (autowarefoundation#797)

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

* Feature/lowpass adaptive cruise control (autowarefoundation#802)

* add lowpass filter

* update xml

* change the method of insert velocity

* change parameter

* change default lowpass gain in acc (autowarefoundation#820)

* change default deceleration in acc

* change lowpass gain

* Reduce calc cost of slow down (#826)

* Cosmetic change

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

* Fix rough search range

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

* Add circle inside/outside judgement

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

* Apply clang

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

* fix uninitialized variables (autowarefoundation#816)

* Revert "Reduce calc cost of slow down (#826)" (autowarefoundation#832)

This reverts commit 845ab7b1b90f8817c8fcb12880b5af6f78c2b183.

* Reduce calc cost stop planner (autowarefoundation#833)

* Reduce calc cost of slow down (#826)

* Cosmetic change

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

* Fix rough search range

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

* Add circle inside/outside judgement

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

* Apply clang

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

* Parameterize step length

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

* Fix search range

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

* remove ROS1 packages temporarily

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

* Revert "remove ROS1 packages temporarily"

This reverts commit dae63c141d17c2c7d0402ca2b9c5c1f008101631.

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

* add COLCON_IGNORE to ros1 packages

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

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

* Port obstacle stop planner (autowarefoundation#86)

* Port to ROS2

Signed-off-by: Servando German Serrano <[email protected]>

* Use autoware_debug_msgs

Signed-off-by: Servando German Serrano <[email protected]>

* Fix variable name

Signed-off-by: Servando German Serrano <[email protected]>

* Fix launch files (autowarefoundation#122)

* [surround_obstacle_checker] add parameter and arguments to launch file

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

* [obstacle_stop_planner] modify launch file to remap trajectory from argument

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

* [obstacle_avoidance_planner] modify launch file to remap topics from arguments

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

* [motion_velocity_optimizer] modify launch file to enable remapping from argument

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

* Convert calls of Duration to Duration::from_seconds where appropriate (autowarefoundation#131)

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

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

* Use quotes for includes where appropriate

* Fix lint tests

* Make tests pass hopefully

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

* Run uncrustify on the entire Pilot.Auto codebase

* Exclude open PRs

* Added linters to obstacle_stop_planner (autowarefoundation#154)

* Added linters to obstacle_stop_planner

* Remove use of deprecated ConstPtr

* Remove use of deprecated ::Ptr

* Removed unused variables

* Fix sign mismatches

* Fix non-void returns

* Fix cpplint error

* Fix sign mismatching

Co-authored-by: Jilada Eccleston <[email protected]>

* Ros2 v0.8.0 obstacle stop planner (autowarefoundation#300)

* rename before v0.8.0 update

* Update default parameters of slow_down_planner (autowarefoundation#846)

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

* Fix missing break (autowarefoundation#855)

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

* fix slow down param (autowarefoundation#871)

* Fix typos in planning modules (autowarefoundation#866)

* fix typos in planning

* fix corresponding typos in planning

* revert fixed typos temporarily due to its impact on launchers

* enable to change acc_param file from arg (autowarefoundation#997)

* Feature/refactor obstacle stop planner (autowarefoundation#1000)

* devide functions

* add StopPoint and SlowDownPoint structure

* apply clang-format 6.0

* Feature/update adaptive cruise control (autowarefoundation#995)

* avoid upper velocity chattering

* add option to use  rough velocity estimation

* fix typo

* apply format

* fix comment

* change min velocity by PID (autowarefoundation#1008)

* Feature/obstacle stop after goal margin (autowarefoundation#957)

* devide functions

* add StopPoint and SlowDownPoint structure

* apply clang-format 6.0

* add extend trajectory method

* change extend_distance default value to 0.0

* does not insert when insert point over output_msg points size

* fix acc limit (autowarefoundation#1015)

* Feature/compensate lidar delay to acc (autowarefoundation#1032)

* add compensation to calc dist

* change compensation way

* delete debug output

* separate emerngecy stop param (autowarefoundation#1033)

* improve accuracy of insert stop pose (autowarefoundation#1034)

* add error handling (autowarefoundation#1037)

* expand stop param (autowarefoundation#1068)

* add param

* add awapi topic

Co-authored-by: tomoya.kimura <[email protected]>

* fix default param (autowarefoundation#1071)

* Add expand_stop_range to obstacle_stop_planner.yaml (autowarefoundation#1084)

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

* Revert "rename before v0.8.0 update"

This reverts commit 395c529ee1a854db35ee4f4d517da2dfb401914c.

* fix clock & restore include guard

* fix code style

* fix node

* fix params

* nest acc params

Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Daisuke Nishimatsu <[email protected]>
Co-authored-by: Taichi Higashide <[email protected]>
Co-authored-by: Kazuki Miyahara <[email protected]>
Co-authored-by: tkimura4 <[email protected]>
Co-authored-by: Yukihiro Saito <[email protected]>

* Ros2 v0.8.0 remove std msgs awapi (autowarefoundation#348)

* [autoware_vehicle_msgs] add BatteryStatus msg

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

* [autoware_planning_msgs] add ExpandStopRange and StopSpeedExceeded messages

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

* [autoware_api_msgs] add DoorControlCommand, StopCommand, and VelocityLimit messages

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

* remove std_msgs related to autoware_awaiv_adapter node

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

* apply ament_uncrustify

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

* fix build failure

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

* fix test failures

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

* address review commends

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

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

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

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

* Remove prefix 'default_' of yaml files

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

* Rename vehicle_info.yaml to vehicle_info.param.yaml

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

* Rename diagnostic_aggregator's param files

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

* Fix overlooked parameters

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

* fix insert slow down point bug (autowarefoundation#1159) (autowarefoundation#376)

* fix slow down insert slow down point bug

* refactor code

Co-authored-by: Taichi Higashide <[email protected]>

* fix implement miss (autowarefoundation#409)

* Sensor data qos (autowarefoundation#407)

* Use sensor data qos for pointcloud preprocessor

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

* Use sensor data qos for pointcloud

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

* Fix lint

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

* Use sensor data qos for livox tag filter and vector map filter

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

* Fix lint

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

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

* Ros2 fix topic name part1 (autowarefoundation#408)

* Fix topic name of lane_departure_checker debug

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

* Fix topic name of mpc_follower debug

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

* Fix topic name of velocity_controller debug

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

* Fix topic name of motion_velocity_optimizer debug

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

* Fix topic name of lane_change_planner debug

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

* Fix topic name of behavior_velocity_planner debug

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

* Fix topic name of obstacle_avoidance_planner debug

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

* Fix topic name of behavior_velocity_planner

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

* Fix topic name of motion_velocity_optimizer

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

* Fix topic name of lane_departure_checker

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

* Fix topic name of mpc_follower

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

* Fix topic name of behavior_velocity_planner

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

* Fix topic name of velocity_controller

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

* Fix topic name of lane_change_planner

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

* Fix topic name of obstacle_avoidance_planner

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

* Fix topic name of obstacle_stop_planner

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

* Fix topic name of costmap_generator

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

* Fix topic name of freespace_planner

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

* Fix topic name of surround_obstacle_checker

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

* Fix topic name of costmap_generator

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

* Fix topic name of emergency_handler

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

* Fix lint errors

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

* Fix typo

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

* add use_sim-time option (autowarefoundation#454)

* Fix rolling build errors (autowarefoundation#1225)

* Add missing include files

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

* Replace rclcpp::Duration

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

* Use reference for exceptions

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

* Use from_seconds

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

* Sync public repo (autowarefoundation#1228)

* [simple_planning_simulator] add readme (autowarefoundation#424)

* add readme of simple_planning_simulator

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

* Update simulator/simple_planning_simulator/README.md

* set transit_margin_time to intersect. planner (autowarefoundation#460)

* Fix pose2twist (autowarefoundation#462)

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

* Ros2 vehicle info param server (autowarefoundation#447)

* add vehicle_info_param_server

* update vehicle info

* apply format

* fix bug

* skip unnecessary search

* delete vehicle param file

* fix bug

* Ros2 fix topic name part2 (autowarefoundation#425)

* Fix topic name of traffic_light_classifier

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

* Fix topic name of traffic_light_visualization

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

* Fix topic name of traffic_light_ssd_fine_detector

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

* Fix topic name of traffic_light_map_based_detector

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

* Fix lint traffic_light_recognition

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

* Fix lint traffic_light_ssd_fine_detector

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

* Fix lint traffic_light_classifier

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

* Fix lint traffic_light_classifier

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

* Fix lint traffic_light_ssd_fine_detector

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

* Fix issues in hdd_reader (autowarefoundation#466)

* Fix some issues detected by Coverity Scan and Clang-Tidy

* Update launch command

* Add more `close(new_sock)`

* Simplify the definitions of struct

* fix: re-construct laneletMapLayer for reindex RTree (autowarefoundation#463)

* Rviz overlay render fix (autowarefoundation#461)

* Moved painiting in SteeringAngle plugin to update()

Signed-off-by: Adam Dabrowski <[email protected]>

* super class now back to MFD

Signed-off-by: Adam Dabrowski <[email protected]>

* uncrustified

Signed-off-by: Adam Dabrowski <[email protected]>

* acquire data in mutex

Signed-off-by: Adam Dabrowski <[email protected]>

* back to RTD as superclass

Signed-off-by: Adam Dabrowski <[email protected]>

* Rviz overlay render in update (autowarefoundation#465)

* Moved painiting in SteeringAngle plugin to update()

Signed-off-by: Adam Dabrowski <[email protected]>

* super class now back to MFD

Signed-off-by: Adam Dabrowski <[email protected]>

* uncrustified

Signed-off-by: Adam Dabrowski <[email protected]>

* acquire data in mutex

Signed-off-by: Adam Dabrowski <[email protected]>

* removed unnecessary includes and some dead code

Signed-off-by: Adam Dabrowski <[email protected]>

* Adepted remaining vehicle plugin classes to render-in-update concept. Returned to MFD superclass

Signed-off-by: Adam Dabrowski <[email protected]>

* restored RTD superclass

Signed-off-by: Adam Dabrowski <[email protected]>

Co-authored-by: Takamasa Horibe <[email protected]>
Co-authored-by: tkimura4 <[email protected]>
Co-authored-by: Takagi, Isamu <[email protected]>
Co-authored-by: Kazuki Miyahara <[email protected]>
Co-authored-by: Makoto Tokunaga <[email protected]>
Co-authored-by: Adam Dąbrowski <[email protected]>

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

* Make planning modules components (autowarefoundation#1263)

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

* fix miss spell (autowarefoundation#1268)

* Remove use_sim_time for set_parameter (autowarefoundation#1260)

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

* Refactor vehicle info util (autowarefoundation#1305)

* Update license

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

* Refactor vehicle_info_util

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

* Rename and split files

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

* Fix interfaces

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

* Fix bug and add error handling

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

* Add "// namespace"

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

* Add missing include

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

* add config file of plot juggler (autowarefoundation#1328)

* Add pre-commit (autowarefoundation#1560)

* add pre-commit

* add pre-commit-config

* add additional settings for private repository

* use default pre-commit-config

* update pre-commit setting

* Ignore whitespace for line breaks in markdown

* Update .github/workflows/pre-commit.yml

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

* exclude svg

* remove pretty-format-json

* add double-quote-string-fixer

* consider COLCON_IGNORE file when seaching modified package

* format file

* pre-commit fixes

* Update pre-commit.yml

* Update .pre-commit-config.yaml

Co-authored-by: Kazuki Miyahara <[email protected]>
Co-authored-by: pre-commit <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>

* Fix -Wunused-parameter (autowarefoundation#1836)

* Fix -Wunused-parameter

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

* Fix mistake

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

* fix spell

* Fix lint issues

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

* Ignore flake8 warnings

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

Co-authored-by: Hiroki OTA <[email protected]>

* Fix compiler warnings (autowarefoundation#1837)

* Fix -Wunused-private-field

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

* Fix -Wunused-variable

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

* Fix -Wformat-security

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

* Fix -Winvalid-constexpr

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

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

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

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

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

* Fix -Winconsistent-missing-override

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

* Fix -Wrange-loop-construct

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

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

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

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

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

* Fix lint

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

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

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

* Fix mistake

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

* Fix -Wunused-parameter

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

* suppress warnings for planning (autowarefoundation#1893)

* add Werror

* add maybe_unused

* fix estm -> estimate

* fix some typos (autowarefoundation#1941)

* fix some typos

* fix typo

* Fix typo

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

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

* fix calc_dist in acc (autowarefoundation#1945)

* fix calc_dist in acc

* use baselink2front

* remove unused variable

* fix

* 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

* Feature/changeable slow down margin (autowarefoundation#1546) (autowarefoundation#1726)

* Feature/changeable slow down margin (autowarefoundation#1546)

* start slow down at SlowDownStart

* add publisher for debug

* update slow down planner implementation

* delete unnecessary publisher

* change function name

* apply clang-format

* refactoring

* refactoring & apply clang-format

* add virtual wall marker

Co-authored-by: satoshi-ota <[email protected]>

* Fix typo

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

* Apply uncrustify

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

* Apply cpplint

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

* Fix package.xml

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

* Remove unused variable

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

Co-authored-by: Satoshi OTA <[email protected]>
Co-authored-by: satoshi-ota <[email protected]>

* Fix/not appropriate velocity overwrite (autowarefoundation#1750)

* fix not appropriate velocity overwrite

* apply format

* cleanup/wrap planner params by using struct (autowarefoundation#1788)

* wrap planner params by using struct

* move bg alias & add address operator

* improve readability of loading parameters

* remove unsuitable vehicle_info alias

* remove unsuitable slow_down/stop planner param alias

* add struct NodeParam

* move using define

* change param order

Co-authored-by: satoshi-ota <[email protected]>

* improvement/replace several lines with autoware_utils func (autowarefoundation#1783)

* clean up

* remove redundant blank line

* LINE_STRIP -> LINE_LIST

Co-authored-by: satoshi-ota <[email protected]>

* Refactor/obstacle stop planner (autowarefoundation#1811)

* use autoware_utils getRPY()

* use point alias & rename variables

* use TrajectoryPoint instead of Eigen::Vector2d

* split insertSlowDownSection() into two part

* use trajectory point alias

* change variables order

* fix build error

* use std::numeric_limits::epsilon() & small change

* add address operator

* fix typo

* apply format

* update TrajectoryPoint insert condition

* use std::hypot

* change alias name

* move using alias & remove unnesessary include

* remove an unnecessary variable

* improve readability

* undo the insert min dist

* remane variables & improve readability

* fix redundant variables name

* tmp : remove scope

* remove unnecessary alias

* rename alias to improve readability

* p_end -> p_back

* undo partial rename

* undo calc order modification

* undo split insertSlowDownSection() into two parts

* prevent TrajectoryPoint overlapping

* remove unnecessary file

* undo logic modification

* initialize struct

* fix constraints

* fix indent

* improve struct initialize

* remove redundant address operator

* initialize TrajectoryPoint

* guard invalid index

* remove std::min

Co-authored-by: satoshi-ota <[email protected]>

* Fix/obstacle search radius in obstacle stop planner (autowarefoundation#1823)

* guard activation both of slow down and stop by a collision obstacle

* fix obstacle search radius bug

* fix indent

* rename variables

* not deactivate slow down planning

* initialize index

* remove .swp

Co-authored-by: satoshi-ota <[email protected]>

* set initial value of lowpass filter in acc (autowarefoundation#1880)

* set initial value of lowpass filter in acc

* add space

* Feature/add obstacle stop doc (autowarefoundation#1890)

* add base doc.

* add svg files

* add flow chart

* add roles

* fix svg

* add discription of flowchart

* add figure to readme

* fix typo

* add plantuml

* fix typo

* upper velocity -> target velocity

* add svg

* add more dicription of stop/slow down planner

* add adaptive cruise document

* fix typo

* apply markdown lint

* fix format

* fix format

* fix svg

* fix typo

* fix format

* Update planning/scenario_planning/lane_driving/motion_planning/obstacle_stop_planner/README.md

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

* Update planning/scenario_planning/lane_driving/motion_planning/obstacle_stop_planner/README.md

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

* add adaptive cruise description

* fix deceleration range

* fix description of slow down planner

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

* add maybe unused (autowarefoundation#1908)

* prevent chattering in adaptive cruise  (autowarefoundation#1954)

* fix typo

* update readme

* add description

* add two threhold of obstacle velocity

* fix calc_dist in acc (autowarefoundation#1945)

* fix calc_dist in acc

* use baselink2front

* remove unused variable

* fix

* remove unused arg (autowarefoundation#1971)

* improve/commonize calc  insert point function (autowarefoundation#1825)

* add insert function

* fix typo

* remove unnecessary address operator

* use common function

* index small change

* rename variables

* fix loop condition

* fix loop condition no use static_cast

* remove .swp

* update insert inplementation

* fix dist_remain plus/minus

* improve readability

Co-authored-by: satoshi-ota <[email protected]>

* Fix package.xml (autowarefoundation#2056)

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

* fix obstacle stop (autowarefoundation#2083) (autowarefoundation#2086)

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

* Feature/keep slow down speed until end point of slow down section (autowarefoundation#1985)

* modify logic: not escape slow down until slow down section end

* refactor: add findNearestFrontIndex()

* remove unused argument & function

* improve readability

* add utility func

* modify logic condition

* fix for createQuaternionFromRPY/Yaw (autowarefoundation#2154)

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

* Fix/insert implementation (autowarefoundation#2186)

* Feature/consider jerk by using external velocity limit (autowarefoundation#2158)

* consider jerk and acc constraint in slow down

* use external velocity limit

* consider constraints

* add publisher for debug

* publish jerk/acc constraints

* add undershoot measures

* add plotjuggle config (slow down planner)

* fix unexpected speed up

* update undershoot guard

* bool initialize

* support new VelocityLimit.msg

* smplify velocity limit logic

* improve readability

* clean up debug publisher

* use planner data

* add publishDebugData()

* clean up trajectory preprocess

* add bad index detection

* split a huge process into two parts

* fix typo(threshould -> threshold)

* use limit selector

* add comment

* update plotjuggler config

* update member variables

Co-authored-by: satoshi-ota <[email protected]>

* Fix/use common planning param (autowarefoundation#2246)

* use common planning param

* jerk_min_slow_down -> slow_down_min_jerk

* fix velocity threshold (autowarefoundation#2264)

* Fix/trajectory preprocess (autowarefoundation#2285)

* fix preprocess

* add index guard

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

* Revert "Temporarily comment out pre-commit hooks"

This reverts commit 748e9cdb145ce12f8b520bcbd97f5ff899fc28a3.

* Replace ament_lint_common with autoware_lint_common

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

* Remove ament_cmake_uncrustify and ament_clang_format

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

* Apply Black

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

* Apply clang-format

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

* Fix build errors

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

* Fix for cpplint

* Fix include double quotes to angle brackets

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

* Apply clang-format

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

* Fix build errors

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

* Add COLCON_IGNORE (autowarefoundation#500)

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

* Auto/obstacle stop planner (autowarefoundation#531)

* delete COLCON_IGNORE

* port obstacle stop planner

* run pre commit

* add nav_msgs

* type conversion

* [apply_predicted_obj_type] adapt to autoware auto msgs (autowarefoundation#564)

* fix obj shape

* fix obj shape

* fix goal pose

* rename topic name twist -> odometry (autowarefoundation#568)

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

* 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 <[email protected]>

* Auto/fix obstacle stop planner (#678)

* change trajectory to trajectory point in node

* update

* update

* delete comment

* fix invalidContainerReference

* substitute header to output

Co-authored-by: tomoya.kimura <[email protected]>

* mix readme

* add common param

Co-authored-by: mitsudome-r <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Yukihiro Saito <[email protected]>
Co-authored-by: Taichi Higashide <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Daisuke Nishimatsu <[email protected]>
Co-authored-by: Kazuki Miyahara <[email protected]>
Co-authored-by: Nikolai Morin <[email protected]>
Co-authored-by: Servando <[email protected]>
Co-authored-by: Ryohsuke Mitsudome <[email protected]>
Co-authored-by: Esteve Fernandez <[email protected]>
Co-authored-by: Jilada Eccleston <[email protected]>
Co-authored-by: Shinnosuke Hirakawa <[email protected]>
Co-authored-by: Autoware <[email protected]>
Co-authored-by: Takagi, Isamu <[email protected]>
Co-authored-by: Takamasa Horibe <[email protected]>
Co-authored-by: Makoto Tokunaga <[email protected]>
Co-authored-by: Adam Dąbrowski <[email protected]>
Co-authored-by: Yusuke FUJII <[email protected]>
Co-authored-by: Keisuke Shima <[email protected]>
Co-authored-by: pre-commit <[email protected]>
Co-authored-by: Hiroki OTA <[email protected]>
Co-authored-by: Satoshi OTA <[email protected]>
Co-authored-by: satoshi-ota <[email protected]>
Co-authored-by: taikitanaka3 <[email protected]>
Co-authored-by: autoware-iv-sync-ci[bot] <87871706+autoware-iv-sync-ci[bot]@users.noreply.github.com>
Co-authored-by: Takayuki Murooka <[email protected]>
Co-authored-by: Sugatyon <[email protected]>
Co-authored-by: Takayuki Murooka <[email protected]>
@xmfcx xmfcx added this to the Bus ODD July-Aug Milestone milestone Jul 19, 2022
brkay54 added a commit to brkay54/autoware.universe that referenced this pull request Jul 19, 2022
…g velocity (autowarefoundation#1071)

function added,


not turning


fix the always positive curvature problem


added lower velocity limit


added vehicle parameters


functions created

Signed-off-by: Berkay <[email protected]>
brkay54 added a commit to brkay54/autoware.universe that referenced this pull request Jul 20, 2022
…g velocity (autowarefoundation#1071)

function added,


not turning


fix the always positive curvature problem


added lower velocity limit


added vehicle parameters


functions created

Signed-off-by: Berkay <[email protected]>
@brkay54 brkay54 force-pushed the add-steer-rate-to-motion-velocity-planner branch from 36a8d6d to 41788d5 Compare August 15, 2022 06:26
@xmfcx
Copy link
Contributor

xmfcx commented Aug 16, 2022

This is being tested on the ISUZU bus right now, the updates will be shared after testing.

voltonomous added a commit to vautonomous/autoware.universe that referenced this pull request Aug 17, 2022
…g velocity (autowarefoundation#1071)

function added,


not turning


fix the always positive curvature problem


added lower velocity limit


added vehicle parameters


functions created

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

Update readme

update svg


readme updated


with test params
change sample rate


calculate accurate dt


test

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

fix trajectory size


update readme


change map loader params
Signed-off-by: Berkay <[email protected]>

clear unnecessary comment

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

change the min and max index

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

ci(pre-commit): autofix

removed unnecessary params and comments

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

ci(pre-commit): autofix

all velocities in lookup distance is changed


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


ci(pre-commit): autofix

works


ci(pre-commit): autofix

changed calculations


with const lookupdistance


ci(pre-commit): autofix

not work peak points


written with constant distances


added param


ci(pre-commit): autofix

update


ci(pre-commit): autofix

update steering angle calculation method


ci(pre-commit): autofix
voltonomous added a commit to vautonomous/autoware.universe that referenced this pull request Aug 18, 2022
…g velocity (autowarefoundation#1071)

function added,


not turning


fix the always positive curvature problem


added lower velocity limit


added vehicle parameters


functions created

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

Update readme

update svg


readme updated


with test params
change sample rate


calculate accurate dt


test

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

fix trajectory size


update readme


change map loader params
Signed-off-by: Berkay <[email protected]>

clear unnecessary comment

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

change the min and max index

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

ci(pre-commit): autofix

removed unnecessary params and comments

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

ci(pre-commit): autofix

all velocities in lookup distance is changed


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


ci(pre-commit): autofix

works


ci(pre-commit): autofix

changed calculations


with const lookupdistance


ci(pre-commit): autofix

not work peak points


written with constant distances


added param


ci(pre-commit): autofix

update


ci(pre-commit): autofix

update steering angle calculation method


ci(pre-commit): autofix
@brkay54
Copy link
Member Author

brkay54 commented Aug 19, 2022

velocity profile of vehicle with 5.0 dps steering rate in sharp turn.

Screenshot from 2022-08-19 14-15-10

@brkay54 brkay54 marked this pull request as draft August 19, 2022 12:38
voltonomous added a commit to vautonomous/autoware.universe that referenced this pull request Aug 25, 2022
…g velocity (autowarefoundation#1071)

function added,


not turning


fix the always positive curvature problem


added lower velocity limit


added vehicle parameters


functions created

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

Update readme

update svg


readme updated


with test params
change sample rate


calculate accurate dt


test

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

fix trajectory size


update readme


change map loader params
Signed-off-by: Berkay <[email protected]>

clear unnecessary comment

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

change the min and max index

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

ci(pre-commit): autofix

removed unnecessary params and comments

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

ci(pre-commit): autofix

all velocities in lookup distance is changed


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


ci(pre-commit): autofix

works


ci(pre-commit): autofix

changed calculations


with const lookupdistance


ci(pre-commit): autofix

not work peak points


written with constant distances


added param


ci(pre-commit): autofix

update


ci(pre-commit): autofix

update steering angle calculation method


ci(pre-commit): autofix
voltonomous added a commit to vautonomous/autoware.universe that referenced this pull request Aug 27, 2022
…g velocity (autowarefoundation#1071)

function added,


not turning


fix the always positive curvature problem


added lower velocity limit


added vehicle parameters


functions created

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

Update readme

update svg


readme updated


with test params
change sample rate


calculate accurate dt


test

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

fix trajectory size


update readme


change map loader params
Signed-off-by: Berkay <[email protected]>

clear unnecessary comment

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

change the min and max index

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

ci(pre-commit): autofix

removed unnecessary params and comments

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

ci(pre-commit): autofix

all velocities in lookup distance is changed


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


ci(pre-commit): autofix

works


ci(pre-commit): autofix

changed calculations


with const lookupdistance


ci(pre-commit): autofix

not work peak points


written with constant distances


added param


ci(pre-commit): autofix

update


ci(pre-commit): autofix

update steering angle calculation method


ci(pre-commit): autofix
@brkay54 brkay54 force-pushed the add-steer-rate-to-motion-velocity-planner branch from 41788d5 to b3f1e7c Compare September 5, 2022 10:37
brkay54 added a commit to brkay54/autoware.universe that referenced this pull request Sep 5, 2022
…g velocity (autowarefoundation#1071)

function added,


not turning


fix the always positive curvature problem


added lower velocity limit


added vehicle parameters


functions created

Signed-off-by: Berkay <[email protected]>
@brkay54 brkay54 marked this pull request as ready for review September 5, 2022 11:09
@brkay54 brkay54 requested a review from rej55 as a code owner September 5, 2022 11:09
@xmfcx
Copy link
Contributor

xmfcx commented Sep 6, 2022

@brkay54 are there any updates on this PR?

@brkay54
Copy link
Member Author

brkay54 commented Sep 6, 2022

@brkay54 are there any updates on this PR?

It is waiting review.

…g velocity (autowarefoundation#1071)

function added,


not turning


fix the always positive curvature problem


added lower velocity limit


added vehicle parameters


functions created

Signed-off-by: Berkay <[email protected]>
update svg


readme updated


with test params
change sample rate


calculate accurate dt


test

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

fix trajectory size


update readme


change map loader params
Signed-off-by: Berkay <[email protected]>

clear unnecessary comment

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

change the min and max index

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

ci(pre-commit): autofix

removed unnecessary params and comments

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

ci(pre-commit): autofix

all velocities in lookup distance is changed


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


ci(pre-commit): autofix

works


ci(pre-commit): autofix

changed calculations


with const lookupdistance


ci(pre-commit): autofix

not work peak points


written with constant distances


added param


ci(pre-commit): autofix

update


ci(pre-commit): autofix

update steering angle calculation method


ci(pre-commit): autofix

changed curvature calculation of steeringAngleLimit func

Signed-off-by: Berkay Karaman <[email protected]>

changed default parameter values

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

update readme

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

update engage velocity parameter

Signed-off-by: Berkay <[email protected]>
@brkay54 brkay54 force-pushed the add-steer-rate-to-motion-velocity-planner branch from b3f1e7c to 7d73b96 Compare September 7, 2022 09:29
@mehmetdogru
Copy link
Contributor

I tested the PR both on the test field (Gebze Technical University) and with planning simulator. Gave an example of a car which has lower steer_rate_lim_dps to make the difference more obvious.


Before the PR

steer_rate_lim_dps: 600.0 # steering angle rate limit [deg/s]

steer_rate_lim_dps: 10

video


After the PR

steer_rate_lim_dps: 600.0 # steering angle rate limit [deg/s]

steer_rate_lim_dps: 10

https://github.com/brkay54/autoware.universe/blob/cf178660cb6640c10b72f51a7e38e1800ef24f88/launch/tier4_planning_launch/config/scenario_planning/common/motion_velocity_smoother/motion_velocity_smoother.param.yaml#L51

max_steering_angle_rate: 10

video

Copy link
Contributor

@mehmetdogru mehmetdogru left a comment

Choose a reason for hiding this comment

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

Looks good to me, PR works as intended.

@mehmetdogru mehmetdogru merged commit c0f3507 into autowarefoundation:main Sep 7, 2022
voltonomous added a commit to vautonomous/autoware.universe that referenced this pull request Sep 7, 2022
fix ndt topic name


yolo multiple camera


fix lanenet


three lidar test


max iteration increased


ndt vehicle_test


controller test  day - 1


controller test day 2


purepursuit param changed


mpc-test-day-3


perception related changes


obstacle detection for planning offset changing


add vehicle_velocity_converter


control test day 4


control test 5


lateral controller tune


motionvel smoother param update


max lateral acc changed


update vehicle velocity controller launch


fix densification param 


update ekf params


Added traffic light 


add lidar_detection_model param


fix ekf init


update map altitude


add gnss twist topic to ekf


ndt max distance set 200


make clustering use non-ground points instead of outlier remover


practically disable object_lanelet_filter


avoid unknowns and pedestrians?


disable occlusion_spot in behavior_velocity_planner


change planner related params


tune mpc parameters for better tracking


change path planner/avoidance module params


tune controllers


feat(motion_velocity_smoother): add steering rate limit while planning velocity (autowarefoundation#1071)


function added,


not turning


fix the always positive curvature problem


added lower velocity limit


added vehicle parameters


functions created

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

Update readme

update svg


readme updated


with test params
change sample rate


calculate accurate dt


test

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

fix trajectory size


update readme


change map loader params
Signed-off-by: Berkay <[email protected]>

clear unnecessary comment

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

change the min and max index

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

ci(pre-commit): autofix

removed unnecessary params and comments

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

ci(pre-commit): autofix

all velocities in lookup distance is changed


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


ci(pre-commit): autofix

works


ci(pre-commit): autofix

changed calculations


with const lookupdistance


ci(pre-commit): autofix

not work peak points


written with constant distances


added param


ci(pre-commit): autofix

update


ci(pre-commit): autofix

update steering angle calculation method


ci(pre-commit): autofix

change controller related params


change controller related params


control pure pursuit longitudinal tune


tune
change some planning params


(temp) add speed_bump vis to lanelet map (temp)


acc std distance -> 7.0 m


Revert "(temp) add speed_bump vis to lanelet map (temp)"

This reverts commit 1c51e37.

modify hdd_reader params


change NTP server


added camera component container


yolo changed gpu variable


added rectifier node 


changed rectifier node on container


configure localization topics as sensordataqos


steering offset topic changed


Revert "feat(motion_velocity_smoother): add steering rate limit while planning velocity (autowarefoundation#1071)"

This reverts commit 88efc4c.
@brkay54 brkay54 deleted the add-steer-rate-to-motion-velocity-planner branch September 9, 2022 07:31
boyali referenced this pull request in boyali/autoware.universe Sep 28, 2022
…g velocity (tier4#1071)

* feat(motion_velocity_smoother): add steering rate limit while planning velocity (tier4#1071)


function added,


not turning


fix the always positive curvature problem


added lower velocity limit


added vehicle parameters


functions created

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

* Update readme

update svg


readme updated


with test params
change sample rate


calculate accurate dt


test

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

fix trajectory size


update readme


change map loader params
Signed-off-by: Berkay <[email protected]>

clear unnecessary comment

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

change the min and max index

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

ci(pre-commit): autofix

removed unnecessary params and comments

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

ci(pre-commit): autofix

all velocities in lookup distance is changed


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


ci(pre-commit): autofix

works


ci(pre-commit): autofix

changed calculations


with const lookupdistance


ci(pre-commit): autofix

not work peak points


written with constant distances


added param


ci(pre-commit): autofix

update


ci(pre-commit): autofix

update steering angle calculation method


ci(pre-commit): autofix

changed curvature calculation of steeringAngleLimit func

Signed-off-by: Berkay Karaman <[email protected]>

changed default parameter values

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

update readme

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

update engage velocity parameter

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

* ci(pre-commit): autofix

Signed-off-by: Berkay <[email protected]>
Co-authored-by: Berkay <[email protected]>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>
boyali referenced this pull request in boyali/autoware.universe Oct 3, 2022
…g velocity (tier4#1071)

* feat(motion_velocity_smoother): add steering rate limit while planning velocity (tier4#1071)


function added,


not turning


fix the always positive curvature problem


added lower velocity limit


added vehicle parameters


functions created

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

* Update readme

update svg


readme updated


with test params
change sample rate


calculate accurate dt


test

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

fix trajectory size


update readme


change map loader params
Signed-off-by: Berkay <[email protected]>

clear unnecessary comment

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

change the min and max index

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

ci(pre-commit): autofix

removed unnecessary params and comments

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

ci(pre-commit): autofix

all velocities in lookup distance is changed


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


ci(pre-commit): autofix

works


ci(pre-commit): autofix

changed calculations


with const lookupdistance


ci(pre-commit): autofix

not work peak points


written with constant distances


added param


ci(pre-commit): autofix

update


ci(pre-commit): autofix

update steering angle calculation method


ci(pre-commit): autofix

changed curvature calculation of steeringAngleLimit func

Signed-off-by: Berkay Karaman <[email protected]>

changed default parameter values

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

update readme

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

update engage velocity parameter

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

* ci(pre-commit): autofix

Signed-off-by: Berkay <[email protected]>
Co-authored-by: Berkay <[email protected]>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>
boyali referenced this pull request in boyali/autoware.universe Oct 3, 2022
…g velocity (tier4#1071)

* feat(motion_velocity_smoother): add steering rate limit while planning velocity (tier4#1071)


function added,


not turning


fix the always positive curvature problem


added lower velocity limit


added vehicle parameters


functions created

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

* Update readme

update svg


readme updated


with test params
change sample rate


calculate accurate dt


test

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

fix trajectory size


update readme


change map loader params
Signed-off-by: Berkay <[email protected]>

clear unnecessary comment

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

change the min and max index

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

ci(pre-commit): autofix

removed unnecessary params and comments

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

ci(pre-commit): autofix

all velocities in lookup distance is changed


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


ci(pre-commit): autofix

works


ci(pre-commit): autofix

changed calculations


with const lookupdistance


ci(pre-commit): autofix

not work peak points


written with constant distances


added param


ci(pre-commit): autofix

update


ci(pre-commit): autofix

update steering angle calculation method


ci(pre-commit): autofix

changed curvature calculation of steeringAngleLimit func

Signed-off-by: Berkay Karaman <[email protected]>

changed default parameter values

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

update readme

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

update engage velocity parameter

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

* ci(pre-commit): autofix

Signed-off-by: Berkay <[email protected]>
Co-authored-by: Berkay <[email protected]>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>
boyali referenced this pull request in boyali/autoware.universe Oct 19, 2022
…g velocity (tier4#1071)

* feat(motion_velocity_smoother): add steering rate limit while planning velocity (tier4#1071)


function added,


not turning


fix the always positive curvature problem


added lower velocity limit


added vehicle parameters


functions created

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

* Update readme

update svg


readme updated


with test params
change sample rate


calculate accurate dt


test

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

fix trajectory size


update readme


change map loader params
Signed-off-by: Berkay <[email protected]>

clear unnecessary comment

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

change the min and max index

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

ci(pre-commit): autofix

removed unnecessary params and comments

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

ci(pre-commit): autofix

all velocities in lookup distance is changed


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


ci(pre-commit): autofix

works


ci(pre-commit): autofix

changed calculations


with const lookupdistance


ci(pre-commit): autofix

not work peak points


written with constant distances


added param


ci(pre-commit): autofix

update


ci(pre-commit): autofix

update steering angle calculation method


ci(pre-commit): autofix

changed curvature calculation of steeringAngleLimit func

Signed-off-by: Berkay Karaman <[email protected]>

changed default parameter values

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

update readme

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

update engage velocity parameter

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

* ci(pre-commit): autofix

Signed-off-by: Berkay <[email protected]>
Co-authored-by: Berkay <[email protected]>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Labels
component:planning Route planning, decision-making, and navigation. (auto-assigned)
Projects
No open projects
Status: Done
Development

Successfully merging this pull request may close these issues.

Motion_velocity_smoother should depend the steering_rate_limit
5 participants