平码五不中公式规律
  • / 10
  • 下载费用:30 金币  

一种基于地理坐标系指向控制的两轴吊舱系统.pdf

关 键 ?#21097;?/dt>
一种 基于 地理 坐标系 指向 控制 两轴吊舱 系统
  专利查询网所有资源均是用户自行上传分享,仅供网友学习交流,未经上传用户书面授权,请勿作他用。
摘要
申请专利号:

CN201610645212.4

申请日:

2016.08.08

公开号:

CN106005455A

公开日:

2016.10.12

当前法律状态:

授权

有效性:

有权

法?#19978;?#24773;: 授权|||实质审查的生效IPC(主分类):B64D 47/00申请日:20160808|||公开
IPC分类号: B64D47/00; B64D47/08; G05D1/08 主分类号: B64D47/00
申请人: 北京宇鹰科技有限公司
发明人: 李志毅
地址: 100083 北京市海淀区学院路6号富润?#20197;?号楼3门601室
优?#28909;ǎ?/td>
专利代理机构: 代理人:
PDF完整版下载: PDF下载
法律状态
申请(专利)号:

CN201610645212.4

授权公告号:

||||||

法律状态公告日:

2018.08.17|||2017.03.15|||2016.10.12

法律状态类型:

授权|||实质审查的生效|||公开

摘要

一种基于地理坐标系指向控制的两轴吊舱系统,包括两轴吊舱结构系统、测控单元、传输系统和地面监控站,两轴吊舱结构系统由基板、方位框和俯仰框构成,承载高精度自动驾驶仪和遥感载荷;测控单元由高精度自动驾驶仪、码盘、俯仰电机和驱动板、方位电机和驱动板构成,实现遥感载荷视轴地理坐标下的测量和控制;传输系统由数传电台和图传电台构成,实现两轴吊舱系统数据和遥感载荷图像的实时传送;地面监控站由数传接收机、图传接收机和地面显示终端构成,实时显示两轴吊舱系统遥感载荷地理坐标系下的角度信息,并根据任务需求向两轴吊舱系统发送控制指令;本发明基于遥感载荷视轴在地理坐标下的指向信息进行直接控制,保证了两轴吊舱系统多扰环境下的控制精度,且成?#38236;汀?#24212;用方便,具有重要的工程价值。

权利要求书

1.一种基于地理坐标系指向控制的两轴吊舱系统,其特征在于包括:两轴吊舱结构系统(1)、测控单元(2)、传输系统(3)和地面监控站(4),其中:两轴吊舱结构系统(1)由基板(11)、方位框(12)和俯仰框(13)构成,基板(11)作为两轴吊舱系统与运动载体的过渡?#26041;冢?#36890;过减震器固连于两轴吊舱系统和运动载体之间,隔离运动载体的非理想高频运动干扰;方位框(12)作为两轴吊舱系统的最外环,承载俯仰框系统,实现两轴吊舱系统方位方向的旋转,进而影响遥感载荷视轴在地理坐标系下方位方向的偏转;俯仰框(13)作为两轴吊舱系统的最内环,承载高精度自动驾驶仪和遥感载荷,实现两轴吊舱系统俯仰方向的旋转,进而影响遥感载荷视轴在地理坐标系下俯仰方向的偏转;测控单元(2)作为两轴吊舱系统的核心,具有测量和控制功能,由高精度自动驾驶仪(21)、码盘(22)、俯仰电机驱动板和电机(23)、方位电机驱动板和电机(24)构成,高精度自动驾驶仪(21)提供安装平面地理坐标下的角度信息,码盘(22)分别安装在俯仰框架和方位框架旋转轴上,提供框架间的相对角度信息,俯仰电机驱动板和电机(23)接收高精度自动驾驶仪(21)产生的PWM信号,驱动俯仰框电机进行转动,方位电机驱动板和电机(24)接收高精度自动驾驶仪(21)产生的PWM信号,驱动方位框电机进行转动,测量功能通过高精度自动驾驶仪(21)和码盘(22)实现,提供遥感载荷视轴在地理坐标系下的指向精度和框架运动角度,控制功能通过高精度自动驾驶仪(21)、俯仰电机驱动板和电机(23)和方位电机驱动板和电机(24)实现,基于?#25104;?#20851;系构建地理坐标系的两轴吊舱惯性稳定平台动力学方程,产生相应的框架运动调整遥感载荷视轴地理坐标系的指向,实现多扰环境下遥感载荷视轴控制;传输系统(3)由数传电台(31)和图传电台(32)构成,数传电台(31) 将载荷视轴在地理坐标系下的俯仰和方位的角度和角速度、俯仰框和方位框码盘的角度实时回传到地面控制终端,图传电台(32)将载荷图像信息实时回传到地面控制终端;地面监控站(4)由数传接收机(41)、图传接收机(42)和地面显示终端(43)构成,数传接收机(41)接收数传电台(31)回传的载荷视轴在地理坐标系下的角度和角速度、俯仰框和方位框码盘的角度,并通过串口发送到地面显示终端(43),图传接收机(42)接收图传电台(32)回传的遥感载荷图像信息,并通过串口发送到地面显示终端(43),地面显示终端(43)接收数传电台和图传电台的信息进行实时显示,并根据任务需求向两轴吊舱系统发送控制指令。2.根据权利要求1所述的一种基于地理坐标系指向控制的两轴吊舱系统,其特征在于:所述的测控单元(2)的测量功能通过高精度自动驾驶仪(21)和码盘(22)实现,不需要陀螺和加速度计传感器,通过在两轴吊舱的俯仰框设?#30772;?#38754;工装,将高精度自动驾驶仪(21)和遥感载荷固定于同一基准面,测量轴系相互平行,从而高精度自动驾驶仪(21)可以提供遥感载荷视轴在地理坐标系的指向角度,即俯仰框在地理坐标下的俯仰角和方位角,对遥感载荷视轴在地理坐标系的偏差提供绝对基准,俯仰框和方位框相对于地理系的角速度数据通过高精度自动驾驶仪(21)和码盘计算得到。3.根据权利要求1所述的一种基于地理坐标系指向控制的两轴吊舱系统,其特征在于:所述的测控单元(2)的基于?#25104;?#20851;系构建地理坐标系的两轴吊舱惯性稳定平台动力学方程如下其中,和分别为遥感载荷视轴在地理坐标下的俯仰角和方位角,通过高精度自动驾驶仪测量得到,表示俯仰框相对地理系的x,y,z方向的角速?#21097;?#34920;示方位框相对地理系的x,y,z方向的角速?#21097;?#36890;过高精度自动驾驶仪和码盘计算得到,为运动载体的角速度信息,由运动载体提供,Jpx,Jpy,Jpz表示俯仰框x,y,z方向的转动惯量,Jax,Jay,Jaz表示方位框x,y,z方向的转动惯量;θp表示俯仰框相对方位框的转角,由码盘测量得到,Jm表示电机的转动惯量,J1=Jpx+N2Jm,J3=Jaz+N2Jm+Jpzcos2θp,N表示电机传动比,Ke表示反电动势常数,Kt表示电机力矩系数;Rm表示电机电阻,Lm表示电机电感,up,ua分别表示俯仰和方位框电机输入电压,Tdm表示电机干扰力矩,Tda表示作用到方位框架?#31995;?#24178;扰力矩;两轴吊舱惯性稳定平台动力学输入为俯仰框架和方位框架的电机输入电压,输出为遥感载荷视轴在地理坐标系的俯仰和方位角度和角速度变化量,从而基于遥感载荷期望角度与实际测量角度的误差值,通过PID控制方法产生俯仰框和方位框的驱动命令,在线调整俯仰框和方位框实现遥感载荷视轴的调整。

