CN111965379A - 一种基于电位计式传感器的速度信号滤波***和滤波方法 - Google Patents

一种基于电位计式传感器的速度信号滤波***和滤波方法 Download PDF

Info

Publication number
CN111965379A
CN111965379A CN202010838610.4A CN202010838610A CN111965379A CN 111965379 A CN111965379 A CN 111965379A CN 202010838610 A CN202010838610 A CN 202010838610A CN 111965379 A CN111965379 A CN 111965379A
Authority
CN
China
Prior art keywords
speed signal
speed
filtering
filter
signal
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.)
Pending
Application number
CN202010838610.4A
Other languages
English (en)
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.)
Guizhou Aerospace Linquan Motor Co Ltd
Original Assignee
Guizhou Aerospace Linquan Motor 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 Guizhou Aerospace Linquan Motor Co Ltd filed Critical Guizhou Aerospace Linquan Motor Co Ltd
Priority to CN202010838610.4A priority Critical patent/CN111965379A/zh
Publication of CN111965379A publication Critical patent/CN111965379A/zh
Pending legal-status Critical Current

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01PMEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
    • G01P3/00Measuring linear or angular speed; Measuring differences of linear or angular speeds
    • G01P3/42Devices characterised by the use of electric or magnetic means
    • G01P3/44Devices characterised by the use of electric or magnetic means for measuring angular speed
    • G01P3/46Devices characterised by the use of electric or magnetic means for measuring angular speed by measuring amplitude of generated current or voltage
    • G01P3/465Devices characterised by the use of electric or magnetic means for measuring angular speed by measuring amplitude of generated current or voltage by using dynamo-electro tachometers or electric generator
    • HELECTRICITY
    • H03ELECTRONIC CIRCUITRY
    • H03HIMPEDANCE NETWORKS, e.g. RESONANT CIRCUITS; RESONATORS
    • H03H17/00Networks using digital techniques
    • H03H17/02Frequency selective networks
    • HELECTRICITY
    • H03ELECTRONIC CIRCUITRY
    • H03HIMPEDANCE NETWORKS, e.g. RESONANT CIRCUITS; RESONATORS
    • H03H17/00Networks using digital techniques
    • H03H17/02Frequency selective networks
    • H03H17/0202Two or more dimensional filters; Filters for complex signals
    • H03H2017/0207Median filters

Landscapes

  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • Computer Hardware Design (AREA)
  • Mathematical Physics (AREA)
  • Transmission And Conversion Of Sensor Element Output (AREA)

Abstract

本发明提供一种基于电位计式传感器的速度信号滤波***和滤波方法,滤波***包括依次串联连接在一起的AD采样电路、中值滤波器、均值滤波器和低通滤波器;滤波方法包括采用T测速法获取速度信号、通过中值滤波器滤除速度信号中波动较大的异常值、通过均值滤波器对速度信号进行平滑处理、通过低通滤波器滤除速度信号中的高频成分。采用本发明的技术方案,通过T测速法直接获取原始的速度信号,测速方法简单快捷,又先后通过中值滤波器滤除速度信号中波动较大的异常值、均值滤波器对速度信号进行滤波平滑处理、低通滤波器滤除速度信号中的高频成分,使最终获得的速度信号可靠性、抗干扰性、可性度更高,可以作为舵机的反馈速度信号使用。

Description

