一种基于三向角度校正的无人机及校正控制方法与流程

本发明涉及测量领域，具体涉及一种基于三向角度校正的无人机及校正控制方法。

背景技术：

今年，随着社会经济和科学技术的发展，在军事和民用领域，航空技术受到了广泛的关注。未来航空技术也是重要的发展趋势。随着航空技术的发展，越来的越多的科技设备都可以装载于无人机中，例如监测传感设备、通讯设备、定位设备、拍摄设备等，都广泛的应用于航空技术领域中。

其中，通过在无人机中装载的设备，可以实现对地面的图像的监控、空中高度的测量等，而且不同的高空高度具有不同的监测环境，而且非预期的测量角度(例如倾斜)会使得测量数据失真，例如拍摄照片的错位等，那么精确的在某一高度进行测量变的尤为重要。然而，目前无人机在对地面进行监测时，由于受到外界环境的影响(例如风、气压、高度等)，往往无法在期望的角度，利用例如照相机等设备进行准确的拍摄。虽然现有技术中已经存在陀螺仪等测量设备来进行角度测量，从而实现角度校正的设备，但是依然无法满足高精度的测量。

技术实现要素：

本发明的目的在于克服现有技术的不足，提供一种能够提高测量精度，精确测量倾斜角度变化趋势后进行无人机的角度校正，从而提高监测效率，提高监测精度的基于三向角度校正的无人机及校正控制方法。

本发明提供了一种基于三向角度校正的无人机，包括机体，以及三个与机体连接的机臂及与其对应旋翼及其动力装置，以及角度校正装置，其中相邻机臂之间的夹角为120°；

其中角度校正装置包括第一、第二、第三测量装置和标定器，第一、第二、第三测量装置分别通过连杆设置于三个机臂上，并且第一、第二、第三测量装置分别能够收缩后容纳于三个机臂内部；

标定器通过柔性连接线设置于机体上，并且标定器能够收纳于机体内部；

其中第一、第二、第三测量装置都包括外壳、底座、第一距离测量单元和第二距离测量单元，底座的上端与外壳的下端固定连接，第一距离测量单元和第二距离测量单元分别设置于底座的下端；第二距离测量单元的信号发射方向垂直向下，并且与第一距离测量单元的信号发射方向的夹角为5°，第一、第二、第三测量装置设置于同一高度，第一、第二、第三测量装置的第一、二距离测量单元的信号发射方向分别在同一平面上，并且第一、第二、第三测量装置的第二距离测量单元分别位于远离的标定器的一侧；

第一、第二、第三测量装置的外壳的外壁上分别设置有测距传感器，测距传感器的设置位置在水平方向与标定器的下沿齐平；

标定器具有刻度，并且其在刻度范围内设置具有对测距传感器发射的信号进行感应，并且实时的记录感应位置的感应器；标定器的下端设置有用于测量标定器到地面的垂直距离的标定传感器。

其中，外壳的内腔容纳电子器件。

其中，标定传感器为高度测量传感器。

本发明还提供了一种对基于三向角度校正的无人机进行校正控制的方法，依次包括如下步骤：

(1)控制飞行器，使得飞行器位于飞行空间，控制测量装置和标定器分别从飞行器的机臂和机体中伸出位于预期的位置；

(2)进行初始化校准：利用第一、第二、第三测量装置的测距传感器发射测距信号至标定器，标定器实时感应测距传感器发射测距信号的感应位置，调整测距传感器发射测距信号的发射角度使得发射信号对准标定器的0点；

(3)通过标定器测量标定器到地面的垂直距离，用测量得到的标定器到地面的垂直距离减去测距传感器的信号水平发射方向到第二距离测量单元的发射测量起点之间的距离，得到第一距离；

(4)利用第一距离和第一距离测量单元的信号发射方向关系，分别计算得到第一、第二测量的第一测量单元发射方向上到地面的第二距离；

(5)利用第一、第二、第三测量装置的第一、二距离测量单元分别测量对应方向上的第一、二测量距离，将第一、二测量距离分别和第一、二距离分别对比，如果两者相同则进入步骤(5)，否则则调整搭载平台的倾斜角后，重复步骤(2)-(4)；

(6)通过测距传感器测量到标定器的0点的标定距离；

(7)分别利用第一、第二、第三测量装置的第一、二距离测量单元和测距传感器实时测量，根据测量结果实时调整飞行器的倾斜角度。

其中，步骤(7)中根据测量结果实时调整飞行器的倾斜角度具体为：

