CN109466784A - 一种基于主动增稳的高精度云台前馈系统及方法 - Google Patents
一种基于主动增稳的高精度云台前馈系统及方法 Download PDFInfo
- Publication number
- CN109466784A CN109466784A CN201811055841.7A CN201811055841A CN109466784A CN 109466784 A CN109466784 A CN 109466784A CN 201811055841 A CN201811055841 A CN 201811055841A CN 109466784 A CN109466784 A CN 109466784A
- Authority
- CN
- China
- Prior art keywords
- gyo
- holder
- coordinate system
- angular speed
- electric machine
- 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.)
- Pending
Links
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64D—EQUIPMENT FOR FITTING IN OR TO AIRCRAFT; FLIGHT SUITS; PARACHUTES; ARRANGEMENTS OR MOUNTING OF POWER PLANTS OR PROPULSION TRANSMISSIONS IN AIRCRAFT
- B64D47/00—Equipment not otherwise provided for
- B64D47/08—Arrangements of cameras
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64U—UNMANNED AERIAL VEHICLES [UAV]; EQUIPMENT THEREFOR
- B64U2101/00—UAVs specially adapted for particular uses or applications
- B64U2101/30—UAVs specially adapted for particular uses or applications for imaging, photography or videography
Abstract
本发明公开了一种基于主动增稳的高精度云台前馈系统及方法,所述系统包括传感器测量单元、云台控制单元以及云台电机;传感器测量单元安装在无人机的机体上,采集无人机飞行过程中机体抖动的角速度,传感器测量单元的输出端通过数据总线与云台控制单元连接;所述云台控制单元,将飞机机体坐标系下机体抖动角速度,换算至云台电机运动方向的坐标系,并计算机身震动的反向抵消量,并据此生成云台电机的反向运动指令,传输给云台电机;所述云台电机,在云台控制单元的指令下进行运动,从而带动安装相机的云台震动,以实现对机身震动的反向抵消,达到云台前馈增稳的作用。本发明提高了云台的增稳精度,进而有效提高了安装在云台上相机的拍摄质量。
Description
技术领域
本发明涉及无人机巡检过程中的一种基于主动增稳的高精度云台前馈系统及方法。
背景技术
随着无人机应用的广泛普及,很多应用场合中需要实现无人机自主飞行或半自主飞行以完成巡检拍照工作,如输电线路巡检等。
工业无人机航空摄影的相机设备在工作的时候,由于无人机震动可能导致视频抖动,为减小无人机震动带来不利影响,常常需要安装增稳云台,普通增稳云台通过检测相机的倾斜角度和运动角速度信息,对相机抖动进行修正,有效减小了无人机振动对相机拍摄视频的影响,对无人机的巡航具有重大意义。
但是,目前的增稳云台对于相机抖动进行修正的前提条件是已经检测到了相机的运动,也就是说已经产生了抖动才做修正,这种修正方式增稳精度不高,存在一定的局限性。
发明内容
本发明的目的在于克服现有技术的不足,提供一种基于主动增稳的高精度云台前馈系统及方法,提高了云台的增稳精度,进而有效提高了安装在云台上相机的拍摄质量。
本发明的目的是通过以下技术方案来实现的:一种基于主动增稳的高精度云台前馈系统,包括传感器测量单元、云台控制单元以及云台电机;
所述传感器测量单元安装在无人机的机体上,用于采集无人机飞行过程中机体抖动的角速度,传感器测量单元的输出端通过数据总线与云台控制单元连接;
所述云台控制单元,用于将飞机机体坐标系下机体抖动角速度,换算至云台电机运动方向的坐标系,并计算机身震动的反向抵消量,并据此生成云台电机的反向运动指令,传输给云台电机;
所述云台电机,用于在云台控制单元的指令下进行运动,从而带动安装相机的云台震动,以实现对机身震动的反向抵消,达到云台前馈增稳的作用。
优选地,所述传感器测量单元包括陀螺仪传感器。
一种基于主动增稳的高精度云台前馈系统的前馈方法,包括以下步骤:
S1.在无人机机体上安装测量飞机机体抖动的传感器测量单元;
S2.无人机飞行过程中,传感器测量单元测得无人机机体的抖动角速度,并通过数据总线将测得的抖动角速度传输给云台控制单元;
S3.云台控制单元将飞机机体坐标系换算至云台的电机运动方向的坐标系,计算出机身震动的反向抵消量;
S4.云台控制单元控制电机按照反向抵消量运动,从而带动安装相机的云台震动,以实现对机身震动的反向抵消,达到云台前馈增稳的作用。
其中,所述步骤S3包括:
S301.将飞机机体坐标系换算至云台电机运动方向的坐标系,计算云台坐标系的震动角速度:
测量得到飞机机体坐标系与云台电机运动方向坐标系的航向夹角YAW;
设机体坐标系下陀螺仪传感器采集到的x轴角速度为gyo_x,y轴角速度为gyo_y,z轴角速度为gyo_z;转换到云台电机运动方向的坐标系后,x轴角速度为gyo_g_x,y轴角速度为gyo_g_y,z轴角速度为gyo_g_z,则:
gyo_g_x=gyo_x*cos(YAW)+gyo_y*sin(YAW);
gyo_g_y=gyo_y*cos(YAW)+gyo_x*sin(YAW);
gyo_g_z=gyo_z;
S302.根据云台坐标系的震动角速度gyo_g_x、gyo_g_y和gyo_g_z,确定震动的反向抵消量。
本发明的有益效果是:本发明根据机身抖动角速度,计算相应的反向抵消量,并控制云台电机反向运动以抵消机身抖动带来的影响,提高了云台的增稳精度,进而有效提高了安装在云台上相机的拍摄质量。
附图说明
图1为本发明的系统原理框图;
图2为本发明的方法流程图。
具体实施方式
下面结合附图进一步详细描述本发明的技术方案,但本发明的保护范围不局限于以下所述。
如图1所示,一种基于主动增稳的高精度云台前馈系统,包括传感器测量单元、云台控制单元以及云台电机;
所述传感器测量单元安装在无人机的机体上,用于采集无人机飞行过程中机体抖动的角速度,传感器测量单元的输出端通过数据总线与云台控制单元连接;
所述云台控制单元,用于将飞机机体坐标系下机体抖动角速度,换算至云台电机运动方向的坐标系,并计算机身震动的反向抵消量,并据此生成云台电机的反向运动指令,传输给云台电机;
所述云台电机,用于在云台控制单元的指令下进行运动,从而带动安装相机的云台震动,以实现对机身震动的反向抵消,达到云台前馈增稳的作用。
所述传感器测量单元包括陀螺仪传感器。
如图2所示,一种基于主动增稳的高精度云台前馈系统的前馈方法,包括以下步骤:
S1.在无人机机体上安装测量飞机机体抖动的传感器测量单元;
S2.无人机飞行过程中,传感器测量单元测得无人机机体的抖动角速度,并通过数据总线将测得的抖动角速度传输给云台控制单元;
S3.云台控制单元将飞机机体坐标系换算至云台的电机运动方向的坐标系,计算出机身震动的抵消量;
S4.云台控制单元控制电机按照抵消量进行运动,从而带动安装相机的云台震动,在云台电机运动方向坐标系下,实现对机身震动的反向抵消,达到云台前馈增稳的作用。
其中所述步骤S3包括:
S301.将飞机机体坐标系换算至云台电机运动方向的坐标系,计算云台坐标系的震动角速度:
测量得到飞机机体坐标系与云台电机运动方向坐标系的航向夹角YAW;
设机体坐标系下陀螺仪传感器采集到的x轴角速度为gyo_x,y轴角速度为gyo_y,z轴角速度为gyo_z;转换到云台电机运动方向的坐标系后,x轴角速度为gyo_g_x,y轴角速度为gyo_g_y,z轴角速度为gyo_g_z,则:
gyo_g_x=gyo_x*cos(YAW)+gyo_y*sin(YAW);
gyo_g_y=gyo_y*cos(YAW)+gyo_x*sin(YAW);
gyo_g_z=gyo_z;
S302.根据云台坐标系的震动角速度gyo_g_x、gyo_g_y和gyo_g_z,确定震动的反向抵消量。具体地,确定反向抵消量时,只需将云台坐标系的震动角速度gyo_g_x、gyo_g_y和gyo_g_z取反即可。
综上,本发明根据机身抖动角速度,计算相应的抵消量,并控制云台电机反向运动以抵消机身抖动带来的影响,提高了云台的增稳精度,进而有效提高了安装在云台上相机的拍摄质量。
最后需要说明的是,以上所述是本发明的优选实施方式,应当理解本发明并非局限于所披露的形式,不应该看作是对其他实施例的排除,而可用于其他组合、修改和环境,并能够在本文所述构想范围内,通过上述教导或相关领域的技术或知识进行改动。而本领域人员所进行的改动和变化不脱离本发明的精神和范围,则都应在本发明所附权利要求的保护范围内。
Claims (4)
1.一种基于主动增稳的高精度云台前馈系统,其特征在于:包括传感器测量单元、云台控制单元以及云台电机;
所述传感器测量单元安装在无人机的机体上,用于采集无人机飞行过程中机体抖动的角速度,传感器测量单元的输出端通过数据总线与云台控制单元连接;
所述云台控制单元,用于将飞机机体坐标系下机体抖动角速度,换算至云台电机运动方向的坐标系,计算机身震动的反向抵消量,并据此生成云台电机的反向运动指令,传输给云台电机;
所述云台电机,用于在云台控制单元的指令下进行运动,从而带动安装相机的云台震动,以实现对机身震动的反向抵消,达到云台前馈增稳的作用。
2.根据权利要求1所述的一种基于主动增稳的高精度云台前馈系统,其特征在于:所述传感器测量单元包括陀螺仪传感器。
3.如权利要求1~2中任意一项所述的一种基于主动增稳的高精度云台前馈系统的前馈方法,其特征在于:包括以下步骤:
S1.在无人机机体上安装测量飞机机体抖动的传感器测量单元;
S2.无人机飞行过程中,传感器测量单元测得无人机机体的抖动角速度,并通过数据总线将测得的抖动角速度传输给云台控制单元;
S3.云台控制单元将飞机机体坐标系换算至云台的电机运动方向的坐标系,计算出机身震动的反向抵消量;
S4.云台控制单元控制电机按照反向抵消量进行运动,从而带动安装相机的云台震动,以实现对机身震动的反向抵消,达到云台前馈增稳的作用。
4.根据权利要求3所述的一种基于主动增稳的高精度云台前馈方法,其特征在于:所述步骤S3包括:
S301.将飞机机体坐标系换算至云台电机运动方向的坐标系,计算云台坐标系的震动角速度:
测量得到飞机机体坐标系与云台电机运动方向坐标系的航向夹角YAW;
设机体坐标系下陀螺仪传感器采集到的x轴角速度为gyo_x,y轴角速度为gyo_y,z轴角速度为gyo_z;转换到云台电机运动方向的坐标系后,x轴角速度为gyo_g_x,y轴角速度为gyo_g_y,z轴角速度为gyo_g_z,则:
gyo_g_x=gyo_x*cos(YAW)+gyo_y*sin(YAW);
gyo_g_y=gyo_y*cos(YAW)+gyo_x*sin(YAW);
gyo_g_z=gyo_z;
S302.根据云台坐标系的震动角速度gyo_g_x、gyo_g_y和gyo_g_z,确定震动的反向抵消量。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811055841.7A CN109466784A (zh) | 2018-09-11 | 2018-09-11 | 一种基于主动增稳的高精度云台前馈系统及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811055841.7A CN109466784A (zh) | 2018-09-11 | 2018-09-11 | 一种基于主动增稳的高精度云台前馈系统及方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN109466784A true CN109466784A (zh) | 2019-03-15 |
Family
ID=65664223
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811055841.7A Pending CN109466784A (zh) | 2018-09-11 | 2018-09-11 | 一种基于主动增稳的高精度云台前馈系统及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109466784A (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110362122A (zh) * | 2019-07-26 | 2019-10-22 | 广西圣尧航空科技有限公司 | 一种云台控制装置及其控制方法 |
CN111959409A (zh) * | 2020-07-29 | 2020-11-20 | 北京三快在线科技有限公司 | 云台调节方法、存储介质、电子设备及车辆 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102355574A (zh) * | 2011-10-17 | 2012-02-15 | 上海大学 | 机载云台运动目标自主跟踪系统的图像稳定方法 |
CN102707734A (zh) * | 2012-06-19 | 2012-10-03 | 上海大学 | 基于惯性姿态传感器的自稳定云台 |
CN203673351U (zh) * | 2013-12-25 | 2014-06-25 | 云南农业大学 | 一种基于双陀螺仪的姿态稳定系统 |
CN103939718A (zh) * | 2011-09-09 | 2014-07-23 | 深圳市大疆创新科技有限公司 | 增稳云台及其控制方法和携带所述增稳云台的无人飞行器 |
CN205490863U (zh) * | 2015-12-23 | 2016-08-17 | 大连海事大学 | 一种基于惯性传感器的船载视频机械稳像系统 |
CN108259736A (zh) * | 2016-12-29 | 2018-07-06 | 昊翔电能运动科技(昆山)有限公司 | 云台增稳系统及云台增稳方法 |
-
2018
- 2018-09-11 CN CN201811055841.7A patent/CN109466784A/zh active Pending
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103939718A (zh) * | 2011-09-09 | 2014-07-23 | 深圳市大疆创新科技有限公司 | 增稳云台及其控制方法和携带所述增稳云台的无人飞行器 |
CN102355574A (zh) * | 2011-10-17 | 2012-02-15 | 上海大学 | 机载云台运动目标自主跟踪系统的图像稳定方法 |
CN102707734A (zh) * | 2012-06-19 | 2012-10-03 | 上海大学 | 基于惯性姿态传感器的自稳定云台 |
CN203673351U (zh) * | 2013-12-25 | 2014-06-25 | 云南农业大学 | 一种基于双陀螺仪的姿态稳定系统 |
CN205490863U (zh) * | 2015-12-23 | 2016-08-17 | 大连海事大学 | 一种基于惯性传感器的船载视频机械稳像系统 |
CN108259736A (zh) * | 2016-12-29 | 2018-07-06 | 昊翔电能运动科技(昆山)有限公司 | 云台增稳系统及云台增稳方法 |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110362122A (zh) * | 2019-07-26 | 2019-10-22 | 广西圣尧航空科技有限公司 | 一种云台控制装置及其控制方法 |
CN111959409A (zh) * | 2020-07-29 | 2020-11-20 | 北京三快在线科技有限公司 | 云台调节方法、存储介质、电子设备及车辆 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106959110B (zh) | 一种云台姿态检测方法及装置 | |
AU2017344750B2 (en) | Thrust vectored multicopters | |
CN203705964U (zh) | 一种机载三自由度云台稳定闭环控制装置 | |
CN109000612B (zh) | 设备的角度估算方法、装置、摄像组件及飞行器 | |
CN105116926B (zh) | 云台控制方法和装置 | |
CN206413079U (zh) | 云台增稳系统 | |
US10279480B1 (en) | Sensor fusion | |
Yang et al. | Precise quadrotor autonomous landing with SRUKF vision perception | |
CN108733066B (zh) | 一种基于吊舱姿态反馈的目标跟踪控制方法 | |
CN105045293A (zh) | 云台控制方法、外部载体控制方法及云台 | |
CN109466784A (zh) | 一种基于主动增稳的高精度云台前馈系统及方法 | |
Gonçalves et al. | Homography-based visual servoing of an aircraft for automatic approach and landing | |
JP2019113992A (ja) | 飛行装置、飛行装置の制御方法及びプログラム | |
JP2021082170A (ja) | 軌跡制御装置 | |
JP4617990B2 (ja) | 自動飛行制御装置、自動飛行制御方法及び自動飛行制御プログラム | |
KR101564298B1 (ko) | 이중김벌 구조를 갖는 시선안정화장치의 기동성 향상을 위한 이중김벌 제어 장치 및 방법 | |
CN203567947U (zh) | 无人机自稳定云台 | |
CN110300941A (zh) | 一种云台的转动控制方法、装置及控制设备、移动平台 | |
CN116149193B (zh) | 一种基于视觉的旋翼无人机抗扰动控制方法及系统 | |
CN108181919B (zh) | 一种基于卡尔曼滤波的小型运输器姿态控制方法 | |
JP2004359002A (ja) | 無人ヘリコプターの自立制御方法及び装置 | |
CN203673351U (zh) | 一种基于双陀螺仪的姿态稳定系统 | |
Raffler et al. | Path generation and control for unmanned multirotor vehicles using nonlinear dynamic inversion and pseudo control hedging | |
JPH06174487A (ja) | 姿勢検出装置 | |
JP2021086029A (ja) | 撮像装置とその空間安定化方法 |
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 | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20190315 |
|
RJ01 | Rejection of invention patent application after publication |