说明书

一种基于地理坐标系指向控制的两轴吊舱系统

技术领域

本发明涉及一种基于地理坐标系指向控制的两轴吊舱系统,可用于多类
无人机、有人机进行高分辨率遥感拍摄,特别?#35270;?#20110;具有大范围多目标巡视
需求的电力巡线、国土资源测绘。

背景技术

两轴吊舱系统具有尺寸小、成?#38236;汀?#26426;动灵活等优点,可以隔离运动载
体非理想姿态干扰对载荷视轴的影响,实现对地面物体进行精确定位拍摄功
能,在军用、民用及科研方面应用前景非常广泛。

高分辨率遥感载荷在进行航摄?#24065;?#27714;运动载体做?#20154;佟?#31283;定的理想运
动,以使获得的图像能够满足数据处理中对相邻时刻两幅图像间覆盖重叠度
的要求。运动载体在实际执行任务过程中因受到自身振动和随机风场干扰影
响,容易形成复杂多模式的非理想运动,进而导致运动成像发生模糊、散焦、
变形、像素混叠而出现?#29616;?#38477;质。?#36865;猓?#39640;分辨率遥感载荷属于远距离拍摄,
基于?#25104;?#21407;理,遥感载荷视轴指向角的微小误差将导致其无法获得指定区域
的图像信息,使相邻采样时刻两幅图像之间的像素覆盖部分减少,影响后期
处理效果。因此,飞行载体的非理想运动将导致成像质量退化。

两轴吊舱系统安装在运动载体上,隔离运动载体的非理想运动对遥感载
荷的影响,提高运动过程中遥感载荷视轴的稳定精度和指向精度,从而提高
遥感载荷的成像质量,即增大遥感作业时相邻时刻两幅图像之间的像素重叠
率和提高系统的工作效率。

目前发展比较成熟的两轴吊舱系统,以安装在俯仰和方位框架的码盘信
息为外?#26041;?#24230;信息,陀螺测量信息为内?#26041;?#36895;度信息进行遥感载荷视轴姿态
调整,但由于飞行载体的位置和姿态的时变特性,遥感载荷视轴地理坐标下
指向精度不能精确获得,很难按照预定规划角度进行控制;另外一种相对高
端的具有视觉跟踪功能的两轴吊舱系统,以载荷图像的像素差作为外?#26041;?#24230;
信息,陀螺测量信息为内?#26041;?#36895;度信息进行遥感载荷视轴姿态调整,但这种
跟踪拍摄模式,需要通过人工初始获得地面拍摄物体信息后,才能连续控制
使拍摄物体位于图像中央,在工作过程中需人工时刻?#31245;ぃ?#19981;利于进行大范
围多目标的全自主跟踪控制。

发明内容

本发明的技术解决问题是:克服现有两轴吊舱平台系统的不足,提出一
种基于地理坐标系指向控制的两轴吊舱系统,通过安装与遥感载荷视轴平行
的自动驾驶仪,实时获得遥感载荷视轴地理坐标下的测量信息并进行控制,
实?#25351;?#26434;多扰环境下的全自主跟踪控制。

本发明的技术解决方案是:一种基于地理坐标系指向控制的两轴吊舱系
统,包括两轴吊舱结构系统(1)、测控单元(2)、传输系统(3)和地面
监控站(4),其中:

两轴吊舱结构系统(1)由基板(11)、方位框(12)和俯仰框(13)
构成,基板(11)作为两轴吊舱系统与运动载体的过渡?#26041;冢?#36890;过减震器固
连于两轴吊舱系统和运动载体之间,隔离运动载体的非理想高频运动干扰;
方位框(12)作为两轴吊舱系统的最外环,承载俯仰框系统,实现两轴吊舱
系统方位方向的旋转,进而影响遥感载荷视轴在地理坐标系下方位方向的偏
转;俯仰框(13)作为两轴吊舱系统的最内环,承载高精度自动驾驶仪和遥
感载荷,实现两轴吊舱系统俯仰方向的旋转,进而影响遥感载荷视轴在地理
坐标系下俯仰方向的偏转;

