一种海洋重力仪用水平稳定平台及其控制方法技术

本发明专利技术涉及一种海洋重力仪用水平稳定平台及其控制方法，其技术特点在于：包括以下步骤：步骤1、通过控制速度环，实现水平稳定平台的速度控制：该速度环的前向通道包括速度控制器、PMW、电机、负载；速度环的反馈通道包括速率陀螺仪以及MEMS倾角测试仪的位置微分环节；步骤2、通过控制位置环，实现水平稳定平台的位置控制：位置环的前向通道包括跟踪器、位置控制器、速度控制器、PWM、电机、负载积分环节，位置环的反馈通道包括速率陀螺仪的积分环节以及MEMS倾角测试仪。本发明专利技术提高了反馈信号的精度，进而提高了稳定控制的精度，进而降低了设备的成本。

【技术实现步骤摘要】
一种海洋重力仪用水平稳定平台及其控制方法
本专利技术属于海洋重力仪
，涉及海洋重力仪用水平稳定平台，尤其是一种海洋重力仪用水平稳定平台及其控制方法。
技术介绍
目前，由于水平稳定平台具有隔离载体扰动、保证平台上设备稳定的特定，国外较早得对水平稳定平台进行了相关的研究和实际应用，在理论研究及工程应用方面形成了一整成熟的理论和设计规范。在舰载设备方面，稳定平台主要是为了保持舰艇上光电设备视轴的稳定，克服海上风浪、舰身晃动等因素的影响。随着海洋重力测量作业过程中对海洋重力测量精度要求的提高，为了隔离重力仪受到海浪起伏航速与航向变化，及其振动以及海风论海流等干扰因素的影响，常规的水平稳定平台方案基于带宽宽、高精度的惯性导航设备以满足高精度(±0.1°)，高动态(±30°，5s)的技术指标要求，存在价格高昂，体积大，重量重，无法满足小型化，价格适中的需求的问题。
技术实现思路
本专利技术的目的在于提供一种设计合理、高动态且高精度的一种海洋重力仪用水平稳定平台及其控制方法。一种海洋重力仪用水平稳定平台，包括台体、俯仰框、横摇框、载体平台；其特征在于：所述台体上垂直固装有横摇框，在该横摇框前侧的台体上垂直固装有载体平台，该载体平台为板状结构且上、下两侧端面分别向后延伸制有与其一体成型的俯仰框，所述载体平台通过该俯仰框固装在横摇框的上边框和下边框之间；在该载体平台的前端面上制有多个垂直于台体的竖槽，在相邻的两个竖槽内分别安装有两个光纤陀螺和单个MEMS倾角测试仪，该光纤陀螺和MEMS倾角测试仪位于载体平台的几何中心位置，其中一个光纤陀螺的输出轴平行于横摇框，另一个光纤陀螺的输出轴平行于俯仰框。一种海洋重力仪用水平稳定平台的控制方法，包括以下骤：步骤1、通过控制速度环，实现水平稳定平台的速度控制：该速度环的前向通道包括速度控制器、PMW、电机、负载；速度环的反馈通道包括速率陀螺仪以及MEMS倾角测试仪的位置微分环节；步骤2、通过控制位置环，实现水平稳定平台的位置控制：位置环的前向通道包括跟踪器、位置控制器、速度控制器、PWM、电机、负载积分环节，位置环的反馈通道包括速率陀螺仪的积分环节以及MEMS倾角测试仪。而且，所述步骤1的具体步骤包括：(1)位置控制器的角位置信息进行微分作为速度控制器的输入；(2)速度控制器的速度信号进行PMW处理作为电机的输出，由电机控制负载的速度；(3)MEMS倾角测试仪检测到当前水平稳定平台的位置进行微分得到稳定平台当前的角速度信息，然后将平稳定平台当前的角速度信息和光纤陀螺作为速率陀螺检测到水平稳定平台当前的速度信息经过限值以及Kalman滤波处理后作为速度环的反馈信号反馈到速度控制器实现水平稳定平台的速度控制。而且，所述步骤1的第(3)步的MEMS倾角测试仪检测到当前水平稳定平台的位置进行微分得到水平稳定平台当前的角速度信息的具体方法为：由MEMS倾角测试仪测输出当前地理坐标系下的水平角，设定位闭环控制的预期位置，并将该预期位置输出至跟踪器；所述跟踪器将测试获得水平稳定平台的实时位置信息输出至位置控制器；所述位置控制器将位置控制器的角位置信息进行微分输出至速度控制器；再将速度控制器的速度信号进行PMW处理后输出至电机，由电机控制负载的角速度。而且，所述步骤1的第(3)步的将水平稳定平台当前的角速度信息和光纤陀螺作为速率陀螺检测到水平稳定平台当前的速度信息经过限值以及Kalman滤波处理的方法为：假定Xk为t时刻滤波后的位置信号，Xk-1为t-1时刻滤波后的位置信号，Xk,k-1为t-1时刻到t时刻滤波后的位置估计值，Pk为t时刻位置信号误差协方差，Pk-1为t-1时刻位置信号误差协方差，Pk,k-1为t-1时刻与t时刻位置的误差协方差，Zk为实际的角度输出量，Kk为Kalman滤波器的增益系数，经分析MEMS倾角测试仪的角度信号噪声方差矩阵Qk非正定，Rk正定，则有：Kk＝Pk,k-1[Pk,k-1+Rk]-1Pk,k-1＝Pk-1而且，所述步骤2的具体步骤包括：(1)根据MEMS倾角测试仪测输出当前地理坐标系下的水平角，设定位闭环控制的预期位置；(2)由跟踪器测试获得水平稳定平台的实时位置信息，作为位置控制器的输入信息；(3)输入信息通过速度环的前向通道进行积分获得实时的水平稳定平台的位置信息；(4)MEMS倾角测试仪检测到当前水平稳定平台的位置信息与光纤陀螺作为速率陀螺积分得到的位置信息，经过限值和Kalman滤波处理后作为位置环的反馈信号反馈到跟踪器，实现水平稳定平台的位置控制。而且，所述步骤2的第(3)步的具体方法为：MEMS倾角测试仪检测到当前水平稳定平台的位置进行积分得到水平稳定平台当前的速度，将该水平稳定平台当前的速度与光纤陀螺作为速率陀螺检测到水平稳定平台当前的速度作为速度环的反馈信号输出至速度控制器，实现水平稳定平台的速度控制，速度环的速度信息进行积分得到水平稳定平台的位置信息。所述步骤2的第(4)步的将MEMS倾角测试仪检测到当前水平稳定平台的位置信息与光纤陀螺作为速率陀螺积分得到的位置信息，经过限值和Kalman滤波处理的方法为：假定Xk为t时刻滤波后的位置信号，Xk-1为t-1时刻滤波后的位置信号，Xk,k-1为t-1时刻到t时刻滤波后的位置估计值，Pk为t时刻位置信号误差协方差，Pk-1为t-1时刻位置信号误差协方差，Pk,k-1为t-1时刻与t时刻位置的误差协方差，Zk为实际的角度输出量，Kk为Kalman滤波器的增益系数，经分析MEMS倾角测试仪的角度信号噪声方差矩阵Qk非正定，Rk正定，则有：Kk＝Pk,k-1[Pk,k-1+Rk]-1Pk,k-1＝Pk-1本专利技术的优点和有益效果：1、本专利技术公开了一种基于光纤陀螺及MEMS倾角测试仪的水平稳定平台及其控制方法，利用光纤陀螺的角速率信息与MEMS倾角测试仪的角度信息微分所得的速率信息作为速度环的反馈信息；光纤陀螺的角速率信息的积分和MEMS倾角测试仪的角度信息作为位置环的反馈信息；根据速度控制环和位置控制环的控制实现了对水平稳定平台的稳定控制。本专利技术基于光纤陀螺及MEMS倾角测试仪实现了高动态、高精度的水平稳定平台。2、本专利技术通过光纤陀螺以及MEMS倾角测试仪实现了高动态、高精度的水平稳定平台要求，解决了常规的控制方法由于采用带宽宽、高精度的惯性导航设备而存在的价格高昂，体积大，重量重，无法满足小型化，价格适中的需求的技术问题，具有推广价值。3、本专利技术通过高数据更新率的光纤陀螺的角速度信息实现高动态的速度环的稳定控制；通过MEMS倾角测试仪的角度信息与光纤陀螺的角速度信息进行融合后所得角位置信息实现位置环的稳定控制；并通过对MEMS倾角测试仪的角度信息微分所得速度信息进行限值、滤波后对光纤陀螺的漂移进行补偿。4、本专利技术专利技术仅利用两个光纤陀螺与一个MEMS倾角传感器即实现了适用于高动态的高精度稳定平台系统，具有尺寸小，体重轻，价格低的特点；5、本专利技术利用直接利用光纤陀螺的4kHz的信号作为反馈信号，克服了惯性导航设备反馈信号输出慢的问题；6、本专利技术利用MEMS倾角测试仪输出的俯仰角和横滚角的信息进行微分对光纤陀螺的漂移进行补偿后得到的角度信息实现稳定平台的位置环的稳定控制，可以克服光纤陀螺的输出随时间漂本文档来自技高网...

