说明：用LQR 控制方法 来实现 平衡 机器人 平衡 ，分析Q值 影响 来确定 最佳 回馈 K值。平衡机器人需要三个 角度 控制，即机器人身体倾斜角，车轮转交 ，还有 水平转交 ，通过这三个转角 的控制最终实现 平衡，。
说明：利用切角距离匹配算法来寻找视频帧与二维图像之间的距离度量图像。这个迭代计算倒角距离，直到找到与帧图像和从三维图像投影的二维图像正确匹配的最佳拟合。
说明：各种灵巧噪声干扰（卷积，假目标，C&I等）仿真及论文； 以及抗干扰的一些算法程序。
说明：惯性测量组件Mti进行数据采集，利用陀螺和加速度计数据进行捷联姿态角解算，采用四元数更新算法，解算周期可调。