测控单元(2)作为两轴吊舱系统的核心,具有测量和控制功能,由高
精度自动驾驶仪(21)、码盘(22)、俯仰电机驱动板和电机(23)、方
位电机驱动板和电机(24)构成,高精度自动驾驶仪(21)提供安装平面
地理坐标下的角度信息,码盘(22)分别安装在俯仰框架和方位框架旋转轴
上,提供框架间的相对角度信息,俯仰电机驱动板和电机(23)接收高精度
自动驾驶仪(21)产生的PWM信号,驱动俯仰框电机进行转动,方位电机
驱动板和电机(24)接收高精度自动驾驶仪(21)产生的PWM信号,驱动
方位框电机进行转动,测量功能通过高精度自动驾驶仪(21)和码盘(22)
实现,提供遥感载荷视轴在地理坐标系下的指向精度和框架运动角度,控制
功能通过高精度自动驾驶仪(21)、俯仰电机驱动板和电机(23)和方位
电机驱动板和电机(24)实现,基于?#25104;?#20851;系构建地理坐标系的两轴吊舱惯
性稳定平台动力学方程,产生相应的框架运动调整遥感载荷视轴地理坐标系
的指向,实现多扰环境下遥感载荷视轴控制;

传输系统(3)由数传电台(31)和图传电台(32)构成,数传电台(31)
将载荷视轴在地理坐标系下的俯仰和方位的角度和角速度、俯仰框和方位框
码盘的角度实时回传到地面控制终端,图传电台(32)将载荷图像信息实时
回传到地面控制终端;

地面监控站(4)由数传接收机(41)、图传接收机(42)和地面显示
终端(43)构成,数传接收机(41)接收数传电台(31)回传的载荷视轴
在地理坐标系下的角度和角速度、俯仰框和方位框码盘的角度,并通过串口
发送到地面显示终端(43),图传接收机(42)接收图传电台(32)回传
的遥感载荷图像信息,并通过串口发送到地面显示终端(43),地面显示终
端(43)接收数传电台和图传电台的信息进行实时显示,并根据任务需求向
两轴吊舱系统发送控制指令;

本发明的一种基于地理坐标系指向控制的两轴吊舱系统,所述的测控单
元(2)的测量功能通过高精度自动驾驶仪(21)和码盘(22)实现,不需
要陀螺和加速度计传感器,通过在两轴吊舱的俯仰框设?#30772;?#38754;工装,将高精
度自动驾驶仪(21)和遥感载荷固定于同一基准面,测量轴系相互平行,从
而高精度自动驾驶仪(21)可以提供遥感载荷视轴在地理坐标系的指向角度,
即俯仰框在地理坐标下的俯仰角和方位角,对遥感载荷视轴在地理坐标系的
偏差提供绝对基准,俯仰框和方位框相对于地理系的角速度数据通过高精度
自动驾驶仪(21)和码盘计算得到;

本发明的一种基于地理坐标系指向控制的两轴吊舱系统,所述的测控单
元(2)的基于?#25104;?#20851;系构建地理坐标系的两轴吊舱惯性稳定平台动力学方
程如下

<mrow> <msubsup> <mover> <mi>&theta;</mi> <mo>&CenterDot;</mo> </mover> <mrow> <mi>n</mi> <mi>p</mi> <mi>x</mi> </mrow> <mi>p</mi> </msubsup> <mo>=</mo> <msubsup> <mi>&omega;</mi> <mrow> <mi>n</mi> <mi>p</mi> <mi>x</mi> </mrow> <mi>p</mi> </msubsup> </mrow>

<mrow> <msubsup> <mover> <mi>&omega;</mi> <mo>&CenterDot;</mo> </mover> <mrow> <mi>n</mi> <mi>p</mi> <mi>x</mi> </mrow> <mi>p</mi> </msubsup> <mo>=</mo> <mfrac> <mrow> <msub> <mi>K</mi> <mi>t</mi> </msub> <msub> <mi>K</mi> <mi>e</mi> </msub> <msup> <mi>N</mi> <mn>2</mn> </msup> <mrow> <mo>(</mo> <msubsup> <mi>&omega;</mi> <mrow> <mi>n</mi> <mi>a</mi> <mi>x</mi> </mrow> <mi>p</mi> </msubsup> <mo>-</mo> <msubsup> <mi>&omega;</mi> <mrow> <mi>n</mi> <mi>p</mi> <mi>x</mi> </mrow> <mi>p</mi> </msubsup> <mo>)</mo> </mrow> <mo>+</mo> <mi>N</mi> <mrow> <mo>(</mo> <mi>N</mi> <mo>-</mo> <mn>1</mn> <mo>)</mo> </mrow> <msub> <mi>R</mi> <mi>m</mi> </msub> <msub> <mi>J</mi> <mi>m</mi> </msub> <msubsup> <mover> <mi>&omega;</mi> <mo>&CenterDot;</mo> </mover> <mrow> <mi>n</mi> <mi>a</mi> <mi>x</mi> </mrow> <mi>p</mi> </msubsup> </mrow> <mrow> <msub> <mi>J</mi> <mn>1</mn> </msub> <msub> <mi>R</mi> <mi>m</mi> </msub> </mrow> </mfrac> <mo>-</mo> <mfrac> <mrow> <mo>(</mo> <msub> <mi>J</mi> <mrow> <mi>p</mi> <mi>z</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>J</mi> <mrow> <mi>p</mi> <mi>y</mi> </mrow> </msub> <mo>)</mo> <msubsup> <mi>&omega;</mi> <mrow> <mi>n</mi> <mi>p</mi> <mi>y</mi> </mrow> <mi>p</mi> </msubsup> <msubsup> <mi>&omega;</mi> <mrow> <mi>n</mi> <mi>p</mi> <mi>z</mi> </mrow> <mi>p</mi> </msubsup> </mrow> <msub> <mi>J</mi> <mn>1</mn> </msub> </mfrac> <mo>+</mo> <mfrac> <mrow> <msub> <mi>NK</mi> <mi>t</mi> </msub> <msub> <mi>u</mi> <mi>p</mi> </msub> </mrow> <mrow> <msub> <mi>J</mi> <mn>1</mn> </msub> <msub> <mi>R</mi> <mi>m</mi> </msub> </mrow> </mfrac> <mo>+</mo> <mfrac> <mrow> <msub> <mi>NT</mi> <mrow> <mi>d</mi> <mi>m</mi> </mrow> </msub> <mo>+</mo> <msub> <mi>T</mi> <mrow> <mi>d</mi> <mi>p</mi> </mrow> </msub> </mrow> <msub> <mi>J</mi> <mn>1</mn> </msub> </mfrac> </mrow>

