CN102611452A - 采用α-β外差值算法进行数字-自整角机信号转换的方法 - Google Patents

采用α-β外差值算法进行数字-自整角机信号转换的方法 Download PDF

Info

Publication number
CN102611452A
CN102611452A CN2012100697191A CN201210069719A CN102611452A CN 102611452 A CN102611452 A CN 102611452A CN 2012100697191 A CN2012100697191 A CN 2012100697191A CN 201210069719 A CN201210069719 A CN 201210069719A CN 102611452 A CN102611452 A CN 102611452A
Authority
CN
China
Prior art keywords
value
beta
alpha
selsyn
heterodyne
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.)
Granted
Application number
CN2012100697191A
Other languages
English (en)
Other versions
CN102611452B (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.)
PLA 92854 ARMY ORDNANCE REPAIRING PLANT
Original Assignee
PLA 92854 ARMY ORDNANCE REPAIRING PLANT
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 PLA 92854 ARMY ORDNANCE REPAIRING PLANT filed Critical PLA 92854 ARMY ORDNANCE REPAIRING PLANT
Priority to CN201210069719.1A priority Critical patent/CN102611452B/zh
Publication of CN102611452A publication Critical patent/CN102611452A/zh
Application granted granted Critical
Publication of CN102611452B publication Critical patent/CN102611452B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Control Of Position Or Direction (AREA)

Abstract

本发明公开了一种采用α-β外差值算法进行数字-自整角机信号转换的方法。其采用α-β外差值算法，所述的方法包括下述步骤：（1）初始化值；（2）读入初始数据；（3）得到初始的；（4）读入数据；（5）计算估计值和速度值
Figure 2012100697191100004DEST_PATH_IMAGE010
；（6）计算
Figure 2012100697191100004DEST_PATH_IMAGE012
，并顺序输出；（7）返回第4步。本发明通过外插值的办法使得通过单片机***输出的自整角机信号平滑，减少时延，克服硬件***带动伺服机构运行时的抖动和步进，提高跟踪精度。

Description

