[发明专利]一种机载角度校正装置及校正方法

权利要求书

1.一种机载角度校正装置，其特征在于：包括测量装置和标定器，测量装置通过连杆设置于支架上，标定器通过柔性连接线设置于支架上；

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

外壳的外壁上设置有测距传感器，测距传感器的设置位置在水平方向与标定器的下沿齐平；

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

2.如权利要求1所述的装置，其特征在于：外壳的内腔容纳电子器件。

3.如权利要求1所述的装置，其特征在于：标定传感器为高度测量传感器。

4.如权利要求1所述的装置，其特征在于：机载角度校正装置设置于搭载平台上。

5.一种利用如上述权利要求4所述的机载角度校正装置的校正方法，其特征在于，依次包括如下步骤：

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

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

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

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

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

(6)利用第一、二、三距离测量单元和测距传感器实时测量，根据测量结果实时调整搭载平台的倾斜角度。

6.如权利要求5所述的方法，其特征在于：步骤(6)中根据测量结果实时调整搭载平台的倾斜角度具体为：

A.如果第一、二距离测量单元的测量路径增大，且第三距离测量单元的测量路径和测距传感器的测量路径减小，则搭载平台的倾斜角度向第三距离测量单元的一侧调整；

B.如果第一距离测量单元的测量路径减小，且第二、三距离测量单元的测量路径和测距传感器的测量路径增大，则搭载平台的倾斜角度向第一距离测量单元的一侧调整；

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

7.如权利要求5或6所述的方法，其特征在于：搭载平台的倾斜角度的调整方式为增大或减小对应侧的动力功率。

8.如权利要求7所述的方法，其特征在于：还包括步骤(7)：利用步骤(2)得到的第二距离和步骤(6)中第二距离测量单元实时测量的距离，通过三角函数得到倾斜角度。

9.如权利要求8所述的方法，其特征在于：还包括步骤(8)：利用预存的校准的测距传感器发射测距信号的路径长度对应的刻度与倾斜角度的关系，通过感应器实时感应的刻度位置得到倾斜角度。