一种基于电位计式传感器的速度信号滤波***和滤波方法
技术领域
本发明涉及电机技术领域,特别是指一种基于电位计式传感器的速度信号滤波***和滤波方法。
背景技术
电位计式传感器是一种可以将位置信号转换为电压信号的低成本、高可靠的位置传感器,适合应用于对成本要求严格的民用工业产品领域,如机器人伺服舵机。然而在机器人伺服舵机中,不仅需要控制准确的位置,还需要控制其转动的速度。一般而言,由于电位计的原理特性,通常来说其具有可靠精度的转角范围有限,通常在300°范围以内。当角度从几百度转动到几度时,由于电压信号不能实现立即突变,会出现解算角度不对的情况,此时计算出的速度会出现较大波动,很难将其直接利用。
基于此,本专利旨在提出一种速度信号的滤波方法。采用T测速法,根据电位计解算位置信号,获取原始的速度信号。
发明内容
为解决上述技术问题,本发明提供了一种基于电位计式传感器的速度信号滤波***。
本发明通过以下技术方案得以实现。
本发明提供了一种基于电位计式传感器的速度信号滤波***,包括依次串联连接在一起的AD采样电路、中值滤波器、均值滤波器和低通滤波器;
AD采样电路:所述AD采样电路包括电位计式传感器,所述AD采样电路用于采集电位计式传感器信号,从而获取实时位置信号,采用T测速法获取速度信号;
中值滤波器:所述中值滤波器用于滤除来自于AD采样电路的速度信号中波动较大的异常值;
均值滤波器:所述均值滤波器用于对来自于所述中值滤波器的速度信号进行滤波平滑处理;
低通滤波器:所述低通滤波器用于滤除来自于所述均值滤波器的速度信号中的高频成分。
所述AD采样电路包括12位的主控芯片。
所述低通滤波器为一阶低通滤波器,其截止频率为100Hz。
此外,本发明还提供了一种使用前述的基于电位计式传感器的速度信号滤波***的滤波方法,包括以下步骤:
通过AD采样电路采集电位计式传感器信号,从而获取实时位置信号,采用T测速法获取速度信号,再使该速度信号依次经过中值滤波器滤除速度信号中波动较大的异常值、均值滤波器进行滤波平滑处理和低通滤波器滤除速度信号中的高频成分后结束。
所述采用T测速法获取速度信号是指:
通过所述AD采样电路内设的12位主控芯片采集电位计式传感器输出电压信号,控制输出电压信号范围为0V-5V,则读取的数字信号为0-4095,对应角度为0-359度,当读到的角度信号变化为10°时,读取相应的时间计数值Tcnt,则速度信号为V=10°/Tcnt。
所述经过中值滤波器滤除速度信号中波动较大的异常值是指:
步骤1:设置中值滤波器的滤波窗口数k,k为正整数,然后将获取的速度信号存储为具有k个组员的速度数组;
步骤2:读取当前最新的速度信号,并依次对速度数组内的所有速度信号进行更新;
步骤3:对速度数组内所有数据进行备份;
步骤4:对速度数组内所有数据进行采用冒泡算法排序后输出所有数据的中间值。
所述滤波窗口数k=19。
所述均值滤波器进行滤波平滑处理是指:
连续获取n个速度信号,n为自然数,并将n个速度信号存储为速度数组X[n],通过算式
Figure BDA0002640605110000031
计算获得算术平均值。
所述速度信号的数量n=20。
本发明的有益效果在于:采用本发明的技术方案,通过T测速法直接获取原始的速度信号,测速方法简单快捷,又先后通过中值滤波器滤除速度信号中波动较大的异常值、均值滤波器对速度信号进行滤波平滑处理、低通滤波器滤除速度信号中的高频成分,使最终获得的速度信号可靠性、抗干扰性、可性度更高,可以作为舵机的反馈速度信号使用。
附图说明
图1是发明的工艺流程图。
具体实施方式
下面进一步描述本发明的技术方案,但要求保护的范围并不局限于所述。
如图1所示,本发明提供了一种基于电位计式传感器的速度信号滤波***,包括依次串联连接在一起的AD采样电路、中值滤波器、均值滤波器和低通滤波器;
AD采样电路:AD采样电路包括电位计式传感器,AD采样电路用于采集电位计式传感器信号,从而获取实时位置信号,采用T测速法获取速度信号;另外,优选AD采样电路包括12位的主控芯片。
中值滤波器:中值滤波器用于滤除来自于AD采样电路的速度信号中波动较大的异常值;
均值滤波器:均值滤波器用于对来自于中值滤波器的速度信号进行滤波平滑处理;
低通滤波器:低通滤波器用于滤除来自于均值滤波器的速度信号中的高频成分。低通滤波器为一阶低通滤波器,其截止频率为100Hz。
此外,本发明还提供了一种使用前述的基于电位计式传感器的速度信号滤波***的滤波方法,包括以下步骤:
通过AD采样电路采集电位计式传感器信号,从而获取实时位置信号,采用T测速法获取速度信号,再使该速度信号依次经过中值滤波器滤除速度信号中波动较大的异常值、均值滤波器进行滤波平滑处理和低通滤波器滤除速度信号中的高频成分后结束。
进一步地,采用T测速法获取速度信号是指:
通过AD采样电路内设的12位主控芯片采集电位计式传感器输出电压信号,控制输出电压信号范围为0V-5V,则读取的数字信号为0-4095,对应角度为0-359度,当读到的角度信号变化为10°时,读取相应的时间计数值Tcnt,则速度信号为V=10°/Tcnt。
另外,经过中值滤波器滤除速度信号中波动较大的异常值是指:
步骤1:设置中值滤波器的滤波窗口数k,k为正整数,然后将获取的速度信号存储为具有k个组员的速度数组;优选滤波窗口数k=19。
步骤2:读取当前最新的速度信号,并依次对速度数组内的所有速度信号进行更新;
步骤3:对速度数组内所有数据进行备份;
步骤4:对速度数组内所有数据进行采用冒泡算法排序后输出所有数据的中间值。
例如,当将设置中值滤波窗口数设置为19时,则速度存储数组为X[19],具有19个组员,将窗口中的所有信号进行更新X[18-i]=X[17-i],读取当前最新速度信号X[0]=V。再在缓冲区内对所有数据进行备份,Xcopy[i]=X[i]。然后对备份的数据进行冒泡排序算法,最后即输出备份区数据的中间值Xcopy[10]。
另外,均值滤波器进行滤波平滑处理是指:
连续获取n个速度信号,n为自然数,并将n个速度信号存储为速度数组X[n],通过算式
Figure BDA0002640605110000051
计算获得算术平均值。优选速度信号的数量n=20。
采用本发明的技术方案,通过T测速法直接获取原始的速度信号,测速方法简单快捷,又先后通过中值滤波器滤除速度信号中波动较大的异常值、均值滤波器对速度信号进行滤波平滑处理、低通滤波器滤除速度信号中的高频成分,使最终获得的速度信号可靠性、抗干扰性、可性度更高,可以作为舵机的反馈速度信号使用。

