一种无人机三维空间运动控制方法及系统与流程

技术特征：
1.一种无人机三维空间运动控制方法，其特征在于，所述的控制方法包括以下步骤：在无人机运动过程中，将无人机的实时位置c点到运动目标点a点之间的距离d输入pid位置环控制器，并基于第一算法计算得到所述无人机在三维空间运动时的三维目标合速度，其中，所述第一算法所采用公式如下：；其中，分别为pid控制算法的比例、积分、微分系数；基于第二算法将所述三维目标合速度分解为水平目标速度和竖直目标速度；根据所述水平目标速度和竖直目标速度分别对应在水平方向、竖直方向做串级pid控制，以得到无人机驱动电机的控制量，并根据所述无人机驱动电机的控制量控制无人机向运动目标点a运动。2.根据权利要求1所述的无人机三维空间运动控制方法，其特征在于，在所述无人机运动前，所述控制方法还包括以下步骤：获取无人机运动的起始位点o点以及运动目标点a点；以o点作为坐标原点建立三维坐标系oxyz，其中，xy为水平面，oz为竖直方向；o点到a点的距离记为预定运动距离m，m≠0。3.根据权利要求2所述的无人机三维空间运动控制方法，其特征在于，在控制无人机开始从o点向a点运动时，所述运动过程中，获取无人机的实时位置c点，且c点到o点之间的距离记为实时距离n，且nm，所述无人机的实时位置c点到a点之间的实时距离d=m-n。4.根据权利要求3所述的无人机三维空间运动控制方法，其特征在于，所述获取无人机的实时位置c点的步骤具体包括：通过安装在所述无人机上的gps模块传感器测量得到所述无人机的实时位置c点。5.根据权利要求3或4所述的无人机三维空间运动控制方法，其特征在于，所述第二算法所采用的公式如下：；其中，m1为运动距离m在水平方向的投影长度，为运动距离m在竖直方向的投影长度。6.一种无人机三维空间运动控制系统，其特征在于，所述的控制系统包括：数据输入单元，在无人机运动过程中，将无人机的实时位置c点到运动目标点a点之间的距离d输入pid位置环控制器，
第一计算单元，用于基于第一算法计算得到所述无人机在三维空间运动时的三维目标合速度，第二计算单元，用于基于第二算法将所述三维目标合速度分解为水平目标速度和竖直目标速度，飞行控制单元，用于根据所述水平目标速度和竖直目标速度分别对应在水平方向、竖直方向做串级pid控制，以得到无人机驱动电机的控制量；飞行执行单元，用于根据所述无人机驱动电机的控制量控制无人机向运动目标点a运动。7.根据权利要求6所述的无人机三维空间运动控制系统，其特征在于，所述的控制系统还包括：运动距离确定单元，用于获取无人机运动的起始位点o点以及运动目标点a点；以o点作为坐标原点建立三维坐标系oxyz，其中，xy为水平面，oz为竖直方向；o点到a点的距离记为预定运动距离m，m≠0。8.根据权利要求7所述的无人机三维空间运动控制系统，其特征在于，所述的控制系统还包括：实时距离确定单元，用于在控制无人机开始从o点向a点运动时，获取无人机的实时位置c点，且c点到o点之间的距离记为实时距离n，且nm，所述无人机的实时位置c点到a点之间的实时距离d=m-n。9.根据权利要求8所述的无人机三维空间运动控制系统，其特征在于，所实时距离确定单元包括：gps模块传感器，用于测量获取所述无人机的实时位置c。

技术总结
本发明实施例涉及无人机技术领域，具体提供了一种无人机三维空间运动控制方法及系统，方法包括：基于第一算法计算得到无人机在三维空间运动时的三维目标合速度，基于第二算法将三维目标合速度分解为水平目标速度和竖直目标速度，根据所述水平目标速度和竖直目标速度分别对应在水平方向、竖直方向做串级PID控制，以得到无人机驱动电机的控制量，并根据无人机驱动电机的控制量控制无人机向运动目标点A运动。本发明实施例能够避免因水平方向、竖直方向距离悬殊过大而导致的距离较短的方向先到达目标点、而距离较长的方向后达到目标点的情形出现，同时避免发生无人机撞击到障碍物的事故发生，以对无人机实现精准的运动控制。实现精准的运动控制。实现精准的运动控制。


技术研发人员：黄立 张钦彦 林家民 张原艺 王龙 薛源 刘华斌
受保护的技术使用者：普宙科技（深圳）有限公司
技术研发日：2021.12.22
技术公布日：2022/1/21