[实用新型]基于球面模型的飞行机械臂视觉伺服结构

说明书

本实用新型提出基于球面模型的飞行机械臂视觉伺服结构，采用的伺服结构包括无人机、机械臂和控制模块；机械臂安装于无人机的机械臂安装面处；机械臂安装面处还设有深度相机，其拍摄角度与机械臂安装面成角度设置，控制模块使深度相机、机械臂组合为机器人手眼标定系统；所述机械臂末端设有执行器；所述控制模块为可对无人机的飞行进行控制的控制模块；当所述飞行机械臂需对目标进行操作时，控制模块经深度相机对目标距离进行评估，若目标位于机械臂操作范围外，则控制模块驱动无人机向目标飞行，若目标位于机械臂操作范围内，则控制模块驱动机械臂对目标进行操作；本实用新型能在无人机上挂载具备主动操纵能力的机械臂。

技术领域

本实用新型涉及无人机技术领域，尤其是基于球面模型的飞行机械臂视觉伺服结构。

背景技术

无人机系统具有运动机动性强、灵活性高等特点，可以在三维世界中自由飞行，因此近年来得到许多不同领域的行业的广泛运用，例如工业工厂检查、战场侦察、自然灾害侦察、地图创建和测量等方面有着广泛的应用。

飞行机械臂系统是在无人机上安装具有一定自由度的机械臂，与常规的无人机相比，作业型无人机系统具有诸多优势，它能在飞行过程中实现对空中或地面目标的快速捕捉，能迅速到达地面机器人无法进入的复杂环境中执行安装或回收测量设备等精细作业任务；但传统无人机系统极大地限制了它们主动操纵的能力，因此，研发无人机与环境之间的物理交互的飞行机械臂具有重大意义。本实用新型正是根据这种需求提出了基于球面模型的飞行机械臂视觉伺服与多任务协调控制方法。

发明内容

本实用新型提出基于球面模型的飞行机械臂视觉伺服结构，能在无人机上挂载具备主动操纵能力的机械臂。

本实用新型采用以下技术方案。

基于球面模型的飞行机械臂视觉伺服结构，所述伺服结构包括六自由度的无人机、三自由度的机械臂和控制模块；所述机械臂安装于无人机的基座的机械臂安装面处；所述机械臂安装面处还设有深度相机；所述深度相机的拍摄角度与机械臂安装面成角度设置，所述控制模块与深度相机、机械臂相连，并使深度相机、机械臂组合为机器人手眼标定系统。

所述机械臂包括三个转动关节；所述机械臂安装面位于基座的平台正下方；所述深度相机为Intel RealSense相机。

所述机械臂末端设有执行器；所述控制模块为可对无人机的飞行进行控制的控制模块；当所述飞行机械臂需对目标进行操作时，控制模块经深度相机对目标距离进行评估，若目标位于机械臂操作范围外，则控制模块驱动无人机向目标飞行，若目标位于机械臂操作范围内，则控制模块驱动机械臂对目标进行操作。

基于球面模型的飞行机械臂视觉伺服与多任务控制方法，所述控制方法使用上文中的基于球面模型的飞行机械臂视觉伺服结构，包括以下步骤；

步骤S1：控制模块通过深度相机获取目标物信息，并基于球面模型建立用于伺服飞行控制的球面坐标系，在无人机飞行过程中，基于球面坐标系实时计算目标物相对于无人机的期望位置实时位置之差，以基于球面坐标系的视觉伺服控制方法来控制无人机向目标物飞行，并得到无人机的伺服速度；

步骤S2：当无人机距目标物较近，使目标物到达相对于无人机的期望位置后，控制模块通过深度相机获取目标物信息和机械臂末端的执行器的信息，并基于球面坐标系对机械臂进行伺服控制，同时得到机械臂在球面坐标系内的角速度；

步骤S3：通过飞行机械臂视觉误差方程控制机械臂动作，以消除深度相机的视觉误差，使控制模块能够对机械臂进行伺服控制来移动执行器，把机械臂末端的执行器移动定位至目标物处；

步骤S4：采用针对多任务的协调控制方法控制飞行机械臂，对目标物定位并抓取，所述多任务包括机械臂末端位置控制、估计目标物体姿态、动态补偿系统重心的变化、避免机械臂关节极限，在对目标物定位并抓取的过程中，所述协调控制方法使飞行机械臂所执行的任务类别与飞行机械臂当前工况匹配。