Skip to content
This repository has been archived by the owner on Jul 3, 2023. It is now read-only.

[pull] main from autowarefoundation:main #14

Merged
merged 1 commit into from
Apr 4, 2022

Conversation

pull[bot]
Copy link

@pull pull bot commented Apr 4, 2022

See Commits and Changes for more details.


Created by pull[bot]

Can you help keep this open source service alive? 💖 Please sponsor : )

…595)

* fix(behavior_path_planner): add angle limits to nearest point search

Signed-off-by: tomoya.kimura <tomoya.kimura@tier4.jp>

* ci(pre-commit): autofix

Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>
@pull pull bot added the ⤵️ pull label Apr 4, 2022
@pull pull bot merged commit 70bc967 into kenji-miyake:main Apr 4, 2022
pull bot pushed a commit that referenced this pull request Jun 22, 2023
…ion#3946)

* adopt scane_case to undistort, segment_filter

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* adopt scane_case to ground_server, ll2_decomposer

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* adopt scane_case to twist_converter, twist_estimator

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* adopt scane_case to validation packages

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* adopt scane_case tomodularized_particle_filter

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* adopt scane_case to gnss_particle_corrector

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* adopt scane_case to camera_particle_corrector

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* adopt scane_case to antishadow_corrector

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* adopt scane_case to particle_initializer

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* organize launch files

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* add twist_visualizer to validate odometry performance

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* use SE3::exp() to predict particles & modify linear noise model

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* stop to use LL2 to rectify initialpose2d

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* fix redundant computation in segment_accumulator

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* improve gnss_particle_corrector

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* fix segment_accumulator's bug

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* add doppler_converter

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* add xx2.launch.xml

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* add hsv_extractor

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* pickup other regions which have same color histogram

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* use additional region to filt line-segments

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* improve graph-segmentation

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* remove `truncate_pixel_threshold`

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* refactor graph_segmentator & segment_filter

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* add mahalanobis_distance_threshold in GNSS particle corrector

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* add extract_line_segments.hpp

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* use pcl::transformCloudWithNormals instead of  transform_cloud

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* filt accumulating segments by LL2

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* move herarchical_cost_map to common

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* apply positive feedback for accumulation

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* move transform_linesegments() to common pkg

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* refactor

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* use all projected lines for camera corrector

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* evaluate iffy linesegments

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* complete to unify ll2-assisted lsd clasification

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* add abs_cos2() which is more strict direction constraint

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* fix orientation initialization bug

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* publish doppler direction

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* TMP: add disable/enable switch for camera corrector

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* implement doppler orientation correction but it's disabled by default

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* speed up camera corrector

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* update ros params

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* implement kalman filter for ground tilt estimation

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* continuous height estimation works well?

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* estimate height cotiniously

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* use only linesegments which are at same height

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* add static_gyro_bias parameter

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* fix bug about overlay varidation

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* increse ll2 height marging in cost map generation

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* add static_gyro_bias in twist.launch.xml

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* load pcdless_init_area from ll2

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* add specified initialization area

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* add corrector_manager node to disable/enable camera_corrector

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* call service to disable camer_corrector from manager

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* load corrector disable area

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* overlay even if pose is not estiamted

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* publish camera corrector's status as string

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* add set_booL_panel for camera_corrector enable/disable

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* load bounding box from lanelet2

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* draw bounding box on cost map

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* remove at2,at1 from cost map

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* use cost_map::at() instread pf at2()

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* move cost map library from common to camera corrector

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* use logit for particle weighting but it does not work well

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* prob_to_logit() requires non-intuitive parameters

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* goodbye stupid parameters (max_raw_score & score_offset)

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* publish two scored pointclouds as debug

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* can handle unmapped areas

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* remove obsolete packages

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* update README.md

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* Update README.md

