一种控制无人机的挂载设备对地角度的装置和方法与流程

本发明涉及自动控制技术领域，特别涉及一种控制无人机的挂载设备对地角度的装置和方法。

背景技术：

对无人机的定位而言，在空旷室外环境下，一般可以使用高精度gps(globalpositioningsystem，全球定位系统)和惯性导航方式获取稳定、高精度的位置和速度信号；而对于室内或者室外有高物遮挡情况下，gps信号较弱，不能利用gps进行定位，通常利用如对地的红外、超声波、雷达或者光流作为辅助传感器被组合引入到无人机系统，无人机系统通过采样获得对地高度、速度信息与无人机本身的惯性传感器进行数据融合，获取较为精确的室内三维空间定位。

目前，室内定位方案无论是采用哪种组合定位方案，所集成的诸如红外、光流、超声波等辅助传感器都是采用固定方式连接在无人机底部，无人机在产生高度或者水平速度变化时，通过辅助传感器获取高度、速度信息。但是在无人机并没有产生速度或者位移变化的情况下，只要无人机的姿态变化，辅助传感器的朝向会跟随变化，进而辅助传感器的输出也会跟随变化，导致辅助传感器检测量会把随姿态变化而产生的变化耦合至实际采样的速度、位移数据中去。比如光流会因为无人机横滚和俯仰的速度不同而产生不同速度信息，红外和超声波测距模块会因为无人机横滚和俯仰角度不同产生不同的高度信息。

现有方案大多是根据无人机内部通过姿态信息，对辅助传感器数据进行相应算法处理，补偿或纠正因姿态变化而导致的辅助传感器误差，但是在大倾角情况下，辅助传感器会因为无人机倾角的存在而使得视野角度向外延伸而无法工作在额定的检测距离，导致在有较大倾角或者来回机动运动状态下，无人机无法获取精确定位数据。

技术实现要素：

基于本发明的一个目的，本发明提供了一种控制无人机的挂载设备对地角度的装置和方法，以解决在有较大倾角或者来回机动运动状态下，无人机无法获取精确定位数据的问题。

为达到上述目的，本发明的技术方案是这样实现的：

一方面，本发明提供了一种控制无人机的挂载设备对地角度的装置，包括：用于安装挂载设备的搭载平台、控制器、惯性测量模组和旋转驱动模组；

惯性测量模组安装在挂载设备上，实时获取挂载设备的运动信息，并发送给控制器；

控制器安装在搭载平台上，实时获取无人机的运动信息和惯性测量模组发送的挂载设备的运动信息，并根据两种运动信息生成驱动控制信息；搭载平台安装在旋转驱动模组上，旋转驱动模组根据驱动控制信息驱动搭载平台三维转动。

另一方面，本发明提供了一种控制无人机的挂载设备对地角度的方法，包括：

实时获取无人机的运动信息，并利用安装在挂载设备上的惯性测量模组实时获取挂载设备的运动信息；

根据无人机的运动信息和挂载设备的运动信息生成驱动控制信息，使旋转驱动模组根据驱动控制信息驱动安装在其上的搭载平台三维转动。

本发明的有益效果是：本发明在搭载平台上安装设置有惯性测量模组的挂载设备和控制器，分别利用惯性测量模组获取挂载设备的运动信息，利用控制器获取无人机的运动信息，控制器根据两种运动信息生成驱动控制信息，使旋转驱动模组根据驱动控制信息驱动搭载平台旋转，带动搭载平台上的挂载设备旋转，避免搭载平台随无人机的姿态变化而发生对地角度的变化，使安装在搭载平台上的挂载设备能够在无人机的各种运动状态下相对地面保持稳定的对地角度，辅助完成自稳控制，以对无人机精确定位。

附图说明

图1为本发明实施例一提供的控制无人机的辅助传感器模组对地角度的装置立体结构示意图；

图2为图1的俯视图；

图3为本发明实施例一提供的控制无人机的辅助传感器模组对地角度的装置的控制流程图；

图4为本发明实施例二提供的控制无人机的挂载设备对地角度的方法流程图。

具体实施方式

为使本发明的目的、技术方案和优点更加清楚，下面将结合附图对本发明实施方式作进一步地详细描述。

针对现有方案中，辅助传感器模组因为无人机倾角的存在而使得视野角度向外延伸而无法工作在额定的检测距离，导致在有较大倾角或者来回机动运动状态下，无人机无法获取精确定位数据的情况，本发明立足于实际应用场景和辅助传感器的特性，着重解决无人机在运动状态，特别是剧烈运动状态、大倾角运动下，无人机辅助传感器相对地球坐标的朝向问题。

本发明的整体设计构思是：将各类对地感应方向有一定角度限制的辅助传感器模组安装在一个搭载平台上，通过机械电子结构控制搭载平台旋转，使得辅助传感器模组在无人机的各种运动状态下相对地面保持稳定的对地角度。

