增加GCP运动学并完善车体平面速度反馈分析

MultiWheelC/Experiments/CompositeMotionPlanTests.cs

@@ -307,6 +307,8 @@ namespace MultiWheelC
                     out var detourVelocityValid,
                     out var rawWheelBodyVx,
                     out var filteredWheelBodyVx,
+                    out var rawWheelBodyVy,
+                    out var filteredWheelBodyVy,
                     out var wheelVelocityValid))
             {
                 _recorder?.UpdateVelocityDiagnostics(
@@ -314,6 +316,8 @@ namespace MultiWheelC
                     detourVelocityValid,
                     rawWheelBodyVx,
                     filteredWheelBodyVx,
+                    rawWheelBodyVy,
+                    filteredWheelBodyVy,
                     wheelVelocityValid);
             }