CN110362120B - 一种二维扫描宽幅成像平台扫描控制方法 - Google Patents
一种二维扫描宽幅成像平台扫描控制方法 Download PDFInfo
- Publication number
- CN110362120B CN110362120B CN201910673972.XA CN201910673972A CN110362120B CN 110362120 B CN110362120 B CN 110362120B CN 201910673972 A CN201910673972 A CN 201910673972A CN 110362120 B CN110362120 B CN 110362120B
- Authority
- CN
- China
- Prior art keywords
- scanning
- coordinate system
- wide
- local horizontal
- los
- 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.)
- Active
Links
- 238000003384 imaging method Methods 0.000 title claims abstract description 43
- 238000000034 method Methods 0.000 title claims abstract description 21
- 239000011159 matrix material Substances 0.000 claims description 16
- 238000005096 rolling process Methods 0.000 claims description 16
- 230000000007 visual effect Effects 0.000 claims description 15
- 230000009466 transformation Effects 0.000 claims description 14
- 238000010408 sweeping Methods 0.000 claims description 3
- 238000005259 measurement Methods 0.000 claims description 2
- 230000003287 optical effect Effects 0.000 claims 3
- 238000013507 mapping Methods 0.000 claims 1
- 230000006641 stabilisation Effects 0.000 abstract 1
- 238000011105 stabilization Methods 0.000 abstract 1
- 230000015572 biosynthetic process Effects 0.000 description 6
- 238000003786 synthesis reaction Methods 0.000 description 6
- 230000009123 feedback regulation Effects 0.000 description 4
- 238000005070 sampling Methods 0.000 description 4
- 230000009286 beneficial effect Effects 0.000 description 3
- 238000010586 diagram Methods 0.000 description 3
- 238000004364 calculation method Methods 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 238000000354 decomposition reaction Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D13/00—Control of linear speed; Control of angular speed; Control of acceleration or deceleration, e.g. of a prime mover
- G05D13/62—Control of linear speed; Control of angular speed; Control of acceleration or deceleration, e.g. of a prime mover characterised by the use of electric means, e.g. use of a tachometric dynamo, use of a transducer converting an electric value into a displacement
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D3/00—Control of position or direction
- G05D3/12—Control of position or direction using feedback
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种二维扫描宽幅成像平台扫描控制方法。该方法根据宽幅成图区间范围要求,在实时飞行状态下,根据飞行速度姿态解算,实时合成二维扫描稳定平台外横滚框和内俯仰框的扫描指令角度,利用合成的指令,以横滚编码器、俯仰编码器为反馈,控制二维扫描平台转动,可完成指定角度范围的宽幅摆扫。本发明具有指令解算简单、精度高,适用于航空宽幅成像二维扫描稳定平台。
Description
技术领域
本发明涉及一种面阵宽幅成像二维扫描宽幅成像平台扫描控制方法。
背景技术
目前,国内宽幅成像多采用镜头拼接技术,利用面阵摆扫实现宽幅成图的技术较少。现有的面阵宽幅摆扫稳定平台,生成的是欧拉速度扫描指令,无法直接与测量反馈元件比较完成控制,需要经过复杂的转换,且不利于扫描条带间的对齐,不利于后期图像处理及三维成图。
发明内容
本发明提出了一种二维扫描宽幅成像平台新的扫描控制方法,解决了现有技术控制算法复杂、不利于后期图像处理及三维成图等问题。
本发明的原理是:
1、参见图3,对于成像条带上的任意位置点A,取当地水平扫描系M(L)为基准,均可以通过两次欧拉角转动实现:旋转分两步进行,将任意点A向当地M系(L系)俯仰轴所在铅锤面与地平面交线OX上投影得到A2点,先沿M系横滚轴旋转横滚角到A2点,再沿着当前俯仰轴旋转俯仰角θLos由A2到A点,完成旋转。由此可得当地M系(L系)与期望LOS的关系。
2、结合M系(L系)与基座B系的关系,可以得到LOS在B系的坐标,进而求得指令角度。
3、扫描指令由两部分决定:一方面由扫描幅宽及扫描周期决定,另一方面受飞行载体与目标条带的相对运动影响。其中飞行载体与目标的相对运动包括两部分,飞行器的飞行运动及目标条带的运动(地球自转);
其中飞行运动分量为:
根据扫描周期选择是否考虑地球自转的影响:如果扫描周期短,地球自转运动在扫描周期内影响较小,通常可忽略,如案例一;如果扫描周期较长,地球自转运动在扫描周期内影响不可忽略,如案例二。根据当前宽幅成图区间范围α、扫描周期T要求,将飞行载体与目标条带的相对运动加以修正,得到扫描周期内各个时刻期望视轴LOS相对当地水平扫描系的横滚、俯仰欧拉角:
或
基于此,本发明的技术解决方案如下:
该二维扫描宽幅成像平台扫描控制方法,所述二维扫描宽幅成像平台包括外横滚框和内俯仰框,光电载荷搭载内俯仰框上;外横滚框由横滚电机驱动,并配置有横滚编码器;内俯仰框由俯仰电机驱动,并配置有俯仰编码器;该控制方法包括:在实时飞行状态下,根据当前宽幅成图区间范围α、扫描周期T要求,测量当前飞行速度及姿态,取当地水平扫描坐标系为基准,得到扫描周期内各时刻期望视轴LOS与当地水平扫描坐标系的关系,再结合当地水平扫描坐标系与二维扫描宽幅成像平台基座坐标系的关系,得到期望视轴LOS在二维扫描宽幅成像平台基座坐标系中的坐标,进而求得二维扫描宽幅成像平台的外横滚框指令角度θo和内俯仰框指令角度θi,并以横滚编码器、俯仰编码器的信号为反馈构成位置回路,位置回路输出为速度指令;安装于内俯仰框的两轴陀螺反馈速度信号构成速度回路,控制横滚电机和俯仰电机转动,实现指定角度范围的宽幅摆扫。
本发明具有以下优点:
扫描指令解算简单、精度高,合成的角度指令可直接与反馈元件比较实现闭环控制。
以当地水平扫描坐标系为基准,不要求扫描过程中载机的航向与扫描条带垂直;扫描条带整齐,不会因扫描过程中载机航向变化造成条带偏转。
附图说明:
图1为本发明实施例一的示意图。
图2为本发明实施例二的示意图。
图3为成图条带上任意位置LOS两步旋转运动分解。
图4为二维扫描宽幅成像平台控制原理框图。
具体实施方式:
以下结合附图和实施例作进一步详述。
实施例一,参见图1:
1)设宽幅扫描成图角度-50°~+10°,每个扫描条带周期为3s,可以算得扫描角速率为
7)根据采集数据计算当前时刻飞行速度在当地水平扫描系M中的速度分量
8)将采样时间内增量与上一时刻结果相加,得到当前采样时刻的期望视轴LOS相对当地水平扫描系的欧拉角
11)进而得到当前时刻外横滚框指令角度θo、内俯仰框指令角度θi;
12)由步骤11得到控制指令,横滚框编码器、俯仰编码器为实时反馈,比较控制二维扫描宽幅成像平台转动;
13)从0时刻到扫描周期3秒,重复步骤3-12,完成一个扫描条带扫描指令的合成以及反馈调节。
完成第一个条带扫描后,第二个扫描条带开始,t=0,横滚欧拉角初值俯仰欧拉角初值θLos=0°,ωFOV取为-20°/s,从0时刻到扫描周期3秒,按照步骤3-13,完成第二个扫描条带扫描指令的合成以及反馈调节。
周期性重复步骤完成多个扫描条带扫描指令的合成以及反馈调节。
实施例二,参见图2:
1)设宽幅扫描成图角度-50°~+10°,每个扫描条带周期为3s,可以算得扫描角速率为
3)取采样时间Δts=100ms,每100ms同步采集安装在二维扫描宽幅成像平台基座上的POS系统输出的位置和姿态数据,包括偏航角俯仰角θ、横滚角北东地速度向量经度log、纬度lat、高度h,以及俯仰内框内激光测距机所测量数据RLOS。
6)根据采集数据计算当前时刻地球坐标系E到地理坐标系N变换矩阵
7)根据采集数据计算当前时刻飞行速度在当地水平系L中的速度分量。
8)根据采集数据计算当前时刻地球自转速度在当地水平系L中的速度分量。
9)将采样时间内增量与上一时刻结果相加,得到当前采样时刻的期望视轴LOS相对当地水平系的欧拉角。
11)由步骤5、10可以算得LOS在基座系的坐标
12)由步骤11可以得到当前时刻外横滚框指令角度θo、内俯仰框指令角度θi。
13)由步骤12得到控制指令,横滚框编码器、俯仰编码器为实时反馈,比较控制二维扫描宽幅成像平台转动。
14)从0时刻到扫描周期3秒,重复步骤2-13,完成第一个扫描条带扫描指令的合成以及反馈调节。
完成第一个条带扫描后,第二个扫描条带开始,t=0,横滚欧拉角初值俯仰欧拉角初值θLos=0°,ωFOV取为-20°/s,从0时刻到扫描周期3秒,重复步骤2-14,完成第二个扫描条带扫描指令的合成以及反馈调节。
周期性重复完成多个扫描条带扫描指令的合成以及反馈调节。
如图4所示,本发明根据宽幅成图幅宽要求,结合当前飞行速度及姿态解算,实时合成二维扫描宽幅成像平台外横滚框和内俯仰框的扫描指令角度,以横滚编码器、俯仰编码器的信号为反馈构成位置回路,位置回路输出为速度指令;安装于内俯仰框的两轴陀螺反馈速度信号构成速度回路,控制横滚电机(外框)和俯仰电机(内框)转动,实现指定角度范围的宽幅摆扫。
Claims (6)
1.一种二维扫描宽幅成像平台扫描控制方法,所述二维扫描宽幅成像平台包括外横滚框和内俯仰框,光电载荷搭载内俯仰框上;外横滚框由横滚电机驱动,并配置有横滚编码器;内俯仰框由俯仰电机驱动,并配置有俯仰编码器;其特征在于:该控制方法包括:
在实时飞行状态下,根据当前宽幅成图区间范围α、扫描周期T要求,测量当前飞行速度及姿态;
取当地水平扫描坐标系为基准,得到扫描周期内各时刻期望视轴LOS与当地水平扫描坐标系的关系;
再结合当地水平扫描坐标系与二维扫描宽幅成像平台基座坐标系的关系,得到期望视轴LOS在二维扫描宽幅成像平台基座坐标系中的坐标;
进而求得二维扫描宽幅成像平台的外横滚框指令角度θo和内俯仰框指令角度θi,并以横滚编码器、俯仰编码器的信号为反馈构成位置回路,位置回路输出为速度指令;
安装于内俯仰框的两轴陀螺反馈速度信号构成速度回路,控制横滚电机和俯仰电机转动,实现指定角度范围的宽幅摆扫。
2.根据权利要求1所述的二维扫描宽幅成像平台扫描控制方法,其特征在于:解算外横滚框指令角度θo和内俯仰框指令角度θi的具体步骤如下:
4)得到当前飞行速度在当地水平扫描坐标系M中的速度分量:
5)根据当前宽幅成图区间范围α、扫描周期T要求,得到扫描周期内各时刻期望视轴LOS相对当地水平扫描坐标系M的横滚、俯仰欧拉角:
式中,RLOS为光轴到目标的距离;
7)计算期望LOS在二维扫描宽幅成像平台基座坐标系B的坐标
8)最终得到外横滚框指令角度θo、内俯仰框指令角度θi:
3.根据权利要求1所述的二维扫描宽幅成像平台扫描控制方法,其特征在于:解算外横滚框指令角度θo和内俯仰框指令角度θi的具体步骤如下:
4)得到地球坐标系E到地理坐标系N的变换矩阵:
5)得到当前飞行速度在当地水平扫描坐标系L中的速度分量:
6)得到地球自转速度在当地水平扫描坐标系L中的速度分量:
7)根据当前宽幅成图区间范围α、扫描周期T要求,得到扫描周期内当前时刻期望视轴LOS相对当地水平扫描坐标系L的横滚、俯仰欧拉角:
式中,RLOS为光轴到目标的距离;
9)计算期望LOS在二维扫描宽幅成像平台基座坐标系B的坐标:
10)最终得到外横滚框指令角度θo、内俯仰框指令角度θi:
4.根据权利要求2或3所述的二维扫描宽幅成像平台扫描控制方法,其特征在于:步骤1)的测量信息均通过安装在二维扫描宽幅成像平台基座上的POS系统获得。
5.根据权利要求2或3所述的二维扫描宽幅成像平台扫描控制方法,其特征在于:所述光轴到目标的距离RLOS由安装于内俯仰框的激光测距机测得。
6.根据权利要求2或3所述的二维扫描宽幅成像平台扫描控制方法,其特征在于:所述地理坐标系N采用北东地系。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910673972.XA CN110362120B (zh) | 2019-07-24 | 2019-07-24 | 一种二维扫描宽幅成像平台扫描控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910673972.XA CN110362120B (zh) | 2019-07-24 | 2019-07-24 | 一种二维扫描宽幅成像平台扫描控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110362120A CN110362120A (zh) | 2019-10-22 |
CN110362120B true CN110362120B (zh) | 2021-01-15 |
Family
ID=68220736
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910673972.XA Active CN110362120B (zh) | 2019-07-24 | 2019-07-24 | 一种二维扫描宽幅成像平台扫描控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110362120B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111272146B (zh) * | 2020-01-17 | 2021-06-15 | 中国科学院长春光学精密机械与物理研究所 | 测绘仪器、测绘方法及装置、终端设备、存储介质 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102865858A (zh) * | 2012-09-07 | 2013-01-09 | 中国科学院长春光学精密机械与物理研究所 | 一种空间光学双相机连续成像的匀速摆扫运动的装置 |
CN103914083A (zh) * | 2014-03-28 | 2014-07-09 | 中国科学院上海技术物理研究所 | 复合稳定平台功能的宽视场成像结构及其控制方法 |
CN105182436A (zh) * | 2015-09-07 | 2015-12-23 | 南京华图信息技术有限公司 | 一种全光学波段图谱协同探测动目标的装置和方法 |
CN106527457A (zh) * | 2016-11-17 | 2017-03-22 | 天津津航技术物理研究所 | 航空扫描仪扫描控制指令规划方法 |
CN109578759A (zh) * | 2019-01-25 | 2019-04-05 | 吉林大学 | 一种被动减振的非球面镜头推扫摆扫型航空相机 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104865972A (zh) * | 2015-06-02 | 2015-08-26 | 中国科学院上海技术物理研究所 | 一种基于实时视轴跟踪的像移补偿结构 |
CN108107920A (zh) * | 2017-12-19 | 2018-06-01 | 天津工业大学 | 一种微小型双轴视觉稳定云台目标探测跟踪系统 |
-
2019
- 2019-07-24 CN CN201910673972.XA patent/CN110362120B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102865858A (zh) * | 2012-09-07 | 2013-01-09 | 中国科学院长春光学精密机械与物理研究所 | 一种空间光学双相机连续成像的匀速摆扫运动的装置 |
CN103914083A (zh) * | 2014-03-28 | 2014-07-09 | 中国科学院上海技术物理研究所 | 复合稳定平台功能的宽视场成像结构及其控制方法 |
CN105182436A (zh) * | 2015-09-07 | 2015-12-23 | 南京华图信息技术有限公司 | 一种全光学波段图谱协同探测动目标的装置和方法 |
CN106527457A (zh) * | 2016-11-17 | 2017-03-22 | 天津津航技术物理研究所 | 航空扫描仪扫描控制指令规划方法 |
CN109578759A (zh) * | 2019-01-25 | 2019-04-05 | 吉林大学 | 一种被动减振的非球面镜头推扫摆扫型航空相机 |
Non-Patent Citations (3)
Title |
---|
The Effect Factors of the Line of Sight Jitter;Sansan Chang 等;《2017 9th International Conference on Intelligent Human-Machine Systems and Cybernetics (IHMSC)》;20170921;全文 * |
宽幅航空相机像移补偿和目标定位技术研究;杨洪涛;《中国博士学位论文全文数据库工程科技Ⅱ辑》;20190615;全文 * |
面阵摆扫宽幅成像技术研究;王义坤;《中国博士学位论文全文数据库工程科技Ⅱ辑》;20160115;第68-73页,图5.4,图5.11 * |
Also Published As
Publication number | Publication date |
---|---|
CN110362120A (zh) | 2019-10-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US10088332B2 (en) | Flight plan preparing method and flying vehicle guiding system | |
Stöcker et al. | Quality assessment of combined IMU/GNSS data for direct georeferencing in the context of UAV-based mapping | |
EP1019862B1 (en) | Method and apparatus for generating navigation data | |
GREJNER‐BRZEZINSKA | Direct exterior orientation of airborne imagery with GPS/INS system: Performance analysis | |
US7602415B2 (en) | Compensation for overflight velocity when stabilizing an airborne camera | |
US9409656B2 (en) | Aerial photographing system | |
US9927513B2 (en) | Method for determining the geographic coordinates of pixels in SAR images | |
US11099030B2 (en) | Attitude estimation apparatus, attitude estimation method, and observation system | |
KR100860771B1 (ko) | 지하 공간 및 차폐 구조물의 내부 공간정보 획득 시스템 | |
JP2017532798A (ja) | 遠隔画像の安定化及び表示 | |
CA2975758A1 (en) | Corridor capture | |
JP7123774B2 (ja) | 飛行装置制御システム | |
CN111426320A (zh) | 一种基于图像匹配/惯导/里程计的车辆自主导航方法 | |
CN110095659B (zh) | 深空探测巡视器通讯天线指向精度动态测试方法 | |
CN113720360A (zh) | 一种敏捷光学遥感卫星星/地相机夹角在轨标定方法 | |
CN110362120B (zh) | 一种二维扫描宽幅成像平台扫描控制方法 | |
CN109708667B (zh) | 一种基于激光陀螺的双动态目标跟踪引导方法 | |
Wu et al. | AFLI-Calib: Robust LiDAR-IMU extrinsic self-calibration based on adaptive frame length LiDAR odometry | |
CN114167900A (zh) | 一种基于无人机和差分gps的光电跟踪系统标校方法及装置 | |
JP2007033258A (ja) | 被観測対象物の観測方法及び装置 | |
CN109471102B (zh) | 一种惯组误差修正方法 | |
JP2009509125A (ja) | 画像に関連する位置を決定するための方法および装置 | |
JP2020071580A (ja) | 情報処理装置、飛行制御方法及び飛行制御システム | |
Tarasov | Calibration of the azimuth drive angle sensor of the mobile automated astronomical system by stars observation | |
CN116012444B (zh) | 一种动态像移补偿偏流曲线拟合方法 |
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 |