<mrow> <msubsup> <mover> <mi>&theta;</mi> <mo>&CenterDot;</mo> </mover> <mrow> <mi>n</mi> <mi>p</mi> <mi>z</mi> </mrow> <mi>p</mi> </msubsup> <mo>=</mo> <msubsup> <mi>&omega;</mi> <mrow> <mi>n</mi> <mi>p</mi> <mi>z</mi> </mrow> <mi>p</mi> </msubsup> </mrow>

<mfenced open = "" close = ""> <mtable> <mtr> <mtd> <mrow> <msubsup> <mover> <mi>&omega;</mi> <mo>&CenterDot;</mo> </mover> <mrow> <mi>n</mi> <mi>p</mi> <mi>z</mi> </mrow> <mi>p</mi> </msubsup> <mo>=</mo> <mfrac> <mrow> <msub> <mi>J</mi> <mrow> <mi>p</mi> <mi>z</mi> </mrow> </msub> <msubsup> <mi>&omega;</mi> <mrow> <mi>n</mi> <mi>p</mi> <mi>z</mi> </mrow> <mi>p</mi> </msubsup> <mrow> <mo>(</mo> <msub> <mover> <mi>&theta;</mi> <mo>&CenterDot;</mo> </mover> <mi>p</mi> </msub> <mo>+</mo> <msubsup> <mi>&omega;</mi> <mrow> <mi>n</mi> <mi>a</mi> <mi>x</mi> </mrow> <mi>a</mi> </msubsup> <mo>)</mo> </mrow> <mi>sin</mi> <mn>2</mn> <msub> <mi>&theta;</mi> <mi>p</mi> </msub> </mrow> <mrow> <mn>2</mn> <msub> <mi>J</mi> <mn>3</mn> </msub> </mrow> </mfrac> <mo>-</mo> <mfrac> <mrow> <msub> <mi>J</mi> <mn>2</mn> </msub> <msubsup> <mi>&omega;</mi> <mrow> <mi>n</mi> <mi>a</mi> <mi>z</mi> </mrow> <mi>a</mi> </msubsup> <msub> <mover> <mi>&theta;</mi> <mo>&CenterDot;</mo> </mover> <mi>p</mi> </msub> <msub> <mi>sin&theta;</mi> <mi>p</mi> </msub> </mrow> <msub> <mi>J</mi> <mn>3</mn> </msub> </mfrac> <mo>+</mo> <mfrac> <mrow> <msub> <mi>NT</mi> <mrow> <mi>d</mi> <mi>m</mi> </mrow> </msub> <mo>+</mo> <msub> <mi>T</mi> <mrow> <mi>d</mi> <mi>a</mi> </mrow> </msub> </mrow> <msub> <mi>J</mi> <mn>3</mn> </msub> </mfrac> <msub> <mi>cos&theta;</mi> <mi>p</mi> </msub> <mo>+</mo> <mfrac> <mrow> <msub> <mi>J</mi> <mrow> <mi>p</mi> <mi>x</mi> </mrow> </msub> <msubsup> <mi>&omega;</mi> <mrow> <mi>n</mi> <mi>p</mi> <mi>x</mi> </mrow> <mi>p</mi> </msubsup> <mo>-</mo> <mrow> <mo>(</mo> <msub> <mi>J</mi> <mrow> <mi>a</mi> <mi>y</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>J</mi> <mrow> <mi>a</mi> <mi>x</mi> </mrow> </msub> <mo>)</mo> </mrow> <msubsup> <mi>&omega;</mi> <mrow> <mi>n</mi> <mi>a</mi> <mi>x</mi> </mrow> <mi>a</mi> </msubsup> </mrow> <msub> <mi>J</mi> <mn>3</mn> </msub> </mfrac> <msubsup> <mi>&omega;</mi> <mrow> <mi>n</mi> <mi>a</mi> <mi>y</mi> </mrow> <mi>a</mi> </msubsup> <msub> <mi>cos&theta;</mi> <mi>p</mi> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>+</mo> <mfrac> <mrow> <msub> <mi>K</mi> <mi>t</mi> </msub> <msub> <mi>K</mi> <mi>e</mi> </msub> <msup> <mi>N</mi> <mn>2</mn> </msup> <mrow> <mo>(</mo> <msubsup> <mi>&omega;</mi> <mrow> <mi>n</mi> <mi>b</mi> <mi>z</mi> </mrow> <mi>a</mi> </msubsup> <mo>-</mo> <msubsup> <mi>&omega;</mi> <mrow> <mi>n</mi> <mi>a</mi> <mi>z</mi> </mrow> <mi>a</mi> </msubsup> <mo>)</mo> </mrow> <mo>+</mo> <mi>N</mi> <mrow> <mo>(</mo> <mi>N</mi> <mo>-</mo> <mn>1</mn> <mo>)</mo> </mrow> <msub> <mi>R</mi> <mi>m</mi> </msub> <msub> <mi>J</mi> <mi>m</mi> </msub> <msubsup> <mover> <mi>&omega;</mi> <mo>&CenterDot;</mo> </mover> <mrow> <mi>n</mi> <mi>b</mi> <mi>z</mi> </mrow> <mi>a</mi> </msubsup> </mrow> <mrow> <msub> <mi>J</mi> <mn>3</mn> </msub> <msub> <mi>R</mi> <mi>m</mi> </msub> </mrow> </mfrac> <msub> <mi>cos&theta;</mi> <mi>p</mi> </msub> <mo>-</mo> <mfrac> <mrow> <msub> <mi>J</mi> <mrow> <mi>p</mi> <mi>y</mi> </mrow> </msub> <msubsup> <mi>&omega;</mi> <mrow> <mi>n</mi> <mi>p</mi> <mi>y</mi> </mrow> <mi>p</mi> </msubsup> <mrow> <mo>(</mo> <msubsup> <mi>&omega;</mi> <mrow> <mi>n</mi> <mi>a</mi> <mi>x</mi> </mrow> <mi>a</mi> </msubsup> <mo>-</mo> <msub> <mover> <mi>&theta;</mi> <mo>&CenterDot;</mo> </mover> <mi>p</mi> </msub> <mo>)</mo> </mrow> <msup> <mi>cos</mi> <mn>2</mn> </msup> <msub> <mi>&theta;</mi> <mi>p</mi> </msub> </mrow> <msub> <mi>J</mi> <mn>3</mn> </msub> </mfrac> <mo>+</mo> <mfrac> <mrow> <msub> <mi>NK</mi> <mi>t</mi> </msub> <msub> <mi>cos&theta;</mi> <mi>p</mi> </msub> </mrow> <mrow> <msub> <mi>J</mi> <mn>3</mn> </msub> <msub> <mi>R</mi> <mi>m</mi> </msub> </mrow> </mfrac> <msub> <mi>u</mi> <mi>p</mi> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>-</mo> <mfrac> <mrow> <msub> <mi>J</mi> <mrow> <mi>p</mi> <mi>y</mi> </mrow> </msub> <msubsup> <mover> <mi>&omega;</mi> <mo>&CenterDot;</mo> </mover> <mrow> <mi>n</mi> <mi>p</mi> <mi>y</mi> </mrow> <mi>p</mi> </msubsup> <msub> <mi>sin&theta;</mi> <mi>p</mi> </msub> <msub> <mi>cos&theta;</mi> <mi>p</mi> </msub> <mo>+</mo> <msub> <mi>J</mi> <mn>2</mn> </msub> <msubsup> <mover> <mi>&omega;</mi> <mo>&CenterDot;</mo> </mover> <mrow> <mi>n</mi> <mi>a</mi> <mi>y</mi> </mrow> <mi>a</mi> </msubsup> <msub> <mi>sin&theta;</mi> <mi>p</mi> </msub> <mo>+</mo> <msub> <mi>J</mi> <mn>2</mn> </msub> <msubsup> <mi>&omega;</mi> <mrow> <mi>n</mi> <mi>a</mi> <mi>y</mi> </mrow> <mi>a</mi> </msubsup> <msub> <mover> <mi>&theta;</mi> <mo>&CenterDot;</mo> </mover> <mi>p</mi> </msub> <msub> <mi>cos&theta;</mi> <mi>p</mi> </msub> </mrow> <msub> <mi>J</mi> <mn>3</mn> </msub> </mfrac> </mrow> </mtd> </mtr> </mtable> </mfenced>

