fullseye

car_reeds_shepp_path — GRAPH path op

使い方

Shortest path of a car that may reverse, between two poses (Reeds and Shepp 1990), by closed form.

poses is [[x, y, theta], [x', y', theta']] (start, goal). The car turns with minimum radius radius and may change gear. Reeds and Shepp proved the shortest path has at most five segments drawn from 48 words (Sussmann and Tang 1991: 46 suffice); the 44 formulas used here (the 12 base words of the paper expanded by time reversal, reflection and backwards reading, as in OMPL) generate every candidate. Each candidate is verified by forward integration and discarded if it misses the goal (counted in n_rejected); the shortest survivor is the answer. Reversed segments carry gear = -1.

Returns word (letters L/S/R; reversed segments are lower-case), length (metres, sum of absolute segment lengths), segments [(kind, gear, length)], points (N, 3) poses sampled every step metres, candidates [(word, length)] sorted, n_candidates, n_rejected, lower_bound (Euclidean distance), radius.

Raises ValueError: poses not (2, 3) finite; radius or step not positive; no word reached the goal.

参考(サンプルデータ・文献)

実行できる例(この op を実際に呼ぶ検証済みサンプル)

型が繋がる次の op(table を入力に取れる)

graph_edge_consensus · graph_core_persistence · tree_morphometry · tree_sholl · tree_run_length

同カテゴリ(path)

car_dubins_path · car_hybrid_astar


Provenance: carpath.py — GRAPH operator registry. この per-op ノートは tools/opdocs.py md が自動生成(手編集しない)。

© 2026 Kazufumi Furuse — Fullseye operator documentation. Licensed under Apache-2.0.