a.如果第一测量装置的第一、二距离测量单元的测量路径增大，且第一测量装置的测距传感器的测量路径减小，同时第二、三测量装置的测量路径的变化趋势相同，则搭载平台的倾斜角度向第一测量装置的反方向一侧调整；

b.如果第二测量装置的第一、二距离测量单元的测量路径增大，且第二测量装置的测距传感器的测量路径减小，同时第一、三测量装置的测量路径的变化趋势相同，则搭载平台的倾斜角度向第二测量装置的反方向一侧调整；

c.如果第三测量装置的第一、二距离测量单元的测量路径增大，且第三测量装置的测距传感器的测量路径减小，同时第一、二测量装置的测量路径的变化趋势相同，则搭载平台的倾斜角度向第三测量装置的反方向一侧调整；

d.如果第一、第二、第三测量装置的第一、二距离测量单元和测距传感器的测量路径不变，则搭载平台的倾斜角度不调整。

其中，飞行器的倾斜角度的调整方式为增大或减小对应旋翼及其动力装置的功率。

其中，还包括步骤(8)：利用步骤(3)得到的第一距离和步骤(7)中第一距离测量单元实时测量的距离，通过三角函数得到倾斜角度。

其中，还包括步骤(9)：利用预存的校准的测距传感器发射测距信号的路径长度对应的刻度与倾斜角度的关系，通过感应器实时感应的刻度位置得到倾斜角度。

本发明的基于三向角度校正的无人机及校正控制方法，可以实现：

1)实时获取倾斜角度，动态调整倾斜角度；

2)在现有角度测量后校正的基础上，对倾斜角度进行进一步的精细测量，能够提高测量精度，监测效率。

附图说明

图1为基于三向角度校正的无人机结构示意图

图2为角度校正装置结构示意图

图3为标定器的结构示意图

图4为角度校正原理示意图

具体实施方式

下面详细说明本发明的具体实施，有必要在此指出的是，以下实施只是用于本发明的进一步说明，不能理解为对本发明保护范围的限制，该领域技术熟练人员根据上述本发明内容对本发明做出的一些非本质的改进和调整，仍然属于本发明的保护范围。

本发明提供了一种基于三向角度校正的无人机及校正控制方法，如图1、2所示，基于三向角度校正的无人机包括机体10，三个与机体10连接的机臂11，旋翼及其动力装置9，以及角度校正装置1，其中相邻机臂11之间的夹角为120°，校正装置1的结构如图2所示。

其中，角度校正装置包括第一、第二、第三测量装置和标定器7，第一、第二、第三测量装置分别通过连杆设置于三个机臂11上，并且第一、第二、第三测量装置分别可以收缩后容纳于三个机臂11内部，从而可以节约空间，提高效率的同时在测量装置不工作时进行保护，标定器7通过柔性连接线设置于机体10上，并且标定器7可收纳于机体10内部；

其中第一、第二、第三测量装置都包括外壳2、底座3、第一距离测量单元4、第二距离测量单元5，底座3的上端与外壳2的下端固定连接，外壳2的内腔可容纳电子器件，例如处理电路等；第一距离测量单元4、第二距离测量单元5分别设置于底座3的下端；第二距离测量单元5的信号发射方向垂直向下，并且与第一距离测量单元4的信号发射方向的夹角为5°，第一、第二、第三测量装置设置于同一高度，第一、第二、第三测量装置的第一、二距离测量单元的信号发射方向分别在同一平面上，并且第一、第二、第三测量装置的第二距离测量单元分别位于远离的标定器的一侧。

第一、第二、第三测量装置的外壳2的外壁上分别设置有测距传感器6，测距传感器6的设置位置在水平方向上与标定器7的下沿齐平，即定标器7的下沿与测距传感器位于同一高度，这样可以通过标定器7来测量垂直距离，根据测量装置的设计尺寸，通过标定器7测量的垂直距离减去测距传感器6的水平方向到第二距离测量单元的发射测量起点之间的距离，得到在没有发生倾斜时第二距离测量单元测量的垂直距离，通过计算同时得到第一距离测量单元到底面的距离。

在进行校正工作时，因为标定器7受到重力的作用，而柔性连接线并不会限制标定器7的移动，因此，当飞行器倾斜的时候，标定器7依然会受到重力的作用，自身不会发生相对的倾斜，那么可以利用标定器7进行标定。如图3所示，标定器7具有刻度，中间为0，向上为正，向下为负，并且其在刻度范围内具有感应器，从而可以对测距传感器6发射的信号进行感应，实时的记录感应位置。