其中,和分别为遥感载荷视轴在地理坐标下的俯仰角和方位角,通过
高精度自动驾驶仪测量得到,表示俯仰框相对地理系的x,y,z方
向的角速?#21097;?#34920;示方位框相对地理系的x,y,z方向的角速?#21097;?br />通过高精度自动驾驶仪和码盘计算得到,为运动载体的角速度信息,由
运动载体提供,Jpx,Jpy,Jpz表示俯仰框x,y,z方向的转动惯量,Jax,Jay,Jaz表示方
位框x,y,z方向的转动惯量;θp表示俯仰框相对方位框的转角,由码盘测量得
到,Jm表示电机的转动惯量,J1=Jpx+N2Jm,J3=Jaz+N2Jm+Jpzcos2θp,N表
示电机传动比,Ke表示反电动势常数,Kt表示电机力矩系数;Rm表示电机
电阻,Lm表示电机电感,up,ua分别表示俯仰和方位框电机输入电压,Tdm表
示电机干扰力矩,Tda表示作用到方位框架?#31995;?#24178;扰力矩;

两轴吊舱惯性稳定平台动力学输入为俯仰框架和方位框架的电机输入
电压,输出为遥感载荷视轴在地理坐标系的俯仰和方位角度和角速度变化
量,从而基于遥感载荷期望角度与实际测量角度的误差值,通过PID控制方
法产生俯仰框和方位框的驱动命令,在线调整俯仰框和方位框实现遥感载荷
视轴的调整。

本发明的原理是?#21644;?#36807;安装在两轴吊舱系统俯仰框的高精度自动驾驶
仪,实时获得遥感载荷视轴在地理坐标系下的俯仰和方位的绝对角度,通过
框架?#25104;?#20851;系建立基于地理坐标系的两轴吊舱惯性稳定平台动力学方程,以
俯仰框和方位框的电机电压为输入,遥感载荷视轴地理坐标系下的俯仰和方
位角度为被控对象,实时调控两轴吊舱惯性稳定平台地理坐标系下视轴指
向,实现全自主控制。

本发明与现有技术相比的优点在于:

(1)本发明提出的基于地理坐标系指向控制的两轴吊舱系统,直接
以遥感载荷视轴在地理坐标系下的俯仰和方位的绝对角度为
被控对象,有效隔离飞行载体非理想姿态干扰对视轴的影响,
控制精度高,抗干扰能力强;

(2)本发明提出的基于地理坐标系指向控制的两轴吊舱稳定平台,
通过安装在两轴吊舱俯仰框的高精度自动驾驶仪,实时获得
遥感载荷视轴在地理坐标系下的位置信息,基于目标对象与
遥感载荷视轴的绝对位置信息,可以全自主的实时规划遥感
载荷视轴的调节角度,在大范围多目标跟踪过程中无需人工
参与,智能性强。

附图说明

图1为本发明的结构组成框图;

图2为本发明的俯仰方向控制精度图;

图3为本发明的方位方向控制精度图;

具体实施方式

如图1所示,本发明主要包括两轴吊舱结构系统(1)、测控单元(2)、
传输系统(3)和地面监控站(4),测控单元(2)和传输系统(3)安装
与两轴吊舱结构系统(1)上;

两轴吊舱结构系统(1)由基板(11)、方位框(12)和俯仰框(13)
构成,基板(11)作为两轴吊舱系统与运动载体的过渡?#26041;冢?#36890;过减震器固
连于两轴吊舱系统和运动载体之间,隔离运动载体的非理想高频运动干扰,
方位框(12)作为两轴吊舱系统的最外环,承载俯仰框系统,实现两轴吊舱
系统方位方向的旋转,进而影响遥感载荷视轴在地理坐标系下方位方向的偏
转,俯仰框(13)作为两轴吊舱的最内环,承载高精度自动驾驶仪和遥感载
荷,实现两轴吊舱系统俯仰方向的旋转,进而影响遥感载荷视轴在地理坐标
系下俯仰方向的偏转;

