Feature/differential dynamic map loading #6

kminoda · 2022-09-08T06:24:27Z

Related Issue(required)

Description(required)

Review Procedure(required)

Related PR(optional)

Pre-Review Checklist for the PR Author

PR Author should check the checkboxes below when creating the PR.

Read commit-guidelines
Assign PR to reviewer

If you are adding new package following items are required:

Documentation with description of the package is available
A sample launch file and parameter file are available if the package contains executable nodes

Checklist for the PR Reviewer

Reviewers should check the checkboxes below before approval.

Commits are properly organized and messages are according to the guideline
PR title describes the changes

Post-Review Checklist for the PR Author

PR Author should check the checkboxes below before merging.

All open points are addressed and tracked via issues or tickets

CI Checks

Build and test for PR / build-and-test-pr: Required to pass before the merge.
Build and test for PR / clang-tidy-pr: NOT required to pass before the merge. It is up to the reviewer(s). Found false positives? See the [guidelines][clang-tidy-guidelines].
Check spelling: NOT required to pass before the merge. It is up to the reviewer(s). See here if you want to add some words to the spell check dictionary.

…tils (autowarefoundation#1489) * feat(motion_velocity_smoother): use resampling fucntion from motion utils Signed-off-by: yutaka <[email protected]> * fix behavior velocity planner Signed-off-by: yutaka <[email protected]>

…towarefoundation#1380) * fix(behavior_velocity_planner): changeable max stop distance Signed-off-by: satoshi-ota <[email protected]> * fix(behavior_velocity_planner): use alias Signed-off-by: satoshi-ota <[email protected]> * fix(behavior_velocity_planner): update default param Signed-off-by: satoshi-ota <[email protected]> * fix(behavior_velocity_plannerl): rename param Signed-off-by: satoshi-ota <[email protected]> * fix(behaivor_velocity_planner): fix current stop position Signed-off-by: satoshi-ota <[email protected]>

… module (autowarefoundation#1454) * feat(behavior_velocity_planner): add hold stop margin distance in vtl module Signed-off-by: satoshi-ota <[email protected]> * fix(behavior_velocity_planner): change default value Signed-off-by: satoshi-ota <[email protected]>

…oundation#1434) * feat(obstacle_stop_planner): add hold stop margin distance Signed-off-by: satoshi-ota <[email protected]> * feat(obstacle_stop_planner): output distance info Signed-off-by: satoshi-ota <[email protected]> * feat(obstacle_stop_planner): add param into config Signed-off-by: satoshi-ota <[email protected]>

…stance (autowarefoundation#1433) * fix(behavior_velocity_planner): use alias Signed-off-by: satoshi-ota <[email protected]> * fix(behavior_velocity_planner): add hold stop margin Signed-off-by: satoshi-ota <[email protected]> * fix(behavior_velocity_planner): use motion_utils Signed-off-by: satoshi-ota <[email protected]> * fix(behavior_velocity_planner): use motion_utils Signed-off-by: satoshi-ota <[email protected]> * fix(bahevior_velocity_planner): clean up Signed-off-by: satoshi-ota <[email protected]> * fix(behavior_velocity_planner): use common function Signed-off-by: satoshi-ota <[email protected]>

) * feat(scan_ground_filter): fix segfault Signed-off-by: Shunsuke Miura <[email protected]> * change using sentence Signed-off-by: Shunsuke Miura <[email protected]> * fix Signed-off-by: Shunsuke Miura <[email protected]> * remove unused code Signed-off-by: Shunsuke Miura <[email protected]>

…oundation#1458) * feat(obstacle_stop_planner): prevent from obstacle hunting Signed-off-by: satoshi-ota <[email protected]> * docs(obstacle_stop_planner): add common parameter description Signed-off-by: satoshi-ota <[email protected]> * fix(obstacle_stop_planner): fix bug Signed-off-by: satoshi-ota <[email protected]>

autowarefoundation#1510) * feat(behavior_path_planner): distance calculation for avoidance module Signed-off-by: Fumiya Watanabe <[email protected]> * feat(behavior_path_planner): add initialization Signed-off-by: Fumiya Watanabe <[email protected]>

* fix(freespace_planner): collision check Signed-off-by: kosuke55 <[email protected]> * Exact collision check Signed-off-by: kosuke55 <[email protected]>

…resampling (autowarefoundation#1506) * fix: lanelet empty case * fix(lanelet2_extension,had_map_utils): fix case point 1 Co-authored-by: Maxime CLEMENT <[email protected]> * fix(lanelet2_extension,had_map_utils): fix case point 1 Co-authored-by: Maxime CLEMENT <[email protected]> Co-authored-by: Maxime CLEMENT <[email protected]>

…oundation#1234) Signed-off-by: Kenji Miyake <[email protected]>

…uence (autowarefoundation#1511) * remove search distance for turn signal Signed-off-by: tomoya.kimura <[email protected]> * set distance to max when a lane_attriute is straight Signed-off-by: tomoya.kimura <[email protected]>

…towarefoundation#1502) * feat(motion_utils): add resampling function for path with lane id Signed-off-by: yutaka <[email protected]> * add test Signed-off-by: yutaka <[email protected]> * update test Signed-off-by: yutaka <[email protected]> * add stop point flag Signed-off-by: yutaka <[email protected]>

) Signed-off-by: Takayuki Murooka <[email protected]>

Signed-off-by: Takayuki Murooka <[email protected]>

…dation#1475) * fix(behavior_path_planner): fix short drivable area bug Signed-off-by: Takayuki Murooka <[email protected]> * add comment Signed-off-by: Takayuki Murooka <[email protected]>

…on#1321) * feat(interpolation): add akima spline interpolation Signed-off-by: Takayuki Murooka <[email protected]> * add test Signed-off-by: Takayuki Murooka <[email protected]> * additional test of sudden value change Signed-off-by: Takayuki Murooka <[email protected]>

…utowarefoundation#1518) Signed-off-by: yutaka <[email protected]>

…towarefoundation#1519) Signed-off-by: Fumiya Watanabe <[email protected]>

…dation#1517) * feat(behavior_path_planner): update resampling function Signed-off-by: yutaka <[email protected]> * feat(motion_utils): substitute input path initila point informaiton Signed-off-by: yutaka <[email protected]>

…tils (autowarefoundation#1520)

…create deleted marker (autowarefoundation#1513) * feat(tier4_autoware_utils): add function to create deleted marker Signed-off-by: Takayuki Murooka <[email protected]> * apply fix to obstacle_cruise_planner Signed-off-by: Takayuki Murooka <[email protected]> * fix bug Signed-off-by: Takayuki Murooka <[email protected]>

…on#1266) * docs(behavior_velocity_planner): add map format doc Signed-off-by: Takayuki Murooka <[email protected]> * Update planning/behavior_velocity_planner/virtual-traffic-light-design.md Co-authored-by: Takamasa Horibe <[email protected]> Co-authored-by: Takamasa Horibe <[email protected]>

…on of redundant restart prevention (autowarefoundation#1507) * docs(behavior_velocity_planner): update README Signed-off-by: satoshi-ota <[email protected]> * docs(obstacle_stop_planner): update README Signed-off-by: satoshi-ota <[email protected]>

…foundation#996) * fix(costmap_generator): restrict costmap within parking lot Signed-off-by: NorahXiong <[email protected]> * add parameters for free space planning area selection Signed-off-by: NorahXiong <[email protected]> * ci(pre-commit): autofix Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>

…n#1526) Signed-off-by: yutaka <[email protected]>

…refoundation#1531) * delete is on ego traj Signed-off-by: yutaka <[email protected]> * update Signed-off-by: yutaka <[email protected]>

…warefoundation#1532) * feat(localization_error_monitor): change subscribing topic type * ci(pre-commit): autofix Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>

* fix(behavior_path_planner): fix turn singal Signed-off-by: tomoya.kimura <[email protected]> * apply pre-commit Signed-off-by: tomoya.kimura <[email protected]>

…ory point (autowarefoundation#1522) * fix(control_performance_analysis): fix choosing wrong closest trajectory point Signed-off-by: Berkay <[email protected]> * removed comments Signed-off-by: Berkay <[email protected]> * ci(pre-commit): autofix * Single-parameter constructors marked explicit. Signed-off-by: Berkay <[email protected]> * Removed unnecessary variable and change the struct name Signed-off-by: Berkay <[email protected]> * optimized declaration of variables Signed-off-by: Berkay <[email protected]> * update for parameter declaration Signed-off-by: Berkay <[email protected]> * ci(pre-commit): autofix * changed desired steering angle calculation Signed-off-by: Berkay <[email protected]> * ci(pre-commit): autofix * get reference of some variables Signed-off-by: Berkay <[email protected]> * ci(pre-commit): autofix Co-authored-by: Berkay <[email protected]> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>

* fix(ekf_localizer): rename biased pose topics * Update topic descriptions in README Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Co-authored-by: kminoda <[email protected]>

…utowarefoundation#1720) * refactor(obstacle_stop_planner): update parameter name for readability Signed-off-by: satoshi-ota <[email protected]> * docs(obstacle_stop_planner): update module documentation Signed-off-by: satoshi-ota <[email protected]> * docs(obstacle_stop_planner): update figure Signed-off-by: satoshi-ota <[email protected]> * refactor(obstacle_stop_planner): separate params by namespace Signed-off-by: satoshi-ota <[email protected]> * fix(tier4_planning_launch): separate params by namespace Signed-off-by: satoshi-ota <[email protected]> * refactor(obstacle_stop_planner): remove default value from declare_parameter Signed-off-by: satoshi-ota <[email protected]> * refactor(obstacle_stop_planner): add params to config Signed-off-by: satoshi-ota <[email protected]> Signed-off-by: satoshi-ota <[email protected]>

* feat(rtc_interface): add_finish_distance Signed-off-by: Fumiya Watanabe <[email protected]> * fix(behavior_path_planner): remove unnecessary include Signed-off-by: Fumiya Watanabe <[email protected]> * fix(behavior_path_planner): fix typo Signed-off-by: Fumiya Watanabe <[email protected]> * fix(behavior_path_planner): fix goal pose Signed-off-by: Fumiya Watanabe <[email protected]> Signed-off-by: Fumiya Watanabe <[email protected]>

…ation#1790) * fix(tier4_screen_capture_rviz_plugin): fix spell check Signed-off-by: h-ohta <[email protected]> * ci(pre-commit): autofix Signed-off-by: h-ohta <[email protected]> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>

…autowarefoundation#1783) Signed-off-by: v-nakayama7440-esol <[email protected]> Signed-off-by: v-nakayama7440-esol <[email protected]> Co-authored-by: ito-san <[email protected]>

…in hybrid A* algorithm (autowarefoundation#1504) Signed-off-by: NorahXiong <[email protected]>

…e utils function (autowarefoundation#1798) * feat(obstacle_cruise_planner): replace interpolation function with the util function Signed-off-by: yutaka <[email protected]> * add dist and yaw threshold Signed-off-by: yutaka <[email protected]> Signed-off-by: yutaka <[email protected]>

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

…ce for pull_over (autowarefoundation#1796) * feat(behavior_path_planner): check goal to objects logitudinal distance for pull_over Signed-off-by: kosuke55 <[email protected]> * Update planning/behavior_path_planner/src/utilities.cpp Co-authored-by: Shumpei Wakabayashi <[email protected]> Signed-off-by: kosuke55 <[email protected]> * rename to goal_to_obstacle_margin Signed-off-by: kosuke55 <[email protected]> * fix rear check Signed-off-by: kosuke55 <[email protected]> Signed-off-by: kosuke55 <[email protected]> Co-authored-by: Shumpei Wakabayashi <[email protected]>

* Added a filter by the norm of the yaw * Fixed typos and tested with rosbags * Added the yaw norm parameter in the launch file

…foundation#1791) * use constPtr Signed-off-by: Takamasa Horibe <[email protected]> * [velocity_controller] use topic for ego-pose, not TF Signed-off-by: Takamasa Horibe <[email protected]> * [mpc] use topic for ego-pose, not TF Signed-off-by: Takamasa Horibe <[email protected]> * rename prev variable Signed-off-by: Takamasa Horibe <[email protected]> Signed-off-by: Takamasa Horibe <[email protected]>

* docs(velodyne_monitor): add known limits Signed-off-by: h-ohta <[email protected]> * Update Readme.md Signed-off-by: h-ohta <[email protected]>

…g velocity (autowarefoundation#1071) * 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 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>

* first commit Signed-off-by: kminoda <[email protected]> * first commit? Signed-off-by: kminoda <[email protected]> * debug Signed-off-by: kminoda <[email protected]> * debug Signed-off-by: kminoda <[email protected]> * now map_tf_generator is merged into map_loader, and works with split maps to load as a wholw Signed-off-by: kminoda <[email protected]> * removed map_tf_generator Signed-off-by: kminoda <[email protected]> * now we can launch map_provider Signed-off-by: kminoda <[email protected]> * now NDT works with partial map (not checked dynamic loading yet, and too many debug logs) Signed-off-by: kminoda <[email protected]> * now works Signed-off-by: kminoda <[email protected]> * debugged Signed-off-by: kminoda <[email protected]> * downsample for each pcd files Signed-off-by: kminoda <[email protected]> * ci(pre-commit): autofix * changed architecture Signed-off-by: kminoda <[email protected]> * ci(pre-commit): autofix * changed default parameter Signed-off-by: kminoda <[email protected]> * debugged Signed-off-by: kminoda <[email protected]> * ci(pre-commit): autofix * fix(ndt_scan_matcher): initialize only if the current map is valid Signed-off-by: kminoda <[email protected]> * ci(pre-commit): autofix * fix(ndt_scan_matcher): added timeout for waiting map when initialization Signed-off-by: kminoda <[email protected]> * ci(pre-commit): autofix * parametrize radius in pose_initializer (+some debug messages) Signed-off-by: kminoda <[email protected]> * ci(pre-commit): autofix * Ignore request when it requests to load an empty pcd map Signed-off-by: kminoda <[email protected]> * ci(pre-commit): autofix * resolved conflict Signed-off-by: kminoda <[email protected]> * ci(pre-commit): autofix * update Signed-off-by: kminoda <[email protected]> * ci(pre-commit): autofix * debugged Signed-off-by: kminoda <[email protected]> * change output num_points Signed-off-by: kminoda <[email protected]> * minor updates Signed-off-by: kminoda <[email protected]> * first commig Signed-off-by: kminoda <[email protected]> * now works (remove: not yet) Signed-off-by: kminoda <[email protected]> * now works with pilot-auto.xx1 (include removing) Signed-off-by: kminoda <[email protected]> * update Signed-off-by: kminoda <[email protected]> * added copyFrom function for deepcopy of voxel_grid_info_dict_ Signed-off-by: kminoda <[email protected]> * debugged Signed-off-by: kminoda <[email protected]> * updated copy function of NDT Signed-off-by: kminoda <[email protected]> * Implemented differential map loading with proposal B architecture Signed-off-by: kminoda <[email protected]> * added architecture proposal B, and debugging completedgit add launch/tier4_map_launch/! * Now debugged pose initialization issue. Should work PERFECTLY finegit add localization/git add localization/ Signed-off-by: kminoda <[email protected]> * Now ndt_scan_matcher subscribes EKF (not tf), and EKF does not publish until initialized. Currently debugging how to wrongly subscribing to EKF initial publish Signed-off-by: kminoda <[email protected]> * fixed callback groups, so now the callbackSensorPoints won't be hindered by updateMap Signed-off-by: kminoda <[email protected]> * debugged callback_group problem (map_callback_group is now a class member variable) Signed-off-by: kminoda <[email protected]> * DEBUGGING COMMITgit add perception/! force elevation_map_loader to load pre-build map Signed-off-by: kminoda <[email protected]> Signed-off-by: kminoda <[email protected]> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Co-authored-by: IshitaTakeshi <[email protected]>

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

…ion#3946) * adopt scane_case to undistort, segment_filter Signed-off-by: Kento Yabuuchi <[email protected]> * adopt scane_case to ground_server, ll2_decomposer Signed-off-by: Kento Yabuuchi <[email protected]> * adopt scane_case to twist_converter, twist_estimator Signed-off-by: Kento Yabuuchi <[email protected]> * adopt scane_case to validation packages Signed-off-by: Kento Yabuuchi <[email protected]> * adopt scane_case tomodularized_particle_filter Signed-off-by: Kento Yabuuchi <[email protected]> * adopt scane_case to gnss_particle_corrector Signed-off-by: Kento Yabuuchi <[email protected]> * adopt scane_case to camera_particle_corrector Signed-off-by: Kento Yabuuchi <[email protected]> * adopt scane_case to antishadow_corrector Signed-off-by: Kento Yabuuchi <[email protected]> * adopt scane_case to particle_initializer Signed-off-by: Kento Yabuuchi <[email protected]> * organize launch files Signed-off-by: Kento Yabuuchi <[email protected]> * add twist_visualizer to validate odometry performance Signed-off-by: Kento Yabuuchi <[email protected]> * use SE3::exp() to predict particles & modify linear noise model Signed-off-by: Kento Yabuuchi <[email protected]> * stop to use LL2 to rectify initialpose2d Signed-off-by: Kento Yabuuchi <[email protected]> * fix redundant computation in segment_accumulator Signed-off-by: Kento Yabuuchi <[email protected]> * improve gnss_particle_corrector Signed-off-by: Kento Yabuuchi <[email protected]> * fix segment_accumulator's bug Signed-off-by: Kento Yabuuchi <[email protected]> * add doppler_converter Signed-off-by: Kento Yabuuchi <[email protected]> * add xx2.launch.xml Signed-off-by: Kento Yabuuchi <[email protected]> * add hsv_extractor Signed-off-by: Kento Yabuuchi <[email protected]> * pickup other regions which have same color histogram Signed-off-by: Kento Yabuuchi <[email protected]> * use additional region to filt line-segments Signed-off-by: Kento Yabuuchi <[email protected]> * improve graph-segmentation Signed-off-by: Kento Yabuuchi <[email protected]> * remove `truncate_pixel_threshold` Signed-off-by: Kento Yabuuchi <[email protected]> * refactor graph_segmentator & segment_filter Signed-off-by: Kento Yabuuchi <[email protected]> * add mahalanobis_distance_threshold in GNSS particle corrector Signed-off-by: Kento Yabuuchi <[email protected]> * add extract_line_segments.hpp Signed-off-by: Kento Yabuuchi <[email protected]> * use pcl::transformCloudWithNormals instead of transform_cloud Signed-off-by: Kento Yabuuchi <[email protected]> * filt accumulating segments by LL2 Signed-off-by: Kento Yabuuchi <[email protected]> * move herarchical_cost_map to common Signed-off-by: Kento Yabuuchi <[email protected]> * apply positive feedback for accumulation Signed-off-by: Kento Yabuuchi <[email protected]> * move transform_linesegments() to common pkg Signed-off-by: Kento Yabuuchi <[email protected]> * refactor Signed-off-by: Kento Yabuuchi <[email protected]> * use all projected lines for camera corrector Signed-off-by: Kento Yabuuchi <[email protected]> * evaluate iffy linesegments Signed-off-by: Kento Yabuuchi <[email protected]> * complete to unify ll2-assisted lsd clasification Signed-off-by: Kento Yabuuchi <[email protected]> * add abs_cos2() which is more strict direction constraint Signed-off-by: Kento Yabuuchi <[email protected]> * fix orientation initialization bug Signed-off-by: Kento Yabuuchi <[email protected]> * publish doppler direction Signed-off-by: Kento Yabuuchi <[email protected]> * TMP: add disable/enable switch for camera corrector Signed-off-by: Kento Yabuuchi <[email protected]> * implement doppler orientation correction but it's disabled by default Signed-off-by: Kento Yabuuchi <[email protected]> * speed up camera corrector Signed-off-by: Kento Yabuuchi <[email protected]> * update ros params Signed-off-by: Kento Yabuuchi <[email protected]> * implement kalman filter for ground tilt estimation Signed-off-by: Kento Yabuuchi <[email protected]> * continuous height estimation works well? Signed-off-by: Kento Yabuuchi <[email protected]> * estimate height cotiniously Signed-off-by: Kento Yabuuchi <[email protected]> * use only linesegments which are at same height Signed-off-by: Kento Yabuuchi <[email protected]> * add static_gyro_bias parameter Signed-off-by: Kento Yabuuchi <[email protected]> * fix bug about overlay varidation Signed-off-by: Kento Yabuuchi <[email protected]> * increse ll2 height marging in cost map generation Signed-off-by: Kento Yabuuchi <[email protected]> * add static_gyro_bias in twist.launch.xml Signed-off-by: Kento Yabuuchi <[email protected]> * load pcdless_init_area from ll2 Signed-off-by: Kento Yabuuchi <[email protected]> * add specified initialization area Signed-off-by: Kento Yabuuchi <[email protected]> * add corrector_manager node to disable/enable camera_corrector Signed-off-by: Kento Yabuuchi <[email protected]> * call service to disable camer_corrector from manager Signed-off-by: Kento Yabuuchi <[email protected]> * load corrector disable area Signed-off-by: Kento Yabuuchi <[email protected]> * overlay even if pose is not estiamted Signed-off-by: Kento Yabuuchi <[email protected]> * publish camera corrector's status as string Signed-off-by: Kento Yabuuchi <[email protected]> * add set_booL_panel for camera_corrector enable/disable Signed-off-by: Kento Yabuuchi <[email protected]> * load bounding box from lanelet2 Signed-off-by: Kento Yabuuchi <[email protected]> * draw bounding box on cost map Signed-off-by: Kento Yabuuchi <[email protected]> * remove at2,at1 from cost map Signed-off-by: Kento Yabuuchi <[email protected]> * use cost_map::at() instread pf at2() Signed-off-by: Kento Yabuuchi <[email protected]> * move cost map library from common to camera corrector Signed-off-by: Kento Yabuuchi <[email protected]> * use logit for particle weighting but it does not work well Signed-off-by: Kento Yabuuchi <[email protected]> * prob_to_logit() requires non-intuitive parameters Signed-off-by: Kento Yabuuchi <[email protected]> * goodbye stupid parameters (max_raw_score & score_offset) Signed-off-by: Kento Yabuuchi <[email protected]> * publish two scored pointclouds as debug Signed-off-by: Kento Yabuuchi <[email protected]> * can handle unmapped areas Signed-off-by: Kento Yabuuchi <[email protected]> * remove obsolete packages Signed-off-by: Kento Yabuuchi <[email protected]> * update README.md Signed-off-by: Kento Yabuuchi <[email protected]> * Update README.md * add image of how_to_launch Signed-off-by: Kento Yabuuchi <[email protected]> * add node diagram in readme Signed-off-by: Kento Yabuuchi <[email protected]> * add rviz_description.png in README Signed-off-by: Kento Yabuuchi <[email protected]> * subscribe pose_with_cov & disconnect base_link <-> particle_pose Signed-off-by: Kento Yabuuchi <[email protected]> * remove segment_accumulator & launch ekf_localizer from this project Signed-off-by: Kento Yabuuchi <[email protected]> * add gnss_ekf_corrector Signed-off-by: Kento Yabuuchi <[email protected]> * add camera_ekf_corrector package Signed-off-by: Kento Yabuuchi <[email protected]> * subscribe ekf prediction & synch pose data Signed-off-by: Kento Yabuuchi <[email protected]> * WIP: ready to implement UKF? Signed-off-by: Kento Yabuuchi <[email protected]> * estimate weighted averaging as pose_estimator Signed-off-by: Kento Yabuuchi <[email protected]> * basic algorithm is implemented but it does not work proparly Signed-off-by: Kento Yabuuchi <[email protected]> * apply after_cov_gain_ Signed-off-by: Kento Yabuuchi <[email protected]> * ekf corrector works a little bit appropriately Signed-off-by: Kento Yabuuchi <[email protected]> * increase twist covariance for ekf Signed-off-by: Kento Yabuuchi <[email protected]> * test probability theory Signed-off-by: Kento Yabuuchi <[email protected]> * updat prob.py Signed-off-by: Kento Yabuuchi <[email protected]> * implement de-bayesing but it loooks ugly Signed-off-by: Kento Yabuuchi <[email protected]> * remove obsolete parameters Signed-off-by: Kento Yabuuchi <[email protected]> * skip measurement publishing if travel distance is so short Signed-off-by: Kento Yabuuchi <[email protected]> * use constant covariance because i dont understand what is correct Signed-off-by: Kento Yabuuchi <[email protected]> * add submodule sample_vehicle_launch Signed-off-by: Kento Yabuuchi <[email protected]> * TMP but it works Signed-off-by: Kento Yabuuchi <[email protected]> * add ekf_trigger in particle_initializer.hpp Signed-off-by: Kento Yabuuchi <[email protected]> * publish gnss markers & camera_est pubishes constant cov Signed-off-by: Kento Yabuuchi <[email protected]> * back to pcd-less only launcher Signed-off-by: Kento Yabuuchi <[email protected]> * add bayes_util package Signed-off-by: Kento Yabuuchi <[email protected]> * apply de-bayesing for camera_ekf Signed-off-by: Kento Yabuuchi <[email protected]> * some launch file update Signed-off-by: Kento Yabuuchi <[email protected]> * organize launch files. we can choice mode from ekf/pekf/pf Signed-off-by: Kento Yabuuchi <[email protected]> * organize particle_initializer Signed-off-by: Kento Yabuuchi <[email protected]> * add swap_mode_adaptor WIP Signed-off-by: Kento Yabuuchi <[email protected]> * use latest ekf in autoware & sample_vehicle Signed-off-by: Kento Yabuuchi <[email protected]> * fix bug of swap_adalptor Signed-off-by: Kento Yabuuchi <[email protected]> * fix FIX & FLOAT converter Signed-off-by: Kento Yabuuchi <[email protected]> * fix septentrio doppler converter Signed-off-by: Kento Yabuuchi <[email protected]> * move ekf packages to ekf directory Signed-off-by: Kento Yabuuchi <[email protected]> * ignore corrector_manager Signed-off-by: Kento Yabuuchi <[email protected]> * add standalone arg in launch files Signed-off-by: Kento Yabuuchi <[email protected]> * update semseg_node Signed-off-by: Kento Yabuuchi <[email protected]> * add camera_pose_initializer pkg Signed-off-by: Kento Yabuuchi <[email protected]> * subscribe camera_info&tf and prepare semantic projection Signed-off-by: Kento Yabuuchi <[email protected]> * project semantic image Signed-off-by: Kento Yabuuchi <[email protected]> * create vector map image from ll2 Signed-off-by: Kento Yabuuchi <[email protected]> * create lane image from vector map Signed-off-by: Kento Yabuuchi <[email protected]> * search the most match angle by non-zero pixels Signed-off-by: Kento Yabuuchi <[email protected]> * camera based pose_initializer Signed-off-by: Kento Yabuuchi <[email protected]> * move ekf packages into unstable Signed-off-by: Kento Yabuuchi <[email protected]> * move ekf theory debugger Signed-off-by: Kento Yabuuchi <[email protected]> * add tier4_autoware_msgs as submodule Signed-off-by: Kento Yabuuchi <[email protected]> * move pose_initializer into initializer dir Signed-off-by: Kento Yabuuchi <[email protected]> * add semse_msgs pkg Signed-off-by: Kento Yabuuchi <[email protected]> * separate marker pub function Signed-off-by: Kento Yabuuchi <[email protected]> * separate projection functions Signed-off-by: Kento Yabuuchi <[email protected]> * add semseg_srv client Signed-off-by: Kento Yabuuchi <[email protected]> * move sem-seg directory Signed-off-by: Kento Yabuuchi <[email protected]> * camera pose initilizer works successfully Signed-off-by: Kento Yabuuchi <[email protected]> * rectify covariance along the orientation Signed-off-by: Kento Yabuuchi <[email protected]> * improve initialization parameters Signed-off-by: Kento Yabuuchi <[email protected]> * take into account covariance of request Signed-off-by: Kento Yabuuchi <[email protected]> * use lanelet direciton to compute init pose scores Signed-off-by: Kento Yabuuchi <[email protected]> * semseg download model automatically Signed-off-by: Kento Yabuuchi <[email protected]> * remove sample_vehicle_launch Signed-off-by: Kento Yabuuchi <[email protected]> * add autoware_msgs Signed-off-by: Kento Yabuuchi <[email protected]> * remove obsolete launch files Signed-off-by: Kento Yabuuchi <[email protected]> * add standalone mode for direct initialization Signed-off-by: Kento Yabuuchi <[email protected]> * fix fix_to_pose Signed-off-by: Kento Yabuuchi <[email protected]> * update launch files Signed-off-by: Kento Yabuuchi <[email protected]> * update rviz config Signed-off-by: Kento Yabuuchi <[email protected]> * remove lidar_particle_corrector Signed-off-by: Kento Yabuuchi <[email protected]> * remove Sophus from sunbmodule Signed-off-by: Kento Yabuuchi <[email protected]> * rename submodule directory Signed-off-by: Kento Yabuuchi <[email protected]> * update README and some sample images Signed-off-by: Kento Yabuuchi <[email protected]> * update README.md Signed-off-by: Kento Yabuuchi <[email protected]> * fix override_camera_frame_id bahaviors Signed-off-by: Kento Yabuuchi <[email protected]> * fix some bugs (#4) Signed-off-by: kminoda <[email protected]> * fix: use initialpose from Rviz (#6) * use initialpose from Rviz to init Signed-off-by: Kento Yabuuchi <[email protected]> * add description about how-to-set-initialpose Signed-off-by: Kento Yabuuchi <[email protected]> --------- Signed-off-by: Kento Yabuuchi <[email protected]> * misc: add license (#7) * WIP: add license description Signed-off-by: Kento Yabuuchi <[email protected]> * add license description Signed-off-by: Kento Yabuuchi <[email protected]> * add description about license in README Signed-off-by: Kento Yabuuchi <[email protected]> --------- Signed-off-by: Kento Yabuuchi <[email protected]> * add quick start demo (#8) Signed-off-by: Kento Yabuuchi <[email protected]> * refactor(launch) remove & update obsolete launch files (#9) * delete obsolete launch files Signed-off-by: Kento Yabuuchi <[email protected]> * update documents Signed-off-by: Kento Yabuuchi <[email protected]> --------- Signed-off-by: Kento Yabuuchi <[email protected]> * docs(readme): update architecture image (#10) * replace architecture image in README Signed-off-by: Kento Yabuuchi <[email protected]> * update some images Signed-off-by: Kento Yabuuchi <[email protected]> --------- Signed-off-by: Kento Yabuuchi <[email protected]> * refactor(pcdless_launc/scripts): remove unnecessary scripts (#11) * remove not useful scripts Signed-off-by: Kento Yabuuchi <[email protected]> * rename scripts & add descriptions Signed-off-by: Kento Yabuuchi <[email protected]> * little change Signed-off-by: Kento Yabuuchi <[email protected]> * remove odaiba.rviz Signed-off-by: Kento Yabuuchi <[email protected]> * grammer fix Signed-off-by: Kento Yabuuchi <[email protected]> --------- Signed-off-by: Kento Yabuuchi <[email protected]> * fix(pcdless_launch): fix a build bug Signed-off-by: kminoda <[email protected]> * fix(twist_estimator): use velocity_report by default Signed-off-by: kminoda <[email protected]> * fix bug Signed-off-by: kminoda <[email protected]> * debugged, now works Signed-off-by: kminoda <[email protected]> * update sample rosbag link (#14) Signed-off-by: Kento Yabuuchi <[email protected]> * feature(graph_segment, gnss_particle_corrector): make some features switchable (#17) * make additional-graph-segment-pickup disablable Signed-off-by: Kento Yabuuchi <[email protected]> * enlarge gnss_mahalanobis_distance_threshold in expressway.launch Signed-off-by: Kento Yabuuchi <[email protected]> --------- Signed-off-by: Kento Yabuuchi <[email protected]> * fix: minor fix for multi camera support (#18) * fix: minor fix for multi camera support Signed-off-by: kminoda <[email protected]> * update Signed-off-by: kminoda <[email protected]> * update Signed-off-by: kminoda <[email protected]> * fix typo Signed-off-by: kminoda <[email protected]> --------- Signed-off-by: kminoda <[email protected]> * refactor(retroactive_resampler): more readable (#19) * make Hisotry class Signed-off-by: Kento Yabuuchi <[email protected]> * use boost:adaptors::indexed() Signed-off-by: Kento Yabuuchi <[email protected]> * add many comment in resampling() Signed-off-by: Kento Yabuuchi <[email protected]> * does not use ConstSharedPtr Signed-off-by: Kento Yabuuchi <[email protected]> * rename interface of resampler Signed-off-by: Kento Yabuuchi <[email protected]> * circular_buffer is unnecessary Signed-off-by: Kento Yabuuchi <[email protected]> --------- Signed-off-by: Kento Yabuuchi <[email protected]> * refactor(mpf::predictor) resampling interval control in out of resampler (#20) * resampling interval management should be done out of resample() Signed-off-by: Kento Yabuuchi <[email protected]> * resampler class throw exeption rather than optional Signed-off-by: Kento Yabuuchi <[email protected]> * split files for resampling_history Signed-off-by: Kento Yabuuchi <[email protected]> * split files for experimental/suspention_adaptor Signed-off-by: Kento Yabuuchi <[email protected]> --------- Signed-off-by: Kento Yabuuchi <[email protected]> * refactor(mpf::predictor): just refactoring (#21) * remove obsolete functions Signed-off-by: Kento Yabuuchi <[email protected]> * remove test of predictor Signed-off-by: Kento Yabuuchi <[email protected]> * remove remapping in pf.launch.xml for suspension_adapator Signed-off-by: Kento Yabuuchi <[email protected]> * add some comments Signed-off-by: Kento Yabuuchi <[email protected]> --------- Signed-off-by: Kento Yabuuchi <[email protected]> * fix(twist_estimator): remove stop filter for velocity (#23) Signed-off-by: kminoda <[email protected]> * feat(pcdless_launch): add multi camera launcher (#22) * feat(pcdless_launch): add multi camera launcher Signed-off-by: kminoda <[email protected]> * minor fix Signed-off-by: kminoda <[email protected]> --------- Signed-off-by: kminoda <[email protected]> * refactor(CMakeListx.txt): just refactoring (#24) * refactor imgproc/*/CMakeListx.txt Signed-off-by: Kento Yabuuchi <[email protected]> * refactor initializer/*/CMakeListx.txt & add gnss_pose_initializer pkg Signed-off-by: Kento Yabuuchi <[email protected]> * rename some files in twist/ & refactor pf/*/cmakelist Signed-off-by: Kento Yabuuchi <[email protected]> * refactor validation/*/CMakeListx.txt Signed-off-by: Kento Yabuuchi <[email protected]> * fix some obsolete executor name Signed-off-by: Kento Yabuuchi <[email protected]> --------- Signed-off-by: Kento Yabuuchi <[email protected]> * fix: rename lsd variables and files (#26) Signed-off-by: kminoda <[email protected]> * misc: reame pcdless to yabloc (#25) * rename pcdless to yabloc Signed-off-by: Kento Yabuuchi <[email protected]> * fix conflict miss Signed-off-by: Kento Yabuuchi <[email protected]> --------- Signed-off-by: Kento Yabuuchi <[email protected]> * visualize path (#28) Signed-off-by: Kento Yabuuchi <[email protected]> * docs: update readme about particle filter (#30) * update mpf/README.md Signed-off-by: Kento Yabuuchi <[email protected]> * update gnss_corrector/README.md Signed-off-by: Kento Yabuuchi <[email protected]> * update camera_corrector/README.md Signed-off-by: Kento Yabuuchi <[email protected]> --------- Signed-off-by: Kento Yabuuchi <[email protected]> * feat(segment_filter): publish images with lines and refactor (#29) * feat(segment_filter): publish images with lines Signed-off-by: kminoda <[email protected]> * update validation Signed-off-by: kminoda <[email protected]> * update imgproc (reverted) Signed-off-by: kminoda <[email protected]> * large change inclding refactoring Signed-off-by: kminoda <[email protected]> * major update Signed-off-by: kminoda <[email protected]> * revert rviz config Signed-off-by: kminoda <[email protected]> * minor fix in name Signed-off-by: kminoda <[email protected]> * add validation option Signed-off-by: kminoda <[email protected]> * update architecture svg Signed-off-by: kminoda <[email protected]> * rename validation.launch to overlay.launch Signed-off-by: Kento Yabuuchi <[email protected]> * no throw runtime_error (unintentionaly applying format) Signed-off-by: Kento Yabuuchi <[email protected]> --------- Signed-off-by: kminoda <[email protected]> Signed-off-by: Kento Yabuuchi <[email protected]> Co-authored-by: Kento Yabuuchi <[email protected]> * catch runtime_error when particle id is invalid (#31) Signed-off-by: Kento Yabuuchi <[email protected]> * return if info is nullopt (#32) Signed-off-by: Kento Yabuuchi <[email protected]> * pose_buffer is sometimes empty (#33) Signed-off-by: Kento Yabuuchi <[email protected]> * use_yaw_of_initialpose (#34) Signed-off-by: Kento Yabuuchi <[email protected]> * feat(interface): remove incompatible interface (#35) * not use ublox_msg when run as autoware Signed-off-by: Kento Yabuuchi <[email protected]> * remove twist/kalman/twist & use twist_estimator/twist_with_covariance Signed-off-by: Kento Yabuuchi <[email protected]> * update particle_array stamp even if the time stamp seems wrong Signed-off-by: Kento Yabuuchi <[email protected]> --------- Signed-off-by: Kento Yabuuchi <[email protected]> * fix: suppress info/warn_stream (#37) * does not stream undistortion time Signed-off-by: Kento Yabuuchi <[email protected]> * improve warn stream when skip particle weighting Signed-off-by: Kento Yabuuchi <[email protected]> * surpress frequency of warnings during synchronized particle searching Signed-off-by: Kento Yabuuchi <[email protected]> * fix camera_pose_initializer Signed-off-by: Kento Yabuuchi <[email protected]> --------- Signed-off-by: Kento Yabuuchi <[email protected]> * /switch must not be nice name (#39) Signed-off-by: Kento Yabuuchi <[email protected]> * misc(readme): update readme (#41) * add youtube link and change thumbnail Signed-off-by: Kento Yabuuchi <[email protected]> * improve input/output topics Signed-off-by: Kento Yabuuchi <[email protected]> * quick start demo screen image Signed-off-by: Kento Yabuuchi <[email protected]> * add abstruct architecture and detail architecture Signed-off-by: Kento Yabuuchi <[email protected]> --------- Signed-off-by: Kento Yabuuchi <[email protected]> * docs(rosdep): fix package.xml to ensure build success (autowarefoundation#44) * fix package.xml to success build Signed-off-by: Kento Yabuuchi <[email protected]> * add 'rosdep install' in how-to-build Signed-off-by: Kento Yabuuchi <[email protected]> --------- Signed-off-by: Kento Yabuuchi <[email protected]> * add geographiclib in package.xml (autowarefoundation#46) Signed-off-by: Kento Yabuuchi <[email protected]> * fix path search error in build stage (autowarefoundation#45) * fix path search error in build stage * fix tier4/YabLoc#45 (comment) * Feature/remove submodule (autowarefoundation#47) * remove submodules Signed-off-by: Kento Yabuuchi <[email protected]> * remove doppler converter Signed-off-by: Kento Yabuuchi <[email protected]> --------- Signed-off-by: Kento Yabuuchi <[email protected]> * feature: change node namespace to /localization/yabloc/** from /localization/** (autowarefoundation#48) * change node namespace Signed-off-by: Kento Yabuuchi <[email protected]> * update namespace for autoware-mode Signed-off-by: Kento Yabuuchi <[email protected]> * update namespace in multi_camera.launch Signed-off-by: Kento Yabuuchi <[email protected]> --------- Signed-off-by: Kento Yabuuchi <[email protected]> * removed unstable packages (autowarefoundation#49) Signed-off-by: Kento Yabuuchi <[email protected]> * feature: add *.param.yaml to manage parameters (autowarefoundation#50) * make *.param.yaml in imgproc packages Signed-off-by: Kento Yabuuchi <[email protected]> * make *.param.yaml in initializer packages Signed-off-by: Kento Yabuuchi <[email protected]> * make *.param.yaml in map packages Signed-off-by: Kento Yabuuchi <[email protected]> * make *.param.yaml in pf packages Signed-off-by: Kento Yabuuchi <[email protected]> * make *.param.yaml in twist packages Signed-off-by: Kento Yabuuchi <[email protected]> * fix expressway parameter Signed-off-by: Kento Yabuuchi <[email protected]> * fix override_frame_id Signed-off-by: Kento Yabuuchi <[email protected]> * remove default parameters Signed-off-by: Kento Yabuuchi <[email protected]> * fix some remaining invalida parameters Signed-off-by: Kento Yabuuchi <[email protected]> --------- Signed-off-by: Kento Yabuuchi <[email protected]> * does not estimate twist (autowarefoundation#51) Signed-off-by: Kento Yabuuchi <[email protected]> * feat(particle_initializer): merge particle_initializer into mpf (autowarefoundation#52) * feat(particle_initializer): merge particle_initializer to modulalized_particle_filter Signed-off-by: kminoda <[email protected]> * remove particle_initializer * remove debug message Signed-off-by: kminoda <[email protected]> * remove related parts Signed-off-by: kminoda <[email protected]> * update readme Signed-off-by: kminoda <[email protected]> * rename publishing topic Signed-off-by: Kento Yabuuchi <[email protected]> --------- Signed-off-by: kminoda <[email protected]> Signed-off-by: Kento Yabuuchi <[email protected]> Co-authored-by: Kento Yabuuchi <[email protected]> * fix: remove ll2_transition_area (autowarefoundation#54) Signed-off-by: kminoda <[email protected]> * feature(initializer): combine some initializer packages (autowarefoundation#56) * combine some package about initializer Signed-off-by: Kento Yabuuchi <[email protected]> * yabloc_pose_initializer works well Signed-off-by: Kento Yabuuchi <[email protected]> * remove old initializer packages Signed-off-by: Kento Yabuuchi <[email protected]> * semseg node can launch Signed-off-by: Kento Yabuuchi <[email protected]> * fix bug Signed-off-by: Kento Yabuuchi <[email protected]> * revert initializer mode Signed-off-by: Kento Yabuuchi <[email protected]> --------- Signed-off-by: Kento Yabuuchi <[email protected]> * feature(imgproc): reudce imgproc packages (autowarefoundation#57) * combine some imgproc packages Signed-off-by: Kento Yabuuchi <[email protected]> * combine overlay monitors into imgproc Signed-off-by: Kento Yabuuchi <[email protected]> --------- Signed-off-by: Kento Yabuuchi <[email protected]> * feature(validation): remove validation packages (autowarefoundation#58) * remove validation packages Signed-off-by: Kento Yabuuchi <[email protected]> * remove path visualization Signed-off-by: Kento Yabuuchi <[email protected]> --------- Signed-off-by: Kento Yabuuchi <[email protected]> * feature(pf): combine some packages related to particle filter (autowarefoundation#59) * create yabloc_particle_filter Signed-off-by: Kento Yabuuchi <[email protected]> * combine gnss_particle_corrector Signed-off-by: Kento Yabuuchi <[email protected]> * combine ll2_cost_map Signed-off-by: Kento Yabuuchi <[email protected]> * combine camera_particle_corrector Signed-off-by: Kento Yabuuchi <[email protected]> * fix launch files Signed-off-by: Kento Yabuuchi <[email protected]> * split README & remove obsolete scripts Signed-off-by: Kento Yabuuchi <[email protected]> * fix config path of multi_camera mode Signed-off-by: Kento Yabuuchi <[email protected]> --------- Signed-off-by: Kento Yabuuchi <[email protected]> * feature: combine map and twist packages (autowarefoundation#60) * removed some twist nodes & rename remains to yabloc_twist Signed-off-by: Kento Yabuuchi <[email protected]> * fix launch files for yabloc_twist Signed-off-by: Kento Yabuuchi <[email protected]> * move map packages to yabloc_common Signed-off-by: Kento Yabuuchi <[email protected]> * WIP: I think its impossible Signed-off-by: Kento Yabuuchi <[email protected]> * Revert "WIP: I think its impossible" This reverts commit 49da507bbf9abe8fcebed4d4df44ea5f4075f6d1. * remove map packages & fix some launch files Signed-off-by: Kento Yabuuchi <[email protected]> --------- Signed-off-by: Kento Yabuuchi <[email protected]> * removed obsolete packages Signed-off-by: Kento Yabuuchi <[email protected]> * remove obsolete dot files Signed-off-by: Kento Yabuuchi <[email protected]> * use tier4_loc_launch instead of yabloc_loc_launch Signed-off-by: Kento Yabuuchi <[email protected]> * move launch files to each packages Signed-off-by: Kento Yabuuchi <[email protected]> * remove yabloc_localization_launch Signed-off-by: Kento Yabuuchi <[email protected]> * remove yabloc_launch Signed-off-by: Kento Yabuuchi <[email protected]> * modify yabloc/README.md Signed-off-by: Kento Yabuuchi <[email protected]> * update yabloc_common/README.md Signed-off-by: Kento Yabuuchi <[email protected]> * update yabloc_imgproc README Signed-off-by: Kento Yabuuchi <[email protected]> * update yabloc_particle_filter/README Signed-off-by: Kento Yabuuchi <[email protected]> * update yabloc_pose_initializer/README Signed-off-by: Kento Yabuuchi <[email protected]> * update README Signed-off-by: Kento Yabuuchi <[email protected]> * use native from_bin_msg Signed-off-by: Kento Yabuuchi <[email protected]> * use ifndef instead of pragma once in yabloc_common Signed-off-by: Kento Yabuuchi <[email protected]> * use ifndef instead of pragma once in yabloc_imgproc & yabloc_pf Signed-off-by: Kento Yabuuchi <[email protected]> * use ifndef instead of pragma once in yabloc_pose_initializer Signed-off-by: Kento Yabuuchi <[email protected]> * style(pre-commit): autofix * use autoware_cmake & suppress build warning Signed-off-by: Kento Yabuuchi <[email protected]> * repalce yabloc::Timer with tier4_autoware_utils::StopWatch Signed-off-by: Kento Yabuuchi <[email protected]> * replace 1.414 with std::sqrt(2) Signed-off-by: Kento Yabuuchi <[email protected]> * style(pre-commit): autofix * removed redundant ament_cmake_auto Signed-off-by: Kento Yabuuchi <[email protected]> * removed yabloc_common/timer.hpp Signed-off-by: Kento Yabuuchi <[email protected]> * replaced low_pass_filter with autoware's lowpass_filter_1d Signed-off-by: Kento Yabuuchi <[email protected]> * style(pre-commit): autofix * Squashed commit of the following: Signed-off-by: Kento Yabuuchi <[email protected]> commit cb08e290cca5c00315a58a973ec068e559c9e0a9 Author: Kento Yabuuchi <[email protected]> Date: Tue Jun 13 14:30:09 2023 +0900 removed ublox_msgs in gnss_particle_corrector Signed-off-by: Kento Yabuuchi <[email protected]> commit c158133f184a43914ec5f929645a7869ef8d03be Author: Kento Yabuuchi <[email protected]> Date: Tue Jun 13 14:24:19 2023 +0900 removed obsolete yabloc_multi_camera.launch Signed-off-by: Kento Yabuuchi <[email protected]> commit 10f578945dc257ece936ede097544bf008e5f48d Author: Kento Yabuuchi <[email protected]> Date: Tue Jun 13 14:22:14 2023 +0900 removed ublox_msgs in yabloc_pose_initializer Signed-off-by: Kento Yabuuchi <[email protected]> Signed-off-by: Kento Yabuuchi <[email protected]> * style(pre-commit): autofix * removed fix2mgrs & ublox_stamp Signed-off-by: Kento Yabuuchi <[email protected]> * added ~/ at the top of topic name Signed-off-by: Kento Yabuuchi <[email protected]> * removed use_sim_time in yabloc launch files Signed-off-by: Kento Yabuuchi <[email protected]> * add architecture diagram in README Signed-off-by: Kento Yabuuchi <[email protected]> * rename lsd_node to line_segment_detector Signed-off-by: Kento Yabuuchi <[email protected]> * style(pre-commit): autofix * Update localization/yabloc/README.md fix typo Co-authored-by: Takagi, Isamu <[email protected]> * removed obsolete debug code in similar_area_searcher Signed-off-by: Kento Yabuuchi <[email protected]> * removed suspension_adaptor which manages lifecycle of particle predictor Signed-off-by: Kento Yabuuchi <[email protected]> * style(pre-commit): autofix * renamed semseg to SemanticSegmentation Signed-off-by: Kento Yabuuchi <[email protected]> * style(pre-commit): autofix * fixed README.md to solve markdownlint Signed-off-by: Kento Yabuuchi <[email protected]> * WIP: reflected cpplint's suggestion Signed-off-by: Kento Yabuuchi <[email protected]> * reflected cpplint's suggestion Signed-off-by: Kento Yabuuchi <[email protected]> * rename AbstParaticleFilter in config files Signed-off-by: Kento Yabuuchi <[email protected]> * fixed typo Signed-off-by: Kento Yabuuchi <[email protected]> * used autoware_lint_common Signed-off-by: Kento Yabuuchi <[email protected]> * fixed miss git add Signed-off-by: Kento Yabuuchi <[email protected]> * style(pre-commit): autofix * replaced lanelet_util by lanelet2_extension Signed-off-by: Kento Yabuuchi <[email protected]> * replaced fast_math by tie4_autoware_utils Signed-off-by: Kento Yabuuchi <[email protected]> * sort package.xml Signed-off-by: Kento Yabuuchi <[email protected]> * renamed yabloc_imgproc with yabloc_image_processing Signed-off-by: Kento Yabuuchi <[email protected]> * reflected some review comments Signed-off-by: Kento Yabuuchi <[email protected]> * resolved some TODO Signed-off-by: Kento Yabuuchi <[email protected]> * prioritize NDT if both NDT and YabLoc initializer enabled Signed-off-by: Kento Yabuuchi <[email protected]> * changed localization_mode option names Signed-off-by: Kento Yabuuchi <[email protected]> --------- Signed-off-by: Kento Yabuuchi <[email protected]> Signed-off-by: kminoda <[email protected]> Co-authored-by: kminoda <[email protected]> Co-authored-by: kminoda <[email protected]> Co-authored-by: Akihiro Komori <[email protected]> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Co-authored-by: Takagi, Isamu <[email protected]>

purewater0901 and others added 30 commits August 3, 2022 10:57

fix(freespace_planner): collision check (autowarefoundation#985)

4d10180

* fix(freespace_planner): collision check Signed-off-by: kosuke55 <[email protected]> * Exact collision check Signed-off-by: kosuke55 <[email protected]>

feat(lanelet2_extension)!: move package to autoware_common (autowaref…

6d7423a

…oundation#1234) Signed-off-by: Kenji Miyake <[email protected]>

fix(obstacle_cruise_planner): add missing param (autowarefoundation#1515

7da6cd4

) Signed-off-by: Takayuki Murooka <[email protected]>

fix(obstacle_cruise_planner): update doc name (autowarefoundation#1516)

49db777

Signed-off-by: Takayuki Murooka <[email protected]>

fix(behavior_path_planner): fix short drivable area bug (autowarefoun…

cdc120c

…dation#1475) * fix(behavior_path_planner): fix short drivable area bug Signed-off-by: Takayuki Murooka <[email protected]> * add comment Signed-off-by: Takayuki Murooka <[email protected]>

feat(motion_utils): substitute input path initila point informaiton (a…

8bd7cff

…utowarefoundation#1518) Signed-off-by: yutaka <[email protected]>

fix(behavior_path_planner): fix turn signal logic in intersection (au…

0db51f5

…towarefoundation#1519) Signed-off-by: Fumiya Watanabe <[email protected]>

feat(behavior_velocity_planner): use sampling functions from motion u…

49d91ff

…tils (autowarefoundation#1520)

feat(behavior_path_planner): fix resampling method (autowarefoundatio…

0fe0931

…n#1526) Signed-off-by: yutaka <[email protected]>

feat(obstacle_cruise_planner): update obstacle cruise planner (autowa…

ac85255

…refoundation#1531) * delete is on ego traj Signed-off-by: yutaka <[email protected]> * update Signed-off-by: yutaka <[email protected]>

feat(localization_error_monitor): change subscribing topic type (auto…

a9acb3f

…warefoundation#1532) * feat(localization_error_monitor): change subscribing topic type * ci(pre-commit): autofix Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>

fix(behavior_path_planner): fix turn singal (autowarefoundation#1539)

3dbcae2

* fix(behavior_path_planner): fix turn singal Signed-off-by: tomoya.kimura <[email protected]> * apply pre-commit Signed-off-by: tomoya.kimura <[email protected]>

IshitaTakeshi and others added 27 commits September 6, 2022 18:43

fix(system_monitor): incorrect counter increment in CPU Usage monitor (…

574be20

…autowarefoundation#1783) Signed-off-by: v-nakayama7440-esol <[email protected]> Signed-off-by: v-nakayama7440-esol <[email protected]> Co-authored-by: ito-san <[email protected]>

fix(freespace_planning_algorithms): non-successive waypoints problem …

37e8c99

…in hybrid A* algorithm (autowarefoundation#1504) Signed-off-by: NorahXiong <[email protected]>

feat: change car size param in shape estimation (autowarefoundation#1709

8792a93

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

feat(lidar_centerpoint): yaw norm filter (autowarefoundation#1728)

f69f612

* Added a filter by the norm of the yaw * Fixed typos and tested with rosbags * Added the yaw norm parameter in the launch file

docs(velodyne_monitor): add known limits (autowarefoundation#1802)

1379811

* docs(velodyne_monitor): add known limits Signed-off-by: h-ohta <[email protected]> * Update Readme.md Signed-off-by: h-ohta <[email protected]>

fixed minor bug

2a06384

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

modified a lot of files to sync with autowarefoundation/main

9ab96d4

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

modified a lot of files to sync with autowarefoundation/main

ea5d2fa

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

minor fix

5fe5540

parametrize dml parameters

0d96b08

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

added diagnostics

71ab521

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

copyFrom() -> copy constructor, WIP!

1d48b50

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

Partially moved to copy ctor (still not yet using ndt_omp's copy ctor)

fccd71e

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

resolve conflicts

2078ed2

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

resolve conflicts

e4ea5e1

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

move set function from ndt to ndt_omp

dd365a4

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

finally solved the copy constructor issue. Now works withoug CopyFrom()!

06a5e1b

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

check nullptr for last_update_position_ptr in callbackEKFOdom()

5382bd8

kminoda closed this Sep 28, 2022

kminoda deleted the feature/differential_dynamic_map_loading branch August 10, 2023 08:51

Provide feedback

Saved searches

Use saved searches to filter your results more quickly

Feature/differential dynamic map loading #6

Feature/differential dynamic map loading #6

kminoda commented Sep 8, 2022

Feature/differential dynamic map loading #6

Feature/differential dynamic map loading #6

Conversation

kminoda commented Sep 8, 2022

Related Issue(required)

Description(required)

Review Procedure(required)

Related PR(optional)

Pre-Review Checklist for the PR Author

Checklist for the PR Reviewer

Post-Review Checklist for the PR Author

CI Checks