matlab最简单的代码
3D-Route-Planning
三维航迹规划
-Matlab
本次代码主要解决数学建模中多约束条件下的航迹规划问题
解决的问题如下:
复杂环境下航迹快速规划是智能飞行器控制的一个重要课题。由于系统结构限制,
这类飞行器的定位系统无法对自身进行精准定位,
一旦定位误差积累到一定程度可能导致任务失败。
因此,
在飞行过程中对定位误差进行校正是智能飞行器航迹规划中一项重要任务。
假设飞行器的飞行区域如图
1
所示,
出发点为
A
点,目的地为
B
点。
其航迹约束如下:
飞行器在空间飞行过程中需要实时定位,其定位误差包括垂直误差和水平误差。
飞行器每飞行
1m,垂直误差和水平误差将各增加δ个专用单位,,以下简称单位。
到达终点时垂直误差和水平误差均应小于
个单位,并且为简化问题,假设当垂直误差和水平误差均小于
个单位时,飞行器仍能够按照规划路径飞行。
飞行器在飞行过程中需要对定位误差进行校正。
飞行区域中存在一些安全位置(称之为校正点)
可用于误差校正,
当飞行器到达校正点即能够根据该位置的误差校正类型进行误差校正。
校正垂直和水平误差的位置可根据地形在
2021-09-05 09:00:02
55KB
系统开源
1