Add fleet curve walk support

This commit is contained in:
2026-07-07 20:28:26 +08:00
parent 6ca401cf68
commit 0d44fb8fde
5 changed files with 1099 additions and 504 deletions
+25
View File
@@ -203,6 +203,31 @@ public class PilotConfig : MultiWheelPilotConfig
[FieldMember(desc = "FleetCrab startup wheel alignment tolerance(deg)")]
public float FleetCrabStartWheelAlignDeg = 2f;
// ===== Fleet linked Bezier curve walk =====
[FieldMember(desc = "FleetCurve MovementTest control points relative to fleet start; format x,y;x,y;...")]
public string FleetCurveControlPoints = "0,0;1000,800;2000,800;3000,0";
[FieldMember(desc = "FleetCurve Bezier resolution")]
public int FleetCurveBezierResolution = 100;
[FieldMember(desc = "FleetCurve speed(m/s)")]
public float FleetCurveSpeed = 0.2f;
[FieldMember(desc = "FleetCurve car direction bias(deg); body target follows tangent+bias")]
public float FleetCurveCarDirectionBias = 0f;
[FieldMember(desc = "FleetCurve slow distance(mm)")]
public float FleetCurveSlowDistance = 2000f;
[FieldMember(desc = "FleetCurve finish distance(mm)")]
public float FleetCurveFinishDistance = 20f;
[FieldMember(desc = "FleetCurve finish speed(m/s)")]
public float FleetCurveFinishSpeed = 0.02f;
[FieldMember(desc = "FleetCurve slowing curve exponent")]
public float FleetCurveSlowingPow = 0.8f;
// ===== 2腿检测(单线雷达识别两腿托盘 / 轮胎)=====
[FieldMember(desc = "2腿检测:雷达名(逗号分隔可多个)")]
public string TwoLegLidarName = "rear_left_lidar_1,rear_right_lidar_1";