图4为角度校正原理示意图，首先，通过标定器7进行初始化校准，第一、第二、第三测量装置的测距传感器6分别发射测距信号，并且发射信号对准标定器7的0点，在进行校正的过程中，如果没有发生倾斜，则第二距离测量单元5的信号发射方向垂直向下，并且第一距离测量单元4的信号发射方向与其夹角为5°。当发生在某一方向的倾斜时，标定器7受到重力的作用依然垂直向下，测距传感器6的发射信号路径e、f、g、第一、二距离测量单元的发射信号路径a，b都会发生偏移，图3为第一测量装置的变化情况(第二、三装置原理类似)，当飞行装置朝右侧倾斜的时候，测距传感器6的发射信号路径e变短，发射信号对准标定器7的负刻度，第一、二距离测量单元的发射信号路径a，b同时变大为a’，b’,那么通过判断各个路径就可以得到倾斜角度的情况，从而对飞行器进行角度的调整。

本发明还提供了一种对基于三向角度校正的无人机进行校正控制的方法，依次包括如下步骤：

(1)控制飞行器，使得飞行器位于飞行空间，控制测量装置和标定器分别从飞行器的机臂和机体中伸出位于预期的位置；

(2)进行初始化校准：利用第一、第二、第三测量装置的测距传感器发射测距信号至标定器，标定器实时感应测距传感器发射测距信号的感应位置，调整测距传感器发射测距信号的发射角度使得发射信号对准标定器的0点；

(3)通过标定器测量标定器到地面的垂直距离，用测量得到的标定器到地面的垂直距离减去测距传感器的信号水平发射方向到第二距离测量单元的发射测量起点之间的距离，得到第一距离；

(4)利用第一距离和第一距离测量单元的信号发射方向关系(5°的夹角)，分别计算得到第一、第二测量的第一测量单元发射方向上到地面的第二距离；

(5)利用第一、第二、第三测量装置的第一、二距离测量单元分别测量对应方向上的第一、二测量距离，将第一、二测量距离分别和第一、二距离分别对比，如果两者相同则进入步骤(5)，否则则调整搭载平台的倾斜角后，重复步骤(2)-(4)；

(6)通过测距传感器测量到标定器的0点的标定距离；

(7)分别利用第一、第二、第三测量装置的第一、二距离测量单元和测距传感器实时测量，根据测量结果实时调整飞行器的倾斜角度。

其中，步骤(7)中根据测量结果实时调整飞行器的倾斜角度具体为：

a.如果第一测量装置的第一、二距离测量单元的测量路径增大，且第一测量装置的测距传感器的测量路径减小，同时第二、三测量装置的测量路径的变化趋势相同，则搭载平台的倾斜角度向第一测量装置的反方向一侧调整；

b.如果第二测量装置的第一、二距离测量单元的测量路径增大，且第二测量装置的测距传感器的测量路径减小，同时第一、三测量装置的测量路径的变化趋势相同，则搭载平台的倾斜角度向第二测量装置的反方向一侧调整；

c.如果第三测量装置的第一、二距离测量单元的测量路径增大，且第三测量装置的测距传感器的测量路径减小，同时第一、二测量装置的测量路径的变化趋势相同，则搭载平台的倾斜角度向第三测量装置的反方向一侧调整；

d.如果第一、第二、第三测量装置的第一、二距离测量单元和测距传感器的测量路径不变，则搭载平台的倾斜角度不调整。

其中，飞行器的倾斜角度的调整方式为增大或减小对应旋翼及其动力装置的功率。

其中，利用预存的校准的测距传感器发射测距信号的路径长度对应的刻度与倾斜角度的关系，通过感应器实时感应的刻度位置得到倾斜角度。

本发明中的参数部分可以通过直接设置、测量的方式获取，其他参数可以通过计算或其他本领域公知的方式获得，另外本发明是在在不明显倾斜的情况下进行的精确微调整，对于一些倾斜较大，或者极端的情况下不适用的技术方案都应当排除，本发明是在合理的预期下完成，任何不适用的参数、公式、方案也都应排除。

尽管为了说明的目的，已描述了本发明的示例性实施方式，但是本领域的技术人员将理解，不脱离所附权利要求中公开的发明的范围和精神的情况下，可以在形式和细节上进行各种修改、添加和替换等的改变，而所有这些改变都应属于本发明所附权利要求的保护范围，并且本发明要求保护的产品各个部门和方法中的各个步骤，可以以任意组合的形式组合在一起。因此，对本发明中所公开的实施方式的描述并非为了限制本发明的范围，而是用于描述本发明。相应地，本发明的范围不受以上实施方式的限制，而是由权利要求或其等同物进行限定。