Claims (9)

1.一种基于电位计式传感器的速度信号滤波***,其特征在于:包括依次串联连接在一起的AD采样电路、中值滤波器、均值滤波器和低通滤波器;
AD采样电路:所述AD采样电路包括电位计式传感器,所述AD采样电路用于采集电位计式传感器信号,从而获取实时位置信号,采用T测速法获取速度信号;
中值滤波器:所述中值滤波器用于滤除来自于AD采样电路的速度信号中波动较大的异常值;
均值滤波器:所述均值滤波器用于对来自于所述中值滤波器的速度信号进行滤波平滑处理;
低通滤波器:所述低通滤波器用于滤除来自于所述均值滤波器的速度信号中的高频成分。
2.如权利要求1所述的基于电位计式传感器的速度信号滤波***,其特征在于:所述AD采样电路包括12位的主控芯片。
3.如权利要求1所述的基于电位计式传感器的速度信号滤波***,其特征在于:所述低通滤波器为一阶低通滤波器,其截止频率为100Hz。
4.一种使用如权利要求1至3任一项所述的基于电位计式传感器的速度信号滤波***的滤波方法,其特征在于:包括以下步骤:
通过AD采样电路采集电位计式传感器信号,从而获取实时位置信号,采用T测速法获取速度信号,再使该速度信号依次经过中值滤波器滤除速度信号中波动较大的异常值、均值滤波器进行滤波平滑处理和低通滤波器滤除速度信号中的高频成分后结束。
5.如权利要求4所述的基于电位计式传感器的速度信号滤波方法,其特征在于:所述采用T测速法获取速度信号是指:
通过所述AD采样电路内设的12位主控芯片采集电位计式传感器输出电压信号,控制输出电压信号范围为0V-5V,则读取的数字信号为0-4095,对应角度为0-359度,当读到的角度信号变化为10°时,读取相应的时间计数值Tcnt,则速度信号为V=10°/Tcnt。
6.如权利要求4所述的基于电位计式传感器的速度信号滤波方法,其特征在于:所述经过中值滤波器滤除速度信号中波动较大的异常值是指:
步骤1:设置中值滤波器的滤波窗口数k,k为正整数,然后将获取的速度信号存储为具有k个组员的速度数组;
步骤2:读取当前最新的速度信号,并依次对速度数组内的所有速度信号进行更新;
步骤3:对速度数组内所有数据进行备份;
步骤4:对速度数组内所有数据进行采用冒泡算法排序后输出所有数据的中间值。
7.如权利要求6所述的基于电位计式传感器的速度信号滤波方法,其特征在于:所述滤波窗口数k=19。
8.如权利要求4所述的基于电位计式传感器的速度信号滤波方法,其特征在于:所述均值滤波器进行滤波平滑处理是指:
连续获取n个速度信号,n为自然数,并将n个速度信号存储为速度数组X[n],通过算式
Figure FDA0002640605100000021
计算获得算术平均值。
9.如权利要求8所述的基于电位计式传感器的速度信号滤波方法,其特征在于:所述速度信号的数量n=20。
CN202010838610.4A 2020-08-19 2020-08-19 一种基于电位计式传感器的速度信号滤波***和滤波方法 Pending CN111965379A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010838610.4A CN111965379A (zh) 2020-08-19 2020-08-19 一种基于电位计式传感器的速度信号滤波***和滤波方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010838610.4A CN111965379A (zh) 2020-08-19 2020-08-19 一种基于电位计式传感器的速度信号滤波***和滤波方法

Publications (1)

Publication Number Publication Date
CN111965379A true CN111965379A (zh) 2020-11-20

Family

ID=73388495

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010838610.4A Pending CN111965379A (zh) 2020-08-19 2020-08-19 一种基于电位计式传感器的速度信号滤波***和滤波方法

Country Status (1)