实施例一

本实施例提供了一种控制无人机的挂载设备对地角度的装置，该装置为具有增稳作用的械电子机构，包括用于安装挂载设备的搭载平台、控制器、惯性测量模组和旋转驱动模组；

惯性测量模组安装在挂载设备上，实时获取挂载设备的运动信息，并发送给控制器；

控制器安装在搭载平台上，实时获取无人机的运动信息和惯性测量模组发送的挂载设备的运动信息，并根据两种运动信息生成驱动控制信息；

搭载平台安装在旋转驱动模组上，旋转驱动模组根据驱动控制信息驱动搭载平台三维转动。

其中，无人机的运动信息包括但不局限于对地角度，如右手坐标系或东北天坐标系中的角度，角速度；挂载设备的运动信息包括但不局限于对地角度，如右手坐标系或东北天坐标系中的角度，角速度；驱动控制信息包括但不局限于转动方向、转动力矩。

本实施例在搭载平台上安装设置有惯性测量模组的挂载设备和控制器，分别利用惯性测量模组获取挂载设备的运动信息，控制器获取无人机的运动信息，控制器根据两种运动信息生成驱动控制信息，使旋转驱动模组根据驱动控制信息驱动搭载平台旋转，带动搭载平台上的挂载设备旋转，避免搭载平台随无人机的姿态变化而发生对地角度的变化，使挂载设备能够在无人机的各种运动状态下相对地面保持稳定的对地角度，以对无人机精确定位。

示例性的，控制器根据无人机的运动信息和挂载设备的运动信息计算搭载平台的当前对地坐标角度和当前运行角速度，比较当前对地坐标角度和参考角度，得到补偿角度，根据补偿角度和当前运行角速度得到驱动控制信息；其中，参考角度是指挂载设备需要维持的角度；一般地，驱动控制信息包括旋转驱动模组当前所需的角速度和旋转方向。

本实施例的旋转驱动模组包括第一旋转驱动组件，第一旋转驱动组件包括第一电机和第一驱动轴；搭载平台固定在第一驱动轴上，第一电机驱动第一驱动轴带动搭载平台沿着第一方向旋转，控制挂载设备旋转，以使其维持所需的对地角度。

为进一步保证挂载设备对地角度的准确性和稳定性，该旋转驱动模组还包括第二旋转驱动组件，第二旋转驱动组件包括第二电机、第二驱动轴和机械臂；机械臂分别固定在第二驱动轴和第一驱动轴上，第二电机驱动第二驱动轴带动机械臂、第一电机和搭载平台沿着第二方向同步旋转；其中，第一方向和第二方向成预设角度，优选地，第一电机和第二电机的轴线垂直分布，第一方向与第二方向相互垂直。

为详细说明本实施例的装置各个部件的连接关系，以及装置对搭载平台的控制过程，下面通过一个具体实现方案进行说明。

在本具体实现方案中，挂载设备为辅助传感器模组，示例性地为对地感应方向有一定角度限制的各类传感器，例如为集成光学传感器(如红外线传感器、光流传感器)和/或声学传感器(超声波传感器)的传感器模组；惯性测量模组包括但不局限于陀螺仪、加速度传感器等。

图1为本实施例提供的控制无人机的传感器模组对地角度的装置立体结构示意图，图2为图1的俯视图；如图1和图2所示，旋转驱动模组包括第一旋转驱动组件和第二旋转驱动组件；

第一旋转驱动组件包括第一电机11和第一驱动轴12；搭载平台2固定在第一驱动轴12上，第一电机11驱动第一驱动轴12带动搭载平台2沿着x轴方向旋转，控制辅助传感器模组3旋转；

第二旋转驱动组件包括第二电机41、第二驱动轴42和机械臂43，第一电机11和第二电机41的轴线垂直分布，机械臂43为u型机械臂，u型机械臂43中轴线的外侧壁位置固定在第二驱动轴42上，u型机械臂43两端口处通过轴承固定在第一驱动轴12上，第二电机41驱动第二驱动轴42带动u型机械臂43、第一电机11和搭载平台2沿着y轴方向同步旋转，控制辅助传感器模组3旋转。

本具体实现方案通过使第一电机11和第二电机41的轴线垂直分布，即以第一电机11的轴线为x轴，第二电机41的轴线为y轴建立直角坐标系，使第二电机41控制整个装置同步地沿着y轴旋转，第一电机11控制搭载平台2沿着x轴旋转，利用两个电机控制搭载平台进行不同的运动，保证安装在搭载平台上的辅助传感器模组维特定的方向角，辅助传感器模组的自稳控制，以对无人机精确定位。

其中，图1所示的装置可以通过第二电机41的底部连接到无人机的底部，以将辅助传感器模组3挂载到无人机上。

