一种实现惯性空间扫描成像的方法及系统
阅读说明：本技术 一种实现惯性空间扫描成像的方法及系统 (Method and system for realizing inertial space scanning imaging ) 是由 周欢喜 杨俊波 贾红辉 于 2021-06-28 设计创作，主要内容包括：本发明公开了一种实现惯性空间扫描成像的方法及系统,该实现惯性空间扫描成像的方法包括以下步骤：通过陀螺积分、误差分析及补偿,得出光具座相对惯性空间的实时三轴姿态；根据得出的光具座相对惯性空间的实时三轴姿态,建立欧拉坐标变换矩阵；按照惯性空间扫描基线及扫描速度要求,分解惯性空间扫描速度向量,通过建立的欧拉坐标变换矩阵解耦驱动机电轴系协同运动。本发明提供的实现惯性空间扫描成像的方法及系统,实现了惯性空间稳定基线的搜索扫描,陀螺漂移小且陀螺速度控制稳定。(The invention discloses a method and a system for realizing inertial space scanning imaging, wherein the method for realizing the inertial space scanning imaging comprises the following steps: obtaining the real-time three-axis attitude of the optical bench relative to the inertial space through gyro integration, error analysis and compensation; establishing an Euler coordinate transformation matrix according to the obtained real-time three-axis attitude of the optical bench relative to the inertial space; decomposing the inertial space scanning velocity vector according to the inertial space scanning baseline and the scanning velocity requirement, and decoupling and driving the electromechanical shafting to cooperatively move through the established Euler coordinate transformation matrix. The method and the system for realizing inertial space scanning imaging realize searching and scanning of the stable base line of the inertial space, and have small gyro drift and stable gyro speed control.)
技术领域
本发明涉及光电成像技术领域，尤其公开了一种实现惯性空间扫描成像的方法及系统。
背景技术
惯性空间可理解为宇宙空间，由于宇宙是无限的，要描述相对惯性空间的运动，需要有具体的参照物才有意义。即要在宇宙空间找到不受力或受力的合力为零的物体，它们在惯性空间绝对保持静止或匀速直线运动，以它们为参照物构成的参照系就是惯性参照系。
在现有技术中，实现惯性空间扫描成像一般采用三轴光纤陀螺控制三轴伺服转台按惯性空间实现稳速扫描，但是存在的核心问题有：一、复杂噪声环境下信号放大与变换，陀螺漂移补偿与修正；二、陀螺稳速控制算法研究与实现。
因此，现有惯性空间扫描成像存在的缺陷，是一件亟待解决的技术问题。
发明内容
本发明提供了一种实现惯性空间扫描成像的方法及系统，旨在解决现有惯性空间扫描成像存在的缺陷的技术问题。
本发明的一方面涉及一种实现惯性空间扫描成像的方法，包括以下步骤：
通过陀螺积分、误差分析及补偿，得出光具座相对惯性空间的实时三轴姿态；
根据得出的光具座相对惯性空间的实时三轴姿态，建立欧拉坐标变换矩阵；
按照惯性空间扫描基线及扫描速度要求，分解惯性空间扫描速度向量，通过建立的欧拉坐标变换矩阵解耦驱动机电轴系协同运动；
进一步地，按照惯性空间扫描基线及扫描速度要求，分解惯性空间扫描速度向量，通过建立的欧拉坐标变换矩阵解耦驱动机电轴系协同运动的步骤包括：
惯性搜索角速度向量通过车体姿态(φ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所示。
本实施例提供的实现惯性空间扫描成像的系统，同现有技术相比，通过计算出机电轴系的速度解耦控制相互关系及要求；机电轴系的速度解耦控制：实时采样陀螺及电机轴系编码器输出，经信号调理变换，陀螺实时积分输出光具座的姿态角；机电轴系采用电流环、电机速度内环、惯性速度外环的双速度控制回路实施闭环控制。本实施例提供的实现惯性空间扫描成像的系统，实现了惯性空间稳定基线的搜索扫描，陀螺漂移小且陀螺速度控制稳定。
尽管已描述了本发明的优选实施例，但本领域内的技术人员一旦得知了基本创造性概念，则可对这些实施例作出另外的变更和修改。所以，所附权利要求意欲解释为包括优选实施例以及落入本发明范围的所有变更和修改。显然，本领域的技术人员可以对本发明进行各种改动和变型而不脱离本发明的精神和范围。这样，倘若本发明的这些修改和变型属于本发明权利要求及其等同技术的范围之内，则本发明也意图包含这些改动和变型在内。
- 上一篇：一种医用注射器针头装配设备
- 下一篇：一种接触式焊接表面缺陷三维测量系统及方法