还原到路径第一次调通的版本，

yincheng.zhong

2025-12-10 8d0d8dec18cc9170f3fb82a4dba18160dd8e5233

 STM32H743/FML/motion_path_data.c

@@ -6,30 +6,55 @@

#include "motion_path_data.h"

//const float g_motion_path_xy[] = {
////    5.61f, -9.91f,
////    4.45f, -3.43f,
////    3.79f, -2.59f,
////    5.32f, -11.12f,
////    4.97f, -11.98f,
////    2.87f, -0.32f,
////    2.26f, 0.26f,
////    4.47f, -12.06f,
////    3.98f, -12.14f,
//    1.77f, 0.16f,
//    1.28f, 0.05f,
//    3.49f, -12.22f,
//    2.95f, -12.05f,
//    0.79f, -0.06f,
//    0.30f, -0.16f,
//    2.39f, -11.76f
//};
const float g_motion_path_xy[] = {
    5.40f, -7.18f,
    5.40f, -10.70f,
    5.40f, -10.70f,
    4.90f, -11.96f,
    4.90f, -11.96f,
    4.90f, -4.85f,
    4.90f, -4.85f,
    4.40f, -3.41f,
    4.40f, -3.41f,
    4.40f, -12.05f,
    4.40f, -12.05f,
    3.90f, -12.13f,
    3.90f, -12.13f,
    3.90f, -2.77f,
    3.90f, -2.77f,
    3.40f, -2.14f,
    3.40f, -2.14f,
    3.40f, -12.21f,
    3.40f, -12.21f,
    2.90f, -11.99f,
    2.90f, -11.99f,
    2.90f, -0.56f
    5.61f, -9.91f,
    4.45f, -3.43f,
    4.45f, -3.43f,
    3.79f, -2.59f,
    3.79f, -2.59f,
    5.32f, -11.12f,
    5.32f, -11.12f,
    4.97f, -11.98f,
    4.97f, -11.98f,
    2.87f, -0.32f,
    2.87f, -0.32f,
    2.26f, 0.26f,
    2.26f, 0.26f,
    4.47f, -12.06f,
    4.47f, -12.06f,
    3.98f, -12.14f,
    3.98f, -12.14f,
    1.77f, 0.16f,
    1.77f, 0.16f,
    1.28f, 0.05f,
    1.28f, 0.05f,
    3.49f, -12.22f,
    3.49f, -12.22f,
    2.95f, -12.05f,
    2.95f, -12.05f,
    0.79f, -0.06f,
    0.79f, -0.06f,
    0.30f, -0.16f,
    0.30f, -0.16f,
    2.39f, -11.76f
};

const HIDO_UINT32 g_motion_path_point_count = sizeof(g_motion_path_xy) / (sizeof(float) * 2U);