32 Commits

Author SHA1 Message Date
parmaski
b5988dbcbc Fix: Hybrid A* direction is incorrect (#1086)
* fix to preseve direction history

* add path to Reeds Shepp and its users e.g. hybrid A*
2024-12-21 19:39:16 +09:00
Videh Patel
d7060f6028 Reopen: Added missing path types (#949)
* added missing RS path types

* modified assert condition in test3

* removed linting errors

* added sign check to avoid non RS paths

* Mathematical description of RS curves

* Undid debugging changes

* Added large step_size consideration

* renamed test3 to test_too_big_step_size

---------

Co-authored-by: Videh Patel <videh.patel@fluxauto.xyz>
2024-01-08 21:36:49 +09:00
Videh Patel
cc3fd0c55e Using util.angle_mod in all codes. #684 (#946)
* switched to using utils.angle_mod()

* switched to using utils.angle_mod()

* renamed mod2pi to pi_2_pi

* Removed linting errors

* switched to using utils.angle_mod()

* switched to using utils.angle_mod()

* renamed mod2pi to pi_2_pi

* Removed linting errors

* annotation changes and round precision

* Reverted to mod2pi

---------

Co-authored-by: Videh Patel <videh.patel@fluxauto.xyz>
2024-01-02 22:39:48 +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
489ee5c0e3 fix github scanning alerts (#784) 2023-01-26 21:56:42 +09:00
Atsushi Sakai
2c3896879b Fix reeds shepp path issue (#529)
* code clean up

* code clean up

* code clean up

* code clean up

* fix length handling issues
2021-07-17 18:28:26 +09:00
Jonathan Schwartz
51689d62b9 Issue #523 fix (Reeds-Shepp planner handling length=0 case) (#524)
* Without equals sign, sometimes get points that are in the wrong direction - relative to the points before and after it- when change in x or change in y along path is 0

* Created test script for dubins path generator

* Made len == 0 it's own case, also changed 'l' to 'len' to appease travisCI

* More variable renaming to appease CI

* Broke == 0 into its own case in dubins planner, also Renaming files to appease CI

* Reverting some naming changes

* Turns out theres already a test for dubins.. not sure how I missed that

* Note to self: run the test cases on your own before throwing them at CI

* Added handling of length=0 case in generate_local_course()

* Missed reverting 'mode' back to 'm' in one spot

* Addressing style issues (line length)
2021-07-02 21:53:02 +09:00
zarmars
d53ec936bc Fix the problem that the length of candidate path is not correctly compared. Optimal path may be discarded. (#487) 2021-03-16 23:13:11 +09:00
Atsushi Sakai
03a92fc23e fix bipedal_planner and add its test (#332) 2020-05-28 22:03:17 +09:00
Atsushi Sakai
29c02fae58 code clean up 2020-01-29 21:49:30 +09:00
Göktuğ Karakaşlı
9ca7d8f148 add comment for stopping the simulation 2019-12-14 14:50:32 +03:00
Göktuğ Karakaşlı
d019e416ba exit on key 2019-12-07 14:30:18 +03:00
Atsushi Sakai
0937486803 fix rrt star reeds shepp rewire and test 2019-07-27 15:56:16 +09:00
Atsushi Sakai
af854d6d1a add # pragma: no cover 2019-02-03 10:20:23 +09:00
Atsushi Sakai
9c626d3f45 code clean up 2019-02-02 09:50:58 +09:00
Atsushi Sakai
98b9f5e84b remove all gif 2019-01-31 15:59:17 +09:00
Atsushi Sakai
a4a8591018 fix test and code clean up for lgtm 2018-11-23 14:46:16 +09:00
Atsushi Sakai
3a7f3c5587 code clean up for lgtm 2018-11-23 11:03:50 +09:00
Atsushi Sakai
a164faa7f2 replace math.radians to np.deg2rad 2018-10-23 21:49:08 +09:00
Alexis Paques
b243750a13 Update the pi_2_pi function to a use of a modulo instead of two while. 2018-07-10 09:22:18 +02:00
Atsushi Sakai
54d698130c update README 2018-02-08 12:14:04 -08:00
Atsushi Sakai
f956e6dacc add reed shepp path gif 2018-02-08 12:09:33 -08:00
Atsushi Sakai
fa3692da3e test fixed 2018-02-07 23:42:30 -08:00
Atsushi Sakai
d700425402 first release own rs path 2018-02-07 13:38:26 -08:00
Atsushi Sakai
c5f2c5c672 keep implementing .. 2018-02-06 14:36:55 -08:00
Atsushi Sakai
f80d8d8951 it can generate path but not correct ... 2018-02-05 12:36:48 -08:00
Atsushi Sakai
08a69bf445 try implement my reeds shepp path 2018-02-04 09:29:09 -08:00
Atsushi Sakai
7f40e1d374 add test codes 2018-01-17 18:17:39 -08:00
Atsushi Sakai
ebeb3d955b code clean up 2018-01-13 10:03:45 -08:00
Atsushi Sakai
a7fec91048 add reedsshepppath test 2017-12-19 22:04:01 -08:00
Atsushi Sakai
d86ba52fc9 update README 2017-07-18 22:22:31 -07:00
AtsushiSakai
f0ee5bd1d7 clean up code folders 2017-06-02 10:12:26 -07:00