CN113607080B - 一种实现惯性空间扫描成像的方法及系统 - Google Patents

一种实现惯性空间扫描成像的方法及系统 Download PDF

Info

Publication number
CN113607080B
CN113607080B CN202110717040.8A CN202110717040A CN113607080B CN 113607080 B CN113607080 B CN 113607080B CN 202110717040 A CN202110717040 A CN 202110717040A CN 113607080 B CN113607080 B CN 113607080B
Authority
CN
China
Prior art keywords
decoupling
electromechanical
inertial
speed
gyro
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
Application number
CN202110717040.8A
Other languages
English (en)
Other versions
CN113607080A (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.)
Hunan Hongdong Photoelectric Co ltd
Original Assignee
Hunan Hongdong Photoelectric 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 Hunan Hongdong Photoelectric Co ltd filed Critical Hunan Hongdong Photoelectric Co ltd
Priority to CN202110717040.8A priority Critical patent/CN113607080B/zh
Publication of CN113607080A publication Critical patent/CN113607080A/zh
Application granted granted Critical
Publication of CN113607080B publication Critical patent/CN113607080B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
    • G01B11/00—Measuring arrangements characterised by the use of optical techniques
    • G01B11/24—Measuring arrangements characterised by the use of optical techniques for measuring contours or curvatures
    • G01B11/2433—Measuring arrangements characterised by the use of optical techniques for measuring contours or curvatures for measuring outlines by shadow casting
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
    • G01B11/00—Measuring arrangements characterised by the use of optical techniques
    • G01B11/002—Measuring arrangements characterised by the use of optical techniques for measuring two or more coordinates
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • G01C21/18—Stabilised platforms, e.g. by gyroscope
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • G01C21/183—Compensation of inertial measurements, e.g. for temperature effects
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
    • G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Manufacturing & Machinery (AREA)
  • Gyroscopes (AREA)

Abstract

本发明公开了一种实现惯性空间扫描成像的方法及系统，该实现惯性空间扫描成像的方法包括以下步骤：通过陀螺积分、误差分析及补偿，得出光具座相对惯性空间的实时三轴姿态；根据得出的光具座相对惯性空间的实时三轴姿态，建立欧拉坐标变换矩阵；按照惯性空间扫描基线及扫描速度要求，分解惯性空间扫描速度向量，通过建立的欧拉坐标变换矩阵解耦驱动机电轴系协同运动。本发明提供的实现惯性空间扫描成像的方法及系统，实现了惯性空间稳定基线的搜索扫描，陀螺漂移小且陀螺速度控制稳定。

Description