* add image of how_to_launch

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* add node diagram in readme

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* add rviz_description.png in README

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* subscribe pose_with_cov & disconnect base_link <-> particle_pose

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* remove segment_accumulator & launch ekf_localizer from this project

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* add gnss_ekf_corrector

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* add camera_ekf_corrector package

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* subscribe ekf prediction & synch pose data

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* WIP: ready to implement UKF?

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* estimate weighted averaging as pose_estimator

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* basic algorithm is implemented but it does not work proparly

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* apply after_cov_gain_

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* ekf corrector works a little bit appropriately

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* increase twist covariance for ekf

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* test probability theory

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* updat prob.py

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* implement de-bayesing but it loooks ugly

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* remove obsolete parameters

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* skip measurement publishing if travel distance is so short

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* use constant covariance because i dont understand what is correct

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* add submodule sample_vehicle_launch

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* TMP but it works

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* add ekf_trigger in particle_initializer.hpp

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* publish gnss markers & camera_est pubishes constant cov

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* back to pcd-less only launcher

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* add bayes_util package

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* apply de-bayesing for camera_ekf

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* some launch file update

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* organize launch files. we can choice mode from ekf/pekf/pf

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* organize particle_initializer

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* add swap_mode_adaptor WIP

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* use latest ekf in autoware & sample_vehicle

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* fix bug of swap_adalptor

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* fix FIX & FLOAT converter

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* fix septentrio doppler converter

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* move ekf packages to ekf directory

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* ignore corrector_manager

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* add standalone arg in launch files

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* update semseg_node

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* add camera_pose_initializer pkg

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* subscribe camera_info&tf and prepare semantic projection

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* project semantic image

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* create vector map image from ll2

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* create lane image from vector map

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* search the most match angle by non-zero pixels

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* camera based pose_initializer

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* move ekf packages into unstable

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* move ekf theory debugger

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* add tier4_autoware_msgs as submodule

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* move pose_initializer into initializer dir

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* add semse_msgs pkg

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* separate marker pub function

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* separate projection functions

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* add semseg_srv client

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* move sem-seg directory

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* camera pose initilizer works successfully

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* rectify covariance along the orientation

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* improve initialization parameters

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* take into account covariance of request

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* use lanelet direciton to compute init pose scores

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* semseg download model automatically

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* remove sample_vehicle_launch

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* add autoware_msgs

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* remove obsolete launch files

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* add standalone mode for direct initialization

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* fix fix_to_pose

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* update launch files

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* update rviz config

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* remove lidar_particle_corrector

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* remove Sophus from sunbmodule

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* rename submodule directory

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* update README and some sample images

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* update README.md

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* fix override_camera_frame_id bahaviors

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* fix some bugs (#4)

Signed-off-by: kminoda <koji.minoda@tier4.jp>

* fix: use initialpose from Rviz (#6)

* use initialpose from Rviz to init

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* add description about how-to-set-initialpose

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

---------

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* misc: add license (#7)

* WIP: add license description

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* add license description

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* add description about license in README

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

---------

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* add quick start demo (#8)

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* refactor(launch) remove & update obsolete launch files (#9)

* delete obsolete launch files

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* update documents

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

---------

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* docs(readme): update architecture image (#10)

* replace architecture image in README

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* update some images

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

---------

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* refactor(pcdless_launc/scripts): remove unnecessary scripts (#11)

* remove not useful scripts

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* rename scripts &  add descriptions

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* little change

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* remove odaiba.rviz

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* grammer fix

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

---------

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* fix(pcdless_launch): fix a build bug

Signed-off-by: kminoda <koji.minoda@tier4.jp>

* fix(twist_estimator): use velocity_report by default

Signed-off-by: kminoda <koji.minoda@tier4.jp>

* fix bug

Signed-off-by: kminoda <koji.minoda@tier4.jp>

* debugged, now works

Signed-off-by: kminoda <koji.minoda@tier4.jp>

* update sample rosbag link (#14)

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* feature(graph_segment, gnss_particle_corrector): make some features switchable (#17)

* make additional-graph-segment-pickup disablable

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* enlarge gnss_mahalanobis_distance_threshold in expressway.launch

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

---------

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* fix: minor fix for multi camera support (#18)

* fix: minor fix for multi camera support

Signed-off-by: kminoda <koji.minoda@tier4.jp>

* update

Signed-off-by: kminoda <koji.minoda@tier4.jp>

* update

Signed-off-by: kminoda <koji.minoda@tier4.jp>

* fix typo

Signed-off-by: kminoda <koji.minoda@tier4.jp>

---------

Signed-off-by: kminoda <koji.minoda@tier4.jp>

* refactor(retroactive_resampler): more readable (#19)

* make Hisotry class

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* use boost:adaptors::indexed()

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* add many comment in resampling()

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* does not use ConstSharedPtr

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* rename interface of resampler

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* circular_buffer is unnecessary

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

---------

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* refactor(mpf::predictor) resampling interval control in out of resampler (#20)

* resampling interval management should be done out of resample()

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* resampler class throw exeption rather than optional

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* split files for resampling_history

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* split files for experimental/suspention_adaptor

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

---------

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* refactor(mpf::predictor): just refactoring (#21)

* remove obsolete functions

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* remove test of predictor

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* remove remapping in pf.launch.xml for suspension_adapator

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* add some comments

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

---------

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* fix(twist_estimator): remove stop filter for velocity (#23)

Signed-off-by: kminoda <koji.minoda@tier4.jp>

* feat(pcdless_launch): add multi camera launcher (#22)

* feat(pcdless_launch): add multi camera launcher

Signed-off-by: kminoda <koji.minoda@tier4.jp>

* minor fix

Signed-off-by: kminoda <koji.minoda@tier4.jp>

---------

Signed-off-by: kminoda <koji.minoda@tier4.jp>

* refactor(CMakeListx.txt): just refactoring (#24)

* refactor imgproc/*/CMakeListx.txt

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* refactor initializer/*/CMakeListx.txt & add gnss_pose_initializer pkg

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* rename some files in twist/ & refactor pf/*/cmakelist

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* refactor validation/*/CMakeListx.txt

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* fix some obsolete executor name

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

---------

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* fix: rename lsd variables and files (#26)

Signed-off-by: kminoda <koji.minoda@tier4.jp>

* misc: reame pcdless to yabloc (#25)

* rename pcdless to yabloc

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* fix conflict miss

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

---------

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* visualize path (#28)

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* docs: update readme about particle filter (#30)

* update mpf/README.md

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* update gnss_corrector/README.md

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* update camera_corrector/README.md

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

---------

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* feat(segment_filter): publish images with lines and refactor (#29)

* feat(segment_filter): publish images with lines

Signed-off-by: kminoda <koji.minoda@tier4.jp>

* update validation

Signed-off-by: kminoda <koji.minoda@tier4.jp>

* update imgproc (reverted)

Signed-off-by: kminoda <koji.minoda@tier4.jp>

* large change inclding refactoring

Signed-off-by: kminoda <koji.minoda@tier4.jp>

* major update

Signed-off-by: kminoda <koji.minoda@tier4.jp>

* revert rviz config

Signed-off-by: kminoda <koji.minoda@tier4.jp>

* minor fix in name

Signed-off-by: kminoda <koji.minoda@tier4.jp>

* add validation option

Signed-off-by: kminoda <koji.minoda@tier4.jp>

* update architecture svg

Signed-off-by: kminoda <koji.minoda@tier4.jp>

* rename validation.launch to overlay.launch

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* no throw runtime_error (unintentionaly applying format)

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

---------

Signed-off-by: kminoda <koji.minoda@tier4.jp>
Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>
Co-authored-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* catch runtime_error when particle id is invalid (#31)

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* return if info is nullopt (#32)

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* pose_buffer is sometimes empty (#33)

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* use_yaw_of_initialpose (#34)

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* feat(interface):  remove incompatible interface (#35)

* not use ublox_msg when run as autoware

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* remove twist/kalman/twist & use twist_estimator/twist_with_covariance

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* update particle_array stamp even if the time stamp seems wrong

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

---------

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* fix: suppress info/warn_stream (#37)

* does not stream undistortion time

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* improve warn stream when skip particle weighting

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* surpress frequency of  warnings during synchronized particle searching

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* fix camera_pose_initializer

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

---------

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* /switch must not be nice name (#39)

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* misc(readme): update readme (#41)

* add youtube link and change thumbnail

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* improve input/output topics

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* quick start demo screen image

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* add abstruct architecture and detail architecture

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

---------

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* docs(rosdep): fix package.xml to ensure build success (#44)

* fix package.xml to success build

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* add 'rosdep install' in how-to-build

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

---------

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* add geographiclib in package.xml (#46)

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* fix path search error in build stage (#45)

* fix path search error in build stage

* fix tier4/YabLoc#45 (comment)

* Feature/remove submodule (#47)

* remove submodules

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* remove doppler converter

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

---------

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* feature: change node namespace to /localization/yabloc/** from /localization/** (#48)

* change node namespace

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* update namespace for autoware-mode

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* update namespace in multi_camera.launch

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

---------

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* removed unstable packages (#49)

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* feature: add *.param.yaml to manage parameters (#50)

* make *.param.yaml in imgproc packages

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* make *.param.yaml in initializer packages

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* make *.param.yaml in map packages

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* make *.param.yaml in pf packages

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* make *.param.yaml in twist packages

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* fix expressway parameter

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* fix override_frame_id

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* remove default parameters

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* fix some remaining invalida parameters

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

---------

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* does not estimate twist (#51)

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* feat(particle_initializer): merge particle_initializer into mpf (#52)

* feat(particle_initializer): merge particle_initializer to modulalized_particle_filter

Signed-off-by: kminoda <koji.minoda@tier4.jp>

* remove particle_initializer

* remove debug message

Signed-off-by: kminoda <koji.minoda@tier4.jp>

* remove related parts

Signed-off-by: kminoda <koji.minoda@tier4.jp>

* update readme

Signed-off-by: kminoda <koji.minoda@tier4.jp>

* rename publishing topic

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

---------

Signed-off-by: kminoda <koji.minoda@tier4.jp>
Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>
Co-authored-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* fix: remove ll2_transition_area (#54)

Signed-off-by: kminoda <koji.minoda@tier4.jp>

* feature(initializer): combine some initializer packages (#56)

* combine some package about initializer

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* yabloc_pose_initializer works well

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* remove old initializer packages

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* semseg node can launch

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* fix bug

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* revert initializer mode

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

---------

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* feature(imgproc): reudce imgproc packages (#57)

* combine some imgproc packages

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* combine overlay monitors into imgproc

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

---------

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* feature(validation): remove validation packages (#58)

* remove validation packages

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* remove path visualization

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

---------

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* feature(pf): combine some packages related to particle filter (#59)

* create yabloc_particle_filter

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* combine gnss_particle_corrector

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* combine ll2_cost_map

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* combine camera_particle_corrector

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* fix launch files

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* split README & remove obsolete scripts

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* fix config path of multi_camera mode

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

---------

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* feature: combine map and twist packages (#60)

* removed some twist nodes & rename remains to yabloc_twist

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* fix launch files for yabloc_twist

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* move map packages to yabloc_common

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* WIP: I think its impossible

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* Revert "WIP: I think its impossible"

This reverts commit 49da507bbf9abe8fcebed4d4df44ea5f4075f6d1.

* remove map packages & fix some launch files

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

---------

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* removed obsolete packages

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* remove obsolete dot files

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* use tier4_loc_launch instead of yabloc_loc_launch

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* move launch files to each packages

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* remove yabloc_localization_launch

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* remove yabloc_launch

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* modify yabloc/README.md

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* update yabloc_common/README.md

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* update yabloc_imgproc README

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* update yabloc_particle_filter/README

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* update yabloc_pose_initializer/README

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* update README

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* use native from_bin_msg

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* use ifndef instead of pragma once in yabloc_common

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* use ifndef instead of pragma once in yabloc_imgproc & yabloc_pf

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* use ifndef instead of pragma once in yabloc_pose_initializer

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* style(pre-commit): autofix

* use autoware_cmake & suppress build warning

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* repalce yabloc::Timer with  tier4_autoware_utils::StopWatch

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* replace 1.414 with std::sqrt(2)

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* style(pre-commit): autofix

* removed redundant ament_cmake_auto

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* removed yabloc_common/timer.hpp

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* replaced low_pass_filter with autoware's lowpass_filter_1d

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* style(pre-commit): autofix

* Squashed commit of the following:

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

commit cb08e290cca5c00315a58a973ec068e559c9e0a9
Author: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>
Date:   Tue Jun 13 14:30:09 2023 +0900

    removed ublox_msgs in gnss_particle_corrector

    Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

commit c158133f184a43914ec5f929645a7869ef8d03be
Author: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>
Date:   Tue Jun 13 14:24:19 2023 +0900

    removed obsolete yabloc_multi_camera.launch

    Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

commit 10f578945dc257ece936ede097544bf008e5f48d
Author: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>
Date:   Tue Jun 13 14:22:14 2023 +0900

    removed ublox_msgs in yabloc_pose_initializer

    Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* style(pre-commit): autofix

* removed fix2mgrs & ublox_stamp

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* added ~/ at the top of topic name

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* removed use_sim_time in yabloc launch files

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* add architecture diagram in README

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* rename lsd_node to line_segment_detector

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* style(pre-commit): autofix

* Update localization/yabloc/README.md

fix typo

Co-authored-by: Takagi, Isamu <43976882+isamu-takagi@users.noreply.github.com>

* removed obsolete debug code in similar_area_searcher

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* removed suspension_adaptor which manages lifecycle of particle predictor

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* style(pre-commit): autofix

* renamed semseg to SemanticSegmentation

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* style(pre-commit): autofix

* fixed README.md to solve markdownlint

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* WIP: reflected cpplint's suggestion

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* reflected cpplint's suggestion

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* rename AbstParaticleFilter in config files

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* fixed typo

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* used autoware_lint_common

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* fixed miss git add

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* style(pre-commit): autofix

* replaced lanelet_util by lanelet2_extension

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* replaced fast_math by tie4_autoware_utils

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* sort package.xml

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* renamed yabloc_imgproc with yabloc_image_processing

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* reflected some review comments

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* resolved some TODO

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* prioritize NDT if both NDT and YabLoc initializer enabled

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* changed localization_mode option names

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

---------

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>
Signed-off-by: kminoda <koji.minoda@tier4.jp>
Co-authored-by: kminoda <44218668+kminoda@users.noreply.github.com>
Co-authored-by: kminoda <koji.minoda@tier4.jp>
Co-authored-by: Akihiro Komori <akihiro.komori@unity3d.com>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>
Co-authored-by: Takagi, Isamu <43976882+isamu-takagi@users.noreply.github.com>
Sign up for free to subscribe to this conversation on GitHub. Already have an account? Sign in.
Projects
None yet
Development

Successfully merging this pull request may close these issues.

1 participant