19 Commits

Author SHA1 Message Date
Yangshen⚡Deng
874ebff495 fix: set rrt_star to find the shortest path (#834)
* fix: set rrt_star to find the shortest path

* fix: code style white space
2023-05-16 21:43:57 +09:00
RyderCRD
80124f20e8 Fix the rewire() of rrt* path planning (#550) (#812)
* Update rrt_star_reeds_shepp.py to fix #550

Add step_size attribute to RRTStarReedsShepp, and a method set_random_seed() to set the random seed, with two test cases.

* Update rewire() of rrt_star.py

Update rewire() of rrt_star.py to fix #550.  Since the old version didn't assign path_yaw of edge_node to near_node, the old rewire() doesn't fit rrt_star_reeds_shepp.py

* Update reeds_shepp_path_planning.py

Limit the range of phi for the sake of planning speed, and simplify the the calculation process in straight_left_straight().

* Update reeds_shepp_path_planning.py

* Remove unnecessary cost calculation

Cost of edge_node is calculated in line 221, and self.node_list[i] is replaced to edge_node, so no need to update.

* Update reeds_shepp_path_planning.py
2023-04-27 23:04:39 +09:00
Atsushi Sakai
cb08c39a93 Add Normal vector estimation (#781)
* add normal vector calculation routine.

* add normal vector calculation routine.

* add normal vector estimation

* fix unittests in not matplotlib frontend

* fix lint ci

* add ransac based normal distribution estimation

* add normal_vector_estimation_main.rst

* normal_vector_estimation_main.rst を更新

* update normal_vector_estimation_main.rst

* update normal_vector_estimation_main.rst

* normal_vector_estimation_main.rst

* normal_vector_estimation_main.rst を更新

* add normal_vector_estimation_main.rst

* add normal_vector_estimation_main.rst

* add normal_vector_estimation_main.rst

* add normal_vector_estimation_main.rst

* add normal_vector_estimation_main.rst

* add normal_vector_estimation_main.rst

* add normal_vector_estimation_main.rst

* add normal_vector_estimation_main.rst

* add normal_vector_estimation_main.rst
2023-03-11 17:54:18 +09:00
Atsushi Sakai
76b0d04a3c using pathlib based local module import (#722)
* using pathlib based local module import

* remove unused import
2022-09-11 07:21:37 +09:00
Chris Mower
b53fdf75f6 Add optional robot radius to RRT/RRTStar path planners (#655)
* Add optional robot radius to RRT/RRTStar path planners.
* update __init__ and check_collision to include radius
* during animation, if a robot radius is given then it is drawn

* Add test for robot radius

* Correct import error

* Correct missing robot_radius errors

* Address "expected 2 blank lines, found 1" error

* Address "line too long" errors

* Add missing argument description.

* Remove collision_check_with_xy and replace with check_collision

* Fix "missing whitespace after ','" error

* Update PathPlanning/ClosedLoopRRTStar/closed_loop_rrt_star_car.py

Co-authored-by: Atsushi Sakai <asakai.amsl+github@gmail.com>

Co-authored-by: Atsushi Sakai <asakai.amsl+github@gmail.com>
2022-04-19 12:53:24 +09:00
Atsushi Sakai
eb1fec748f Clean up Path planning docs (#579)
* update docs

* update docs
2021-11-26 23:14:23 +09:00
Rafael Rojas
2b316502e3 Bug RRT* fix, issues #382 and #383 (#401) 2020-10-01 20:15:52 +09:00
Mahyar Abdeetedal
6d29bcd97d support no obstacle in RRT* (#375) 2020-08-11 16:31:45 +09:00
Shilong
cacb6db028 fix RRT rewire 2020-02-09 16:24:21 -08:00
Atsushi Sakai
d2da3abe25 fix safe index reference 2019-10-05 18:00:18 +09:00
Atsushi Sakai
295645f416 fixed rrt star.py 2019-10-02 20:51:22 +09:00
Atsushi Sakai
76977ac256 cleanup closed loop RRT star. 2019-07-28 19:50:02 +09:00
Atsushi Sakai
0937486803 fix rrt star reeds shepp rewire and test 2019-07-27 15:56:16 +09:00
Atsushi Sakai
d9508f6e72 fix rrt_star_dubins 2019-07-27 15:08:25 +09:00
Atsushi Sakai
2bf23adb27 code clean up again 2019-07-20 12:01:03 +09:00
Atsushi Sakai
33d62af0dd update import for travis 2019-07-15 12:13:53 +09:00
Atsushi Sakai
b14a97f153 add module setting for travis 2019-07-15 12:02:05 +09:00
Atsushi Sakai
29da707a9a clean rrt codes 2019-07-15 11:42:35 +09:00
Atsushi Sakai
80d0be2baf Fix RRT Star algorithm 2019-07-15 08:31:46 +09:00