采用α-β外差值算法进行数字-自整角机信号转换的方法
技术领域
本发明涉及一种信号转换的方法，具体是指一种采用α-β外差值算法进行数字-自整角机信号转换的方法。
背景技术
目前，在现有技术中，上位机发出的命令首先给下位机，下位机再根据此命令解释成相应时序信号直接控制相应设备（伺服机构），下位机不时读取设备状态数据（一般为模拟量），转换成数字信号反馈给上位机。由于数据采样、数据处理和数据通讯方面的限制，上位机模数转换量化产生的不连续数字信号，上位机的数据帧间隔时间不能完全满足伺服机构的平稳性要求，硬件***带动伺服机构运行时会产生抖动和步进，跟踪精度较低。
发明内容
本发明的目的在于避免现有技术中的不足而提供一种采用α-β外差值算法进行数字-自整角机信号转换的方法，其通过外插值的办法使得通过单片机***输出的自整角机信号平滑，减少时延，克服硬件***带动伺服机构运行时的抖动和步进，提高跟踪精度。
本发明的目的通过以下技术方案实现：
提供一种采用α-β外差值算法进行数字-自整角机信号转换的方法，所述α-β外差值算法的计算公式如下：
Figure 2012100697191100002DEST_PATH_IMAGE001
；
其中：
Figure 2012100697191100002DEST_PATH_IMAGE002
——上位机传输过来的输入值；
——当前的位置估计值，即单步解算的过渡值；
Figure 2012100697191100002DEST_PATH_IMAGE004
——当前的外推值；
Figure 2012100697191100002DEST_PATH_IMAGE005
——单步外推值；
Figure 2012100697191100002DEST_PATH_IMAGE006
——速度估计值，通过对速度的估计实现外推和预测；
Figure 2012100697191100002DEST_PATH_IMAGE007
——数据通讯的周期，常值；
Figure 2012100697191100002DEST_PATH_IMAGE008
——一个通讯周期内，单片机所需要的插值数，即单片机单个周期内的数据输出频率，
Figure 159496DEST_PATH_IMAGE008
为自然数；
Figure 2012100697191100002DEST_PATH_IMAGE009
——单位周期内插值的步数，
Figure 2012100697191100002DEST_PATH_IMAGE010
；
Figure 2012100697191100002DEST_PATH_IMAGE011
——位置的衰减系数，常值；
Figure 2012100697191100002DEST_PATH_IMAGE012
——速度的衰减系数，常值；
所述方法包括下述步骤：
（1）初始化
Figure 2012100697191100002DEST_PATH_IMAGE013
值；
（2）读入初始数据
Figure 2012100697191100002DEST_PATH_IMAGE014
；
（3）得到初始的
Figure 2012100697191100002DEST_PATH_IMAGE015
；
（4）读入数据；
（5）计算估计值和速度值
Figure 2012100697191100002DEST_PATH_IMAGE017
；
（6）计算
Figure 2012100697191100002DEST_PATH_IMAGE018
，并顺序输出；
（7）返回第4步。
其中，初始时：
Figure 2012100697191100002DEST_PATH_IMAGE019
。
其中，所述α-β的取值为下述三种组合中的任意一种：
（1） 
Figure 2012100697191100002DEST_PATH_IMAGE020
；
（2）
Figure 2012100697191100002DEST_PATH_IMAGE021
；
（3）。
本发明的有益效果：根据硬件***上下位机的工作特点及上下位机间RS485串行通讯的工作模式，在下位机的单片机推导了一种α-β外差值算法，对上位机通过RS485串口传输过来的数据实施实时的外插值，使得通过单片机输出到伺服机构的自整角机信号平滑，该外插值算法程序还具有一定的预测能力，伺服机构跟随在外插值后输出的数据时还可以有效减少***时延和跟踪误差，达到稳定跟踪，精确定位的目的。
附图说明
利用附图对本发明作进一步说明，但附图中的实施例不构成对本发明的任何限制，对于本领域的普通技术人员，在不付出创造性劳动的前提下，还可以根据以下附图获得其它的附图。
图１是采用α-β外差值算法进行数字-自整角机信号转换的方法的流程图。
具体实施方式
下面结合附图对本发明的具体实施方式作进一步详细的描述。
为在下位机简洁地实现数字信号到自整角机信号的转换，并使得通过单片机驱动的双速数字/自整角机转换器能够平稳输出自整角机信号，需完成数字-自整角机信号转换模式的设计和对不连续数字信号的插值平滑。在本设计中，采用单片机、485串行通讯、数模转换技术，提出了一种基于单片机***的数字/自整角机新转换模式，并首次在α-β滤波的基础上推导出了一种适用于单片机***的α-β外差值算法，该算法采用局部线性化方法，通过目标运动假设，进行目标运动位置的预测，该方法可以有效提高数据处理***的输出频率，克服电机步进问题。该方法结构简单有效，对运算速度和存储空间要求低，适用于单片机编程，通过实装试验证明该算法可以有效提高***执行的实时性，改善伺服机构跟踪品质和精度，算法结构简单，可靠性高，对硬件***的要求低，不会导致算法发散，引起电机失控和抖动，算法的稳定性好。
本发明采用α-β外差值算法的计算公式如下：
；
其中：
Figure 236135DEST_PATH_IMAGE002
——上位机传输过来的输入值；
Figure 942929DEST_PATH_IMAGE003
——当前的位置估计值，即单步解算的过渡值；
Figure 819618DEST_PATH_IMAGE004
——当前的外推值；
Figure 455130DEST_PATH_IMAGE005
——单步外推值；
Figure 784480DEST_PATH_IMAGE006
——速度估计值，通过对速度的估计实现外推和预测；
Figure 983380DEST_PATH_IMAGE007
——数据通讯的周期，常值；
Figure 963843DEST_PATH_IMAGE008
——一个通讯周期内，单片机所需要的插值数，即单片机单个周期内的数据输出频率，
Figure 19524DEST_PATH_IMAGE008
为自然数；
Figure 586902DEST_PATH_IMAGE009
——单位周期内插值的步数，；
——位置的衰减系数，常值；
Figure 651045DEST_PATH_IMAGE012
——速度的衰减系数，常值。
本发明所述方法的流程如图1所示，包括下述步骤：
（1）初始化
Figure 954988DEST_PATH_IMAGE013
值；
（2）读入初始数据
Figure 2012100697191100002DEST_PATH_IMAGE023
；
（3）得到初始的
Figure 105477DEST_PATH_IMAGE015
；
（4）读入数据；
（5）计算估计值和速度值
Figure 225777DEST_PATH_IMAGE017
；
（6）计算
Figure 17016DEST_PATH_IMAGE018
，并顺序输出；
（7）返回第4步。
其中，初始时：
Figure 908880DEST_PATH_IMAGE019
。
其中，所述α-β的取值为下述三种组合中的任意一种：
（1） 
Figure 2012100697191100002DEST_PATH_IMAGE024
；
（2）
Figure 2012100697191100002DEST_PATH_IMAGE025
；
（3）
Figure 2012100697191100002DEST_PATH_IMAGE026
。
本发明具体工作时，通过上位机采集传感器的模拟信号，然后在上位机上完成模数转换和数据信号处理，通过RS485串行通讯将处理后的数据传输给下位机的单片机，在单片机实时数据插值和数模转换，最后将转换后的模拟信号传输给伺服机构，由伺服机构带动平台实施动态跟踪。
具体实施本发明时，本发明的硬件***主要由RS-485电路，单片机最小***和双速数字/自整角机转换电路组成。单片机***是该子***的核心，用于接收来自RS-485电路的信息，并处理后送往双速数字/自整角机转换器组；RS-485电路由RS-485收发接口芯片电路构成，用于接收上位机通过RS-485总线传输过来的数字信息；双速数字/自整角机转换电路组由角度转换器电路组成，用于角度位置信号的数模转换。
在板件设计过程中以单片机***为控制核心，接收RS-485数据帧，控制DSC模块（数字—自整角机转换器）的数模转换，为伺服***提供角度的自整角机信息。单片机***采用ATMEL公司的AT89S52。
DSC模块选用中船重工集团709研究所的双速数字—自整角机转换器DSC48-319B-1630，它是一种高精度的数字—自整角机转换器，分辨率为16位。
本发明的单片机程序可采用KEIL集成开发环境C51语言进行开发，软件整体流程图如图1所示。
为了满足在单片机环境下外插值，要求算法实现简单，能够根据当前值实时外推单步数据，并予以输出，还要求算法稳定性好，不发散。在第K个周期，利用上位机传输过来的当前输入值和上步解算出来的外推值求得当前的位置估计值，然后用当前输入值和外推值修正速度估计值，最后根据所计算出来的位置估计值和速度估计值得出单步外推的输出值。位置衰减系数α的作用是根据输入值和历史的外推值，修正位置估计值；速度衰减系数β的作用是对新的输入值对速度估计进行修正。
在算法程序运行过程中，每一个通讯周期内，可以拟线性地均匀***
Figure 2012100697191100002DEST_PATH_IMAGE027
个外推值，并实时输出，通过提高数据处理***的输出频率，以达到外插值实现平滑，减少误差和时延，提高精度的目的，可以有效克服伺服***步进问题。
本发明中的算法时间复杂度和空间复杂度计算如下：
本算法程序的时间复杂度函数如下：
Figure 2012100697191100002DEST_PATH_IMAGE028
，
其中，
Figure 2012100697191100002DEST_PATH_IMAGE029
的滑动窗口容纳的样本数量，
Figure 2012100697191100002DEST_PATH_IMAGE030
为关于n的一次多项式，n为样本数量。在32位定点单片机中，采用KEIL集成开发环境C51语言进行开发16位浮点运算程序，进行精确的浮点运算。估算的运算量如下：
Figure 2012100697191100002DEST_PATH_IMAGE031
，
若外插值数
Figure 2012100697191100002DEST_PATH_IMAGE032
，运算次数为112。若取采样时间为20毫秒，只需单片机运算速度大于5.5K既可满足要求。
本算法程序的空间复杂度函数为如下：
Figure 2012100697191100002DEST_PATH_IMAGE033
，
Figure 2012100697191100002DEST_PATH_IMAGE034
为关于n的一次多项式，n为样本数量。采用16位浮点运算程序，则估算的缓存空间为：
Figure 2012100697191100002DEST_PATH_IMAGE035
，
若外插值数
Figure 2012100697191100002DEST_PATH_IMAGE036
，则所需缓存40字节，只需单片机运算缓存空间大于40字节既可满足要求。
由此可见，本算法程序的时间复杂度、空间复杂度都是是比较低的，适用于单片机环境。
总之，本发明虽然例举了上述优选实施方式，但是应该说明，虽然本领域的技术人员可以进行各种变化和改型，除非这样的变化和改型偏离了本发明的范围，否则都应该包括在本发明的保护范围内。

