一种基于无人机定位的风机姿态的标定方法及系统技术方案

本发明专利技术涉及风电技术领域，具体涉及一种基于无人机定位的风机姿态的标定方法及系统。其标定方法包括，对风机叶轮在任意角度进行锁定，利用无人机标定出轮毂中心点GPS坐标以及三个前缘点GPS坐标；在所述无人机标定所述轮毂中心点GPS坐标的同时记录轮毂中心处无人机GPS坐标以及轮毂中心处无人机方位角；根据所述轮毂中心处无人机GPS坐标、所述轮毂中心点GPS坐标以及三个所述前缘点GPS坐标对所述轮毂中心处无人机方位角进行校正，得到风机方位角；基于所述风机方位角和所述轮毂中心点GPS坐标，根据任一所述前缘点GPS坐标，计算出风机叶轮旋转角。采用本发明专利技术可以得到准确的风机姿态数据，满足风机叶片巡检路径规划高精度的需求。求。求。

【技术实现步骤摘要】
一种基于无人机定位的风机姿态的标定方法及系统


[0001]本专利技术涉及风电
，具体涉及一种基于无人机定位的风机姿态的标定方法及系统。

技术介绍

[0002]在基于无人机的风机叶片巡检路径规划中，风机的姿态参数例如风机方位角和风机叶轮旋转角是两个很重要的参数，风机方位角和风机叶轮旋转角可以描述当前风机的姿态，也是建立风机模型坐标系的基础。而在现有的无人机叶片巡检的路径规划相关方法中，大多只介绍了路径规划的流程，鲜有阐述风机姿态参数标定方案。另外，现有的风机姿态参数标定方法得到的姿态参数精度较低，无法满足风机叶片巡检路径规划高精度的需求。

技术实现思路