一种实现惯性空间扫描成像的方法及系统
技术领域
本发明涉及光电成像技术领域，尤其公开了一种实现惯性空间扫描成像的方法及系统。
背景技术
惯性空间可理解为宇宙空间，由于宇宙是无限的，要描述相对惯性空间的运动，需要有具体的参照物才有意义。即要在宇宙空间找到不受力或受力的合力为零的物体，它们在惯性空间绝对保持静止或匀速直线运动，以它们为参照物构成的参照系就是惯性参照系。
在现有技术中，实现惯性空间扫描成像一般采用三轴光纤陀螺控制三轴伺服转台按惯性空间实现稳速扫描，但是存在的核心问题有：一、复杂噪声环境下信号放大与变换，陀螺漂移补偿与修正；二、陀螺稳速控制算法研究与实现。
因此，现有惯性空间扫描成像存在的缺陷，是一件亟待解决的技术问题。
发明内容
本发明提供了一种实现惯性空间扫描成像的方法及系统，旨在解决现有惯性空间扫描成像存在的缺陷的技术问题。
本发明的一方面涉及一种实现惯性空间扫描成像的方法，包括以下步骤：
通过陀螺积分、误差分析及补偿，得出光具座相对惯性空间的实时三轴姿态；
根据得出的光具座相对惯性空间的实时三轴姿态，建立欧拉坐标变换矩阵；
按照惯性空间扫描基线及扫描速度要求，分解惯性空间扫描速度向量，通过建立的欧拉坐标变换矩阵解耦驱动机电轴系协同运动；
进一步地，按照惯性空间扫描基线及扫描速度要求，分解惯性空间扫描速度向量，通过建立的欧拉坐标变换矩阵解耦驱动机电轴系协同运动的步骤包括：
惯性搜索角速度向量通过车体姿态(φ1 φ2 φ3)欧拉变换投影到车体坐标系OX1Y1Z1；
根据车体姿态与光电系统的机电轴系之间的角度关系，通过(θ1 θ2 θ3)欧拉变换解耦到光电坐标系OX2Y2Z2，按解耦向量分别闭环控制光电轴系，采用轴系编码器角位移及角速率闭环，使光电搜索跟踪装置运动满足方位陀螺输出角速率等于设定搜索速度，俯仰、滚转陀螺角速率等于零。
进一步地，通过陀螺积分、误差分析及补偿，得出光具座相对惯性空间的三轴姿态的步骤包括：
初始对准及系统标定：进行定位定向、陀螺或惯性导航组件初始化进行标定对准，建立系统惯性坐标系；
陀螺积分并进行误差分析补偿，求解光电系统惯性姿态角(α β γ)，光电系统惯性姿态角(α β γ)的求解通过下式得出：
其中，(ω1 ω2 ω3)为陀螺角速率；(φ1 φ2 φ3)为车体姿态；(θ1 θ2 θ3)为欧拉变换解耦；(φ1+θ1 φ2+θ2 φ3+θ3)为光具座相对于惯性坐标系的实时方位、俯仰、滚转角。
进一步地，根据车体姿态与光电系统的机电轴系之间的角度关系，通过(θ1 θ2 θ3)欧拉变换解耦到光电坐标系OX2Y2Z2，按解耦向量分别闭环控制光电轴系，采用轴系编码器角位移及角速率闭环，使光电搜索跟踪装置运动满足方位陀螺输出角速率等于设定搜索速度，俯仰、滚转陀螺角速率等于零的步骤包括：
计算出机电轴系的速度解耦控制相互关系及要求；
机电轴系的速度解耦控制：实时采样陀螺及电机轴系编码器输出，经信号调理变换，陀螺实时积分输出光具座的姿态角；
机电轴系采用电流环、电机速度内环、惯性速度外环的双速度控制回路实施闭环控制。
进一步地，机电轴系的速度解耦控制相互关系包括机电轴系解耦反馈速度向量，机电轴系解耦反馈速度向量为：
其中，(φ1 φ2 φ3)为车体姿态；(α β γ)为光电系统惯性姿态角；(ω1 ω2 ω3)为陀螺角速率，(θ1 θ2 θ3)为欧拉变换解耦。
进一步地，机电轴系的速度解耦控制相互关系包括陀螺角速率，陀螺角速率为：
其中，(ω1 ω2 ω3)为陀螺角速率；(φ1 φ2 φ3)为车体姿态；(α β γ)为光电系统惯性姿态角；(θ1 θ2 θ3)为欧拉变换解耦。
进一步地，机电轴系的速度解耦控制相互关系包括机电轴系解耦驱动速度向量，机电轴系解耦驱动速度向量为：
最终，使系统满足：(ω1 ω2 ω3)＝(ω0 0 0)
其中，(θ1 θ2 θ3)为欧拉变换解耦；(ω1 ω2 ω3)为陀螺角速率；(φ1 φ2 φ3)为车体姿态；(α β γ)为光电系统惯性姿态角；ω0为设定搜索速度。
进一步地，机电轴系的速度解耦控制的步骤中，控制系统速度闭环的控制偏差量为：
ΔUt＝(Δd(θ1 θ2 θ3)/dt-d(θ1 θ2 θ3)/dt)
其中，Δd(θ1 θ2 θ3)/d为机电轴系解耦驱动速度向量；d(θ1 θ2 θ3)/dt为机电轴系解耦反馈速度向量。
本发明的另一方面涉及一种实现惯性空间扫描成像的系统，包括：
三轴姿态获取模块，用于通过陀螺积分、误差分析及补偿，得出光具座相对惯性空间的实时三轴姿态；
欧拉坐标变换矩阵建立模块，用于根据得出的光具座相对惯性空间的实时三轴姿态，建立欧拉坐标变换矩阵；
机电轴系解耦模块，用于按照惯性空间扫描基线及扫描速度要求，分解惯性空间扫描速度向量，通过建立的欧拉坐标变换矩阵解耦驱动机电轴系协同运动；
机电轴系解耦模块包括：
投影单元，用于惯性搜索角速度向量通过车体姿态(φ1 φ2 φ3)欧拉变换投影到车体坐标系OX1Y1Z1；
解耦向量控制单元(32)，用于根据车体姿态与光电系统的机电轴系之间的角度关系，通过(θ1 θ2 θ3)欧拉变换解耦到光电坐标系OX2Y2Z2，按解耦向量分别闭环控制光电轴系，采用轴系编码器角位移及角速率闭环，使光电搜索跟踪装置运动满足方位陀螺输出角速率等于设定搜索速度，俯仰、滚转陀螺角速率等于零。
进一步地，三轴姿态获取模块包括：
标定单元，用于初始对准及系统标定，进行定位定向、陀螺或惯性导航组件初始化进行标定对准，建立系统惯性坐标系；
求解单元，用于陀螺积分并进行误差分析补偿，求解光电系统惯性姿态角(α βγ)。
进一步地，解耦向量控制单元包括：
计算子单元，用于计算出机电轴系的速度解耦控制相互关系及要求；
解耦控制子单元，用于机电轴系的速度解耦控制，实时采样陀螺及电机轴系编码器输出，经信号调理变换，陀螺实时积分输出光具座的姿态角；
闭环控制子单元，用于机电轴系采用电流环、电机速度内环、惯性速度外环的双速度控制回路实施闭环控制。
本发明所取得的有益效果为：
本发明提供的实现惯性空间扫描成像的方法及系统，通过陀螺积分、误差分析及补偿，得出光具座相对惯性空间的实时三轴姿态；根据得出的光具座相对惯性空间的实时三轴姿态，建立欧拉坐标变换矩阵；按照惯性空间扫描基线及扫描速度要求，分解惯性空间扫描速度向量，通过建立的欧拉坐标变换矩阵解耦驱动机电轴系协同运动。具体地，惯性搜索角速度向量通过车体姿态(φ1 φ2 φ3)欧拉变换投影到车体坐标系OX1Y1Z1；根据车体姿态与光电系统的机电轴系之间的角度关系，通过(θ1 θ2 θ3)欧拉变换解耦到光电坐标系OX2Y2Z2，按解耦向量分别闭环控制光电轴系，采用轴系编码器角位移及角速率闭环，使光电搜索跟踪装置运动满足方位陀螺输出角速率等于设定搜索速度，俯仰、滚转陀螺角速率等于零。本发明提供的实现惯性空间扫描成像的方法及系统，实现了惯性空间稳定基线的搜索扫描，陀螺漂移小且陀螺速度控制稳定。
附图说明
图1为本发明提供的实现惯性空间扫描成像的方法第一实施例的流程示意图；
图2为图1中所示的按照惯性空间扫描基线及扫描速度要求，分解惯性空间扫描速度向量，通过建立的欧拉坐标变换矩阵解耦驱动机电轴系协同运动步骤中一实施例的细化流程示意图；
图3为图1中所示的通过陀螺积分、误差分析及补偿，得出光具座相对惯性空间的实时三轴姿态步骤中一实施例的细化流程示意图；
图4为图2中所示的根据车体姿态与光电系统的机电轴系之间的角度关系，通过(θ1 θ2 θ3)欧拉变换解耦到光电坐标系OX2Y2Z2，按解耦向量分别闭环控制光电轴系，采用轴系编码器角位移及角速率闭环，使光电搜索跟踪装置运动满足方位陀螺输出角速率等于设定搜索速度，俯仰、滚转陀螺角速率等于零步骤中一实施例的细化流程示意图；
图5为发明提供的实现惯性空间扫描成像的方法中双速度环控制逻辑图；
图6为本发明提供的实现惯性空间扫描成像的系统一实施例的功能框图；
图7为图6中所示的机电轴系解耦模块一实施例的功能模块示意图；
图8为图6中所示的三轴姿态获取模块一实施例的功能模块示意图；
图9为图7中所示的解耦向量控制单元一实施例的功能模块示意图。
附图标号说明：
10、三轴姿态获取模块；20、欧拉坐标变换矩阵建立模块；30、机电轴系解耦模块；31、投影单元；32、解耦向量控制单元；11、标定单元；12、求解单元；321、计算子单元；322、解耦控制子单元；323、闭环控制子单元。
具体实施方式
为了更好的理解上述技术方案，下面将结合说明书附图以及具体的实施方式对上述技术方案做详细的说明。
如图1和图2所示，本发明第一实施例提出一种实现惯性空间扫描成像的方法，包括以下步骤：
步骤S100、通过陀螺积分、误差分析及补偿，得出光具座相对惯性空间的实时三轴姿态。
通过陀螺积分、误差分析及补偿，借助北斗及倾角仪进行漂移修正，得出光具座相对惯性空间的三轴姿态，也可采用小型惯性导航组件测量光电系统的姿态角。
步骤S200、根据得出的光具座相对惯性空间的实时三轴姿态，建立欧拉坐标变换矩阵。
根据光具座相对惯性空间的实时三轴姿态建立坐标系欧拉变换矩阵。
步骤S300、按照惯性空间扫描基线及扫描速度要求，分解惯性空间扫描速度向量，通过建立的欧拉坐标变换矩阵解耦驱动机电轴系协同运动。
请见图2，图2为图1中所示的步骤S300中一实施例的细化流程示意图，在本实施例中，S300具体包括：
步骤S310、惯性搜索角速度向量通过车体姿态(φ1 φ2 φ3)欧拉变换投影到车体坐标系OX1Y1Z1。
步骤S320、根据车体姿态与光电系统的机电轴系之间的角度关系，通过(θ1 θ2 θ3)欧拉变换解耦到光电坐标系OX2Y2Z2，按解耦向量分别闭环控制光电轴系，采用轴系编码器角位移及角速率闭环，使光电搜索跟踪装置运动满足方位陀螺输出角速率等于设定搜索速度，俯仰、滚转陀螺角速率等于零。
本实施例提供的实现惯性空间扫描成像的方法，同现有技术相比，通过陀螺积分、误差分析及补偿，得出光具座相对惯性空间的实时三轴姿态；根据得出的光具座相对惯性空间的实时三轴姿态，建立欧拉坐标变换矩阵；按照惯性空间扫描基线及扫描速度要求，分解惯性空间扫描速度向量，通过建立的欧拉坐标变换矩阵解耦驱动机电轴系协同运动。具体地，惯性搜索角速度向量通过车体姿态(φ1 φ2 φ3)欧拉变换投影到车体坐标系OX1Y1Z1；根据车体姿态与光电系统的机电轴系之间的角度关系，通过(θ1 θ2 θ3)欧拉变换解耦到光电坐标系OX2Y2Z2，按解耦向量分别闭环控制光电轴系，采用轴系编码器角位移及角速率闭环，使光电搜索跟踪装置运动满足方位陀螺输出角速率等于设定搜索速度，俯仰、滚转陀螺角速率等于零。本实施例提供的实现惯性空间扫描成像的方法，实现了惯性空间稳定基线的搜索扫描，陀螺漂移小且陀螺速度控制稳定。
优选地，请见图3，图3为图1中所示的步骤S100中一实施例的细化流程示意图，在本实施例中，步骤S100包括：
步骤S110、初始对准及系统标定：进行定位定向、陀螺或惯性导航组件初始化进行标定对准，建立系统惯性坐标系。
步骤S120、陀螺积分并进行误差分析补偿，求解光电系统惯性姿态角(α β γ)，光电系统惯性姿态角(α β γ)的求解通过公式(1)得出：
在公式(1)中，(ω1 ω2 ω3)为陀螺角速率；(φ1 φ2 φ3)为车体姿态；(θ1 θ2θ3)为欧拉变换解耦；(φ1+θ1 φ2+θ2 φ3+θ3)为光具座相对于惯性坐标系的实时方位、俯仰、滚转角。
本实施例提供的实现惯性空间扫描成像的方法，同现有技术相比，通过初始对准及系统标定：进行定位定向、陀螺或惯性导航组件初始化进行标定对准，建立系统惯性坐标系；陀螺积分并进行误差分析补偿，求解光电系统惯性姿态角(α β γ)。本实施例提供的实现惯性空间扫描成像的方法，实现了惯性空间稳定基线的搜索扫描，陀螺漂移小且陀螺速度控制稳定。
进一步地，参见图4，图4为图2中所示的步骤S320中一实施例的细化流程示意图，在本实施例中，步骤S320包括：
步骤S321、计算出机电轴系的速度解耦控制相互关系及要求。
机电轴系的速度解耦控制相互关系包括机电轴系解耦反馈速度向量，机电轴系解耦反馈速度向量为：
在公式(2)中，(φ1 φ2 φ3)为车体姿态；(α β γ)为光电系统惯性姿态角；(ω1ω2 ω3)为陀螺角速率，(θ1 θ2 θ3)为欧拉变换解耦。
机电轴系的速度解耦控制相互关系包括陀螺角速率，陀螺角速率为：
在公式(3)中，(ω1 ω2 ω3)为陀螺角速率；(φ1 φ2 φ3)为车体姿态；(α βγ)为光电系统惯性姿态角；(θ1 θ2 θ3)为欧拉变换解耦。
机电轴系的速度解耦控制相互关系包括机电轴系解耦驱动速度向量，机电轴系解耦驱动速度向量为：
最终，使系统满足：(ω1 ω2 ω3)＝(ω0 0 0)(5)
在公式(4)中，(θ1 θ2 θ3)为欧拉变换解耦；(ω1 ω2 ω3)为陀螺角速率；(φ1φ2 φ3)为车体姿态；(α β γ)为光电系统惯性姿态角；ω0为设定搜索速度。
步骤S322、机电轴系的速度解耦控制：实时采样陀螺及电机轴系编码器输出，经信号调理变换，陀螺实时积分输出光具座的姿态角。
实时采样陀螺及电机轴系编码器输出，经信号调理变换，陀螺实时积分输出光具座的姿态角，光电平台角速度与惯性空间陀螺角速度关系符合式(2)及公式(3)，协同控制机电轴系运动按式(4)三轴的速度预期与当前三轴的实时速度合成矢量式(6)驱动轴系速度闭环，循环迭代实现惯性扫描。
控制系统速度闭环的控制偏差量为：
ΔUt＝(Δd(θ1 θ2 θ3)/dt-d(θ1 θ2 θ3)/dt) (6)
在公式(6)中，Δd(θ1 θ2 θ3)/dt为机电轴系解耦驱动速度向量；d(θ1 θ2 θ3)/dt为机电轴系解耦反馈速度向量。
步骤S323、机电轴系采用电流环、电机速度内环、惯性速度外环的双速度控制回路实施闭环控制。
机电轴系采用电流环(抑制力矩波动)、电机速度内环(快速响应)、惯性速度外环(惯性稳速)的双速度控制回路实施闭环控制，基于光电坐标系的实时速度可由编码器微分及滤波得到，亦可由陀螺积分或惯性导航组件输出的姿态角按(2)式由陀螺角速率(ω1 ω2 ω3)依据姿态角(α β γ)的欧拉变换矩阵得到，各轴系给定速度按(4)式，速度偏差控制按(6)式。控制逻辑如图5所示。
本实施例提供的实现惯性空间扫描成像的方法，同现有技术相比，通过计算出机电轴系的速度解耦控制相互关系及要求；机电轴系的速度解耦控制：实时采样陀螺及电机轴系编码器输出，经信号调理变换，陀螺实时积分输出光具座的姿态角；机电轴系采用电流环、电机速度内环、惯性速度外环的双速度控制回路实施闭环控制。本实施例提供的实现惯性空间扫描成像的方法，实现了惯性空间稳定基线的搜索扫描，陀螺漂移小且陀螺速度控制稳定。
如图6和图7所示，图6为本发明提供的实现惯性空间扫描成像的系统一实施例的功能框图，在本实施例中，该实现惯性空间扫描成像的系统，包括三轴姿态获取模块10、欧拉坐标变换矩阵建立模块20和机电轴系解耦模块30，其中，三轴姿态获取模块10，用于通过陀螺积分、误差分析及补偿，得出光具座相对惯性空间的实时三轴姿态；欧拉坐标变换矩阵建立模块20，用于根据得出的光具座相对惯性空间的实时三轴姿态，建立欧拉坐标变换矩阵；机电轴系解耦模块30，用于按照惯性空间扫描基线及扫描速度要求，分解惯性空间扫描速度向量，通过建立的欧拉坐标变换矩阵解耦驱动机电轴系协同运动。请见图7，图7为图6中所示的机电轴系解耦模块一实施例的功能模块示意图，在本实施例中，机电轴系解耦模块30包括投影单元31和解耦向量控制单元32，投影单元31，用于惯性搜索角速度向量通过车体姿态(φ1 φ2 φ3)欧拉变换投影到车体坐标系OX1Y1Z1；解耦向量控制单元32，用于根据车体姿态与光电系统的机电轴系之间的角度关系，通过(θ1 θ2 θ3)欧拉变换解耦到光电坐标系OX2Y2Z2，按解耦向量分别闭环控制光电轴系，采用轴系编码器角位移及角速率闭环，使光电搜索跟踪装置运动满足方位陀螺输出角速率等于设定搜索速度，俯仰、滚转陀螺角速率等于零。
本实施例提供的实现惯性空间扫描成像的系统，同现有技术相比，通过陀螺积分、误差分析及补偿，得出光具座相对惯性空间的实时三轴姿态；根据得出的光具座相对惯性空间的实时三轴姿态，建立欧拉坐标变换矩阵；按照惯性空间扫描基线及扫描速度要求，分解惯性空间扫描速度向量，通过建立的欧拉坐标变换矩阵解耦驱动机电轴系协同运动。具体地，惯性搜索角速度向量通过车体姿态(φ1 φ2 φ3)欧拉变换投影到车体坐标系OX1Y1Z1；根据车体姿态与光电系统的机电轴系之间的角度关系，通过(θ1 θ2 θ3)欧拉变换解耦到光电坐标系OX2Y2Z2，按解耦向量分别闭环控制光电轴系，采用轴系编码器角位移及角速率闭环，使光电搜索跟踪装置运动满足方位陀螺输出角速率等于设定搜索速度，俯仰、滚转陀螺角速率等于零。本实施例提供的实现惯性空间扫描成像的系统，实现了惯性空间稳定基线的搜索扫描，陀螺漂移小且陀螺速度控制稳定。
优选地，请见图8，图8为图6中所示的三轴姿态获取模块一实施例的功能模块示意图，在本实施例中，三轴姿态获取模块10包括标定单元11和求解单元12，其中，标定单元11，用于初始对准及系统标定，进行定位定向、陀螺或惯性导航组件初始化进行标定对准，建立系统惯性坐标系；求解单元12，用于陀螺积分并进行误差分析补偿，求解光电系统惯性姿态角(α β γ)。光电系统惯性姿态角(α β γ)的求解通过公式(1)得出：
在公式(7)中，(ω1 ω2 ω3)为陀螺角速率；(φ1 φ2 φ3)为车体姿态；(θ1 θ2θ3)为欧拉变换解耦；(φ1+θ1 φ2+θ2 φ3+θ3)为光具座相对于惯性坐标系的实时方位、俯仰、滚转角。
本实施例提供的实现惯性空间扫描成像的系统，同现有技术相比，通过初始对准及系统标定：进行定位定向、陀螺或惯性导航组件初始化进行标定对准，建立系统惯性坐标系；陀螺积分并进行误差分析补偿，求解光电系统惯性姿态角(α β γ)。本实施例提供的实现惯性空间扫描成像的系统，实现了惯性空间稳定基线的搜索扫描，陀螺漂移小且陀螺速度控制稳定。
进一步地，参见图9，图9为图7中所示的解耦向量控制单元一实施例的功能模块示意图，在本实施例中，解耦向量控制单元32包括计算子单元321和解耦控制子单元322，其中，计算子单元321，用于计算出机电轴系的速度解耦控制相互关系及要求；解耦控制子单元322，用于机电轴系的速度解耦控制，实时采样陀螺及电机轴系编码器输出，经信号调理变换，陀螺实时积分输出光具座的姿态角；闭环控制子单元323，用于机电轴系采用电流环、电机速度内环、惯性速度外环的双速度控制回路实施闭环控制。
计算子单元321用于计算出机电轴系的速度解耦控制相互关系及要求，机电轴系的速度解耦控制相互关系包括机电轴系解耦反馈速度向量，机电轴系解耦反馈速度向量为：
在公式(8)中，(φ1 φ2 φ3)为车体姿态；(α β γ)为光电系统惯性姿态角；(ω1ω2 ω3)为陀螺角速率，(θ1 θ2 θ3)为欧拉变换解耦。
机电轴系的速度解耦控制相互关系包括陀螺角速率，陀螺角速率为：
在公式(9)中，(ω1 ω2 ω3)为陀螺角速率；(φ1 φ2 φ3)为车体姿态；(α βγ)为光电系统惯性姿态角；(θ1 θ2 θ3)为欧拉变换解耦。
机电轴系的速度解耦控制相互关系包括机电轴系解耦驱动速度向量，机电轴系解耦驱动速度向量为：
最终，使系统满足：(ω1 ω2 ω3)＝(ω0 0 0) (11)
在公式(10)中，(θ1 θ2 θ3)为欧拉变换解耦；(ω1 ω2 ω3)为陀螺角速率；(φ1φ2 φ3)为车体姿态；(α β γ)为光电系统惯性姿态角；ω0为设定搜索速度。
解耦控制子单元322用于实时采样陀螺及电机轴系编码器输出，经信号调理变换，陀螺实时积分输出光具座的姿态角，光电平台角速度与惯性空间陀螺角速度关系符合式(8)及公式(9)，协同控制机电轴系运动按式(10)三轴的速度预期与当前三轴的实时速度合成矢量式(12)驱动轴系速度闭环，循环迭代实现惯性扫描。
控制系统速度闭环的控制偏差量为：
ΔUt＝(Δd(θ1 θ2 θ3)/dt-d(θ1 θ2 θ3)/dt) (12)
在公式(12)中，Δd(θ1 θ2 θ3)/dt为机电轴系解耦驱动速度向量；d(θ1 θ2 θ3)/dt为机电轴系解耦反馈速度向量。
闭环控制子单元323用于机电轴系采用电流环(抑制力矩波动)、电机速度内环(快速响应)、惯性速度外环(惯性稳速)的双速度控制回路实施闭环控制，基于光电坐标系的实时速度可由编码器微分及滤波得到，亦可由陀螺积分或惯性导航组件输出的姿态角按(8)式由陀螺角速率(ω1 ω2 ω3)依据姿态角(α β γ)的欧拉变换矩阵得到，各轴系给定速度按(10)式，速度偏差控制按(12)式。控制逻辑如图5所示。
本实施例提供的实现惯性空间扫描成像的系统，同现有技术相比，通过计算出机电轴系的速度解耦控制相互关系及要求；机电轴系的速度解耦控制：实时采样陀螺及电机轴系编码器输出，经信号调理变换，陀螺实时积分输出光具座的姿态角；机电轴系采用电流环、电机速度内环、惯性速度外环的双速度控制回路实施闭环控制。本实施例提供的实现惯性空间扫描成像的系统，实现了惯性空间稳定基线的搜索扫描，陀螺漂移小且陀螺速度控制稳定。
尽管已描述了本发明的优选实施例，但本领域内的技术人员一旦得知了基本创造性概念，则可对这些实施例作出另外的变更和修改。所以，所附权利要求意欲解释为包括优选实施例以及落入本发明范围的所有变更和修改。显然，本领域的技术人员可以对本发明进行各种改动和变型而不脱离本发明的精神和范围。这样，倘若本发明的这些修改和变型属于本发明权利要求及其等同技术的范围之内，则本发明也意图包含这些改动和变型在内。