测控单元(2)由高精度自动驾驶仪(21)、码盘(22)、俯仰电机驱
动板(23)和方位电机驱动板(24)构成,高精度自动驾驶仪(21)由惯
性自动驾驶仪(IMU)、全球定位系统(GPS)接收机、磁罗盘、气压高度
计、控制板构成,惯性自动驾驶仪(IMU)提供姿态信息,全球定位系统(GPS)
提供位置信息,磁罗盘提供航向信息,气压高度计提供高度信息,控制板负
责采集传感器提供的测量信息,并通过捷联解算和卡尔曼滤波实时获得高精
度自动驾驶仪(21)所在安装平面的地理坐标下的位置、姿态、角速度信息,
码盘(22)分别安装在俯仰框架和方位框架旋转轴上,提供框架间的相对角
度信息,测量功能通过高精度自动驾驶仪(21)和码盘(22)实现,不需
要陀螺和加速度计传感器,通过在两轴吊舱的俯仰框设?#30772;?#38754;工装,将高精
度自动驾驶仪(21)和遥感载荷固定于同一基准面,测量轴系相互平行,从
而高精度自动驾驶仪可以提供遥感载荷视轴在地理坐标系的指向角度,对遥
感载荷视轴在地理坐标系的偏差提供绝对基准,俯仰框和方位框相对于地理
系的角速度数据通过高精度自动驾驶仪和码盘计算得到;

俯仰电机驱动板和电机(23)接收高精度自动驾驶仪(21)产生的PWM
信号,驱动俯仰框电机进行转动,方位电机驱动板和电机(24)接收高精度
自动驾驶仪(21)产生的PWM信号,驱动方位框电机进行转动;

控制功能基于地理坐标系的两轴吊舱惯性稳定平台动力学方程如下

<mrow> <msubsup> <mover> <mi>&theta;</mi> <mo>&CenterDot;</mo> </mover> <mrow> <mi>n</mi> <mi>p</mi> <mi>x</mi> </mrow> <mi>p</mi> </msubsup> <mo>=</mo> <msubsup> <mi>&omega;</mi> <mrow> <mi>n</mi> <mi>p</mi> <mi>x</mi> </mrow> <mi>p</mi> </msubsup> </mrow>

<mrow> <msubsup> <mover> <mi>&omega;</mi> <mo>&CenterDot;</mo> </mover> <mrow> <mi>n</mi> <mi>p</mi> <mi>x</mi> </mrow> <mi>p</mi> </msubsup> <mo>=</mo> <mfrac> <mrow> <msub> <mi>K</mi> <mi>t</mi> </msub> <msub> <mi>K</mi> <mi>e</mi> </msub> <msup> <mi>N</mi> <mn>2</mn> </msup> <mrow> <mo>(</mo> <msubsup> <mi>&omega;</mi> <mrow> <mi>n</mi> <mi>a</mi> <mi>x</mi> </mrow> <mi>p</mi> </msubsup> <mo>-</mo> <msubsup> <mi>&omega;</mi> <mrow> <mi>n</mi> <mi>p</mi> <mi>x</mi> </mrow> <mi>p</mi> </msubsup> <mo>)</mo> </mrow> <mo>+</mo> <mi>N</mi> <mrow> <mo>(</mo> <mi>N</mi> <mo>-</mo> <mn>1</mn> <mo>)</mo> </mrow> <msub> <mi>R</mi> <mi>m</mi> </msub> <msub> <mi>J</mi> <mi>m</mi> </msub> <msubsup> <mover> <mi>&omega;</mi> <mo>&CenterDot;</mo> </mover> <mrow> <mi>n</mi> <mi>a</mi> <mi>x</mi> </mrow> <mi>p</mi> </msubsup> </mrow> <mrow> <msub> <mi>J</mi> <mn>1</mn> </msub> <msub> <mi>R</mi> <mi>m</mi> </msub> </mrow> </mfrac> <mo>-</mo> <mfrac> <mrow> <mo>(</mo> <msub> <mi>J</mi> <mrow> <mi>p</mi> <mi>z</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>J</mi> <mrow> <mi>p</mi> <mi>y</mi> </mrow> </msub> <mo>)</mo> <msubsup> <mi>&omega;</mi> <mrow> <mi>n</mi> <mi>p</mi> <mi>y</mi> </mrow> <mi>p</mi> </msubsup> <msubsup> <mi>&omega;</mi> <mrow> <mi>n</mi> <mi>p</mi> <mi>z</mi> </mrow> <mi>p</mi> </msubsup> </mrow> <msub> <mi>J</mi> <mn>1</mn> </msub> </mfrac> <mo>+</mo> <mfrac> <mrow> <msub> <mi>NK</mi> <mi>t</mi> </msub> <msub> <mi>u</mi> <mi>p</mi> </msub> </mrow> <mrow> <msub> <mi>J</mi> <mn>1</mn> </msub> <msub> <mi>R</mi> <mi>m</mi> </msub> </mrow> </mfrac> <mo>+</mo> <mfrac> <mrow> <msub> <mi>NT</mi> <mrow> <mi>d</mi> <mi>m</mi> </mrow> </msub> <mo>+</mo> <msub> <mi>T</mi> <mrow> <mi>d</mi> <mi>p</mi> </mrow> </msub> </mrow> <msub> <mi>J</mi> <mn>1</mn> </msub> </mfrac> </mrow>

<mrow> <msubsup> <mover> <mi>&theta;</mi> <mo>&CenterDot;</mo> </mover> <mrow> <mi>n</mi> <mi>p</mi> <mi>z</mi> </mrow> <mi>p</mi> </msubsup> <mo>=</mo> <msubsup> <mi>&omega;</mi> <mrow> <mi>n</mi> <mi>p</mi> <mi>z</mi> </mrow> <mi>p</mi> </msubsup> </mrow>

