Shamil bf2d9df83d Add ICP support for 3d point clouds (#465) ...

* Add 3d support ICP

* icp_matching function returns R,T corresponding to 2D or 3D set of points
* update_homogeneuous_matrix - general operations for translation and rotation matrixes

* Add test for 3d point cloud (with 2d visualization)

* Separate test for 3d points to main_3d_points

* Add test for ICP 3d

* Correct style

* Add space

* Style correction

* Add more spaces

* Add 3d visualizing for ICP

* Style corrections

* Delete spaces

* Style correction

* remove space

* Separate plot drawing

* plot drawing in a separate function for both 2D and 3D versions
* figure creating before while loop

* Style correction

* Comment 3d plot drawing

Co-authored-by: Shamil GEMUEV <https://github.maf-roda.com/>

2021-04-02 20:49:16 +09:00

..

EKFSLAM

fix deprecation warning for latest numpy (#480)

2021-02-10 22:02:51 +09:00

FastSLAM1

fix inaccurate covariance calculation to add a new landmark in FastSLAM1,2 (#334)

2020-06-05 21:21:35 +09:00

FastSLAM2

fix inaccurate covariance calculation to add a new landmark in FastSLAM1,2 (#334)

2020-06-05 21:21:35 +09:00

GraphBasedSLAM

fix deprecation warning for latest numpy (#480)

2021-02-10 22:02:51 +09:00

iterative_closest_point

Add ICP support for 3d point clouds (#465)

2021-04-02 20:49:16 +09:00

__init__.py

optimized tests for speed up

2019-02-06 09:44:06 +09:00