Claims (9)

1.一种实现惯性空间扫描成像的方法，其特征在于，包括以下步骤：
通过陀螺积分、误差分析及补偿，得出光具座相对惯性空间的实时三轴姿态；
根据得出的光具座相对惯性空间的实时三轴姿态，建立欧拉坐标变换矩阵；
按照惯性空间扫描基线及扫描速度要求，分解惯性空间扫描速度向量，通过建立的欧拉坐标变换矩阵解耦驱动机电轴系协同运动；
所述按照惯性空间扫描基线及扫描速度要求，分解惯性空间扫描速度向量，通过建立的欧拉坐标变换矩阵解耦驱动机电轴系协同运动的步骤包括：
惯性搜索角速度向量通过车体姿态(φ1 φ2 φ3)欧拉变换投影到车体坐标系OX1Y1Z1；
根据车体姿态与光电系统的机电轴系之间的角度关系，通过(θ1 θ2 θ3)欧拉变换解耦到光电坐标系OX2Y2Z2，按解耦向量分别闭环控制光电轴系，采用轴系编码器角位移及角速率闭环，使光电搜索跟踪装置运动满足方位陀螺输出角速率等于设定搜索速度，俯仰、滚转陀螺角速率等于零；
所述通过陀螺积分、误差分析及补偿，得出光具座相对惯性空间的三轴姿态的步骤包括：
初始对准及系统标定：进行定位定向、陀螺或惯性导航组件初始化进行标定对准，建立系统惯性坐标系；
陀螺积分并进行误差分析补偿，求解光电系统惯性姿态角(α β γ)，所述光电系统惯性姿态角(α β γ)的求解通过下式得出：
其中，(ω1 ω2 ω3)为陀螺角速率；(φ1 φ2 φ3)为车体姿态；(θ1 θ2 θ3)为欧拉变换解耦；(φ1+θ1 φ2+θ2 φ3+θ3)为光具座相对于惯性坐标系的实时方位、俯仰、滚转角。
2.如权利要求1所述的实现惯性空间扫描成像的方法，其特征在于，所述根据车体姿态与光电系统的机电轴系之间的角度关系，通过(θ1 θ2 θ3)欧拉变换解耦到光电坐标系OX2Y2Z2，按解耦向量分别闭环控制光电轴系，采用轴系编码器角位移及角速率闭环，使光电搜索跟踪装置运动满足方位陀螺输出角速率等于设定搜索速度，俯仰、滚转陀螺角速率等于零的步骤包括：
计算出机电轴系的速度解耦控制相互关系及要求；
机电轴系的速度解耦控制：实时采样陀螺及电机轴系编码器输出，经信号调理变换，陀螺实时积分输出光具座的姿态角；
机电轴系采用电流环、电机速度内环、惯性速度外环的双速度控制回路实施闭环控制。
3.如权利要求2所述的实现惯性空间扫描成像的方法，其特征在于，所述机电轴系的速度解耦控制相互关系包括机电轴系解耦反馈速度向量，所述机电轴系解耦反馈速度向量为：
其中，(φ1 φ2 φ3)为车体姿态；(α β γ)为光电系统惯性姿态角；(ω1 ω2 ω3)为陀螺角速率，(θ1 θ2 θ3)为欧拉变换解耦。
4.如权利要求3所述的实现惯性空间扫描成像的方法，其特征在于，所述机电轴系的速度解耦控制相互关系包括陀螺角速率，所述陀螺角速率为：
其中，(ω1 ω2 ω3)为陀螺角速率；(φ1 φ2 φ3)为车体姿态；(α β γ)为光电系统惯性姿态角；(θ1 θ2 θ3)为欧拉变换解耦。
5.如权利要求4所述的实现惯性空间扫描成像的方法，其特征在于，所述机电轴系的速度解耦控制相互关系包括机电轴系解耦驱动速度向量，所述机电轴系解耦驱动速度向量为：
最终，使系统满足：(ω1 ω2 ω3)＝(ω0 0 0)
其中，(θ1 θ2 θ3)为欧拉变换解耦；(ω1 ω2 ω3)为陀螺角速率；(φ1 φ2 φ3)为车体姿态；(αβγ)为光电系统惯性姿态角；ω0为设定搜索速度。
6.如权利要求5所述的实现惯性空间扫描成像的方法，其特征在于，所述机电轴系的速度解耦控制的步骤中，控制系统速度闭环的控制偏差量为：
ΔUt＝(Δd(θ1 θ2 θ3)/dt-d(θ1 θ2 θ3)/dt)
其中，Δd(θ1 θ2 θ3)/dt为机电轴系解耦驱动速度向量；d(θ1 θ2 θ3)/dt为机电轴系解耦反馈速度向量。
7.一种实现惯性空间扫描成像的系统，应用于如权利要求1至6任意一项所述的实现惯性空间扫描成像的方法中，其特征在于，包括：
三轴姿态获取模块(10)，用于通过陀螺积分、误差分析及补偿，得出光具座相对惯性空间的实时三轴姿态；
欧拉坐标变换矩阵建立模块(20)，用于根据得出的光具座相对惯性空间的实时三轴姿态，建立欧拉坐标变换矩阵；
机电轴系解耦模块(30)，用于按照惯性空间扫描基线及扫描速度要求，分解惯性空间扫描速度向量，通过建立的欧拉坐标变换矩阵解耦驱动机电轴系协同运动；
所述机电轴系解耦模块(30)包括：
投影单元(31)，用于惯性搜索角速度向量通过车体姿态(φ1 φ2 φ3)欧拉变换投影到车体坐标系OX1Y1Z1；
解耦向量控制单元(32)，用于根据车体姿态与光电系统的机电轴系之间的角度关系，通过(θ1 θ2 θ3)欧拉变换解耦到光电坐标系OX2Y2Z2，按解耦向量分别闭环控制光电轴系，采用轴系编码器角位移及角速率闭环，使光电搜索跟踪装置运动满足方位陀螺输出角速率等于设定搜索速度，俯仰、滚转陀螺角速率等于零。
8.如权利要求7所述的实现惯性空间扫描成像的系统，其特征在于，所述三轴姿态获取模块(10)包括：
标定单元(11)，用于初始对准及系统标定，进行定位定向、陀螺或惯性导航组件初始化进行标定对准，建立系统惯性坐标系；
求解单元(12)，用于陀螺积分并进行误差分析补偿，求解光电系统惯性姿态角(α βγ)。
9.如权利要求8所述的实现惯性空间扫描成像的系统，其特征在于，所述解耦向量控制单元(32)包括：
计算子单元(321)，用于计算出机电轴系的速度解耦控制相互关系及要求；
解耦控制子单元(322)，用于机电轴系的速度解耦控制，实时采样陀螺及电机轴系编码器输出，经信号调理变换，陀螺实时积分输出光具座的姿态角；
闭环控制子单元(323)，用于机电轴系采用电流环、电机速度内环、惯性速度外环的双速度控制回路实施闭环控制。
CN202110717040.8A 2021-06-28 2021-06-28 一种实现惯性空间扫描成像的方法及系统 Active CN113607080B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110717040.8A CN113607080B (zh) 2021-06-28 2021-06-28 一种实现惯性空间扫描成像的方法及系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110717040.8A CN113607080B (zh) 2021-06-28 2021-06-28 一种实现惯性空间扫描成像的方法及系统