Claims (3)

1.一种采用α-β外差值算法进行数字-自整角机信号转换的方法，其特征在于，所述α-β外差值算法的计算公式如下：
Figure 2012100697191100001DEST_PATH_IMAGE001
；
其中：
Figure 2012100697191100001DEST_PATH_IMAGE003
——上位机传输过来的输入值；
Figure 2012100697191100001DEST_PATH_IMAGE005
——当前的位置估计值，即单步解算的过渡值；
Figure 2012100697191100001DEST_PATH_IMAGE007
——当前的外推值；
Figure 2012100697191100001DEST_PATH_IMAGE009
——单步外推值；
Figure 2012100697191100001DEST_PATH_IMAGE011
——速度估计值，通过对速度的估计实现外推和预测；
Figure 2012100697191100001DEST_PATH_IMAGE013
——数据通讯的周期，常值；
——一个通讯周期内，单片机所需要的插值数，即单片机单个周期内的数据输出频率，
Figure 488842DEST_PATH_IMAGE015
为自然数；
Figure 2012100697191100001DEST_PATH_IMAGE017
——单位周期内插值的步数，；
Figure 2012100697191100001DEST_PATH_IMAGE021
——位置的衰减系数，常值；
Figure 2012100697191100001DEST_PATH_IMAGE023
——速度的衰减系数，常值；
所述方法包括下述步骤：
（1）初始化
Figure 2012100697191100001DEST_PATH_IMAGE025
值；
（2）读入初始数据
Figure 2012100697191100001DEST_PATH_IMAGE027
；
（3）得到初始的
Figure 2012100697191100001DEST_PATH_IMAGE029
；
（4）读入数据
Figure 2012100697191100001DEST_PATH_IMAGE031
；
（5）计算估计值和速度值
Figure 2012100697191100001DEST_PATH_IMAGE033
；
（6）计算
Figure 2012100697191100001DEST_PATH_IMAGE035
，并顺序输出；
（7）返回第4步。
2.根据权利要求1所述的采用α-β外差值算法进行数字-自整角机信号转换的方法，其特征在于，初始时：
Figure DEST_PATH_IMAGE037
。
3.根据权利要求1或2所述的采用α-β外差值算法进行数字-自整角机信号转换的方法，其特征在于，所述α-β的取值为下述三种组合中的任意一种：
（1） 
Figure DEST_PATH_IMAGE039
；
（2）
Figure DEST_PATH_IMAGE041
；
（3）
Figure DEST_PATH_IMAGE043
。
CN201210069719.1A 2012-03-16 2012-03-16 采用α-β外差值算法进行数字-自整角机信号转换的方法 Expired - Fee Related CN102611452B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201210069719.1A CN102611452B (zh) 2012-03-16 2012-03-16 采用α-β外差值算法进行数字-自整角机信号转换的方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201210069719.1A CN102611452B (zh) 2012-03-16 2012-03-16 采用α-β外差值算法进行数字-自整角机信号转换的方法

