路径点不重复的控制算法测试通了，但是好像不如之前路径点重复的版本好。增加了蓝牙接口部分。准备移植外包的MQTT。

yincheng.zhong

10 天以前 4adc78553c8d48ff122506195fa33641134bd7b1

 STM32H743/FML/PythonLink.c

@@ -16,6 +16,8 @@
#include <math.h>
#include <stdio.h>

#define ENABLE_PYTHONLINK_CTRL_LOG 1

/*******************************************************************************
 *                             Global Variables                                *
 *******************************************************************************/
@@ -590,7 +592,9 @@
                      _target_heading_deg,
                      target_e,
                      target_n);
#if ENABLE_PYTHONLINK_CTRL_LOG
    PythonLink_SendAsciiSentence(PYTHONLINK_ASCII_KEY_CTRL, payload);
#endif
}

HIDO_VOID PythonLink_ReportPose(const HIDO_FLOAT _enu[3],