CN106020059A - 一种编码补偿方法、装置及伺服驱动器 - Google Patents
一种编码补偿方法、装置及伺服驱动器 Download PDFInfo
- Publication number
- CN106020059A CN106020059A CN201610573365.2A CN201610573365A CN106020059A CN 106020059 A CN106020059 A CN 106020059A CN 201610573365 A CN201610573365 A CN 201610573365A CN 106020059 A CN106020059 A CN 106020059A
- Authority
- CN
- China
- Prior art keywords
- encoded radio
- compensation
- history
- encoding
- abnormal
- 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
- 238000000034 method Methods 0.000 title claims abstract description 25
- 230000002159 abnormal effect Effects 0.000 claims abstract description 64
- 230000005540 biological transmission Effects 0.000 claims abstract description 36
- 238000004891 communication Methods 0.000 claims abstract description 31
- 230000001447 compensatory effect Effects 0.000 claims description 41
- 238000001514 detection method Methods 0.000 claims description 5
- 238000000151 deposition Methods 0.000 claims description 2
- 230000005856 abnormality Effects 0.000 abstract description 7
- 108091006146 Channels Proteins 0.000 description 31
- 230000009977 dual effect Effects 0.000 description 7
- 230000000694 effects Effects 0.000 description 7
- 230000002093 peripheral effect Effects 0.000 description 4
- 238000005516 engineering process Methods 0.000 description 3
- 230000005611 electricity Effects 0.000 description 2
- 230000005855 radiation Effects 0.000 description 2
- 230000007704 transition Effects 0.000 description 2
- 230000002547 anomalous effect Effects 0.000 description 1
- 238000003556 assay Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000000052 comparative effect Effects 0.000 description 1
- 230000007322 compensatory function Effects 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 239000000126 substance Substances 0.000 description 1
- 230000001360 synchronised effect Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/04—Programme control other than numerical control, i.e. in sequence controllers or logic controllers
- G05B19/042—Programme control other than numerical control, i.e. in sequence controllers or logic controllers using digital processors
- G05B19/0423—Input/output
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/20—Pc systems
- G05B2219/25—Pc structure of the system
- G05B2219/25257—Microcontroller
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Control Of Electric Motors In General (AREA)
Abstract
本发明实施例公开了一种编码补偿方法、装置及伺服驱动器。所述方法包括获取编码器发送的编码值;根据预设的补偿条件判断所获取的编码值是否异常,在所述编码值异常时,根据历史编码值预测补偿编码值;根据判断结果执行数字通道切换,将所述补偿编码值通过异常数据传输通道输出至电机驱动模块,以使所述电机驱动模块在编码值异常时,根据所述补偿编码值控制电机运行。本发明实现通过对历史编码值的计算,预测在发生通讯异常时编码器应该返回的编码值,伺服驱动器根据补偿编码值控制电机的运行,使电机的运行状态能够平滑过渡,达到了提高伺服控制系统在强干扰环境下的可靠性的效果。
Description
技术领域
本发明实施例涉及电机控制技术,尤其涉及一种编码补偿方法、装置及伺服驱动器。
背景技术
伺服控制系统是一种能对试验装置的机械运动按预定要求进行自动控制的操作系统。因此,伺服控制系统常被应用于各种恶劣和高危的自动化应用环境,例如高辐射环境、电源谐波大及电压不稳定的环境等。上述恶劣的环境对编码器的正常工作造成巨大的影响。
编码器,特别是绝对式编码器是伺服控制系统实现高精度定位及定速控制的关键零部件。编码器的精度和抗干扰能力直接决定了伺服控制系统的控制精度和电磁兼容性能。实际应用中,编码器一般与永磁同步电机同轴安装,与伺服驱动器通过线缆连接,通常采用485通讯协议与伺服驱动器进行串行通讯,以进行数据交换。当伺服控制系统应用于高辐射或电源谐波大等强干扰的工况时,编码器与伺服驱动器之间的通讯容易被外部电磁信号打断或破坏,造成伺服控制系统或电机运行异常,更严重地,可能造成事故。
本申请的发明人在实现本发明的过程中,发现现有技术的伺服控制系统中编码器与伺服驱动器之间的线缆多采用了共地与编织网屏蔽的线缆结构,但实践证明该结构未能完全杜绝编码器通讯因外部干扰而中断或影响编码值的现象。
发明内容
本发明提供一种编码补偿方法、装置及伺服驱动器,以在出现编码异常时,实现编码补偿,使电机运行状态平滑过渡,提高伺服控制系统在强干扰环境下的可靠性。
第一方面,本发明实施例提供了一种编码补偿方法,包括:
获取编码器发送的编码值;
根据预设的补偿条件判断所获取的编码值是否异常,在所述编码值异常时,根据历史编码值预测补偿编码值;
根据判断结果执行数字通道切换,将所述补偿编码值通过异常数据传输通道输出至电机驱动模块,以使所述电机驱动模块在编码值异常时,根据所述补偿编码值控制电机运行。
进一步的,根据预设的补偿条件判断所获取的编码值是否异常,包括:
判断所述编码值是否超过设定阈值;
若超过设定阈值,则确定所述编码值异常;
若未超过设定阈值,则判断与编码器的通讯时间是否超过设定时间阈值,若超过设定时间阈值,则确定所述编码值异常,若未超过设定时间阈值,则确定所述编码值正常。
进一步的,在根据预设的补偿条件判断所获取的编码值是否异常之后,还包括:
在所述编码值正常时,根据所述编码值更新对应的寄存器,用于根据寄存器中的正常编码值计算补偿编码值;
通过正常数据传输通道输出所述编码值至电机驱动模块。
进一步的,在根据历史编码值预测补偿编码值之前,还包括:
检测连续的补偿次数,判断所述补偿次数是否超过设定次数阈值;
若是,则向电机驱动模块发送停机指示,并报警;
若否,则获取寄存器中存储的历史编码值。
进一步的,在所述编码值异常时,根据历史编码值预测补偿编码值,包括:
在当前编码值异常时,将与当前时刻最接近的三个连续的正常编码值中,与当前时刻时间间隔最短的时刻对应的正常编码值作为第一历史编码值,以及,与当前时刻时间间隔最长的时刻对应的正常编码值作为第二历史编码值;
根据所述第一历史编码值和所述第二历史编码值,计算补偿编码值。
进一步的,将所述补偿编码值通过所述异常数据传输通道输出至电机驱动模块之前,还包括:
通过所述异常数据传输通道将所述补偿编码值发送至随机存储器进行缓存,以使所述电机驱动模块从所述随机存储器中读取所述补偿编码值。
第二方面,本发明实施例还提供了一种编码补偿装置,该编码补偿装置包括:
编码获取模块,用于获取编码器发送的编码值;
编码补偿模块,用于根据预设的补偿条件判断所获取的编码值是否异常,在所述编码值异常时,根据历史编码值预测补偿编码值;
补偿编码发送模块,用于根据判断结果执行数字通道切换,将所述补偿编码值通过异常数据传输通道输出至电机驱动模块,以使所述电机驱动模块在编码值异常时,根据所述补偿编码值控制电机运行。
进一步的,编码补偿模块具体用于:
判断所述编码值是否超过设定阈值;
若超过设定阈值,则确定所述编码值异常;
若未超过设定阈值,则判断与编码器的通讯时间是否超过设定时间阈值,若超过设定时间阈值,则确定所述编码值异常,若未超过设定时间阈值,则确定所述编码值正常。
进一步的,还包括:
寄存器更新模块,用于在根据预设的补偿条件判断所获取的编码值是否异常之后,在所述编码值正常时,根据所述编码值更新对应的寄存器,用于根据寄存器中的正常编码值计算补偿编码值;
正常编码发送模块,用于通过正常数据传输通道输出所述编码值至电机驱动模块。
进一步的,还包括:
判断模块,用于在根据历史编码值预测补偿编码值之前,检测连续的补偿次数,判断所述补偿次数是否超过设定次数阈值;
若是,则向电机驱动模块发送停机指示,并报警;
若否,则获取寄存器中存储的历史编码值。
进一步的,编码补偿模块具体用于:
在当前编码值异常时,将与当前时刻最接近的三个连续的正常编码值中,与当前时刻时间间隔最短的时刻对应的正常编码值作为第一历史编码值,以及,与当前时刻时间间隔最长的时刻对应的正常编码值作为第二历史编码值;
根据所述第一历史编码值和所述第二历史编码值,计算补偿编码值。
进一步的,还包括:
缓存模块,用于将所述补偿编码值通过所述异常数据传输通道输出至电机驱动模块之前,通过所述异常数据传输通道将所述补偿编码值发送至随机存储器进行缓存,以使所述电机驱动模块从所述随机存储器中读取所述补偿编码值。
第三方面,本发明实施例还提供了一种伺服驱动器,所述伺服驱动器集成如第二方面所述的编码补偿装置。
本发明实施例通过在检测到编码值异常时,根据历史编码值预测补偿编码值;将数字通道切换至设定的异常数据传输通道,将所述补偿编码值通过所述异常数据传输通道输出至电机驱动模块,以使所述电机驱动模块根据所述补偿编码值控制电机运行,解决编码器与伺服驱动器之间通讯异常影响伺服驱动器的稳定性的问题,实现通过对历史编码值的计算,预测在发生通讯异常时编码器应该返回的编码值,伺服驱动器根据补偿编码值控制电机的运行,使电机的运行状态能够平滑过渡,达到了提高伺服控制系统在强干扰环境下的可靠性的效果。
附图说明
图1是本发明实施例一中提供的一种编码补偿方法的流程图;
图2是本发明实施例二中提供的一种编码补偿方法的一个示例的流程图;
图3是本发明实施例三中提供的一种编码补偿装置的结构示意图;
图4是本发明实施例四中提供的一种伺服控制系统的结构示意图。
具体实施方式
下面结合附图和实施例对本发明作进一步的详细说明。可以理解的是,此处所描述的具体实施例仅仅用于解释本发明,而非对本发明的限定。另外还需要说明的是,为了便于描述,附图中仅示出了与本发明相关的部分而非全部结构。
实施例一
图1示出了本发明实施例一中的一种编码补偿方法,本实施例可适用于在编码器传输的编码值异常时,进行编码补偿的情况,该方法可以由编码补偿装置来执行,具体包括如下步骤:
步骤110、获取编码器发送的编码值。
其中,编码器与电机同轴连接,用于实时检测电机的位置与速度。连接方式可以是高速端安装(例如连接于电机转轴)、低速端安装(例如与减速齿轮安装)或辅助机械装置安装等。编码器与伺服驱动器通过线缆连接,伺服驱动器的通讯模块周期性地向编码器发送获取指令,并接收编码器根据所述获取指令返回的编码值,其中,编码值包括当前时刻电机的位置与速度信息。传输方式可以是并行通信讯、串行通讯或现场总线通讯等方式。
步骤120、根据预设的补偿条件判断所获取的编码值是否异常,在所述编码值异常时,根据历史编码值预测补偿编码值。
其中,预设的补偿条件包括将获取的编码值超过设定阈值,或在获取的编码值未超过设定阈值时,与编码器的通讯时间超过设定时间阈值。设定阈值可以由用户根据伺服控制系统所处的实际工况下的干扰值进行设定,可以设定为编码值范围。设定时间阈值可以在伺服控制系统出厂前设置默认时间阈值,还可以由用户根据实际情况对默认时间阈值进行修改。
特殊情况下,在外界干扰十分巨大以至于伺服驱动器未收到编码器发送的当前时刻的编码值时,伺服驱动器默认当前时刻的编码值为零,由于零超出设定的阈值范围,则可以确定此时需要进行编码补偿。同时,伺服驱动器的通讯模块输出一个错误信号给伺服驱动器中FPGA控制电路,以指示通讯异常或编码值异常。
伺服驱动器将所获取的当前编码值与设定的补偿条件进行匹配,若所获取的编码值符合设定的补偿条件,则确定当前编码值异常,根据历史编码值计算补偿编码值。其中,历史编码值存储于伺服驱动器中,以根据至少两个设定寄存器中的历史编码值预测在发生通讯异常时,编码器应该返回的编码值。
步骤130、根据判断结果执行数字通道切换,将所述补偿编码值通过异常数据传输通道输出至电机驱动模块。
其中,所述数字通道包括供正常编码值传输的正常数据传输通道,以及供补偿编码值传输的异常数据传输通道。
在上述判断结果为所获取的编码值为正常编码值时,通过该正常数据传输通道传输,直至,在上述判断结果为所获取的编码值为异常编码值时,将数字通道切换至异常数据传输通道,通过相应的数字通道将正常编码值或补偿编码值输出至伺服控制器中的电机驱动模块,以使正常算法流程与异常补偿算法流程并行计算,实现在发生通讯故障时,通过数字通道切换将补偿编码值输出,减小编码值传输的延迟,达到对伺服驱动器原有性能无影响的基础上,算法快速切换执行,保证电机运行状态平稳过渡的效果。
本实施例的技术方案,通过在检测到编码值异常时,根据历史编码值预测补偿编码值;将数字通道切换至设定的异常数据传输通道,将所述补偿编码值通过所述异常数据传输通道输出至电机驱动模块,以使所述电机驱动模块根据所述补偿编码值控制电机运行,解决编码器与伺服驱动器之间通讯异常影响伺服驱动器的稳定性的问题,实现通过对历史编码值的计算,预测在发生通讯异常时编码器应该返回的编码值,伺服驱动器根据补偿编码值控制电机的运行,使电机的运行状态能够平滑过渡,达到了提高伺服控制系统在强干扰环境下的可靠性的效果。
实施例二
图2示出了本发明实施例二中的一种编码补偿方法的一个示例。本实施例的技术方案在上述实施例的基础上,提供了一种具体的编码补偿方式。如图2所示,本实施例具体包括如下步骤:
步骤210、读取设定阈值。
伺服驱动器可以由DSP(数字信号处理器)与FPGA(现场可编程门阵列)的逻辑控制电路硬件结构实现。在工作时,FPGA读取用户根据实际工况下的干扰值设定的编码值范围,作为设定阈值。
步骤220、向编码器发送数据指令,以根据该数据指令获取编码值。
FPGA周期性发送数据指令至编码器,编码器根据该数据指令将当前时刻的编码值发送至伺服驱动器,从而获得电机当前的位置和速度信息。
步骤230、判断所述编码值是否超过设定阈值,若是,则执行步骤240、若否,则执行步骤250。
FPGA判断所获取的编码值是否超过设定的编码值范围,若是,则执行步骤240,否则执行步骤250。
步骤240、判断连续的补偿次数是否超过设定次数阈值,若是,则执行步骤290,若否,则执行步骤270。
其中,设定次数阈值为可以根据历史编码值计算补偿编码值的最大补偿次数,可以根据实际情况由用户设定。补偿次数与电机动态性能成反比,若补偿次数设计的较大,则要在一定程度上牺牲电机的动态性能。
FPGA判断所获取的编码值超过设定的编码值范围,则确定当前的编码值为异常编码值。获取计数器中记录的连续的补偿次数,判断所述补偿次数是否超过设定次数阈值,根据判断结果确定是否执行编码补偿操作。若所述补偿次数超过设定次数阈值,则执行步骤290,以停止DSP工作并报警。若所述补偿次数未超过设定次数阈值,则执行步骤270,以执行编码补偿操作。
步骤250、判断与编码器的通讯时间是否超过设定时间阈值,若是,则返回执行步骤240,若否,则执行步骤260。
FPGA判断所获取的编码值未超过设定的编码值范围,则获取计时器中记录的当前编码值对应的获取操作的通讯时间。然后,将该通讯时间与设定时间阈值进行比较,根据比较结果当前编码值是否异常。若该通讯时间超过设定时间阈值,则确定为与编码器的通讯错误,即当前所获取的编码值异常,返回执行步骤240。若该通讯时间未超过设定时间阈值,则确定当前编码值正常,执行步骤260。
步骤260、根据所述编码值更新对应的寄存器。
其中,寄存器为FPGA中用于存储正常编码值的存储单元。在所述编码值正常时,根据所述编码值更新对应的寄存器,用于根据寄存器中的正常编码值计算补偿编码值。示例性的,在开始工作之前,清除FPGA中寄存器的历史数据。在正常工作后,若FPGA接收到第一个编码值为正常编码值,则根据该第一编码值更新第一寄存器P(1);若FPGA接收到第二个编码值仍为正常编码值,则根据该第二编码值更新第二寄存器P(2);若FPGA接收到第三个编码值为异常编码值,则不更新第三寄存器;依次类推,若FPGA接收到第i个编码值为正常编码值,则根据该第i个编码值更新对应的寄存器P(i)。
步骤270、获取设定的寄存器中存储的历史编码值,根据历史编码值预测补偿编码值。
在当前编码值异常时,将与当前时刻最接近的三个连续的正常编码值中,与当前时刻时间间隔最短的时刻对应的正常编码值作为第一历史编码值,以及,与当前时刻时间间隔最长的时刻对应的正常编码值作为第二历史编码值。根据所述第一历史编码值和所述第二历史编码值,计算补偿编码值。
示例性的,在当前编码值异常时,且未出现连续的编码异常,则屏蔽该异常编码值,并判断是否存在对应于当前时刻n最接近的三个连续的时刻n-1、n-2和n-3的正常编码值。若不存在,则发出错误警报。若存在,则将n-1时刻对应的寄存器P(n-1)内的正常编码值作为第一历史编码值;将n-3时刻对应的寄存器P(n-3)内的正常编码值作为第二历史编码值。通过下述公式计算补偿编码值,得到补偿编码值后执行步骤280。
其中,P(n)、P(n-1)和P(n-3)均为寄存器标识,在下述公式中出现寄存器标识的地方对应的含义均为相应的编码值。
若当前时刻的下一时刻获取的编码值仍为异常编码值,且设定次数阈值大于2,即未达到补偿次数上限,则屏蔽该异常编码值,并继续使用上述第一历史编码值和第二历史编码值计算n+1时刻的补偿编码值,得到补偿编码值后执行步骤280。公式如下:
依次类推,若从时刻n出现编码值异常后,又连续出现i次编码异常,且i+1仍未达到补偿次数上限,则屏蔽该异常编码值,并继续使用上述第一历史编码值和第二历史编码值计算n+i时刻的补偿编码值,得到补偿编码值后执行步骤280。公式如下:
如上述记载,若n+i时刻的编码值仍然为异常编码值,但i+1大于设定的次数阈值,即i+1超过补偿次数上限,则不对此时的编码值进行补偿,执行步骤290。
步骤280、通过相应的数据传输通道将正常编码值或补偿编码值发送至随机存储器进行缓存。
在确定当前时刻获取的编码值正常时,通过正常数据传输通道输出所述编码值至随机存储器RAM(例如双口RAM),以使电机驱动模块(例如DSP芯片)从所述随机存储器中读取该正常编码值。
在确定当前时刻获取的编码值异常或通讯错误时,执行数字通道切换,以选择异常数据传输通道传输数据。获取根据历史编码值预测的补偿编码值,将该补偿编码值通过异常数据传输通道输出至随机存储器RAM(例如双口RAM),以使电机驱动模块(例如DSP芯片)从所述随机存储器中读取所述补偿编码值。
步骤290、向电机驱动模块发送停机指示,并报警。
在连续补偿次数超过设定次数阈值时,向DSP芯片发送停机指示,以使DSP芯片停止工作,并发出错误警报。
实施例三
图3示出了本发明实施例三中一种的编码补偿装置。所述编码值补偿装置包括:
编码获取模块310,用于获取编码器发送的编码值;
编码补偿模块320,用于根据预设的补偿条件判断所获取的编码值是否异常,在所述编码值异常时,根据历史编码值预测补偿编码值;
补偿编码发送模块330,用于根据判断结果执行数字通道切换,将所述补偿编码值通过异常数据传输通道输出至电机驱动模块,以使所述电机驱动模块在编码值异常时,根据所述补偿编码值控制电机运行。
本发明实施例的技术方案,在编码获取模块310获取编码值后,通过编码补偿模块320检测该编码值是否异常,从而,在编码值异常时,根据历史编码值预测补偿编码值;然后,通过补偿编码发送模块330将数字通道切换至设定的异常数据传输通道,将所述补偿编码值输出至电机驱动模块,以使所述电机驱动模块根据所述补偿编码值控制电机运行,解决编码器与伺服驱动器之间通讯异常影响伺服驱动器的稳定性的问题,实现通过对历史编码值的计算,预测在发生通讯异常时编码器应该返回的编码值,伺服驱动器根据补偿编码值控制电机的运行,使电机的运行状态能够平滑过渡,达到了提高伺服控制系统在强干扰环境下的可靠性的效果。
在上述技术方案的基础上,编码补偿模块320具体用于:判断所述编码值是否超过设定阈值。若超过设定阈值,则确定所述编码值异常;若未超过设定阈值,则判断与编码器的通讯时间是否超过设定时间阈值,若超过设定时间阈值,则确定所述编码值异常,若未超过设定时间阈值,则确定所述编码值正常,达到准确及时确定编码值异常时刻的效果。
在上述技术方案的基础上,编码补偿装置还包括:
寄存器更新模块350,用于在根据预设的补偿条件判断所获取的编码值是否异常之后,在所述编码值正常时,根据所述编码值更新对应的寄存器,用于根据寄存器中的正常编码值计算补偿编码值。
正常编码发送模块360,用于通过正常数据传输通道输出所述编码值至电机驱动模块。
在上述技术方案的基础上,编码补偿装置还包括:
判断模块340,用于在根据历史编码值预测补偿编码值之前,检测连续的补偿次数,判断所述补偿次数是否超过设定次数阈值。
若是,则向电机驱动模块发送停机指示,并报警;若否,则获取寄存器中存储的历史编码值。
在上述技术方案的基础上,编码补偿模块320具体用于:
在当前编码值异常时,将与当前时刻最接近的三个连续的正常编码值中,与当前时刻时间间隔最短的时刻对应的正常编码值作为第一历史编码值,以及,与当前时刻时间间隔最长的时刻对应的正常编码值作为第二历史编码值。
根据所述第一历史编码值和所述第二历史编码值,计算补偿编码值,达到了计算得到最接近于正常编码值的补偿编码值,使电机的运行状态在伺服驱动器发生编码值异常或通讯错误时也可平稳过渡。
在上述技术方案的基础上,编码补偿装置还包括:
缓存模块370,用于将所述补偿编码值通过所述异常数据传输通道输出至电机驱动模块之前,通过所述异常数据传输通道将所述补偿编码值发送至随机存储器进行缓存,以使所述电机驱动模块从所述随机存储器中读取所述补偿编码值。达到了为FPGA与DSP提供读写缓存,避免因二者的读写速度不匹配而出现读写错误的效果。
上述编码补偿装置可执行本发明任意实施例所提供的编码补偿方法,具备执行方法相应的功能模块和有益效果。
实施例四
图4示出了本发明实施例四中的一种伺服控制系统,其中伺服驱动器410集成如上述实施例三所述的编码补偿装置。如图4所示,所述伺服控制系统具体包括:伺服驱动器410和编码器420,伺服驱动器410与编码器420通过线缆连接。
其中,伺服驱动器410包括编码器通讯电路411、FPGA控制电路412、双口RAM 413(双口随机存储器)、DSP控制电路414、FPGA外围电路和DSP外围电路。FPGA控制电路412通过编码器通讯电路411周期性的发送数据指令,以使编码器420根据该数据指令向伺服驱动器410发送编码值。从而,通过编码器通讯电路411接收编码器420发送的编码值后,发送给FPGA控制电路412。
FPGA控制电路412获取编码值,在编码值异常或发生通讯错误的情况下,根据历史编码值预测补偿编码值,将补偿编码值输出至双口RAM 413进行缓存。或在编码值正常且通讯正常的情况下,根据该正常编码值更新对应的寄存器,并将该正常编码值输出至双口RAM 413进行缓存。FPGA外围电路可以包括晶振电路、复位电路、蜂鸣器电路、通讯电路和显示电路等,用于为FPGA控制电路412的正常工作提供支持。
双口RAM 413对正常编码值或异常编码值进行缓存,供DSP控制电路414按照需要读取正常编码值或异常编码值。双口RAM 413为FPGA与DSP提供读写缓存,避免因二者的读写速度不匹配而出现读写错误的效果。
DSP控制电路414采用并口通讯的方式读取双口RAM413中的正常编码值或异常编码值,并根据所读取的编码值进行电机控制与计算。DSP外围电路包括时钟电路、电源及复位电路、通讯电路和数模转换电路等,用于为DSP控制电路414的正常工作提供支持。
本实施例的技术方案,通过伺服驱动器集成具有编码补偿功能的编码补偿装置,提高了伺服控制系统在强干扰环境下的抗干扰能力。
注意,上述仅为本发明的较佳实施例及所运用技术原理。本领域技术人员会理解,本发明不限于这里所述的特定实施例,对本领域技术人员来说能够进行各种明显的变化、重新调整和替代而不会脱离本发明的保护范围。因此,虽然通过以上实施例对本发明进行了较为详细的说明,但是本发明不仅仅限于以上实施例,在不脱离本发明构思的情况下,还可以包括更多其他等效实施例,而本发明的范围由所附的权利要求范围决定。
Claims (13)
1.一种编码补偿方法,其特征在于,包括:
获取编码器发送的编码值;
根据预设的补偿条件判断所获取的编码值是否异常,在所述编码值异常时,根据历史编码值预测补偿编码值;
根据判断结果执行数字通道切换,将所述补偿编码值通过异常数据传输通道输出至电机驱动模块,以使所述电机驱动模块在编码值异常时,根据所述补偿编码值控制电机运行。
2.根据权利要求1所述的方法,其特征在于,根据预设的补偿条件判断所获取的编码值是否异常,包括:
判断所述编码值是否超过设定阈值;
若超过设定阈值,则确定所述编码值异常;
若未超过设定阈值,则判断与编码器的通讯时间是否超过设定时间阈值,若超过设定时间阈值,则确定所述编码值异常,若未超过设定时间阈值,则确定所述编码值正常。
3.根据权利要求1所述的方法,其特征在于,在根据预设的补偿条件判断所获取的编码值是否异常之后,还包括:
在所述编码值正常时,根据所述编码值更新对应的寄存器,用于根据寄存器中的正常编码值计算补偿编码值;
通过正常数据传输通道输出所述编码值至电机驱动模块。
4.根据权利要求3所述的方法,其特征在于,在根据历史编码值预测补偿编码值之前,还包括:
检测连续的补偿次数,判断所述补偿次数是否超过设定次数阈值;
若是,则向电机驱动模块发送停机指示,并报警;
若否,则获取寄存器中存储的历史编码值。
5.根据权利要求4所述的方法,其特征在于,在所述编码值异常时,根据历史编码值预测补偿编码值,包括:
在当前编码值异常时,将与当前时刻最接近的三个连续的正常编码值中,与当前时刻时间间隔最短的时刻对应的正常编码值作为第一历史编码值,以及,与当前时刻时间间隔最长的时刻对应的正常编码值作为第二历史编码值;
根据所述第一历史编码值和所述第二历史编码值,计算补偿编码值。
6.根据权利要求1所述的方法,其特征在于,将所述补偿编码值通过所述异常数据传输通道输出至电机驱动模块之前,还包括:
通过所述异常数据传输通道将所述补偿编码值发送至随机存储器进行缓存,以使所述电机驱动模块从所述随机存储器中读取所述补偿编码值。
7.一种编码补偿装置,其特征在于,包括:
编码获取模块,用于获取编码器发送的编码值;
编码补偿模块,用于根据预设的补偿条件判断所获取的编码值是否异常,在所述编码值异常时,根据历史编码值预测补偿编码值;
补偿编码发送模块,用于根据判断结果执行数字通道切换,将所述补偿编码值通过异常数据传输通道输出至电机驱动模块,以使所述电机驱动模块在编码值异常时,根据所述补偿编码值控制电机运行。
8.根据权利要求7所述的编码补偿装置,其特征在于,编码补偿模块具体用于:
判断所述编码值是否超过设定阈值;
若超过设定阈值,则确定所述编码值异常;
若未超过设定阈值,则判断与编码器的通讯时间是否超过设定时间阈值,若超过设定时间阈值,则确定所述编码值异常,若未超过设定时间阈值,则确定所述编码值正常。
9.根据权利要求7所述的编码器补偿装置,其特征在于,还包括:
寄存器更新模块,用于在根据预设的补偿条件判断所获取的编码值是否异常之后,在所述编码值正常时,根据所述编码值更新对应的寄存器,用于根据寄存器中的正常编码值计算补偿编码值;
正常编码发送模块,用于通过正常数据传输通道输出所述编码值至电机驱动模块。
10.根据权利要求9所述的编码器补偿装置,其特征在于,还包括:
判断模块,用于在根据历史编码值预测补偿编码值之前,检测连续的补偿次数,判断所述补偿次数是否超过设定次数阈值;
若是,则向电机驱动模块发送停机指示,并报警;
若否,则获取寄存器中存储的历史编码值。
11.根据权利要求10所述的编码器补偿装置,其特征在于,编码补偿模块具体用于:
在当前编码值异常时,将与当前时刻最接近的三个连续的正常编码值中,与当前时刻时间间隔最短的时刻对应的正常编码值作为第一历史编码值,以及,与当前时刻时间间隔最长的时刻对应的正常编码值作为第二历史编码值;
根据所述第一历史编码值和所述第二历史编码值,计算补偿编码值。
12.根据权利要求7所述的编码补偿模块,其特征在于,还包括:
缓存模块,用于将所述补偿编码值通过所述异常数据传输通道输出至电机驱动模块之前,通过所述异常数据传输通道将所述补偿编码值发送至随机存储器进行缓存,以使所述电机驱动模块从所述随机存储器中读取所述补偿编码值。
13.一种伺服驱动器,其特征在于,所述伺服驱动器集成如权利要求7-12任一所述的编码补偿装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610573365.2A CN106020059B (zh) | 2016-07-19 | 2016-07-19 | 一种编码补偿方法、装置及伺服驱动器 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610573365.2A CN106020059B (zh) | 2016-07-19 | 2016-07-19 | 一种编码补偿方法、装置及伺服驱动器 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106020059A true CN106020059A (zh) | 2016-10-12 |
CN106020059B CN106020059B (zh) | 2018-01-19 |
Family
ID=57116834
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610573365.2A Active CN106020059B (zh) | 2016-07-19 | 2016-07-19 | 一种编码补偿方法、装置及伺服驱动器 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106020059B (zh) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111614301A (zh) * | 2019-02-26 | 2020-09-01 | 达明机器人股份有限公司 | 马达编码器的动态采样方法 |
CN111831019A (zh) * | 2019-04-17 | 2020-10-27 | 中车株洲电力机车研究所有限公司 | 一种电机位置数据补偿方法及电机控制系统 |
CN112803865A (zh) * | 2020-12-31 | 2021-05-14 | 上海新时达机器人有限公司 | 位置锁存的方法、伺服驱动器及存储介质 |
CN114047439A (zh) * | 2021-10-21 | 2022-02-15 | 南京埃斯顿自动化股份有限公司 | 一种探针功能的测试系统及测试方法 |
CN114352738A (zh) * | 2021-12-08 | 2022-04-15 | 深圳市拓安信计控仪表有限公司 | 基于电磁水表的供水控制方法、服务器、电磁蝶阀及系统 |
CN115296784A (zh) * | 2022-08-10 | 2022-11-04 | 横川机器人(深圳)有限公司 | 伺服驱动器低延时同步方法 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6333614B1 (en) * | 1997-10-15 | 2001-12-25 | Johannas Heidenhain Gmbh | Method and circuit for monitoring the operating condition of electric motors |
JP2002370816A (ja) * | 2001-06-13 | 2002-12-24 | Fuji Electric Co Ltd | 位置同期制御装置 |
CN101470436A (zh) * | 2007-12-28 | 2009-07-01 | 中国科学院沈阳计算技术研究所有限公司 | 带绝对编码值接收功能的轴运动控制卡及其数据转换方法 |
JP2012117884A (ja) * | 2010-11-30 | 2012-06-21 | Fuji Electric Co Ltd | エンコーダ誤差補正装置 |
CN105162551A (zh) * | 2015-07-29 | 2015-12-16 | 中工科安科技有限公司 | 一种针对编码器信号处理的crc安全校验码的计算方法 |
CN105404283A (zh) * | 2015-12-11 | 2016-03-16 | 马鞍山钢铁股份有限公司 | 降低混合型编码器故障率的控制系统及方法 |
CN205176623U (zh) * | 2015-12-01 | 2016-04-20 | 襄阳科威电气有限公司 | 钢管成型机伺服系统 |
-
2016
- 2016-07-19 CN CN201610573365.2A patent/CN106020059B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6333614B1 (en) * | 1997-10-15 | 2001-12-25 | Johannas Heidenhain Gmbh | Method and circuit for monitoring the operating condition of electric motors |
JP2002370816A (ja) * | 2001-06-13 | 2002-12-24 | Fuji Electric Co Ltd | 位置同期制御装置 |
CN101470436A (zh) * | 2007-12-28 | 2009-07-01 | 中国科学院沈阳计算技术研究所有限公司 | 带绝对编码值接收功能的轴运动控制卡及其数据转换方法 |
JP2012117884A (ja) * | 2010-11-30 | 2012-06-21 | Fuji Electric Co Ltd | エンコーダ誤差補正装置 |
CN105162551A (zh) * | 2015-07-29 | 2015-12-16 | 中工科安科技有限公司 | 一种针对编码器信号处理的crc安全校验码的计算方法 |
CN205176623U (zh) * | 2015-12-01 | 2016-04-20 | 襄阳科威电气有限公司 | 钢管成型机伺服系统 |
CN105404283A (zh) * | 2015-12-11 | 2016-03-16 | 马鞍山钢铁股份有限公司 | 降低混合型编码器故障率的控制系统及方法 |
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111614301A (zh) * | 2019-02-26 | 2020-09-01 | 达明机器人股份有限公司 | 马达编码器的动态采样方法 |
CN111614301B (zh) * | 2019-02-26 | 2022-01-04 | 达明机器人股份有限公司 | 马达编码器的动态采样方法 |
CN111831019A (zh) * | 2019-04-17 | 2020-10-27 | 中车株洲电力机车研究所有限公司 | 一种电机位置数据补偿方法及电机控制系统 |
CN111831019B (zh) * | 2019-04-17 | 2024-04-09 | 中车株洲电力机车研究所有限公司 | 一种电机位置数据补偿方法及电机控制系统 |
CN112803865A (zh) * | 2020-12-31 | 2021-05-14 | 上海新时达机器人有限公司 | 位置锁存的方法、伺服驱动器及存储介质 |
CN112803865B (zh) * | 2020-12-31 | 2023-04-07 | 上海新时达机器人有限公司 | 位置锁存的方法、伺服驱动器及存储介质 |
CN114047439A (zh) * | 2021-10-21 | 2022-02-15 | 南京埃斯顿自动化股份有限公司 | 一种探针功能的测试系统及测试方法 |
CN114352738A (zh) * | 2021-12-08 | 2022-04-15 | 深圳市拓安信计控仪表有限公司 | 基于电磁水表的供水控制方法、服务器、电磁蝶阀及系统 |
CN114352738B (zh) * | 2021-12-08 | 2022-12-13 | 深圳市拓安信计控仪表有限公司 | 基于电磁水表的供水控制方法、服务器、电动蝶阀及系统 |
CN115296784A (zh) * | 2022-08-10 | 2022-11-04 | 横川机器人(深圳)有限公司 | 伺服驱动器低延时同步方法 |
CN115296784B (zh) * | 2022-08-10 | 2023-10-20 | 横川机器人(深圳)有限公司 | 伺服驱动器低延时同步方法 |
Also Published As
Publication number | Publication date |
---|---|
CN106020059B (zh) | 2018-01-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106020059A (zh) | 一种编码补偿方法、装置及伺服驱动器 | |
CN101456513B (zh) | 全数字门机控制系统 | |
CN201177763Y (zh) | 新型智能电动执行器 | |
CN102472633B (zh) | 用于确定调节部件的设定位置的方法 | |
CN102070064A (zh) | 电梯门机控制系统及方法 | |
CN101254878A (zh) | 电梯系统 | |
CN102674121B (zh) | 电梯门电机控制系统及控制方法 | |
CN103277003A (zh) | 电动尾门速度制动方法及装置、速度控制方法及装置 | |
US20200019137A1 (en) | Production system with quality measuring function and mechanism diagnosing function, and drive and production method thereof | |
CA2944774C (en) | Data collection system and method | |
US20220099717A1 (en) | Frequency sensing systems and methods | |
CN114184943B (zh) | 一种电控塞拉门开关辅助调试装置 | |
CN201225880Y (zh) | 闸门开度测量装置 | |
US10514285B2 (en) | Drive circuit and electromagnetic flowmeter | |
CN102856929A (zh) | 一种发电机自动准同期实时监控方法及系统 | |
CN109510551A (zh) | 本质安全型伺服系统的实现方法及装置 | |
CN215006354U (zh) | 一种集成plc、视觉或力反馈的一体化执行机构 | |
CN112904794A (zh) | 一种集成plc、视觉或力反馈的一体化执行机构 | |
CN203204384U (zh) | 汽车智能电器控制系统的自适应搜索智能学习控制系统 | |
CN209298041U (zh) | 基于多态量的高压断路器故障诊断系统 | |
CN202794953U (zh) | 电动螺杆启闭机顶闸事故自动控制装置 | |
CN112197802A (zh) | 一种绝对值编码器通讯故障处理方法 | |
CN105060120A (zh) | 装卸料机起升机构高低速轴传动比保护装置及方法 | |
CN202886559U (zh) | 高压断路器在线监测系统 | |
CN115248374A (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 | ||
TA01 | Transfer of patent application right |
Effective date of registration: 20170823 Address after: 519070, Guangdong, province Zhuhai Jiuzhou Road No. 2097 Zhuhai Ling Compressor Co., Ltd. plant No. Applicant after: ZHUHAI GREE INTELLIGENT EQUIPMENT TECHNOLOGY RESEARCH INSTITUTE Co.,Ltd. Applicant after: GREE ELECTRIC APPLIANCES,Inc.OF ZHUHAI Address before: GREE ELECTRIC APPLIANCES,Inc.OF ZHUHAI Applicant before: GREE ELECTRIC APPLIANCES,Inc.OF ZHUHAI |
|
TA01 | Transfer of patent application right | ||
GR01 | Patent grant | ||
GR01 | Patent grant |