Feature/synchronize pose initialization #10
Closed
Conversation
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
Signed-off-by: kminoda <koji.minoda@tier4.jp>
Signed-off-by: kminoda <koji.minoda@tier4.jp>
kminoda
force-pushed
the
feature/synchronize_pose_initialization
branch
from
6cd6721
to
9e23fb5
Compare
kminoda
added a commit
that referenced
this pull request
Jul 7, 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 (autowarefoundation#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 (autowarefoundation#46) Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * 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 <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/** (autowarefoundation#48) * change node namespace Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * update namespace for autoware-mode Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * update namespace in multi_camera.launch Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> --------- Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * removed unstable packages (autowarefoundation#49) Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * feature: add *.param.yaml to manage parameters (autowarefoundation#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 (autowarefoundation#51) Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp> * feat(particle_initializer): merge particle_initializer into mpf (autowarefoundation#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 (autowarefoundation#54) Signed-off-by: kminoda <koji.minoda@tier4.jp> * feature(initializer): combine some initializer packages (autowarefoundation#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 (autowarefoundation#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 (autowarefoundation#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 (autowarefoundation#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 (autowarefoundation#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 join this conversation on GitHub.
Already have an account?
Sign in to comment
Add this suggestion to a batch that can be applied as a single commit.
This suggestion is invalid because no changes were made to the code.
Suggestions cannot be applied while the pull request is closed.
Suggestions cannot be applied while viewing a subset of changes.
Only one suggestion per line can be applied in a batch.
Add this suggestion to a batch that can be applied as a single commit.
Applying suggestions on deleted lines is not supported.
You must change the existing code in this line in order to create a valid suggestion.
Outdated suggestions cannot be applied.
This suggestion has been applied or marked resolved.
Suggestions cannot be applied from pending reviews.
Suggestions cannot be applied on multi-line comments.
Suggestions cannot be applied while the pull request is queued to merge.
Suggestion cannot be applied right now. Please check back later.
Note: Confirm the contribution guidelines before submitting a pull request.
Click the
Previewtab and select a PR template:Do NOT send a PR with this description.