curvature_speed_plan — DRIVE lateral op

• 数据种类:any → table

• 调用: import fullseye as fs; fs.ledger.curvature_speed_plan(s, kappa, *, v_max, a_lat_max: 'float', a_accel: 'float', a_decel: 'float', a_total: 'Optional[float]' = None, v_start: 'Optional[float]' = None, v_end: 'Optional[float]' = None) -> 'Dict[str, np.ndarray]'(要直接调用实现,import drivelateral; drivelateral.curvature_speed_plan(s, kappa, *, v_max, a_lat_max: 'float', a_accel: 'float', a_decel: 'float', a_total: 'Optional[float]' = None, v_start: 'Optional[float]' = None, v_end: 'Optional[float]' = None) -> 'Dict[str, np.ndarray]';从台账取用则 opsdrive.get("curvature_speed_plan"))

用法

由曲率序列构造速度上限,并通过前向、后向 2 遍处理满足加减速上限的速度规划(经典方法)。

> 以下的详细说明为原文 —— 摘要与标题已翻译。

s: 弧長(増加、(N,))。kappa: 各点の曲率(符号は問わない)。v_max: 速度の上限(スカラーまたは (N,)、法定速度・徐行の区間など)。上限 v_lim = min(v_max, √(a_lat_max/|κ|))。刻みの間は v² を s に一次(一定の加減速)。a_total(摩擦円の半径、例 μg)を与えると、縦の加減速を √(a_total² − (v²κ_m)²) でも抑える(κ_m = 刻みの両端の |κ| の大きい方、2 次方程式で解くので刻みの中の どこでも √(a_x² + a_y²) ≤ a_total)。a_lat_max ≤ a_total を要求。

返り値: v, v_limit, ax(刻みごとの縦の加速度、(N−1,))、ay_max(刻みの中の横の加速度の最大)、time(到着時刻、v² 一次の厳密な時間)。

Raises ValueError: 形の誤り、s が増加でない、上限が正でない、a_lat_max > a_total、v_start/v_end が上限超え。

参考(示例数据、文献)

• 示例数据目录(下载 URL / 许可证) —— 2-D 用 skimage.data(BSD/公有领域)加合成图,3-D 给出真实数据源(Stanford/PDS 等)的下载 URL。

• 算子来历与参考文献 —— 该算子族所依据的研究/方法出处。

• 算法的正典(作者、年份)与用途见上面的族使用指南。

可运行的示例(实际调用该算子并已验证的样例)

• poc_driving_lateral — py -3.11 examples/poc_driving_lateral.py

类型可衔接的下一个算子(可接受 table 作为输入)

course_layout · course_occupancy · course_contains · world_build · world_camera · world_move · lidar_scan · rss_longitudinal_same

同类别(lateral)

friction_circle_usage · curve_speed_limit · design_min_radius · understeer_gradient · steady_cornering · bicycle_model_step · ackermann_steer_angles · offtracking_circle


*Provenance: drivelateral.py — DRIVE 算子登记表。本条目由 tools/opdocs.py md 自动生成(请勿手工编辑)。*

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