<mfenced open = "" close = ""> <mtable> <mtr> <mtd> <mrow> <msubsup> <mover> <mi>&omega;</mi> <mo>&CenterDot;</mo> </mover> <mrow> <mi>n</mi> <mi>p</mi> <mi>z</mi> </mrow> <mi>p</mi> </msubsup> <mo>=</mo> <mfrac> <mrow> <msub> <mi>J</mi> <mrow> <mi>p</mi> <mi>z</mi> </mrow> </msub> <msubsup> <mi>&omega;</mi> <mrow> <mi>n</mi> <mi>p</mi> <mi>z</mi> </mrow> <mi>p</mi> </msubsup> <mrow> <mo>(</mo> <msub> <mover> <mi>&theta;</mi> <mo>&CenterDot;</mo> </mover> <mi>p</mi> </msub> <mo>+</mo> <msubsup> <mi>&omega;</mi> <mrow> <mi>n</mi> <mi>a</mi> <mi>x</mi> </mrow> <mi>a</mi> </msubsup> <mo>)</mo> </mrow> <mi>sin</mi> <mn>2</mn> <msub> <mi>&theta;</mi> <mi>p</mi> </msub> </mrow> <mrow> <mn>2</mn> <msub> <mi>J</mi> <mn>3</mn> </msub> </mrow> </mfrac> <mo>-</mo> <mfrac> <mrow> <msub> <mi>J</mi> <mn>2</mn> </msub> <msubsup> <mi>&omega;</mi> <mrow> <mi>n</mi> <mi>a</mi> <mi>z</mi> </mrow> <mi>a</mi> </msubsup> <msub> <mover> <mi>&theta;</mi> <mo>&CenterDot;</mo> </mover> <mi>p</mi> </msub> <msub> <mi>sin&theta;</mi> <mi>p</mi> </msub> </mrow> <msub> <mi>J</mi> <mn>3</mn> </msub> </mfrac> <mo>+</mo> <mfrac> <mrow> <msub> <mi>NT</mi> <mrow> <mi>d</mi> <mi>m</mi> </mrow> </msub> <mo>+</mo> <msub> <mi>T</mi> <mrow> <mi>d</mi> <mi>a</mi> </mrow> </msub> </mrow> <msub> <mi>J</mi> <mn>3</mn> </msub> </mfrac> <msub> <mi>cos&theta;</mi> <mi>p</mi> </msub> <mo>+</mo> <mfrac> <mrow> <msub> <mi>J</mi> <mrow> <mi>p</mi> <mi>x</mi> </mrow> </msub> <msubsup> <mi>&omega;</mi> <mrow> <mi>n</mi> <mi>p</mi> <mi>x</mi> </mrow> <mi>p</mi> </msubsup> <mo>-</mo> <mrow> <mo>(</mo> <msub> <mi>J</mi> <mrow> <mi>a</mi> <mi>y</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>J</mi> <mrow> <mi>a</mi> <mi>x</mi> </mrow> </msub> <mo>)</mo> </mrow> <msubsup> <mi>&omega;</mi> <mrow> <mi>n</mi> <mi>a</mi> <mi>x</mi> </mrow> <mi>a</mi> </msubsup> </mrow> <msub> <mi>J</mi> <mn>3</mn> </msub> </mfrac> <msubsup> <mi>&omega;</mi> <mrow> <mi>n</mi> <mi>a</mi> <mi>y</mi> </mrow> <mi>a</mi> </msubsup> <msub> <mi>cos&theta;</mi> <mi>p</mi> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>+</mo> <mfrac> <mrow> <msub> <mi>K</mi> <mi>t</mi> </msub> <msub> <mi>K</mi> <mi>e</mi> </msub> <msup> <mi>N</mi> <mn>2</mn> </msup> <mrow> <mo>(</mo> <msubsup> <mi>&omega;</mi> <mrow> <mi>n</mi> <mi>b</mi> <mi>z</mi> </mrow> <mi>a</mi> </msubsup> <mo>-</mo> <msubsup> <mi>&omega;</mi> <mrow> <mi>n</mi> <mi>a</mi> <mi>z</mi> </mrow> <mi>a</mi> </msubsup> <mo>)</mo> </mrow> <mo>+</mo> <mi>N</mi> <mrow> <mo>(</mo> <mi>N</mi> <mo>-</mo> <mn>1</mn> <mo>)</mo> </mrow> <msub> <mi>R</mi> <mi>m</mi> </msub> <msub> <mi>J</mi> <mi>m</mi> </msub> <msubsup> <mover> <mi>&omega;</mi> <mo>&CenterDot;</mo> </mover> <mrow> <mi>n</mi> <mi>b</mi> <mi>z</mi> </mrow> <mi>a</mi> </msubsup> </mrow> <mrow> <msub> <mi>J</mi> <mn>3</mn> </msub> <msub> <mi>R</mi> <mi>m</mi> </msub> </mrow> </mfrac> <msub> <mi>cos&theta;</mi> <mi>p</mi> </msub> <mo>-</mo> <mfrac> <mrow> <msub> <mi>J</mi> <mrow> <mi>p</mi> <mi>y</mi> </mrow> </msub> <msubsup> <mi>&omega;</mi> <mrow> <mi>n</mi> <mi>p</mi> <mi>y</mi> </mrow> <mi>p</mi> </msubsup> <mrow> <mo>(</mo> <msubsup> <mi>&omega;</mi> <mrow> <mi>n</mi> <mi>a</mi> <mi>x</mi> </mrow> <mi>a</mi> </msubsup> <mo>-</mo> <msub> <mover> <mi>&theta;</mi> <mo>&CenterDot;</mo> </mover> <mi>p</mi> </msub> <mo>)</mo> </mrow> <msup> <mi>cos</mi> <mn>2</mn> </msup> <msub> <mi>&theta;</mi> <mi>p</mi> </msub> </mrow> <msub> <mi>J</mi> <mn>3</mn> </msub> </mfrac> <mo>+</mo> <mfrac> <mrow> <msub> <mi>NK</mi> <mi>t</mi> </msub> <msub> <mi>cos&theta;</mi> <mi>p</mi> </msub> </mrow> <mrow> <msub> <mi>J</mi> <mn>3</mn> </msub> <msub> <mi>R</mi> <mi>m</mi> </msub> </mrow> </mfrac> <msub> <mi>u</mi> <mi>p</mi> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>-</mo> <mfrac> <mrow> <msub> <mi>J</mi> <mrow> <mi>p</mi> <mi>y</mi> </mrow> </msub> <msubsup> <mover> <mi>&omega;</mi> <mo>&CenterDot;</mo> </mover> <mrow> <mi>n</mi> <mi>p</mi> <mi>y</mi> </mrow> <mi>p</mi> </msubsup> <msub> <mi>sin&theta;</mi> <mi>p</mi> </msub> <msub> <mi>cos&theta;</mi> <mi>p</mi> </msub> <mo>+</mo> <msub> <mi>J</mi> <mn>2</mn> </msub> <msubsup> <mover> <mi>&omega;</mi> <mo>&CenterDot;</mo> </mover> <mrow> <mi>n</mi> <mi>a</mi> <mi>y</mi> </mrow> <mi>a</mi> </msubsup> <msub> <mi>sin&theta;</mi> <mi>p</mi> </msub> <mo>+</mo> <msub> <mi>J</mi> <mn>2</mn> </msub> <msubsup> <mi>&omega;</mi> <mrow> <mi>n</mi> <mi>a</mi> <mi>y</mi> </mrow> <mi>a</mi> </msubsup> <msub> <mover> <mi>&theta;</mi> <mo>&CenterDot;</mo> </mover> <mi>p</mi> </msub> <msub> <mi>cos&theta;</mi> <mi>p</mi> </msub> </mrow> <msub> <mi>J</mi> <mn>3</mn> </msub> </mfrac> </mrow> </mtd> </mtr> </mtable> </mfenced>