Publications (2)

Publication Number Publication Date
CN113607080A CN113607080A (zh) 2021-11-05
CN113607080B true CN113607080B (zh) 2024-05-17

Family

ID=78303790

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110717040.8A Active CN113607080B (zh) 2021-06-28 2021-06-28 一种实现惯性空间扫描成像的方法及系统

Country Status (1)

Country Link
CN (1) CN113607080B (zh)

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH02100111A (ja) * 1988-10-06 1990-04-12 Toshiba Corp 三軸姿勢制御装置
CN106525073A (zh) * 2016-09-27 2017-03-22 北京控制工程研究所 一种基于三轴转台的惯性空间陀螺标定试验方法
CN107796392A (zh) * 2017-09-11 2018-03-13 北京航天控制仪器研究所 一种三轴稳定平台、全数字控制系统及方法
CN109459065A (zh) * 2018-12-26 2019-03-12 长光卫星技术有限公司 一种基于卫星惯性空间旋转姿态的陀螺安装矩阵标定方法
CN110285838A (zh) * 2019-08-02 2019-09-27 中南大学 基于重力矢量时间差分的惯性导航设备对准方法
CN111141251A (zh) * 2019-12-24 2020-05-12 中国船舶重工集团公司第七一七研究所 一种舰船形变测量系统及方法
AU2020101544A4 (en) * 2020-07-28 2020-09-03 Harbin Engineering University A Method of Relative Deformation Measurement Based on Inertial Measurement Unit

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US7065888B2 (en) * 2004-01-14 2006-06-27 Aai Corporation Gyroscopic system for boresighting equipment

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH02100111A (ja) * 1988-10-06 1990-04-12 Toshiba Corp 三軸姿勢制御装置
CN106525073A (zh) * 2016-09-27 2017-03-22 北京控制工程研究所 一种基于三轴转台的惯性空间陀螺标定试验方法
CN107796392A (zh) * 2017-09-11 2018-03-13 北京航天控制仪器研究所 一种三轴稳定平台、全数字控制系统及方法
CN109459065A (zh) * 2018-12-26 2019-03-12 长光卫星技术有限公司 一种基于卫星惯性空间旋转姿态的陀螺安装矩阵标定方法
CN110285838A (zh) * 2019-08-02 2019-09-27 中南大学 基于重力矢量时间差分的惯性导航设备对准方法
CN111141251A (zh) * 2019-12-24 2020-05-12 中国船舶重工集团公司第七一七研究所 一种舰船形变测量系统及方法
AU2020101544A4 (en) * 2020-07-28 2020-09-03 Harbin Engineering University A Method of Relative Deformation Measurement Based on Inertial Measurement Unit

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
三轴陀螺稳定平台空间解耦算法及其工程设计;郗小鹏;苏敏;李雪玲;崔向宇;;机械设计与研究(第06期);第72-76页 *
基于惯性系下陀螺误差在线估计修正的惯性与星光组合导航方法;赵慧;熊智;施丽娟;郁丰;林爱军;;兵工学报(第12期);第2259-2267页 *

