本代码为以STM32为主芯片进行飞行器轨迹定位的算法实现，以C语言编写。