CN115655203A - 一种基于无人机定位的风机姿态的标定方法及系统 - Google Patents

一种基于无人机定位的风机姿态的标定方法及系统 Download PDF

Info

Publication number
CN115655203A
CN115655203A CN202211572637.9A CN202211572637A CN115655203A CN 115655203 A CN115655203 A CN 115655203A CN 202211572637 A CN202211572637 A CN 202211572637A CN 115655203 A CN115655203 A CN 115655203A
Authority
CN
China
Prior art keywords
fan
hub
aerial vehicle
unmanned aerial
point
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN202211572637.9A
Other languages
English (en)
Other versions
CN115655203B (zh
Inventor
郭鹏程
韩梦婷
汪杨
张翼龙
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Windmagics Wuhan Co ltd
Original Assignee
Windmagics Wuhan Co ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Windmagics Wuhan Co ltd filed Critical Windmagics Wuhan Co ltd
Priority to CN202211572637.9A priority Critical patent/CN115655203B/zh
Publication of CN115655203A publication Critical patent/CN115655203A/zh
Application granted granted Critical
Publication of CN115655203B publication Critical patent/CN115655203B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02E—REDUCTION OF GREENHOUSE GAS [GHG] EMISSIONS, RELATED TO ENERGY GENERATION, TRANSMISSION OR DISTRIBUTION
    • Y02E10/00—Energy generation through renewable energy sources
    • Y02E10/70—Wind energy
    • Y02E10/72—Wind turbines with rotation axis in wind direction

Landscapes

  • Structures Of Non-Positive Displacement Pumps (AREA)

Abstract

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

Description

一种基于无人机定位的风机姿态的标定方法及系统
技术领域
本发明涉及风电技术领域，具体涉及一种基于无人机定位的风机姿态的标定方法及系统。
背景技术
在基于无人机的风机叶片巡检路径规划中，风机的姿态参数例如风机方位角和风机叶轮旋转角是两个很重要的参数，风机方位角和风机叶轮旋转角可以描述当前风机的姿态，也是建立风机模型坐标系的基础。而在现有的无人机叶片巡检的路径规划相关方法中，大多只介绍了路径规划的流程，鲜有阐述风机姿态参数标定方案。另外，现有的风机姿态参数标定方法得到的姿态参数精度较低，无法满足风机叶片巡检路径规划高精度的需求。
发明内容
本发明所要解决的技术问题是提供一种基于无人机定位的风机姿态的标定方法及系统，可以得到准确的风机姿态数据，满足风机叶片巡检路径规划高精度的需求。
本发明解决上述技术问题的技术方案如下：一种基于无人机定位的风机姿态的标定方法，包括以下步骤，
S1，对风机叶轮在任意角度进行锁定，利用无人机标定出轮毂中心点GPS坐标以及三支叶片中每支叶片上的前缘点GPS坐标；在所述无人机标定所述轮毂中心点GPS坐标的同时记录轮毂中心处无人机GPS坐标以及轮毂中心处无人机方位角；其中，前缘点为叶片前缘上的任一点，且三支叶片上的前缘点到轮毂中心点的距离一致；
S2，根据所述轮毂中心处无人机GPS坐标、所述轮毂中心点GPS坐标以及三个所述前缘点GPS坐标对所述轮毂中心处无人机方位角进行校正，得到风机方位角；
S3，基于所述风机方位角和所述轮毂中心点GPS坐标，根据任一所述前缘点GPS坐标，计算出风机叶轮旋转角。
在上述一种基于无人机定位的风机姿态的标定方法的基础上，本发明还提供一种基于无人机定位的风机姿态的标定系统。
一种基于无人机定位的风机姿态的标定系统，包括以下模块，
风机标定点确定模块，其用于对风机叶轮在任意角度进行锁定，利用无人机标定出轮毂中心点GPS坐标以及三支叶片中每支叶片上的前缘点GPS坐标；在所述无人机标定所述轮毂中心点GPS坐标的同时记录轮毂中心处无人机GPS坐标以及轮毂中心处无人机方位角；其中，前缘点为叶片前缘上的任一点，且三支叶片上的前缘点到轮毂中心点的距离一致；
风机方位角确定模块，其用于根据所述轮毂中心处无人机GPS坐标、所述轮毂中心点GPS坐标以及三个所述前缘点GPS坐标对所述轮毂中心处无人机方位角进行校正，得到风机方位角；
风机叶轮旋转角确定模块，其用于基于所述风机方位角和所述轮毂中心点GPS坐标，根据任一所述前缘点GPS坐标，计算出风机叶轮旋转角。
本发明的有益效果是：在本发明一种基于无人机定位的风机姿态的标定方法及系统中，首先通过无人机确定风机的标定点，其中标定点包括轮毂中心点和三个前缘点，然后利用标定点对无人机在标定轮毂中心点是的轮毂中心处无人机方位角进行校正，即可得到准确的风机方位角，根据风机方位角即可确定风机模型坐标系，基于风机模型坐标系可以计算出风机叶轮旋转角；采用本发明可以得到准确的风机姿态数据，满足风机叶片巡检路径规划高精度的需求。
附图说明
图1为本发明一种基于无人机定位的风机姿态的标定方法的流程图；
图2为无人机标定风机时的标定点位置示意图；
图3为风机模型坐标系的示意图；
图4为模板风机与待巡检风机对应叶片的风机叶轮旋转角的示意图；
图5为本发明一种基于无人机定位的风机姿态的标定系统的结构图。
具体实施方式
以下结合附图对本发明的原理和特征进行描述，所举实例只用于解释本发明，并非用于限定本发明的范围。
如图1所示，一种基于无人机定位的风机姿态的标定方法，包括以下步骤，
S1，对风机叶轮在任意角度进行锁定，利用无人机标定出轮毂中心点GPS坐标以及三支叶片中每支叶片上的前缘点GPS坐标；在所述无人机标定所述轮毂中心点GPS坐标的同时记录轮毂中心处无人机GPS坐标以及轮毂中心处无人机方位角；其中，前缘点为叶片前缘上的任一点，且三支叶片上的前缘点到轮毂中心点的距离一致；
S2，根据所述轮毂中心处无人机GPS坐标、所述轮毂中心点GPS坐标以及三个所述前缘点GPS坐标对所述轮毂中心处无人机方位角进行校正，得到风机方位角；
S3，基于所述风机方位角和所述轮毂中心点GPS坐标，根据任一所述前缘点GPS坐标，计算出风机叶轮旋转角。
下面对各步骤进行具体说明。
图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坐标。
具体的，在控制无人机飞行的过程中，在移动端飞控软件中输入风机的塔筒高度 H，然后启动无人机。无人机自动飞到塔筒高度H处轮毂前方位置，调整无人机朝向正对风 机，激光点打在轮毂中心处，记下当前点的轮毂中心处无人机方位角
Figure 201550DEST_PATH_IMAGE001
（方位角：无人机当 前朝向与正北方向之间的夹角，俯视顺时针为正，逆时针为负）、无人机位置的GPS坐标
Figure 430275DEST_PATH_IMAGE002
（即轮毂中心处无人机GPS坐标）和激光点的GPS坐标
Figure 147695DEST_PATH_IMAGE003
（即轮毂中心点GPS坐 标）。
同理，无人机在叶轮面前方正对风机，风机三支叶片分别记为叶片A、叶片B、叶片 C。无人机分别飞到三支叶片的前缘位置，无人机面对风机叶片，激光点打在前缘的任一点 上，记下激光点的GPS坐标（即前缘点GPS坐标），分别记为
Figure 916806DEST_PATH_IMAGE004
。特别 的，为了方便无人机的标定，前缘点可以选择叶尖点。
在本具体实施例中：所述S2具体为，
S21，基于大地坐标与笛卡尔坐标之间的转换关系，以轮毂中心点为笛卡尔坐标系的原点，分别将所述轮毂中心点GPS坐标、所述轮毂中心处无人机GPS坐标以及三个所述前缘点GPS坐标对应转换为轮毂中心点笛卡尔坐标、轮毂中心处无人机笛卡尔坐标以及三个前缘点笛卡尔坐标；
S22，根据所述轮毂中心点笛卡尔坐标、所述轮毂中心处无人机笛卡尔坐标以及三个所述前缘点笛卡尔坐标，计算出三个前缘点所确定平面的法向量与所述轮毂中心处无人机方位角的向量在水平面上投影分量之间的夹角，并利用三个前缘点所确定平面的法向量与所述轮毂中心处无人机方位角的向量在水平面上投影分量之间的夹角对所述轮毂中心处无人机方位角进行校正，得到所述风机方位角。
在基于无人机的风机叶片巡检路径规划中，路径规划是基于风机模型坐标系进行的。而风机模型坐标系是以轮毂中心点为原点且以A、B、C三支叶片中前缘点所确定平面的法向量的水平分量的方位角为Y轴方向建立的；其中，轮毂到机舱方向为Y轴正方向。因此，在建立风机模型坐标系之前，首先需要确定三个前缘点所确定平面的法向量的水平分量的方位角（也就是风机方位角）。
已知轮毂中心处无人机方位角
Figure 668861DEST_PATH_IMAGE005
、轮毂中心处无人机GPS坐标
Figure 865225DEST_PATH_IMAGE006
、轮毂中心 点GPS坐标
Figure 69941DEST_PATH_IMAGE007
、叶片A的前缘点GPS坐标
Figure 580426DEST_PATH_IMAGE008
、叶片B的前缘点GPS坐标
Figure 124671DEST_PATH_IMAGE009
和叶片C 的前缘点GPS坐标
Figure 491936DEST_PATH_IMAGE010
，若要计算三个前缘点所确定平面的法向量的水平分量方位角
Figure DEST_PATH_IMAGE011
，则需要先把GPS坐标换算到笛卡尔坐标系（具体的为笛卡尔直角坐标系）中，才能进行向量 的计算。把GPS坐标换算到笛卡尔坐标系是基于大地坐标与笛卡尔坐标之间的转换关系进 行转换的。
本实施例是以轮毂中心点为笛卡尔坐标系的原点进行坐标转换的。令
Figure 59315DEST_PATH_IMAGE012
为轮毂中 心点，
Figure 170228DEST_PATH_IMAGE013
为任意待转换点，且轮毂中心点GPS坐标为
Figure 631296DEST_PATH_IMAGE014
，任意待转换点GPS 坐标为
Figure 435042DEST_PATH_IMAGE015
，则在所述S21中，大地坐标与笛卡尔坐标之间的转换关系为，
Figure 552033DEST_PATH_IMAGE016
；
其中，
Figure 764840DEST_PATH_IMAGE017
，
Figure 782212DEST_PATH_IMAGE018
；
具体的，
Figure 55062DEST_PATH_IMAGE019
为任意待转换点与轮毂中心点之间的水平距离，
Figure 157885DEST_PATH_IMAGE020
为任意待转 换点与轮毂中心点之间的垂直距离，
Figure 174382DEST_PATH_IMAGE021
为所述轮毂中心处无人机方位角，
Figure 547726DEST_PATH_IMAGE022
为由轮毂中 心点到任意待转换点构成的向量基于所述轮毂中心处无人机方位角的水平相对角度，
Figure 755591DEST_PATH_IMAGE023
，
Figure 581596DEST_PATH_IMAGE024
为地球半径，
Figure 401784DEST_PATH_IMAGE025
为任意待转换点笛卡尔坐标的
Figure 128170DEST_PATH_IMAGE026
轴值，
Figure 8401DEST_PATH_IMAGE027
为 任意待转换点笛卡尔坐标的
Figure 820237DEST_PATH_IMAGE028
轴值，
Figure 178537DEST_PATH_IMAGE029
为任意待转换点笛卡尔坐标的
Figure 526473DEST_PATH_IMAGE030
轴值。
参见上述的大地坐标与笛卡尔坐标之间的转换关系，即可将轮毂中心点GPS坐标
Figure 76141DEST_PATH_IMAGE031
、叶片A的前缘点GPS坐标
Figure 876738DEST_PATH_IMAGE032
、叶片B的前缘点GPS坐标
Figure 38729DEST_PATH_IMAGE033
和叶片C的前缘点 GPS坐标
Figure 474127DEST_PATH_IMAGE034
转换至笛卡尔坐标系中，进而得到轮毂中心点笛卡尔坐标
Figure 696161DEST_PATH_IMAGE035
、轮毂中心处无人机笛卡尔坐标
Figure 482589DEST_PATH_IMAGE036
、叶片A的前 缘点笛卡尔坐标
Figure 448271DEST_PATH_IMAGE037
、叶片B的前缘点笛卡尔坐标
Figure 505220DEST_PATH_IMAGE038
和 叶片C的前缘点笛卡尔坐标
Figure 967049DEST_PATH_IMAGE039
。
在坐标转换完成之后即可进行向量计算，计算出风机方位角。风机方位角具体的计算过程为：根据三个所述前缘点笛卡尔坐标计算出其中一个前缘点分别到另外两个前缘点的向量；根据右手定则计算出其中一个前缘点分别到另外两个前缘点的向量的外积向量；其中，所述外积向量为三个前缘点所确定平面的法向量；根据所述轮毂中心点笛卡尔坐标和所述轮毂中心处无人机笛卡尔坐标确定出所述轮毂中心处无人机方位角的向量，并根据所述外积向量与所述轮毂中心处无人机方位角的向量计算出所述外积向量与所述轮毂中心处无人机方位角的向量在水平面上投影分量之间的夹角；将所述外积向量与所述轮毂中心处无人机方位角的向量在水平面上投影分量之间的夹角叠加至所述轮毂中心处无人机方位角中，得到所述风机方位角；其中，风机方位角即为三个前缘点所确定平面的法向量的水平分量的方位角。
例如：叶片C的前缘点到叶片B的前缘点的向量为
Figure 742238DEST_PATH_IMAGE040
，则
Figure 246031DEST_PATH_IMAGE041
； 叶片C的前缘点到叶片A的前缘点的向量为
Figure 921601DEST_PATH_IMAGE042
，则
Figure 219858DEST_PATH_IMAGE043
；根据右手定则 求向量
Figure 980879DEST_PATH_IMAGE044
与向量
Figure 288363DEST_PATH_IMAGE045
的外积向量
Figure 54325DEST_PATH_IMAGE046
，得到垂直于三个前缘点所确定 平面向内的向量
Figure 287598DEST_PATH_IMAGE047
，已知
Figure 771800DEST_PATH_IMAGE048
为轮毂中心处无人机方位角
Figure 506145DEST_PATH_IMAGE049
的向量表达式，可求得向量
Figure 454509DEST_PATH_IMAGE050
和向量
Figure 796366DEST_PATH_IMAGE051
在水平面上投影的分量之间的夹角
Figure 830181DEST_PATH_IMAGE052
； 则A、B、C三支叶片的前缘点所确定平面的法向量的水平分量的方位角
Figure 417152DEST_PATH_IMAGE053
，即对轮毂中心处无人机方位角
Figure 718558DEST_PATH_IMAGE054
进行校正得到风机方位角（也就 是A、B、C三支叶片的前缘点所确定平面的法向量的水平分量的方位角）。A、B、C三支叶片的 前缘点所确定平面的法向量的水平分量的方位角即为风机模型坐标系的Y轴方向，风机叶 轮面朝外的方位角为风机模型坐标系Y轴负方向为
Figure 732781DEST_PATH_IMAGE055
。
在本具体实施例中：所述S3具体为，根据所述风机方位角和所述轮毂中心点GPS坐标对应的轮毂中心点笛卡尔坐标确定出风机模型坐标系；其中，风机模型坐标系如图3所示，轮毂中心点为所述风机模型坐标系的坐标原点，所述风机方位角为所述风机模型坐标系Y轴方向的方位角，三个前缘点所确定平面与水平面的相交线为所述风机模型坐标系的X轴，大地高度方向为所述风机模型坐标系的Z轴；根据任一所述前缘点GPS坐标对应的前缘点笛卡尔坐标和所述轮毂中心点GPS坐标对应的轮毂中心点笛卡尔坐标，计算出轮毂中心点到该任一前缘点的向量；获取所述风机模型坐标系中Z轴正方向的Z轴单位向量，并计算出轮毂中心点到该任一前缘点的向量在所述风机模型坐标系中XOZ平面上的投影与所述Z轴单位向量之间的相对角度；其中，该轮毂中心点到任一前缘点的向量在所述风机模型坐标系中XOZ平面上的投影与所述Z轴单位向量之间的相对角度即为所述风机叶轮旋转角。
所述风机叶轮旋转角为任意一支叶片（一般是风机倒Y字型朝上的那支叶片）与Z 轴正方向之间的夹角；例如，如求叶片A的风机叶轮旋转角。因为轮毂中心点为坐标系原点， 则轮毂中心点到叶片A的前缘点的向量为
Figure 253892DEST_PATH_IMAGE056
；取风 机模型坐标系的Z轴正方向的单位向量（Z轴单位向量）
Figure 877510DEST_PATH_IMAGE057
，求向量
Figure 800466DEST_PATH_IMAGE058
在风机模型坐标系中XOZ平面上的投影与向量
Figure 484126DEST_PATH_IMAGE059
之间的相对角度
Figure 492534DEST_PATH_IMAGE060
，角度
Figure 421306DEST_PATH_IMAGE061
即为叶片A的 风机叶轮旋转角。
风机姿态标定的应用：风机姿态标定的目的是根据风机方位角确定风机模型坐标系，并基于风机模型坐标系和风机叶轮旋转角规划无人机的风机叶片巡检路径；因此，在所述S3之后，还包括如下步骤，
将经过上述S1-S3标定之后的风机作为模板风机，并在模板风机上录制路径规划模板，得到模板参数；（需要说明的是：将经过上述S1-S3标定之后的风机作为模板风机时，所述S3中得到的所述风机叶轮旋转角即为模板风机叶轮旋转角）；
采用上述S1-S3的方法对待巡检风机进行同样的标定；（需要说明的是：将路径规划模板应用在待巡检风机上时，模板风机的叶片位置可能与待巡检风机叶片位置不符，此时只需要对该待巡检风机进行同样的标定，即可得到待巡检风机方位角和待巡检风机叶轮旋转角以确定待巡检风机的姿态）；
计算模板风机与待巡检风机对应叶片的风机叶轮旋转角之和
Figure 697305DEST_PATH_IMAGE062
；
将所述模板参数带入待巡检风机模型坐标系中，得到待巡检风机的初始路径规划航路点GPS坐标；
基于待巡检风机模型坐标系，将所述初始路径规划航路点GPS坐标转换成初始路 径规划航路点笛卡尔坐标，并将所述初始路径规划航路点笛卡尔坐标绕所述待巡检风机模 型坐标系的Y轴旋转
Figure 53331DEST_PATH_IMAGE062
角度，得到待巡检风机的最终路径规划航路点笛卡尔坐标；
基于大地坐标系，将所述最终路径规划航路点笛卡尔坐标转换成最终路径规划航路点GPS坐标。
图4为模板风机与待巡检风机对应叶片的风机叶轮旋转角的示意图；将所述初始 路径规划航路点笛卡尔坐标绕所述待巡检风机模型坐标系的Y轴旋转
Figure 283455DEST_PATH_IMAGE062
角度，得到待巡检 风机的最终路径规划航路点笛卡尔坐标的公式为，
Figure 514454DEST_PATH_IMAGE063
；
其中，
Figure 146424DEST_PATH_IMAGE064
；
具体的，
Figure 171886DEST_PATH_IMAGE065
为模板风机一叶片的风机叶轮旋转角，
Figure 154886DEST_PATH_IMAGE066
为待巡检风机对应叶片的 风机叶轮旋转角，
Figure 425461DEST_PATH_IMAGE067
角度对应的弧度值，
Figure 410472DEST_PATH_IMAGE068
为所述初始路径规划航路 点笛卡尔坐标，
Figure 623148DEST_PATH_IMAGE069
为所述最终路径规划航路点笛卡尔坐标。
在上述一种基于无人机定位的风机姿态的标定方法的基础上，本发明还提供一种基于无人机定位的风机姿态的标定系统。
如图5所示，一种基于无人机定位的风机姿态的标定系统，包括以下模块，
风机标定点确定模块，其用于对风机叶轮在任意角度进行锁定，利用无人机标定出轮毂中心点GPS坐标以及三支叶片中每支叶片上的前缘点GPS坐标；在所述无人机标定所述轮毂中心点GPS坐标的同时记录轮毂中心处无人机GPS坐标以及轮毂中心处无人机方位角；其中，前缘点为叶片前缘上的任一点，且三支叶片上的前缘点到轮毂中心点的距离一致；
风机方位角确定模块，其用于根据所述轮毂中心处无人机GPS坐标、所述轮毂中心点GPS坐标以及三个所述前缘点GPS坐标对所述轮毂中心处无人机方位角进行校正，得到风机方位角；
风机叶轮旋转角确定模块，其用于基于所述风机方位角和所述轮毂中心点GPS坐标，根据任一所述前缘点GPS坐标，计算出风机叶轮旋转角。
在本发明一种基于无人机定位的风机姿态的标定方法及系统中，首先通过无人机确定风机的标定点，其中标定点包括轮毂中心点和三个前缘点，然后利用标定点对无人机在标定轮毂中心点是的轮毂中心处无人机方位角进行校正，即可得到准确的风机方位角，根据风机方位角即可确定风机模型坐标系，基于风机模型坐标系可以计算出风机叶轮旋转角；采用本发明可以得到准确的风机姿态数据，满足风机叶片巡检路径规划高精度的需求。风机位姿的标定是所有路径规划方法的理论基础，可以在后续进行多种方法的延展。
以上所述仅为本发明的较佳实施例，并不用以限制本发明，凡在本发明的精神和原则之内，所作的任何修改、等同替换、改进等，均应包含在本发明的保护范围之内。

Claims (9)

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所述的基于无人机定位的风机姿态的标定方法，其特征在于：令
Figure 885756DEST_PATH_IMAGE001
为 轮毂中心点，
Figure 22339DEST_PATH_IMAGE002
为任意待转换点，且轮毂中心点GPS坐标为
Figure 301005DEST_PATH_IMAGE003
，任意待 转换点GPS坐标为
Figure 933849DEST_PATH_IMAGE004
，则在所述S21中，大地坐标与笛卡尔坐标之间的 转换关系为，
Figure 625862DEST_PATH_IMAGE005
；
其中，
Figure 736775DEST_PATH_IMAGE006
，
Figure 197843DEST_PATH_IMAGE007
，
Figure 503054DEST_PATH_IMAGE008
；
具体的，
Figure 915319DEST_PATH_IMAGE009
为任意待转换点与轮毂中心点之间的水平距离，
Figure 331388DEST_PATH_IMAGE010
为任意待转换点 与轮毂中心点之间的垂直距离，
Figure 912542DEST_PATH_IMAGE011
为所述轮毂中心处无人机方位角，
Figure 559292DEST_PATH_IMAGE012
为由轮毂中心点 到任意待转换点构成的向量基于所述轮毂中心处无人机方位角的水平相对角度，
Figure 225897DEST_PATH_IMAGE013
为 地球半径，
Figure 678613DEST_PATH_IMAGE014
为任意待转换点笛卡尔坐标的
Figure 114273DEST_PATH_IMAGE015
轴值，
Figure 994243DEST_PATH_IMAGE016
为任意待转换点笛卡尔坐标的
Figure 148143DEST_PATH_IMAGE017
轴值，
Figure 906015DEST_PATH_IMAGE018
为任意待转换点笛卡尔坐标的
Figure 718155DEST_PATH_IMAGE019
轴值。
5.根据权利要求3所述的基于无人机定位的风机姿态的标定方法，其特征在于：所述S22具体为，
根据三个所述前缘点笛卡尔坐标计算出其中一个前缘点分别到另外两个前缘点的向量；
根据右手定则计算出其中一个前缘点分别到另外两个前缘点的向量的外积向量；其中，所述外积向量为三个前缘点所确定平面的法向量；
根据所述轮毂中心点笛卡尔坐标和所述轮毂中心处无人机笛卡尔坐标确定出所述轮毂中心处无人机方位角的向量，并根据所述外积向量与所述轮毂中心处无人机方位角的向量计算出所述外积向量与所述轮毂中心处无人机方位角的向量在水平面上投影分量之间的夹角；
将所述外积向量与所述轮毂中心处无人机方位角的向量在水平面上投影分量之间的夹角叠加至所述轮毂中心处无人机方位角中，得到所述风机方位角。
6.根据权利要求3所述的基于无人机定位的风机姿态的标定方法，其特征在于：所述S3具体为，
根据所述风机方位角和所述轮毂中心点GPS坐标对应的轮毂中心点笛卡尔坐标确定出风机模型坐标系；其中，轮毂中心点为所述风机模型坐标系的坐标原点，所述风机方位角为所述风机模型坐标系Y轴方向的方位角，三个前缘点所确定平面与水平面的相交线为所述风机模型坐标系的X轴，大地高度方向为所述风机模型坐标系的Z轴；
根据任一所述前缘点GPS坐标对应的前缘点笛卡尔坐标和所述轮毂中心点GPS坐标对应的轮毂中心点笛卡尔坐标，计算出轮毂中心点到该任一前缘点的向量；
获取所述风机模型坐标系中Z轴正方向的Z轴单位向量，并计算出轮毂中心点到该任一前缘点的向量在所述风机模型坐标系中XOZ平面上的投影与所述Z轴单位向量之间的相对角度；其中，轮毂中心点到该任一前缘点的向量在所述风机模型坐标系中XOZ平面上的投影与所述Z轴单位向量之间的相对角度即为所述风机叶轮旋转角。
7.根据权利要求1至6任一项所述的基于无人机定位的风机姿态的标定方法，其特征在于：在所述S3之后，还包括如下步骤，
将经过上述S1-S3标定之后的风机作为模板风机，并在模板风机上录制路径规划模板，得到模板参数；
采用上述S1-S3的方法对待巡检风机进行同样的标定；
计算模板风机与待巡检风机对应叶片的风机叶轮旋转角之和
Figure 536069DEST_PATH_IMAGE020
；
将所述模板参数带入待巡检风机模型坐标系中，得到待巡检风机的初始路径规划航路点GPS坐标；
基于待巡检风机模型坐标系，将所述初始路径规划航路点GPS坐标转换成初始路径规 划航路点笛卡尔坐标，并将所述初始路径规划航路点笛卡尔坐标绕所述待巡检风机模型坐 标系的Y轴旋转
Figure 911687DEST_PATH_IMAGE021
角度，得到待巡检风机的最终路径规划航路点笛卡尔坐标；
基于大地坐标系，将所述最终路径规划航路点笛卡尔坐标转换成最终路径规划航路点GPS坐标。
8.根据权利要求7所述的基于无人机定位的风机姿态的标定方法，其特征在于：将所述 初始路径规划航路点笛卡尔坐标绕所述待巡检风机模型坐标系的Y轴旋转
Figure 706205DEST_PATH_IMAGE022
角度，得到待 巡检风机的最终路径规划航路点笛卡尔坐标的公式为，
Figure 116458DEST_PATH_IMAGE023
；
其中，
Figure 902011DEST_PATH_IMAGE024
；
具体的，
Figure 201143DEST_PATH_IMAGE025
为模板风机一叶片的风机叶轮旋转角，
Figure 300817DEST_PATH_IMAGE026
为待巡检风机对应叶片的风机 叶轮旋转角，
Figure 939478DEST_PATH_IMAGE027
角度对应的弧度值，
Figure 161512DEST_PATH_IMAGE028
为所述初始路径规划航路点 笛卡尔坐标，
Figure 947940DEST_PATH_IMAGE029
为所述最终路径规划航路点笛卡尔坐标。
9.一种基于无人机定位的风机姿态的标定系统，其特征在于：包括以下模块，
风机标定点确定模块，其用于对风机叶轮在任意角度进行锁定，利用无人机标定出轮毂中心点GPS坐标以及三支叶片中每支叶片上的前缘点GPS坐标；在所述无人机标定所述轮毂中心点GPS坐标的同时记录轮毂中心处无人机GPS坐标以及轮毂中心处无人机方位角；其中，前缘点为叶片前缘上的任一点，且三支叶片上的前缘点到轮毂中心点的距离一致；
风机方位角确定模块，其用于根据所述轮毂中心处无人机GPS坐标、所述轮毂中心点GPS坐标以及三个所述前缘点GPS坐标对所述轮毂中心处无人机方位角进行校正，得到风机方位角；
风机叶轮旋转角确定模块，其用于基于所述风机方位角和所述轮毂中心点GPS坐标，根据任一所述前缘点GPS坐标，计算出风机叶轮旋转角。
CN202211572637.9A 2022-12-08 2022-12-08 一种基于无人机定位的风机姿态的标定方法及系统 Active CN115655203B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202211572637.9A CN115655203B (zh) 2022-12-08 2022-12-08 一种基于无人机定位的风机姿态的标定方法及系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202211572637.9A CN115655203B (zh) 2022-12-08 2022-12-08 一种基于无人机定位的风机姿态的标定方法及系统

Publications (2)

Publication Number Publication Date
CN115655203A true CN115655203A (zh) 2023-01-31
CN115655203B CN115655203B (zh) 2023-04-14

Family

ID=85017172

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202211572637.9A Active CN115655203B (zh) 2022-12-08 2022-12-08 一种基于无人机定位的风机姿态的标定方法及系统

Country Status (1)

Country Link
CN (1) CN115655203B (zh)

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106091941A (zh) * 2016-06-21 2016-11-09 远景能源（江苏）有限公司 风力发电机叶尖塔筒净空的测量方法
CN108733079A (zh) * 2018-06-19 2018-11-02 上海扩博智能技术有限公司 通过无人机对风机进行自动巡检飞行路径确定方法及系统
CN112902955A (zh) * 2021-03-05 2021-06-04 上海竹格智能传感技术有限公司 风机叶片转速传感器和风机叶片姿态测量方法
CN113885580A (zh) * 2021-11-17 2022-01-04 国能定边新能源有限公司 基于无人机实现自动化巡检风机的路径规划方法及系统
CN115145314A (zh) * 2022-09-01 2022-10-04 风脉能源（武汉）股份有限公司 基于无人机的风机叶片巡检路径规划方法

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106091941A (zh) * 2016-06-21 2016-11-09 远景能源（江苏）有限公司 风力发电机叶尖塔筒净空的测量方法
CN108733079A (zh) * 2018-06-19 2018-11-02 上海扩博智能技术有限公司 通过无人机对风机进行自动巡检飞行路径确定方法及系统
CN112902955A (zh) * 2021-03-05 2021-06-04 上海竹格智能传感技术有限公司 风机叶片转速传感器和风机叶片姿态测量方法
CN113885580A (zh) * 2021-11-17 2022-01-04 国能定边新能源有限公司 基于无人机实现自动化巡检风机的路径规划方法及系统
CN115145314A (zh) * 2022-09-01 2022-10-04 风脉能源（武汉）股份有限公司 基于无人机的风机叶片巡检路径规划方法

Also Published As

Publication number Publication date
CN115655203B (zh) 2023-04-14

Similar Documents

Publication Publication Date Title
CN108733079B (zh) 通过无人机对风机进行自动巡检飞行路径确定方法及系统
EP3454008B1 (en) Survey data processing device, survey data processing method, and survey data processing program
CN106871927B (zh) 一种无人机光电吊舱安装误差标校方法
CN106595668B (zh) 一种用于光电吊舱的无源定位算法
CN107894241A (zh) 一种基于椭球拟合的无人机磁传感器校准方法、无人机
CN109708639B (zh) 飞行器平飞跟踪直线和圆弧路径的侧向制导指令生成方法
US20130325222A1 (en) Automatic recovery method for an unmanned aerial vehicle
CN110134134B (zh) 一种无人机悬停状态下的测风方法
CN105698762A (zh) 一种单机航迹上基于不同时刻观测点的目标快速定位方法
CN105891821A (zh) 一种机载下视测量目标的自动跟踪方法
CN106705996B (zh) 一种基于大气特征参数的飞行器导航信息修正方法
CN109883444A (zh) 一种姿态角耦合误差补偿方法、装置及电子设备
CN115683170B (zh) 基于雷达点云数据融合误差的校准方法
CN116299369A (zh) 一种基于机载激光测深系统的安置角误差修正方法
CN110398242A (zh) 一种高旋高过载条件飞行器的姿态角确定方法
CN112950719A (zh) 一种基于无人机主动式光电平台的无源目标快速定位方法
CN106908085B (zh) 一种基于地球自转补偿的星光测量指向控制方法
CN108592860B (zh) 用于机载光电观瞄系统基轴对准操作后的瞄准线输出角度计算方法
CN114900609A (zh) 一种无人机的自动化拍摄控制方法和系统
CN108917698B (zh) 一种方位角计算方法
CN111679261B (zh) 一种基于反光板的激光雷达定位方法及系统
CN114564031A (zh) 一种基于旋翼无人机实现风机巡检拍摄的路径规划方法
CN115655203B (zh) 一种基于无人机定位的风机姿态的标定方法及系统
CN109444915A (zh) 一种基于激光雷达数据的危险区域预判方法
CN116908818B (zh) 基于rtk无人机的激光雷达的标定方法、装置及存储介质

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
PE01 Entry into force of the registration of the contract for pledge of patent right

Denomination of invention: A calibration method and system for wind turbine attitude based on drone positioning

Granted publication date: 20230414

Pledgee: Guanggu Branch of Wuhan Rural Commercial Bank Co.,Ltd.

Pledgor: WINDMAGICS (WUHAN) CO.,LTD.

Registration number: Y2024980009864

PE01 Entry into force of the registration of the contract for pledge of patent right