Also Published As

Publication number Publication date
CN113607080A (zh) 2021-11-05

Similar Documents

Publication Publication Date Title
CN112630813B (zh) 基于捷联惯导和北斗卫星导航系统的无人机姿态测量方法
CN106871928B (zh) 基于李群滤波的捷联惯性导航初始对准方法
CN114216456B (zh) 一种基于imu与机器人本体参数融合的姿态测量方法
CN104501838B (zh) 捷联惯导系统初始对准方法
CN102288133B (zh) 一种陀螺间接稳定系统安装偏角标定方法
Guo et al. Model-based deep learning for low-cost IMU dead reckoning of wheeled mobile robot
CN115876239B (zh) 传感器的标定方法、装置、介质、设备和车辆
CN108871323B (zh) 一种低成本惯性传感器在机动环境下的高精度导航方法
CN112325841A (zh) 一种动中通天线安装误差角的估计方法
CN105865488B (zh) 一种基于自主量测信息的静基座动态快速精确对准方法
CN108592943A (zh) 一种基于opreq方法的惯性系粗对准计算方法
CN113607080B (zh) 一种实现惯性空间扫描成像的方法及系统
CN116610156A (zh) 一种云台电机控制方法
CN101430565A (zh) 一种摄像机光轴稳定跟踪的一体化单回路控制器
CN119681965B (zh) 一种面向柔性基座空间机械臂的抑振控制方法及系统
CN120406581A (zh) 一种基于速率陀螺的自稳定控制光电跟踪转台及方法
CN117719702B (zh) 用于卫星高精度凝视的复合姿态控制方法、设备及介质
CN114777777B (zh) 一种捷联化平台式惯导系统及导航方法
CN116718182B (zh) 一种基于拓展卡尔曼滤波的卫星姿态确定方法
CN114252073B (zh) 一种机器人姿态数据融合方法
CN116839634B (zh) 一种用机械臂标定陀螺仪的方法与机械臂
CN119937408B (zh) 一种基于非对称交叉耦合的车载两轴随动控制方法
CN113131215B (zh) 动中通天线控制方法、装置及电子设备
CN113670330A (zh) 一种基于递推最小二乘法的mems陀螺仪快速标定方法
Zhang et al. PSO-CNN-Based Initial Alignment for Fiber Optic Gyroscope

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