关于UKF在MATLAB中的详细公式推导过程，通俗易懂

stm32红外循迹小车硬件原理图

基于STM32F1的智能循迹小车的PWM调速的程序源码，KEIL5下载即可使用，红外传感器，光电传感器均可。

为准确估计捷联导引头视线角速率，建立了捷联式光学图像导引头数学模型，根据弹目运动相对关系进行视线角速率估计算法研究。定义了估计算法所需坐标系并建立了导引头与陀螺数学模型；根据弹目相对运动学及姿态关系建立视线角速率估计非线性状态方程；针对滤波精度与实时性应用的问题，提出无迹Kalman滤波(UKF)方法估计视线角速率，并建立半物理实验系统进行算法验证，实验结果表明：视线角及视线角速率的最大估计误差分别为0.37°与0.68°/s，估计精度分别为0.1008°与0.2116°/s；数字信号处理器(DSP)中算法运行时间约为3.8 ms，视线角速率估计算法同时能满足制导系统对精度与实时性的要求。基于UKF的视线角速率估计算法为捷联式光学图像导引头的工程应用提供理论依据。

主要采用舵机控制小车前进方向，代码本身仅供参考。 1．给超声波模块接入电源和地，电源为5V,3.3V有时会出错。 2.给脉冲触发引脚（trig）输入一个长为20us（最小为10us）的高电平方波，ECHO设置为PA4，TRIG设置为PA5。 3.输入方波后，模块会自动发射8个40KHz的声波，与此同时回波引脚（echo）端的电平会由0变为1；（此时应该启动定时器计时） 4.当超声波返回被模块接收到时，回波引脚端的电平会由1变为0；（此时应该停止定时器计数），定时器记下的这个时间即为超声波由发射到返回的总时长。 5.根据声音在空气中的速度为344米/秒，即可计算出所测的距离。

基于AT89s52单片机，不仅具有智能小车一般的功能，如：循迹、避障，还有超声波测量距离功能、电池电压测量、电机过流测量、无线遥控功能等等。 包含原理图与程序代码.

15届ai电磁小白组程序，获奖省二，有需要可下载。

ATMEGA16单片机寻迹小车程序及其原理图

备注： 无迹卡尔曼滤波在目标跟踪中的应用 无迹卡尔曼滤波算法； MATLAB仿真 目标跟踪matlab仿真实现; Case: 二维目标跟踪情况 对应的理论分析和参数设置，见博文https://blog.csdn.net/weixin_44044161/article/details/115381848?spm=1001.2014.3001.5501

备注： 无迹卡尔曼滤波在目标跟踪中的应用 无迹卡尔曼滤波算法； MATLAB仿真 目标跟踪matlab仿真实现; Case: 三维目标跟踪情况 对应的理论分析和参数设置，见博文https://blog.csdn.net/weixin_44044161/article/details/115381848?spm=1001.2014.3001.5501