需要说明的是，图1或图2仅示例性示出构成旋转驱动模组的部件，及其连接关系，只要部件能够完成旋转驱动模组的功能即可，不限定其部件数量、尺寸和形状；例如搭载平台2不限于图1或图2中示出的平板状，可以为具有凹槽结构的底座；机械臂不限于u型机械臂，可以为方框形等其他形状。

图3为本实施例提供的控制无人机的传感器模组对地角度的装置的控制流程图，参考图1-3，在本具体实现方案中，对搭载平台的旋转控制过程如下：

步骤31：对装置进行上电初始化。

在本步骤过程中，能够完成控制所需的各项参数的初始化，如初始化参考角度，本实施例中的参考角度可以为一固定数值，也可以根据需求实时进行调整。

步骤32：获取无人机的运动信息。

利用装置的控制器5获取无人机的运动信息，具体的获取方式不限定，示例性地，控制器5可以与无人机的cpu处理器无线连接，通过与无人机的cpu通讯，获得所需的无人机的运动信息。

其中，本实施例中的运动信息一般包括高度信息、方向角信息等。

步骤33：获取辅助传感器模组的运动信息。

利用装置的惯性测量模组6获取辅助传感器模组3的运动信息，该运动信息一般包括高度信息、方向角信息等。其中，惯性测量模组3和控制器5同步地、实时地获取辅助传感器模组的运动信息和无人机的运动信息。

步骤34：生成驱动控制信息，控制第一电机11和第二电机41的旋转。

在本步骤中，控制器5根据无人机的运动信息和辅助传感器模组的运动信息估算搭载平台2的当前对地坐标角度和当前运行角速度，将当前对地坐标角度和参考角度进行比较，得到补偿角度；根据补偿角度和当前运行角速度计算得到第一电机11和第二电机41当前所需的角速度和旋转方向，驱动第一电机11和第二电机41按照计算所得的角速度和旋转方向工作，使搭载平台进行相应方向和角度旋转，避免搭载平台上的辅助传感器模组不随无人机的姿态变化而发生对地角度的变化。

基于上述步骤31-34实现了对搭载平台的控制，保证安装在搭载平台上的辅助传感器模组维特定的方向角，进而辅助传感器模组的自稳控制。

实施例二

本实施例提供了一种控制无人机的挂载设备对地角度的方法。

图4为本实施例提供的控制无人机的挂载设备对地角度的方法流程图，如图4所示，该方法包括：

s400：实时获取无人机的运动信息，并利用安装在挂载设备上的惯性测量模组实时获取挂载设备的运动信息。

由于本实施例中的惯性测量模组可能包括多种传感器，如陀螺仪、加速度传感器等，因此在利用安装在挂载设备上的惯性测量模组实时获取挂载设备的运动信息时，需要根据传感器融合算法计算挂载设备的运动信息；其中，挂载设备的运动信息包括但不局限于对地角度，如右手坐标系或东北天坐标系中的角度，角速度。

s410：根据无人机的运动信息和挂载设备的运动信息生成驱动控制信息，使旋转驱动模组根据所述驱动控制信息驱动安装在其上的搭载平台旋转。

本步骤根据无人机的运动信息和挂载设备的运动信息预估挂载平台由于无人机运动在下一时刻可能产生的运动状态，通过负反馈方式生成驱动控制信息进，使旋转驱动模组根据该驱动控制信息驱动安装在其上的搭载平台进行三维转动。

其中，无人机的运动信息包括但不局限于相对地角度，如右手坐标系或东北天坐标系中的角度，角速度；驱动控制信息包括但不局限于转动方向、转动力矩。

本实施例实时获取无人机的运动信息和挂载设备的运动信息，根据两种运动信息生成驱动控制信息，使旋转驱动模组根据所述驱动控制信息驱动安装在其上的搭载平台旋转，使挂载设备能够在无人机的各种运动状态下相对地面保持稳定的对地角度。

示例性地，通过下述方式生成驱动控制信息：

根据无人机的运动信息和挂载设备的运动信息计算搭载平台当前对地坐标角度和当前运行角速度；

比较当前对地坐标角度和参考角度，得到补偿角度；

根据补偿角度和当前运行角速度得到所述驱动控制信息，驱动控制信息包括旋转驱动模组当前所需的角速度和旋转方向。

为了便于清楚描述本发明实施例的技术方案，在发明的实施例中，采用了“第一”、“第二”等字样对功能和作用基本相同的相同项或相似项进行区分，本领域技术人员可以理解“第一”、“第二”等字样并不对数量和执行次序进行限定。

以上所述，仅为本发明的具体实施方式，在本发明的上述教导下，本领域技术人员可以在上述实施例的基础上进行其他的改进或变形。本领域技术人员应该明白，上述的具体描述只是更好的解释本发明的目的，本发明的保护范围应以权利要求的保护范围为准。