【技术保护点】
1.一种海洋重力仪用水平稳定平台，包括台体、俯仰框、横摇框、载体平台；其特征在于：所述台体上垂直固装有横摇框，在该横摇框前侧的台体上垂直固装有载体平台，该载体平台为板状结构且上、下两侧端面分别向后延伸制有与其一体成型的俯仰框，所述载体平台通过该俯仰框固装在横摇框的上边框和下边框之间；在该载体平台的前端面上制有多个垂直于台体的竖槽，在相邻的两个竖槽内分别安装有两个光纤陀螺和单个MEMS倾角测试仪，该光纤陀螺和MEMS倾角测试仪位于载体平台的几何中心位置，其中一个光纤陀螺的输出轴平行于横摇框，另一个光纤陀螺的输出轴平行于俯仰框。

【技术特征摘要】
1.一种海洋重力仪用水平稳定平台，包括台体、俯仰框、横摇框、载体平台；其特征在于：所述台体上垂直固装有横摇框，在该横摇框前侧的台体上垂直固装有载体平台，该载体平台为板状结构且上、下两侧端面分别向后延伸制有与其一体成型的俯仰框，所述载体平台通过该俯仰框固装在横摇框的上边框和下边框之间；在该载体平台的前端面上制有多个垂直于台体的竖槽，在相邻的两个竖槽内分别安装有两个光纤陀螺和单个MEMS倾角测试仪，该光纤陀螺和MEMS倾角测试仪位于载体平台的几何中心位置，其中一个光纤陀螺的输出轴平行于横摇框，另一个光纤陀螺的输出轴平行于俯仰框。2.如权利要求1所述的一种海洋重力仪用水平稳定平台的控制方法，其特征在于：包括以下骤：步骤1、通过控制速度环，实现水平稳定平台的速度控制：该速度环的前向通道包括速度控制器、PMW、电机、负载；速度环的反馈通道包括速率陀螺仪以及MEMS倾角测试仪的位置微分环节；步骤2、通过控制位置环，实现水平稳定平台的位置控制：位置环的前向通道包括跟踪器、位置控制器、速度控制器、PWM、电机、负载积分环节，位置环的反馈通道包括速率陀螺仪的积分环节以及MEMS倾角测试仪。3.根据权利要求2所述的一种海洋重力仪用水平稳定平台的控制方法，其特征在于：所述步骤1的具体步骤包括：(1)位置控制器的角位置信息进行微分作为速度控制器的输入；(2)速度控制器的速度信号进行PMW处理作为电机的输出，由电机控制负载的速度；(3)MEMS倾角测试仪检测到当前水平稳定平台的位置进行微分得到稳定平台当前的角速度信息，然后将平稳定平台当前的角速度信息和光纤陀螺作为速率陀螺检测到水平稳定平台当前的速度信息经过限值以及Kalman滤波处理后作为速度环的反馈信号反馈到速度控制器实现水平稳定平台的速度控制。4.根据权利要求3所述的一种海洋重力仪用水平稳定平台的控制方法，其特征在于：所述步骤1的第(3)步的MEMS倾角测试仪检测到当前水平稳定平台的位置进行微分得到水平稳定平台当前的角速度信息的具体方法为：由MEMS倾角测试仪测输出当前地理坐标系下的水平角，设定位闭环控制的预期位置，并将该预期位置输出至跟踪器；所述跟踪器将测试获得水平稳定平台的实时位置信息输出至位置控制器；所述位置控制器将位置控制器的角位置信息进行微分输出至速度控制器；再将速度控制器的速度信号进行PMW处理后输出至电机，由电机控制负载的角速度。5.根据权利要求3所述的一种海洋重力仪用水平稳定平台的控制方法，其特征在于：所述步骤1的第(3)步的将水平稳定平台当前的角速度信息和光...

【专利技术属性】
技术研发人员：皮燕燕，贾福利，高山，宋高玲，
申请(专利权)人：中国船舶重工集团公司第七零七研究所，
类型：发明
国别省市：天津,12