CN109270288B - 一种基于位置插值的轴角速度估计方法 - Google Patents
一种基于位置插值的轴角速度估计方法 Download PDFInfo
- Publication number
- CN109270288B CN109270288B CN201811195600.2A CN201811195600A CN109270288B CN 109270288 B CN109270288 B CN 109270288B CN 201811195600 A CN201811195600 A CN 201811195600A CN 109270288 B CN109270288 B CN 109270288B
- Authority
- CN
- China
- Prior art keywords
- code wheel
- value
- angular velocity
- theta
- stored
- 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
- 238000000034 method Methods 0.000 title claims abstract description 15
- 238000005070 sampling Methods 0.000 claims description 7
- 238000005259 measurement Methods 0.000 abstract description 3
- 230000001629 suppression Effects 0.000 abstract 1
- 230000002708 enhancing effect Effects 0.000 description 2
- 238000002955 isolation Methods 0.000 description 2
- 230000000007 visual effect Effects 0.000 description 2
- 206010034719 Personality change Diseases 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000005693 optoelectronics Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01P—MEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
- G01P3/00—Measuring linear or angular speed; Measuring differences of linear or angular speeds
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01P—MEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
- G01P3/00—Measuring linear or angular speed; Measuring differences of linear or angular speeds
- G01P3/36—Devices characterised by the use of optical means, e.g. using infrared, visible, or ultraviolet light
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Electromagnetism (AREA)
- Power Engineering (AREA)
- Control Of Position Or Direction (AREA)
- Length Measuring Devices With Unspecified Measuring Means (AREA)
Abstract
本发明提出的基于位置插值的轴角速度估计方法,将在码盘T法测速的基础上,准确捕获码盘最小分辨位变化的时刻,使用增强速度估计公式得到轴角速度,减小了相位滞后,提高速度环增益,提升稳定平台扰动抑制能力和跟随精度,具有广阔的应用前景。
Description
技术领域
本发明涉及一种基于位置插值的轴角速度估计方法,属于光电探测技术领域。
背景技术
机载光电稳定平台主要用来隔离外界扰动,并跟随指令角度,实现对目标的捕获和精确跟踪。然而在机载环境下,对指令角度的跟随受到载机姿态变化、目标机动、载机振动等因素的影响,视轴不能按照期望的精度跟踪目标运动,因此必须提升速度环的频响和跟随精度,从而提高光电稳定平台的抗扰能力和目标跟踪精度。
机载光电平台实现扰动隔离与指令跟随最主要的条件就是对轴角速度的快速、准确量测。然而,光电稳定平台因为体积限制,很难安装高精度的轴角测量传感器得到角速度。而T法、M法等,利用角位置差分,得到的角速率噪声非常大,且相位滞后严重,很难在较大的调速范围内使用。因此必须改进速度估计方法来消除角速度噪声、相位滞后等因素对机载光电平台扰动隔离与指令跟随性能的影响。
发明内容
要解决的技术问题
为了避免现有技术的不足之处,本发明提出一种基于位置插值的轴角速度估计方法。在测速定时器间隔内进行插值,准确捕获码盘最小分辨位变化的时刻,缩小采样时间与码盘分辨位之间的随机关系,使用增强速度估计的差分公式,得到轴角速度的方法。
技术方案
一种基于位置插值的轴角速度估计方法,其特征在于步骤如下:
步骤1:上电后,初始化速度估计值ω;
步骤2:启动FPGA的计数器C和位置触发器TR;
步骤3:码盘位置变化时,位置触发器TR工作,计数器C清零重新计数,当前码盘位置存于寄存器θ(Tm)中;
步骤4:重复步骤3直到控制器N-1采样时刻时,将最近一次码盘值变化时的计数值C(Tm)和位置值θ(Tm),存储在寄存器C(N-1)和θ(N-1)中;
步骤5:码盘位置变化时,位置触发器TR工作,当前计数器值存于寄存器C(Tn)中,码盘位置存于寄存器θ(Tn)中;
步骤6:重复步骤5直到控制器N采样时刻时,将最近一次码盘值变化时的计数值C(Tn)和位置值θ(Tn),存储在寄存器C(N)和θ(N)中;
步骤7:将寄存器C(N-1)、C(N)、θ(N-1)、θ(N)数据进行差分,ω(N)=(θ(N)-θ(N-1))/(C(N)-C(N-1)),得到轴角速度估计值;
步骤8:进行赋值C(N-1)=0,θ(N-1)=θ(N)后,重复步骤5,开始下一采样周期轴角速度估计。
有益效果
本发明提出的基于位置插值的轴角速度估计方法,将在码盘T法测速的基础上,准确捕获码盘最小分辨位变化的时刻,使用增强速度估计公式得到轴角速度,减小了相位滞后,提高速度环增益,提升稳定平台扰动抑制能力和跟随精度,有非常明显的作战优势,具有广阔的应用前景。
附图说明
图1位置变化时间捕获原理图
图2基于位置插值的速度估计流程图
具体实施方式
基于位置插值的速度估计方法,通过在测速定时器间隔内进行插值,准确捕获码盘最小分辨位变化的时刻,使用增强速度估计的差分公式,得到较高速度分辨率和相位滞后的轴角速度,提升速度环的跟踪性能,从而提高光电稳定平台的视轴跟踪精度。主要涉及到三个方面:
1)位置变化时刻的捕获。采用FPGA对位置变化的信号边沿进行触发,将FPGA的计数器记为零,并开始计数,计数间隔可以按照待估计速度的范围进行设置,一般定为百ns级到μs级。
2)时间间隔计算。第二次位置变化的信号边沿出现时,将FPGA的计数器数据发送至一个寄存器中,该数据即为两次位置变化的时间间隔,同时将计数器清零。
3)速度估计。根据控制器两次采样时码盘位置变化的准确时间和位置,采用FPGA对两次存储的位置和位置变化时刻进行差分,并将差分后的速度值存到寄存器中,在控制器采样时由CPU读取。
以下结合附图1和附图2,对本发明进行详细说明。
定义控制器采样时刻为N-1、N,码盘位置变化时刻为Tm、Tn,码盘角度为θ,速度估计值为ω,FPGA的计数器为C,位置触发器为TR,具体实施步骤如下:
第一步,上电后,初始化速度估计值ω;
第二步,启动计数器C和触发器TR;
第三步,码盘位置变化时,触发器TR工作,计数器C清零重新计数,当前码盘位置存于寄存器θ(Tm)中;
第四步,重复第三步直到控制器N-1采样时刻时,将最近一次码盘值变化时的计数值C(Tm)和位置值θ(Tm),存储在寄存器C(N-1)和θ(N-1)中;
第五步,码盘位置变化时,触发器TR工作,当前计数器值存于寄存器C(Tn)中,码盘位置存于寄存器θ(Tn)中;
第六步,重复第五步直到控制器N采样时刻时,将最近一次码盘值变化时的计数值C(Tn)和位置值θ(Tn),存储在寄存器C(N)和θ(N)中;
第七步,将寄存器C(N-1)、C(N)、θ(N-1)、θ(N)数据进行差分,ω(N)=(θ(N)-θ(N-1))/(C(N)-C(N-1)),得到轴角速度估计值。
第八步,进行赋值C(N-1)=0,θ(N-1)=θ(N)后,重复第五步,开始下一采样周期轴角速度估计。
Claims (1)
1.一种基于位置插值的轴角速度估计方法,其特征在于步骤如下:
步骤1:上电后,初始化轴角速度估计值ω;
步骤2:启动FPGA的计数器C和位置触发器TR;
步骤3:码盘位置变化时,位置触发器TR工作,计数器C清零重新计数,当前码盘位置存于寄存器θ(Tm)中;
步骤4:重复步骤3直到控制器N-1采样时刻时,将最近一次码盘值变化时的计数值C(Tm)和位置值θ(Tm),存储在寄存器C(N-1)和θ(N-1)中;
步骤5:码盘位置变化时,位置触发器TR工作,当前计数器值存于寄存器C(Tn)中,码盘位置存于寄存器θ(Tn)中;
步骤6:重复步骤5直到控制器N采样时刻时,将最近一次码盘值变化时的计数值C(Tn)和位置值θ(Tn),存储在寄存器C(N)和θ(N)中;
步骤7:将寄存器C(N-1)、C(N)、θ(N-1)、θ(N)数据进行差分,ω(N)=(θ(N)-θ(N-1))/(C(N)-C(N-1)),得到轴角速度估计值;
步骤8:进行赋值C(N-1)=0,θ(N-1)=θ(N)后,重复步骤5,开始下一采样周期轴角速度估计。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811195600.2A CN109270288B (zh) | 2018-10-15 | 2018-10-15 | 一种基于位置插值的轴角速度估计方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811195600.2A CN109270288B (zh) | 2018-10-15 | 2018-10-15 | 一种基于位置插值的轴角速度估计方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109270288A CN109270288A (zh) | 2019-01-25 |
CN109270288B true CN109270288B (zh) | 2020-10-30 |
Family
ID=65196098
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811195600.2A Active CN109270288B (zh) | 2018-10-15 | 2018-10-15 | 一种基于位置插值的轴角速度估计方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109270288B (zh) |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4481137B2 (ja) * | 2003-11-13 | 2010-06-16 | アスモ株式会社 | モータ、回転制御装置、及び回転検出回路 |
CN101886932B (zh) * | 2009-04-30 | 2013-02-06 | 浙江中科德润科技有限公司 | 位置检测装置及其信号处理装置与方法 |
CN102121827B (zh) * | 2010-11-29 | 2013-12-18 | 浙江亚特电器有限公司 | 一种移动机器人定位系统及其定位方法 |
CN107796419A (zh) * | 2016-08-31 | 2018-03-13 | 青岛农业大学 | 低成本高精度复合数字轴角检测器 |
CN106871904A (zh) * | 2017-03-02 | 2017-06-20 | 南阳师范学院 | 一种基于机器视觉的移动机器人码盘定位修正方法 |
CN108471266B (zh) * | 2018-03-22 | 2019-12-20 | 北京控制工程研究所 | 一种伺服电机的角速度指令及旋转角位置预处理系统 |
-
2018
- 2018-10-15 CN CN201811195600.2A patent/CN109270288B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN109270288A (zh) | 2019-01-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Su et al. | A simple improved velocity estimation for low-speed regions based on position measurements only | |
CN109945819B (zh) | 一种永磁同步电机转子位置测量方法 | |
CN105007016B (zh) | 一种基于旋转变压器的永磁同步电机测速方法 | |
CN110677140B (zh) | 一种含未知输入和非高斯量测噪声的随机系统滤波器 | |
CN106645780B (zh) | 一种基于dsp的转速检测方法及系统 | |
CN105738642A (zh) | 一种四路并行采样的t法电机测速方法 | |
CN112762944B (zh) | 零速区间检测及零速更新方法 | |
CN109270288B (zh) | 一种基于位置插值的轴角速度估计方法 | |
CN105737793A (zh) | 滚转角测量单元及测量方法 | |
CN109471192B (zh) | 一种全自动重力测试仪高精度动态数据处理方法 | |
CN113791240A (zh) | 基于高阶滑膜跟踪微分器的加速度估计方法、系统、设备和介质 | |
Fu et al. | Maneuvering target tracking with improved unbiased FIR filter | |
CN110888142B (zh) | 基于mems激光雷达测量技术的航天器隐藏目标点测量方法 | |
KR20210076412A (ko) | 차량 센서 성능 평가 장치 및 그의 성능 평가 방법 | |
CN114997247B (zh) | 基于fpga的无人机涡轮发动机转速采集方法及系统 | |
JP5278128B2 (ja) | 変換係数導出装置および変換係数導出方法 | |
CN106970357B (zh) | 高精度的实时超声波定位追踪方法及系统 | |
US20150285833A1 (en) | Motion sensor assembly for determining the angular velocity of a moving contrast in its field of view with a high accuracy | |
CN110726988B (zh) | Pd雷达探测高超声速目标的距离和速度模糊互解方法 | |
CN112241583A (zh) | 一种最小化后验距离的传感器路径优化方法 | |
CN114689081A (zh) | Gnss辅助的mins自动校准系统和方法 | |
CN112504269B (zh) | 一种应用于半捷联稳定平台的轴角速度估计方法 | |
CN112198504B (zh) | 一种主被动观测特征交织的融合滤波方法 | |
Bingbing et al. | A RLSN-based Current Statistical Model for Target Range Tracking | |
Guo et al. | Modeling and analysis of measurements of tightly coupled GPS/SINS integrated navigation system |
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 |