Publications (2)

Publication Number Publication Date
CN102611452A true CN102611452A (zh) 2012-07-25
CN102611452B CN102611452B (zh) 2015-06-17

Family

ID=46528641

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201210069719.1A Expired - Fee Related CN102611452B (zh) 2012-03-16 2012-03-16 采用α-β外差值算法进行数字-自整角机信号转换的方法

Country Status (1)

Country Link
CN (1) CN102611452B (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106324633A (zh) * 2015-06-26 2017-01-11 无线电通信***公司 Gnss应用中跟踪位置及速度的***及方法

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101281041A (zh) * 2008-04-14 2008-10-08 连云港杰瑞电子有限公司 单电源cmos集成电路自整角机/旋转变压器-数字转换技术
CN101789757A (zh) * 2010-03-12 2010-07-28 连云港杰瑞电子有限公司 单芯片的自整角机/旋转变压器—数字转换方法
US20110037627A1 (en) * 2009-11-03 2011-02-17 The United States Of America As Represented By The Secretary Of The Navy Modular Units for Synchro-to-Digital Conversion and Digital-to-Synchro Conversion

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101281041A (zh) * 2008-04-14 2008-10-08 连云港杰瑞电子有限公司 单电源cmos集成电路自整角机/旋转变压器-数字转换技术
US20110037627A1 (en) * 2009-11-03 2011-02-17 The United States Of America As Represented By The Secretary Of The Navy Modular Units for Synchro-to-Digital Conversion and Digital-to-Synchro Conversion
CN101789757A (zh) * 2010-03-12 2010-07-28 连云港杰瑞电子有限公司 单芯片的自整角机/旋转变压器—数字转换方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
徐大林等: "一种高精度全数字跟踪型轴角-数字转换***", 《微电机》, vol. 42, no. 1, 24 April 2009 (2009-04-24) *

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106324633A (zh) * 2015-06-26 2017-01-11 无线电通信***公司 Gnss应用中跟踪位置及速度的***及方法

Also Published As

Publication number Publication date
CN102611452B (zh) 2015-06-17

Similar Documents

Publication Publication Date Title
CN103591961B (zh) 一种基于dsp和fpga的捷联罗经导航计算机
CN106569487B (zh) 一种基于观测器的伺服***的故障检测方法
CN102624375B (zh) 兼容多种编码器与旋转变压器接口的信号处理装置
CN102185546B (zh) 大口径望远镜弧线电机驱动控制方法及其***
CN101114174A (zh) 嵌入式四轴运动控制器
CN111624878B (zh) 自主式水面机器人轨迹跟踪的积分滑模获取方法及***
CN1752874A (zh) 基于片上***的嵌入式运动控制方法及装置
CN104132663A (zh) 一种基于fpga的导航计算机协处理器
CN109445274B (zh) 一种柔性空间机械臂振动控制方法及***
JP5280871B2 (ja) サーボモーターの低速制御方法と装置
CN112834249B (zh) 转向参数检测方法、装置、设备及存储介质
CN103092219B (zh) 一种fsm远程实时控制时间补偿***及方法
CN115509135A (zh) 一种激光扫描振镜模型预测控制方法及***
CN108471266B (zh) 一种伺服电机的角速度指令及旋转角位置预处理***
CN105676197A (zh) 一种阵列雷达回波模拟器及其模拟方法
CN102611452A (zh) 采用α-β外差值算法进行数字-自整角机信号转换的方法
CN111181559B (zh) 一种旋***解码方法、装置、设备和存储介质
CN107612431A (zh) 一种电动舵机的控制方法和控制***
CN113108811A (zh) 光电转塔跟踪精度自动分析计算装置
CN109015646B (zh) 位置信息自标定方法、装置、设备和存储介质
CN102184521A (zh) 高性能图像处理***及图像数据处理方法
CN208224851U (zh) 控制电路和粗瞄控制***
CN104469166B (zh) 一种图像采集控制装置和方法
CN2935226Y (zh) 以设定角度和周期往复摇摆运动的控制装置
CN220653355U (zh) 基于模拟接入端口驱动器的数模转接卡

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20150617

Termination date: 20160316

CF01 Termination of patent right due to non-payment of annual fee