Country Link
CN (1) CN111965379A (zh)

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
GB1478835A (en) * 1973-06-01 1977-07-06 Stiftelsen Inst Mikrovags Velocity measuring device
CN101458096A (zh) * 2007-12-12 2009-06-17 中国科学院沈阳自动化研究所 一种高分辨率姿态角度测量方法及装置
CN101976048A (zh) * 2010-08-25 2011-02-16 中国兵器工业第二〇五研究所 手柄控制器信号处理方法
US20140067124A1 (en) * 2012-08-28 2014-03-06 Matthew Murray Williamson Monitoring robot sensor consistency
CN104394411A (zh) * 2014-11-28 2015-03-04 上海集成电路研发中心有限公司 中值滤波装置及方法
CN107241032A (zh) * 2017-06-20 2017-10-10 四川建筑职业技术学院 基于无刷电机的多路电动舵机控制***
CN108152527A (zh) * 2017-12-14 2018-06-12 北京青云航空仪表有限公司 一种基于中值平均滤波的数字测速方法
CN108631679A (zh) * 2017-03-24 2018-10-09 湖南中车时代电动汽车股份有限公司 一种位置信号滤波方法及***
CN110311651A (zh) * 2018-12-05 2019-10-08 林德(中国)叉车有限公司 一种车辆的加速踏板电位计电压信号的过滤方法和过滤装置

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
GB1478835A (en) * 1973-06-01 1977-07-06 Stiftelsen Inst Mikrovags Velocity measuring device
CN101458096A (zh) * 2007-12-12 2009-06-17 中国科学院沈阳自动化研究所 一种高分辨率姿态角度测量方法及装置
CN101976048A (zh) * 2010-08-25 2011-02-16 中国兵器工业第二〇五研究所 手柄控制器信号处理方法
US20140067124A1 (en) * 2012-08-28 2014-03-06 Matthew Murray Williamson Monitoring robot sensor consistency
CN104394411A (zh) * 2014-11-28 2015-03-04 上海集成电路研发中心有限公司 中值滤波装置及方法
CN108631679A (zh) * 2017-03-24 2018-10-09 湖南中车时代电动汽车股份有限公司 一种位置信号滤波方法及***
CN107241032A (zh) * 2017-06-20 2017-10-10 四川建筑职业技术学院 基于无刷电机的多路电动舵机控制***
CN108152527A (zh) * 2017-12-14 2018-06-12 北京青云航空仪表有限公司 一种基于中值平均滤波的数字测速方法
CN110311651A (zh) * 2018-12-05 2019-10-08 林德(中国)叉车有限公司 一种车辆的加速踏板电位计电压信号的过滤方法和过滤装置

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
蔡登胜等: "发动机转速信号的检测及数字滤波方法", 《工程机械》 *

Similar Documents

Publication Publication Date Title
US20030160160A1 (en) Signal processing apparatus for encoder
CN110673657B (zh) 一种稳定平台角度自动补偿解算方法
CN110231845B (zh) 一种导引头稳定平台的控制方法及复合控制***
EP2975364B1 (en) Position sensor device and method for providing a filtered position signal
CN114003045B (zh) 一种光电跟踪仪的目标跟踪方法、终端、可读存储介质
CN111965379A (zh) 一种基于电位计式传感器的速度信号滤波***和滤波方法
CN114629389A (zh) 一种电机正余弦编码器的位置速度信息解码方案
CN107561306B (zh) 基于转子电流的绕线式电机转速测量方法
CN109842350B (zh) 一种基于分析电流变化率的机械定位方法
CN106199169A (zh) 一种智能化高精度电压数据采集***及方法
CN102830249B (zh) 一种加速度传感器传递函数的辨识方法
CN209857935U (zh) 用于检测光电编码器精度的检测装置
CN112560762B (zh) 车体回转角度数据处理方法、装置、控制器以及介质
CN107547024B (zh) 一种无轴承永磁同步电机无速度传感器
Kubus et al. A sensor fusion approach to angle and angular rate estimation
CN114781432B (zh) 一种基于多源信息融合与去趋势波动分析的位移解算方法
CN116007663B (zh) 用于起落架收放***的接近传感器实时解算方法及***
CN116301081B (zh) 一种惯性测试设备的速率控制方法、装置、设备及介质
DE19920968C2 (de) Anordnung und Meßverfahren zur Erfassung von wenigstens einer bewegungscharakteristischen Größe eines bewegten Meßgerätekörpers
CN111865172B (zh) 一种伺服***电机转速精确估算方法
CN112611447B (zh) 航空发动机转子转速自适应跟踪振动基频信号调理电路
CN117781994B (zh) 旋变传感器的测试方法、装置、介质
CN117826691B (zh) 一种iepe兼容接口数据采集***
CN117767838A (zh) 一种电机转速获取方法
CN111446891B (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
RJ01 Rejection of invention patent application after publication

Application publication date: 20201120

RJ01 Rejection of invention patent application after publication