CN104133489A - 连续波导航雷达精确伺服控制***及其控制方法 - Google Patents
连续波导航雷达精确伺服控制***及其控制方法 Download PDFInfo
- Publication number
- CN104133489A CN104133489A CN201410352004.6A CN201410352004A CN104133489A CN 104133489 A CN104133489 A CN 104133489A CN 201410352004 A CN201410352004 A CN 201410352004A CN 104133489 A CN104133489 A CN 104133489A
- Authority
- CN
- China
- Prior art keywords
- module
- stepper motor
- continuous wave
- motor
- control system
- 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
Links
Landscapes
- Variable-Direction Aerials And Aerial Arrays (AREA)
Abstract
本发明涉及公开了一种连续波导航雷达精确伺服控制***及其控制方法,***包括步进电机、驱动步进电机转动的驱动单元、方位反馈装置和Microblaze软核处理器模块、方位解析模块、电机控制模块;Microblaze软核处理器模块包括接收包含有外部控制指令的网络数据的媒体访问模块、从媒体访问模块获取网络数据并解析出外部控制指令的协议解析模块;方位反馈装置用于采集步进电机方位信息并发送给方位解析模块;方位解析模块用于接收和解析步进电机方位信息;电机控制模块根据外部控制指令和步进电机方位信息控制驱动单元工作,从而驱动步进电机转动,具有数据处理快、精确度和可靠性高的优点,可以为连续波导航雷达***提供快速、高可靠性、高精确的伺服控制。
Description
技术领域
本发明涉及雷达伺服控制技术领域,具体地,涉及一种连续波导航雷达精确伺服控制***及其控制方法。
背景技术
船用雷达主要用于发现和测定周围目标的方位和距离,正确地显示岸线、航标、其他航行船舶或其他标志物相对于雷达的坐标位置,以便于本船只采取正确的航行姿态和航向。
雷达按发射信号的形式分为脉冲雷达和连续波雷达,脉冲雷达通过测量回波信号相对于发射信号的时间计算目标距离,为了探测远处目标需要很大的峰值功率。连续波以多普勒效应来探测目标位置,距离和速度等信息。相对于脉冲雷达,连续波导航雷达距离分辨率高、无盲区、发射功率低、成本低,适用于内河及近海导航,目前广泛应用于民用中小型船只。
发明内容
本发明所要解决的技术问题是提供一种连续波导航雷达精确伺服控制***,该连续波导航雷达精确伺服控制***可以为连续波导航雷达***提供快速、高可靠性、高精确的伺服控制***,本发明还提供了该伺服控制***的控制方法。
本发明解决上述问题所采用的技术方案是:
连续波导航雷达精确伺服控制***,包括步进电机、驱动步进电机转动的驱动单元,还包括方位反馈装置和设置在FPGA内的Microblaze软核处理器模块、方位解析模块、电机控制模块;
所述Microblaze软核处理器模块包括媒体访问模块和协议解析模块;
所述媒体访问模块,用于接收包含有外部控制指令的网络数据;
所述协议解析模块,用于从媒体访问模块获取网络数据并解析出外部控制指令;
所述方位反馈装置,用于采集步进电机方位信息并发送给方位解析模块;
所述方位解析模块,用于接收和解析方位反馈装置发送的步进电机方位信息;
所述电机控制模块,用于根据协议解析模块解析出的外部控制指令和方位解析模块解析的步进电机方位信息控制驱动单元工作,从而驱动步进电机转动。
作为本发明的进一步改进,上述连续波导航雷达精确伺服控制***还包括以太网接口和网络芯片,所述媒体访问模块通过网络芯片与以太网接口相连。
现有技术中的导航雷达伺服控制***一般由上位机发送外部指令给伺服控制***,从而控制伺服驱动器控制电机转动,步进电机方位信息直接反馈给伺服驱动器,由伺服驱动器解析步进电机的方位信息,并结合外部指令进行步进电机的控制,发明人在长期的研究中发现,在该***中,伺服控制器接收到反馈的步进电机方位信息后,其处理速度受限,鉴于此发明人提供了上述方案,本方案的方位反馈装置采集步进电机方位信息直接发送给FPGA的方位解析模块,FPGA内进行步进电机的方位信息解析并结合反馈的步进电机方位信息和外部控制指令对驱动单元进行控制,驱动单元驱动步进电机,形成一个闭环控制,具有高可靠性和高精确性,由于FPGA具有强大的数据处理能力,其处理速度快,还可以支持驱动单元的轻量化。
进一步,上述网络芯片为PHY芯片。
进一步,上述连续波导航雷达精确伺服控制***还包括上位机,上位机连接以太网接口。
进一步,上述方位反馈装置为编码器。
连续波导航雷达精确伺服控制***的控制方法,包括以下步骤:
S1:上位机发送外部控制指令;
S2:媒体访问模块通过以太网接口和网络芯片接收包含外部控制指令的网络数据,并转发给协议解析模块解析;
S3:协议解析模块接收媒体访问模块的网络数据并解析出外部控制指令;
S4:方位解析模块根据方位反馈装置发送的当前步进电机方位信息解析出步进电机的当前方位数据;
S5:电机控制模块根据解析出的外部控制指令和当前步进电机方位数据控制驱动单元工作;
S6:驱动单元驱动步进电机转动或停止,同时跳转到步骤S7和步骤S2;
S7:方位反馈装置采集步进电机方位信息并反馈给方位解析模块,跳转到步骤S4;
其中步骤S4与步骤S3同时进行或者在步骤S3之前进行。
进一步,所述外部控制指令中包括设定转动角度θ;所述步进电机的当前方位数据包括当前步进电机的转角α;步骤S5中,电机控制模块依次执行以下步骤:
S51,获得解析出的外部控制指令中的设定转动角度θ和当前步进电机方位数据中的当前步进电机的转角α;
S52:计算出θ和α的差值Δ,Δ=α-θ;
S53:比较Δ和步进电机的步距角Δ0的大小,如果|Δ|<=Δ0,则向驱动单元发送停止信号;如果|Δ|>Δ0,则继续判定;
S54:如果Δ<0,则向驱动单元发送顺时针转动信号,如果Δ>0,则向驱动单元发送逆时钟转动信号。
进一步,步骤S54中,电机控制模块还根据设定转动角度θ向驱动单元发送相应个数的脉冲信号;步骤S6中,驱动单元根据接收到的脉冲信号驱动步进电机顺时针转动或逆时针转动。
进一步,步骤S5中,电机控制模块还会首先判断协议解析模块解析出的外部控制指令是否为停止转动,是则结束控制,步进电机停止转动;否则执行步骤S51-S54。
进一步,上述步进电机的当前方位数据还包括步进电机的磁极位置和转速。
综上,本发明的有益效果是:
1、本发明的方位反馈装置采集步进电机方位信息并直接发送给FPGA的方位解析模块,FPGA内方位解析模块解析反馈的步进电机方位信息,电机控制模块结合步进电机方位信息和外部控制指令对驱动单元进行控制,驱动单元驱动步进电机,形成一个闭环控制,能够精确伺服并且具有较高的可靠性。
2、本发明由FPGA进行解析步进电机的方位信息,结合外部控制指令对驱动单元进行控制,从而控制步进电机的转动,由于FPGA具有强大的数据处理能力,其不仅可以支持驱动单元的轻量化,而且其精确性也比驱动单元的精确性更高,还能大大加快数据和指令的处理速度,达到高速处理和高精度控制。
3、本发明的连续波导航雷达精确伺服控制***可以为连续波导航雷达***提供快速、高可靠性、高精确的伺服控制***。
附图说明
图1是本发明的连续波导航雷达精确伺服控制***的结构示意图;
图2是本发明的连续波导航雷达精确伺服控制***的控制方法流程图;
图3是电机控制模块的工作流程图。
具体实施方式
下面结合实施例及附图,对本发明作进一步地的详细说明,但本发明的实施方式不限于此。
实施例1:
如图1所示,连续波导航雷达精确伺服控制***,包括步进电机、驱动步进电机转动的驱动单元、方位反馈装置、Microblaze软核处理器模块(即图1中的Microblaze核)、方位解析模块、电机控制模块,其中Microblaze软核处理器模块、方位解析模块、电机控制模块设置在FPGA内:
所述Microblaze软核处理器模块包括媒体访问模块和协议解析模块;
所述媒体访问模块,用于接收包含有外部控制指令的网络数据;
所述协议解析模块,用于从媒体访问模块获取网络数据并解析出外部控制指令;
所述方位反馈装置用于采集步进电机方位信息并发送给方位解析模块;
所述方位解析模块用于接收和解析方位反馈装置发送的步进电机方位信息;
所述电机控制模块用于根据协议解析模块解析出的外部控制指令和方位解析模块解析的步进电机方位信息控制驱动单元工作,从而驱动步进电机转动。
步进电机后还依次连接转台和天线等。
MicroBlaze核是一个被Xilinx公司优化过的可以嵌入在FPGA中的RISC处理器软核,具有运行速度快、占用资源少、可配置性强等优点,本实施例中步进电机的伺服控制***中采用FPGA并嵌入MicroBlaze核,可以快速地处理***数据,能够迅速接收和解析包含控制指令的网络数据并对步进电机进行控制。
本实施例中,方位反馈装置采集步进电机方位信息并直接发送给FPGA的方位解析模块,FPGA内的方位解析模块解析反馈的步进电机当前方位信息,而电机控制模块结合解析的步进电机方位信息和外部控制指令对驱动单元进行控制,驱动单元驱动步进电机,形成一个闭环控制,能够精确伺服并且具有较高的可靠性。
此外,现有技术中的方位反馈装置一般将步进电机方位信息直接反馈给驱动单元,由驱动单元进行判断并进行步进电机的控制,这样需要驱动单元具有较高的计算处理能力。
本实施例中,方位反馈装置将步进电机方位信息直接反馈给FPGA,由FPGA进行解析,结合外部控制指令对驱动单元进行控制,从而控制步进电机的转动。由于FPGA具有强大的数据处理能力,其不仅可以支持驱动单元的轻量化(驱动单元无需具备步进电机的位置判断和结合外部指令计算控制能力,其只需按照FPGA的电机控制模块的指令控制步进电机转动即可),而且其精确性也比驱动单元的精确性更高,还能大大加快数据和指令的处理速度,达到高速处理和高精度控制。
实施例2:
在实施例1的基础上,本实施例中的连续波导航雷达精确伺服控制***还包括上位机、以太网接口、网络芯片,上位机连接以太网接口,所述媒体访问模块通过网络芯片与以太网接口相连,使得FPGA与上位机相连,上位机通过网络向FPGA发送指令,本实施例中,网络芯片采用PHY芯片,上述方位反馈装置采用编码器,编码器采集步进电机的转角、转速、磁极位置等数据反馈给FPGA上的电机控制模块,上述驱动单元采用伺服电机驱动器,其接收FPGA的控制脉冲并根据该脉冲控制步进电机转动。伺服电机驱动器接收FPGA发送的脉冲信号控制控制步进电机的转动为本领域常用技术手段,本实施例中不再赘述其具体实施方式。
如图2所示,连续波导航雷达精确伺服控制***的控制方法,包括以下步骤:
S1:上位机发送外部控制指令;
S2:媒体访问模块通过以太网接口和网络芯片接收包含外部控制指令的网络数据,并转发给协议解析模块解析;
S3:协议解析模块接收媒体访问模块的网络数据并解析出外部控制指令,该外部控制指令中包括设定转动角度θ;
S4:方位解析模块根据方位反馈装置发送的当前步进电机方位信息解析出步进电机的当前方位数据,该当前方位数据包括当前步进电机的转角α,该步骤可以与步骤S1至S3中的任一个或任两个步骤或3个步骤同时进行,即与步骤S3同时进行或者在步骤S3之前进行;
S5:电机控制模块根据解析出的外部控制指令和当前步进电机方位数据控制驱动单元工作;
S6:驱动单元驱动步进电机转动或停止,同时跳转到步骤S7和步骤S2;
S7:方位反馈装置采集步进电机方位信息并反馈给方位解析模块,跳转到步骤S4。
其中,如图3所示,步骤S5中,电机控制模块依次执行以下步骤:
S51,获得解析出的外部控制指令中的设定转动角度θ和当前步进电机方位数据中的当前步进电机的转角α;
S52:计算出θ和α的差值Δ,Δ=α-θ;
S53:比较Δ和步进电机的步距角Δ0的大小,如果Δ<=Δ0,则向驱动单元发送停止信号;如果|Δ|>Δ0,则继续判定;
S54:如果Δ<0,则向驱动单元发送顺时针转动信号,如果Δ>0,则向驱动单元发送逆时钟转动信号。
步骤S54中,电机控制模块还根据设定转动角度θ向驱动单元发送相应个数的脉冲信号;这种情况下在步骤S6中,驱动单元根据接收到的脉冲信号驱动步进电机顺时针转动或逆时针转动。
进一步,上述方法在步骤S5中,电机控制模块还会首先判断协议解析模块解析出的外部控制指令是否为停止转动,是则结束控制,步进电机停止转动;否则执行步骤S51-S54。
实际应用中,所述步进电机的当前方位数据不仅限于上述转角α,还可以进一步包括步进电机的磁极位置和转速。
以上仅是本发明的优选实施方式,本发明的保护范围并不仅局限于上述实施例,凡属于本发明思路下的技术方案均属于本发明的保护范围。应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理前提下的若干改进和润饰,应视为本发明的保护范围。
Claims (10)
1.连续波导航雷达精确伺服控制***,其特征在于,包括步进电机、驱动步进电机转动的驱动单元,其特征在于,还包括方位反馈装置和设置在FPGA内的Microblaze软核处理器模块、方位解析模块、电机控制模块;
所述Microblaze软核处理器模块包括媒体访问模块和协议解析模块;
所述媒体访问模块,用于接收包含有外部控制指令的网络数据;
所述协议解析模块,用于从媒体访问模块获取网络数据并解析出外部控制指令;
所述方位反馈装置,用于采集步进电机方位信息并发送给方位解析模块;
所述方位解析模块,用于接收和解析方位反馈装置发送的步进电机方位信息;
所述电机控制模块,用于根据协议解析模块解析出的外部控制指令和方位解析模块解析的步进电机方位信息控制驱动单元工作,从而驱动步进电机转动。
2.根据权利要求1所述的连续波导航雷达精确伺服控制***,其特征在于,还包括以太网接口和网络芯片,所述媒体访问模块通过网络芯片与以太网接口相连。
3.根据权利要求2所述的连续波导航雷达精确伺服控制***,其特征在于,所述网络芯片为PHY芯片。
4.根据权利要求2所述的连续波导航雷达精确伺服控制***,其特征在于,还包括上位机,上位机连接以太网接口。
5.根据权利要求1至4任一所述的连续波导航雷达精确伺服控制***,其特征在于,所述方位反馈装置为编码器。
6.连续波导航雷达精确伺服控制***的控制方法,其特征在于,包括以下步骤:
S1:上位机发送外部控制指令;
S2:媒体访问模块通过以太网接口和网络芯片接收包含外部控制指令的网络数据,并转发给协议解析模块解析;
S3:协议解析模块接收媒体访问模块的网络数据并解析出外部控制指令;
S4:方位解析模块根据方位反馈装置发送的当前步进电机方位信息解析出步进电机的当前方位数据;
S5:电机控制模块根据解析出的外部控制指令和当前步进电机方位数据控制驱动单元工作;
S6:驱动单元驱动步进电机转动或停止,同时跳转到步骤S7和步骤S2;
S7:方位反馈装置采集步进电机方位信息并反馈给方位解析模块,跳转到步骤S4;
其中步骤S4与步骤S3同时进行或者在步骤S3之前进行。
7.根据权利要求6所述的连续波导航雷达精确伺服控制***的控制方法,其特征在于,所述外部控制指令中包括设定转动角度θ;所述步进电机的当前方位数据包括当前步进电机的转角α;
步骤S5中,电机控制模块依次执行以下步骤:
S51,获得解析出的外部控制指令中的设定转动角度θ和当前步进电机方位数据中的当前步进电机的转角α;
S52:计算出θ和α的差值Δ,Δ=α-θ;
S53:比较Δ和步进电机的步距角Δ0的大小,如果|Δ|<=Δ0,则向驱动单元发送停止信号;如果|Δ|>Δ0,则继续判定;
S54:如果Δ<0,则向驱动单元发送顺时针转动信号,如果Δ>0,则向驱动单元发送逆时钟转动信号。
8.根据权利要求7所述连续波导航雷达精确伺服控制***的控制方法,其特征在于,步骤S54中,电机控制模块还根据设定转动角度θ向驱动单元发送相应个数的脉冲信号;步骤S6中,驱动单元根据接收到的脉冲信号驱动步进电机顺时针转动或逆时针转动。
9.根据权利要求7所述连续波导航雷达精确伺服控制***的控制方法,其特征在于,步骤S5中,电机控制模块还会首先判断协议解析模块解析出的外部控制指令是否为停止转动,是则结束控制,步进电机停止转动;否则执行步骤S51-S54。
10.根据权利要求6至9任一所述连续波导航雷达精确伺服控制***的控制方法,其特征在于,所述步进电机的当前方位数据还包括步进电机的磁极位置和转速。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410352004.6A CN104133489B (zh) | 2014-07-23 | 2014-07-23 | 连续波导航雷达精确伺服控制***及其控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410352004.6A CN104133489B (zh) | 2014-07-23 | 2014-07-23 | 连续波导航雷达精确伺服控制***及其控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104133489A true CN104133489A (zh) | 2014-11-05 |
CN104133489B CN104133489B (zh) | 2016-08-17 |
Family
ID=51806204
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410352004.6A Expired - Fee Related CN104133489B (zh) | 2014-07-23 | 2014-07-23 | 连续波导航雷达精确伺服控制***及其控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104133489B (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105355166A (zh) * | 2015-10-15 | 2016-02-24 | 西安诺瓦电子科技有限公司 | 嵌入式控制卡、显示卡以及油价牌控制*** |
CN111948610A (zh) * | 2019-05-15 | 2020-11-17 | 深圳越登智能技术有限公司 | 一种雷达的控制方法及设备 |
CN114265016A (zh) * | 2021-12-28 | 2022-04-01 | 河北德冠隆电子科技有限公司 | 一种多角度调节广域雷达传感器***及方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0222709A (ja) * | 1988-07-12 | 1990-01-25 | Mitsubishi Electric Corp | 数値制御装置 |
JPH03134714A (ja) * | 1989-10-20 | 1991-06-07 | Citizen Watch Co Ltd | 位置決め制御装置及び位置教示方法 |
JPH05300779A (ja) * | 1992-04-20 | 1993-11-12 | Takaoka Electric Mfg Co Ltd | サーボモータ制御方法 |
CN2924613Y (zh) * | 2006-06-13 | 2007-07-18 | 中国科学院空间科学与应用研究中心 | 一种天线伺服***控制装置 |
CN202995032U (zh) * | 2012-12-28 | 2013-06-12 | 成都天奥信息科技有限公司 | 一种基于Microblaze实现连续波导航雷达数据高速传输的平台 |
CN203658766U (zh) * | 2014-01-17 | 2014-06-18 | 成都天奥信息科技有限公司 | 船用连续导航波雷达伺服电机精准控制*** |
-
2014
- 2014-07-23 CN CN201410352004.6A patent/CN104133489B/zh not_active Expired - Fee Related
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0222709A (ja) * | 1988-07-12 | 1990-01-25 | Mitsubishi Electric Corp | 数値制御装置 |
JPH03134714A (ja) * | 1989-10-20 | 1991-06-07 | Citizen Watch Co Ltd | 位置決め制御装置及び位置教示方法 |
JPH05300779A (ja) * | 1992-04-20 | 1993-11-12 | Takaoka Electric Mfg Co Ltd | サーボモータ制御方法 |
CN2924613Y (zh) * | 2006-06-13 | 2007-07-18 | 中国科学院空间科学与应用研究中心 | 一种天线伺服***控制装置 |
CN202995032U (zh) * | 2012-12-28 | 2013-06-12 | 成都天奥信息科技有限公司 | 一种基于Microblaze实现连续波导航雷达数据高速传输的平台 |
CN203658766U (zh) * | 2014-01-17 | 2014-06-18 | 成都天奥信息科技有限公司 | 船用连续导航波雷达伺服电机精准控制*** |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105355166A (zh) * | 2015-10-15 | 2016-02-24 | 西安诺瓦电子科技有限公司 | 嵌入式控制卡、显示卡以及油价牌控制*** |
CN111948610A (zh) * | 2019-05-15 | 2020-11-17 | 深圳越登智能技术有限公司 | 一种雷达的控制方法及设备 |
CN114265016A (zh) * | 2021-12-28 | 2022-04-01 | 河北德冠隆电子科技有限公司 | 一种多角度调节广域雷达传感器***及方法 |
Also Published As
Publication number | Publication date |
---|---|
CN104133489B (zh) | 2016-08-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106597393B (zh) | 一种星载微波光学复合跟瞄雷达在轨标定***和方法 | |
CN103259089A (zh) | 一种x波段气象雷达天线控制方法和控制装置 | |
CN109358342B (zh) | 基于2d激光雷达的三维激光slam***及控制方法 | |
CN103501141A (zh) | 圆形角位置传感器角位置误差检测补偿装置及补偿方法 | |
CN111366908B (zh) | 一种激光雷达转台及其测量装置和测量方法 | |
CN104133489A (zh) | 连续波导航雷达精确伺服控制***及其控制方法 | |
CN103487787A (zh) | 一种四旋翼无人机的超声波定位装置及方法 | |
CN104281158A (zh) | 摄像头稳定跟踪装置及方法 | |
CN108592887A (zh) | 一种水下光通信自动瞄准捕获跟踪装置 | |
CN104729538A (zh) | 基于激光扫描的采煤机定位定姿***的校准方法及装置 | |
CN104648613B (zh) | 一种基于激光引导技术的船模操纵性试验装置 | |
CN106654531A (zh) | 一种船载vsat天线***卫星捕获方法 | |
CN111176290A (zh) | 一种无人艇信息融合处理方法和*** | |
CN206671888U (zh) | 一种自主无人船 | |
CN104007769A (zh) | 高空气球电池标定用太阳跟踪控制方法 | |
CN204479086U (zh) | 基于激光扫描的采煤机定位定姿***的校准装置 | |
CN106919168B (zh) | 室内自航模操纵性实验定位*** | |
CN109994834A (zh) | 特种设备天线快速精确定位***及其方法 | |
CN106646504A (zh) | 激光雷达导航方法及装置 | |
CN104236549B (zh) | 一种航向发送设备及航向发送方法 | |
CN203433110U (zh) | 一种车用雷达激光扫描机构 | |
CN206470615U (zh) | 一种通用型无人机云台控制*** | |
CN203224622U (zh) | 一种x波段气象雷达天线控制装置 | |
CN201039215Y (zh) | 一种串行通讯及解码装置 | |
CN101393460A (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 | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20160817 Termination date: 20170723 |