其中,和分别为遥感载荷视轴在地理坐标下的俯仰角和方位角,通过
高精度自动驾驶仪测量得到,表示俯仰框相对地理系的x,y,z方
向的角速?#21097;?#34920;示方位框相对地理系的x,y,z方向的角速?#21097;?br />通过高精度自动驾驶仪和码盘计算得到,为运动载体的角速度信息,由
运动载体提供,Jpx,Jpy,Jpz表示俯仰框x,y,z方向的转动惯量,Jax,Jay,Jaz表示方
位框x,y,z方向的转动惯量;θp表示俯仰框相对方位框的转角,由码盘测量得
到,Jm表示电机的转动惯量,J1=Jpx+N2Jm,J3=Jaz+N2Jm+Jpzcos2θp,N表
示电机传动比,Ke表示反电动势常数,Kt表示电机力矩系数;Rm表示电机
电阻,Lm表示电机电感,up,ua分别表示俯仰和方位框电机输入电压,Tdm表
示电机干扰力矩,Tda表示作用到方位框架?#31995;?#24178;扰力矩;

两轴吊舱惯性稳定平台动力学输入为俯仰框架和方位框架的电机输入
电压,输出为遥感载荷视轴在地理坐标系的俯仰和方位角速度变化量,从而
基于遥感载荷期望角度与实际测量角度的误差值,通过PID控制方法产生俯
仰框和方位框的驱动命令PWM信号,俯仰电机驱动板(23)接收高精度自
动驾驶仪(21)产生的PWM信号,从而进一步驱动俯仰框电机进行运动;
方位电机驱动板(24)接收高精度自动驾驶仪(21)产生的PWM信号,从
而驱动方位框电机进行运动,通过框架的转动在线调整俯仰框和方位框实现
遥感载荷视轴的调整;

传输系统(3)由数传电台(31)和图传电台(32)构成,数传电台(31)
由5V直流供电,载波频率为900MHz,将载荷视轴在俯仰和方位的角度、
俯仰和码盘的角度实时回传到地面控制终端;图传电台(32)由12V直流
供电,载波频率为1.2GHz,将载荷图像信息实时回传到地面控制终端;

地面监控站(4)由数传接收机(41)、图传接收机(42)和地面显示
终端(43)构成,数传接收机(41)接收数传电台(31)回传的载荷视轴
在俯仰和方位的角度、角速度和码盘的角度,并通过串口发送到地面显示终
端(43),图传电台(42)接收图传电台(32)回传的遥感载荷图像信息,
并通过串口发送到地面显示终端(43),地面显示终端(43)接收数传电
台和图传电台的信息进行实时显示,并根据任务需求向两轴吊舱系统发送控
制指令。

为验证基于地理坐标系指向控制的两轴吊舱系统控制性能,进行了相应
的飞行测试,通过高精度自动驾驶仪的输出数据与期望角度之间的关系来评
估系统的性能,某次实验的飞行结果如图2、图3所示。

基于地理坐标系指向控制的两轴吊舱系统在地理坐标系下实现?#23435;?#23450;
的控制,俯仰方向的标准差是0.021度,调节时间为1.1秒,方位方向的标
准差是0.018,调节时间为0.4秒。

本发明基于地理坐标系指向控制的两轴吊舱系统克服了现有两轴吊舱
系统地不足,有效的隔离飞行载体非理想姿态干扰对视轴的影响,实现遥感
载荷视轴在地理坐标系下的俯仰和方位的高精度控制。

本发明说明书中未作详细描述的内容属于本领域专业技术人员公知的
现有技术。

关于本文
本文标题:一种基于地理坐标系指向控制的两轴吊舱系统.pdf
链接地址:http://www.pqiex.tw/p-5837632.html
关于我们 - 网站声明 - 网站地图 - 资源地图 - 友情链接 - 网站客服 - 联系我们

[email protected] 2017-2018 zhuanlichaxun.net网站版权所有
经营许可证编号:粤ICP备17046363号-1 
 


收起
展开
平码五不中公式规律 彩票哥 网球王子之英雄系统 北京赛车pk10免费软件 江苏时时彩代理公司 事后分析 贵州茅台股票分析论文 排列五走势图带坐标 福建时时彩11选5玩法 贵州十一选五走势图解 真人龙虎斗攻略