[0003]本专利技术所要解决的技术问题是提供一种基于无人机定位的风机姿态的标定方法及系统，可以得到准确的风机姿态数据，满足风机叶片巡检路径规划高精度的需求。
[0004]本专利技术解决上述技术问题的技术方案如下：一种基于无人机定位的风机姿态的标定方法，包括以下步骤，S1，对风机叶轮在任意角度进行锁定，利用无人机标定出轮毂中心点GPS坐标以及三支叶片中每支叶片上的前缘点GPS坐标；在所述无人机标定所述轮毂中心点GPS坐标的同时记录轮毂中心处无人机GPS坐标以及轮毂中心处无人机方位角；其中，前缘点为叶片前缘上的任一点，且三支叶片上的前缘点到轮毂中心点的距离一致；S2，根据所述轮毂中心处无人机GPS坐标、所述轮毂中心点GPS坐标以及三个所述前缘点GPS坐标对所述轮毂中心处无人机方位角进行校正，得到风机方位角；S3，基于所述风机方位角和所述轮毂中心点GPS坐标，根据任一所述前缘点GPS坐标，计算出风机叶轮旋转角。
[0005]在上述一种基于无人机定位的风机姿态的标定方法的基础上，本专利技术还提供一种基于无人机定位的风机姿态的标定系统。
[0006]一种基于无人机定位的风机姿态的标定系统，包括以下模块，风机标定点确定模块，其用于对风机叶轮在任意角度进行锁定，利用无人机标定出轮毂中心点GPS坐标以及三支叶片中每支叶片上的前缘点GPS坐标；在所述无人机标定所述轮毂中心点GPS坐标的同时记录轮毂中心处无人机GPS坐标以及轮毂中心处无人机方位角；其中，前缘点为叶片前缘上的任一点，且三支叶片上的前缘点到轮毂中心点的距离一致；风机方位角确定模块，其用于根据所述轮毂中心处无人机GPS坐标、所述轮毂中心点GPS坐标以及三个所述前缘点GPS坐标对所述轮毂中心处无人机方位角进行校正，得到风机方位角；风机叶轮旋转角确定模块，其用于基于所述风机方位角和所述轮毂中心点GPS坐
标，根据任一所述前缘点GPS坐标，计算出风机叶轮旋转角。
[0007]本专利技术的有益效果是：在本专利技术一种基于无人机定位的风机姿态的标定方法及系统中，首先通过无人机确定风机的标定点，其中标定点包括轮毂中心点和三个前缘点，然后利用标定点对无人机在标定轮毂中心点是的轮毂中心处无人机方位角进行校正，即可得到准确的风机方位角，根据风机方位角即可确定风机模型坐标系，基于风机模型坐标系可以计算出风机叶轮旋转角；采用本专利技术可以得到准确的风机姿态数据，满足风机叶片巡检路径规划高精度的需求。
附图说明
[0008]图1为本专利技术一种基于无人机定位的风机姿态的标定方法的流程图；图2为无人机标定风机时的标定点位置示意图；图3为风机模型坐标系的示意图；图4为模板风机与待巡检风机对应叶片的风机叶轮旋转角的示意图；图5为本专利技术一种基于无人机定位的风机姿态的标定系统的结构图。
具体实施方式
[0009]以下结合附图对本专利技术的原理和特征进行描述，所举实例只用于解释本专利技术，并非用于限定本专利技术的范围。
[0010]如图1所示，一种基于无人机定位的风机姿态的标定方法，包括以下步骤，S1，对风机叶轮在任意角度进行锁定，利用无人机标定出轮毂中心点GPS坐标以及三支叶片中每支叶片上的前缘点GPS坐标；在所述无人机标定所述轮毂中心点GPS坐标的同时记录轮毂中心处无人机GPS坐标以及轮毂中心处无人机方位角；其中，前缘点为叶片前缘上的任一点，且三支叶片上的前缘点到轮毂中心点的距离一致；S2，根据所述轮毂中心处无人机GPS坐标、所述轮毂中心点GPS坐标以及三个所述前缘点GPS坐标对所述轮毂中心处无人机方位角进行校正，得到风机方位角；S3，基于所述风机方位角和所述轮毂中心点GPS坐标，根据任一所述前缘点GPS坐标，计算出风机叶轮旋转角。
[0011]下面对各步骤进行具体说明。
[0012]图2为无人机标定风机时的标定点位置示意图，在本具体实施例中：所述S1具体为，对风机叶轮在任意角度进行锁定，控制搭载有激光测距仪的无人机飞到风机轮毂前方位置O1，并调整无人机朝向正对风机，使激光测距仪发出的激光点打在轮毂中心点O处并记录激光点的GPS坐标，得到轮毂中心点GPS坐标，同时记录处于当前位置O1的轮毂中心处无人机GPS坐标和轮毂中心处无人机方位角；令风机中的三支叶片分别为叶片A、叶片B和叶片C；控制无人机分别飞到叶片A的前缘位置、叶片B的前缘位置以及叶片C的前缘位置，并使激光测距仪发出的激光点分别打到叶片A前缘上的任一点处、风机叶片B前缘上的任一点处以及风机叶片C前缘上的任一点处并记录激光点的GPS坐标（但要保证激光点打到叶片A前缘上的任一点、风机叶片B前缘上的任一点以及风机叶片C前缘上的任一点分别到轮毂中心点O之间的距离一致），得到叶片A的前缘点GPS坐标、叶片B的前缘点GPS坐标以及叶片C的前缘点GPS坐标。
[0013]具体的，在控制无人机飞行的过程中，在移动端飞控软件中输入风机的塔筒高度H，然后启动无人机。无人机自动飞到塔筒高度H处轮毂前方位置，调整无人机朝向正对风机，激光点打在轮毂中心处，记下当前点的轮毂中心处无人机方位角（方位角：无人机当前朝向与正北方向之间的夹角，俯视顺时针为正，逆时针为负）、无人机位置的GPS坐标（即轮毂中心处无人机GPS坐标）和激光点的GPS坐标（即轮毂中心点GPS坐标）。
[0014]同理，无人机在叶轮面前方正对风机，风机三支叶片分别记为叶片A、叶片B、叶片C。无人机分别飞到三支叶片的前缘位置，无人机面对风机叶片，激光点打在前缘的任一点上，记下激光点的GPS坐标（即前缘点GPS坐标），分别记为。特别的，为了方便无人机的标定，前缘点可以选择叶尖点。
[0015]在本具体实施例中：所述S2具体为，S21，基于大地坐标与笛卡尔坐标之间的转换关系，以轮毂中心点为笛卡尔坐标系的原点，分别将所述轮毂中心点GPS坐标、所述轮毂中心处无人机GPS坐标以及三个所述前缘点GPS坐标对应转换为轮毂中心点笛卡尔坐标、轮毂中心处无人机笛卡尔坐标以及三个前缘点笛卡尔坐标；S22，根据所述轮毂中心点笛卡尔坐标、所述轮毂中心处无人机笛卡尔坐标以及三个所述前缘点笛卡尔坐标，计算出三个前缘点所确定平面的法向量与所述轮毂中心处无人机方位角的向量在水平面上投影分量之间的夹角，并利用三个前缘点所确定平面的法向量与所述轮毂中心处无人机方位角的向量在水平面上投影分量之间的夹角对所述轮毂中心处无人机方位角进行校正，得本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种基于无人机定位的风机姿态的标定方法，其特征在于：包括以下步骤，S1，对风机叶轮在任意角度进行锁定，利用无人机标定出轮毂中心点GPS坐标以及三支叶片中每支叶片上的前缘点GPS坐标；在所述无人机标定所述轮毂中心点GPS坐标的同时记录轮毂中心处无人机GPS坐标以及轮毂中心处无人机方位角；其中，前缘点为叶片前缘上的任一点，且三支叶片上的前缘点到轮毂中心点的距离一致；S2，根据所述轮毂中心处无人机GPS坐标、所述轮毂中心点GPS坐标以及三个所述前缘点GPS坐标对所述轮毂中心处无人机方位角进行校正，得到风机方位角；S3，基于所述风机方位角和所述轮毂中心点GPS坐标，根据任一所述前缘点GPS坐标，计算出风机叶轮旋转角。2.根据权利要求1所述的基于无人机定位的风机姿态的标定方法，其特征在于：所述S1具体为，对风机叶轮在任意角度进行锁定，控制搭载有激光测距仪的无人机飞到风机轮毂前方位置，并调整无人机朝向正对风机，使激光测距仪发出的激光点打在轮毂中心点处并记录激光点的GPS坐标，得到轮毂中心点GPS坐标，同时记录处于当前位置的轮毂中心处无人机GPS坐标和轮毂中心处无人机方位角；令风机中的三支叶片分别为叶片A、叶片B和叶片C；控制无人机分别飞到叶片A的前缘位置、叶片B的前缘位置以及叶片C的前缘位置，并使激光测距仪发出的激光点分别打到叶片A前缘上的任一点处、风机叶片B前缘上的任一点处以及风机叶片C前缘上的任一点处并记录激光点的GPS坐标，得到叶片A的前缘点GPS坐标、叶片B的前缘点GPS坐标以及叶片C的前缘点GPS坐标。3.根据权利要求1所述的基于无人机定位的风机姿态的标定方法，其特征在于：所述S2具体为，S21，基于大地坐标与笛卡尔坐标之间的转换关系，以轮毂中心点为笛卡尔坐标系的原点，分别将所述轮毂中心点GPS坐标、所述轮毂中心处无人机GPS坐标以及三个所述前缘点GPS坐标对应转换为轮毂中心点笛卡尔坐标、轮毂中心处无人机笛卡尔坐标以及三个前缘点笛卡尔坐标；S22，根据所述轮毂中心点笛卡尔坐标、所述轮毂中心处无人机笛卡尔坐标以及三个所述前缘点笛卡尔坐标，计算出三个前缘点所确定平面的法向量与所述轮毂中心处无人机方位角的向量在水平面上投影分量之间的夹角，并利用三个前缘点所确定平面的法向量与所述轮毂中心处无人机方位角的向量在水平面上投影分量之间的夹角对所述轮毂中心处无人机方位角进行校正，得到所述风机方位角。4.根据权利要求3所述的基于无人机定位的风机姿态的标定方法，其特征在于：令为轮毂中心点，为任意待转换点，且轮毂中心点GPS坐标为，任意待转换点GPS坐标为，则在所述S21中，大地坐标与笛卡尔坐标之间的转换关系为，
ꢀ
；其中，，，；具体的，为任意待转换点与轮毂中心点之间的水平距离，为任意待转换点与轮毂中心点之间的垂直距离，为所述轮毂中心处无人机方位角，为由轮毂中心点到任意待转换点构成的向量基于所述轮毂中心处无人机方位角的水平相对角度，为地球半径，为任意待转换点笛卡尔坐标的轴值，为任意待转换点笛卡尔坐标的轴值，为任意待转换点笛卡尔坐标的轴值。5.根据权利要求3所述的基于无人机定位的风机姿态的标定方法，其特征在于：所述S22具体为，根据三个所述前缘点笛卡尔坐标计算出其中一个前缘点分别到另外两个前缘点的向量；根据右手定则计算出其中一个前缘点分别到另外两个前缘点的向量的外积向量；其中，所述外积向量为三个前缘点所确定平面的法向量；根据所述轮毂中心点笛卡尔坐标和所述轮毂中心处无人机笛卡尔坐标确定出所述轮毂中心处无人机方位...

【专利技术属性】
技术研发人员：郭鹏程，韩梦婷，汪杨，张翼龙，
申请(专利权)人：风脉能源武汉股份有限公司，
类型：发明
国别省市：