CN110793553A - 零点定位方法、系统、伺服电机及存储介质 - Google Patents
零点定位方法、系统、伺服电机及存储介质 Download PDFInfo
- Publication number
- CN110793553A CN110793553A CN201911086041.6A CN201911086041A CN110793553A CN 110793553 A CN110793553 A CN 110793553A CN 201911086041 A CN201911086041 A CN 201911086041A CN 110793553 A CN110793553 A CN 110793553A
- Authority
- CN
- China
- Prior art keywords
- motion block
- motor motion
- encoder
- collision
- zero point
- 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
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01D—MEASURING NOT SPECIALLY ADAPTED FOR A SPECIFIC VARIABLE; ARRANGEMENTS FOR MEASURING TWO OR MORE VARIABLES NOT COVERED IN A SINGLE OTHER SUBCLASS; TARIFF METERING APPARATUS; MEASURING OR TESTING NOT OTHERWISE PROVIDED FOR
- G01D5/00—Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable
- G01D5/12—Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable using electric or magnetic means
- G01D5/244—Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable using electric or magnetic means influencing characteristics of pulses or pulse trains; generating pulses or pulse trains
- G01D5/245—Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable using electric or magnetic means influencing characteristics of pulses or pulse trains; generating pulses or pulse trains using a variable number of pulses in a train
- G01D5/2451—Incremental encoders
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Control Of Position Or Direction (AREA)
- Control Of Electric Motors In General (AREA)
Abstract
本发明公开了一种零点定位方法、系统、伺服电机及存储介质。本发明通过控制电机运动块朝向限位块运行，并对电机运动块进行碰撞检测；当碰撞成功时，控制电机运动块背离限位块运行，并实时检测是否接收到编码器发送的Z信号；在检测到Z信号时从编码器读取第一编码器值，并控制电机运动块减速运行，以读取电机运动块停止时的第二编码器值；基于预设算法根据第一编码器值及第二编码器值确定零点位置。其中，通过Z信号检测及对电机运动块减速运行的距离补偿实现对零点的精确定位，取消了传统零点定位时使用的位置传感器，在降低成本的同时减小了零点定位的误差，提高了使用增量式编码器的伺服电机的精度。
Description
技术领域
本发明涉及电机控制技术领域，尤其涉及一种零点定位方法、系统、伺服电机及存储介质。
背景技术
在现代工业生产的很多领域中，都需要高精度误差为微米的位置动作，该功能主要依靠伺服电机实现。目前伺服电机通常使用高精度绝对式编码器或增量式编码器，其中，增量式编码器因其成本适中，操作方便等优势成为主流，但是使用增量式编码器的伺服电机的精度较低。
为了提高伺服电机的精度，通常需要精确地对零点进行定位。现有技术中大部分使用外接的定位传感器，如霍尔传感器、光电开关等位置传感器，将传感器放置在零点附近作为伺服电机回零点的定位基准，具体地为，将运动块以某一恒定速度向着某方向运行，行进过程中如果位置传感器检测到运动块，伺服电机就控制运动块减速停止，当运动块完全停止时，运动块所处的位置就设定为零点。
上述回零点方法，在检测到位置传感器开始减速停止时，受到电机转速控制误差、传感器响应误差以及机械传动结构几大因素的影响(如加工装配误差，结构磨合程度等)，会造成停止位置误差较大，很难将误差控制在微米的范围内，无法满足一些高精度要求的行业的生产要求。
发明内容
本发明的主要目的在于提供一种零点定位方法、系统、伺服电机及存储介质，旨在解决现有技术中零点定位误差较大的技术问题。
为实现上述目的，本发明提供一种零点定位方法，所述方法包括以下步骤：
控制电机运动块朝向限位块运行，并对所述电机运动块进行碰撞检测；
当碰撞成功时，控制所述电机运动块背离所述限位块运行，并实时检测是否接收到编码器发送的Z信号；
在检测到所述Z信号时从所述编码器读取第一编码器值，并控制所述电机运动块减速运行，以读取所述电机运动块停止时的第二编码器值；
基于预设算法根据所述第一编码器值及所述第二编码器值确定零点位置。
优选地，所述基于预设算法根据所述第一编码器值及所述第二编码器值确定零点位置的步骤，包括：
根据所述第二编码器值与所述第一编码器值的差值确定停车距离；
基于正弦S曲线算法对所述停车距离进行补偿，获得所述电机运动块停止时的实际位置；
将所述实际位置作为零点位置。
优选地，所述基于正弦S曲线算法对所述停车距离进行补偿，获得所述电机运动块停止时的实际位置的步骤，包括：
基于正弦S曲线算法根据所述停车距离及预设目标速度获取所述电机运动块的加加速度；
控制所述电机运动块以所述加加速度朝向限位块运行；
当所述电机运动块的运行距离为所述停车距离时，记录所述电机运动块的当前位置，并将所述当前位置作为所述电机运动块停止时的实际位置。
优选地，所述正弦S曲线算法为：
其中，Vp为预设目标速度，Sp为所述停车距离，t为运行时间，j(t)为所述电机运动块的加加速度。
优选地，所述对所述电机运动块进行碰撞检测的步骤，包括：
分别对所述电机运动块的碰撞电流、碰撞时间及碰撞位移进行检测；
当所述碰撞电流不小于预设电流且当所述碰撞时间不小于第一预设时间时，控制三相逆变模块关闭，以使所述三相逆变模块停止驱动所述电机运动块。
优选地，所述分别对所述电机运动块的碰撞电流、碰撞时间及碰撞位移进行检测的步骤之后，所述方法还包括：
当所述碰撞时间不小于第一预设时间时，控制三相逆变模块关闭，以使所述三相逆变模块停止驱动所述电机运动块。
优选地，所述在检测到所述Z信号时从所述编码器读取第一编码器值的步骤，包括：
在检测到第N个Z信号时判断检测到所述第N个Z信号的时间是否大于第二预设时间；其中，N为预设正整数；
若是，则控制所述三相逆变模块关闭；
若否，从所述编码器读取第一编码器值。
此外，为实现上述目的，本发明还提供一种零点定位系统，所述零点定位系统包括：
碰撞检测模块，用于控制电机运动块朝向限位块运行，并对所述电机运动块进行碰撞检测；
信号检测模块，用于当碰撞成功时，控制所述电机运动块背离所述限位块运行，并实时检测是否接收到编码器发送的Z信号；
编码器读取模块，用于在检测到所述Z信号时从所述编码器读取第一编码器值，并控制所述电机运动块减速运行，以读取所述电机运动块停止时的第二编码器值；
距离补偿模块，用于基于预设算法根据所述第一编码器值及所述第二编码器值确定零点位置。
此外，为实现上述目的，本发明还提供一种伺服电机，所述伺服电机包括：存储器、处理器及存储在所述存储器上并可在所述处理器上运行的零点定位程序，所述零点定位程序配置为实现所述的零点定位方法的步骤。
此外，为实现上述目的，本发明还提供一种存储介质，所述存储介质上存储有零点定位程序，所述零点定位程序被处理器执行时实现所述的零点定位方法的步骤。
本发明通过控制电机运动块朝向限位块运行，并对电机运动块进行碰撞检测；当碰撞成功时，控制电机运动块背离限位块运行，并实时检测是否接收到编码器发送的Z信号；在检测到Z信号时从编码器读取第一编码器值，并控制电机运动块减速运行，以读取电机运动块停止时的第二编码器值；基于预设算法根据第一编码器值及第二编码器值确定零点位置。其中，通过Z信号检测及对电机运动块减速运行的距离补偿实现对零点的精确定位，取消了传统零点定位时使用的位置传感器，在降低成本的同时减小了零点定位的误差，提高了使用增量式编码器的伺服电机的精度。
附图说明
图1是本发明实施例方案涉及的硬件运行环境的伺服电机结构示意图；
图2为本发明零点定位方法第一实施例的流程示意图；
图3为本发明零点定位方法第二实施例的流程示意图；
图4为本发明零点定位系统第一实施例的功能模块图。
本发明目的的实现、功能特点及优点将结合实施例，参照附图做进一步说明。
具体实施方式
应当理解，此处所描述的具体实施例仅仅用以解释本发明，并不用于限定本发明。
参照图1，图1为本发明实施例方案涉及的硬件运行环境的伺服电机结构示意图。
如图1所示，该伺服电机可以包括：处理器1001，例如CPU，通信总线1002、用户接口1003，网络接口1004，存储器1005。其中，通信总线1002用于实现这些组件之间的连接通信。用户接口1003可以包括显示屏(Display)、输入单元比如键盘(Keyboard)，可选用户接口1003还可以包括标准的有线接口、无线接口。网络接口1004可选的可以包括标准的有线接口、无线接口(如WI-FI接口)。存储器1005可以是高速RAM存储器，也可以是稳定的存储器(non-volatile memory)，例如磁盘存储器。存储器1005可选的还可以是独立于前述处理器1001的存储装置。
本领域技术人员可以理解，图1中示出的结构并不构成对伺服电机的限定，可以包括比图示更多或更少的部件，或者组合某些部件，或者不同的部件布置。
如图1所示，作为一种计算机存储介质的存储器1005中可以包括操作系统、网络通信模块、用户接口模块以及零点定位程序。
在图1所示的伺服电机中，网络接口1004主要用于与外部网络进行数据通信；用户接口1003主要用于接收用户的输入指令；所述伺服电机通过处理器1001调用存储器1005中存储的零点定位程序，并执行以下操作：
控制电机运动块朝向限位块运行，并对所述电机运动块进行碰撞检测；
当碰撞成功时，控制所述电机运动块背离所述限位块运行，并实时检测是否接收到编码器发送的Z信号；
在检测到所述Z信号时从所述编码器读取第一编码器值，并控制所述电机运动块减速运行，以读取所述电机运动块停止时的第二编码器值；
基于预设算法根据所述第一编码器值及所述第二编码器值确定零点位置。
进一步地，处理器1001可以调用存储器1005中存储的零点定位程序，还执行以下操作：
根据所述第二编码器值与所述第一编码器值的差值确定停车距离；
基于正弦S曲线算法对所述停车距离进行补偿，获得所述电机运动块停止时的实际位置；
将所述实际位置作为零点位置。
进一步地，处理器1001可以调用存储器1005中存储的零点定位程序，还执行以下操作：
基于正弦S曲线算法根据所述停车距离及预设目标速度获取所述电机运动块的加加速度；
控制所述电机运动块以所述加加速度朝向限位块运行；
当所述电机运动块的运行距离为所述停车距离时，记录所述电机运动块的当前位置，并将所述当前位置作为所述电机运动块停止时的实际位置。
进一步地，处理器1001可以调用存储器1005中存储的零点定位程序，还执行以下操作：
分别对所述电机运动块的碰撞电流、碰撞时间及碰撞位移进行检测；
当所述碰撞电流不小于预设电流，所述碰撞时间不小于第一预设时间且所述碰撞位置不大于预设位移时判定碰撞成功。
进一步地，处理器1001可以调用存储器1005中存储的零点定位程序，还执行以下操作：
当所述碰撞电流不小于预设电流且所述碰撞时间不小于第一预设时间时，控制三相逆变模块关闭，以使所述三相逆变模块停止驱动所述电机运动块。
进一步地，处理器1001可以调用存储器1005中存储的零点定位程序，还执行以下操作：
在检测到第N个Z信号时判断检测到所述第N个Z信号的时间是否大于第二预设时间；其中，N为预设正整数；
若是，则控制所述三相逆变模块关闭；
若否，从所述编码器读取第一编码器值。
本实施例通过控制电机运动块朝向限位块运行，并对电机运动块进行碰撞检测；当碰撞成功时，控制电机运动块背离限位块运行，并实时检测是否接收到编码器发送的Z信号；在检测到Z信号时从编码器读取第一编码器值，并控制电机运动块减速运行，以读取电机运动块停止时的第二编码器值；基于预设算法根据第一编码器值及第二编码器值确定零点位置。其中，通过Z信号检测及对电机运动块减速运行的距离补偿实现对零点的精确定位，取消了传统零点定位时使用的位置传感器，在降低成本的同时减小了零点定位的误差，提高了使用增量式编码器的伺服电机的精度。
基于上述硬件结构，提出本发明零点定位方法实施例。
参照图2，图2为本发明零点定位方法第一实施例的流程示意图。
在第一实施例中，所述零点定位方法包括以下步骤：
S10：控制电机运动块朝向限位块运行，并对所述电机运动块进行碰撞检测；
可以理解的是，传统的零点定位方法是将传感器放置在零点附近，将电机运动块以某一恒定速度向着固定方向运动，当检测到传感器就减速停止，将电机运动块完全停止时的位置设置为零点。但是由于电机运动块停止需要时间，并会运行一段距离，因此，真正的零点与电机运动块完全停止的位置并不相同，导致零点定位存在较大误差。本实施例取消了传感器，利用伺服电机中的限位块、编码器及相应的程序控制实现精确的零点定位。
应理解的是，所述朝向限位块运行指向限位块的方向运行，本实施例中不限定具体运行路径。
需要说明的是，所述碰撞检测是对电机运动块是否碰撞到限位块进行检测，其检测方式有很多种。作为一优选实施例，在进行碰撞检测时分别对电机运动块的碰撞电流、碰撞时间及碰撞位移进行检测；只有同时满足三个条件，即当所述碰撞电流不小于预设电流，所述碰撞时间不小于第一预设时间且所述碰撞位置不大于预设位移时才判定碰撞成功，以保证碰撞充分。
在具体实现中，三相逆变模块是电机的驱动硬件，用于驱动电机运行。当碰撞电流不小于预设电流且碰撞时间不小于第一预设时间时，说明电流过大并且持续时间较长，此时需要控制三相逆变模块关闭，以使三相逆变模块停止驱动电机运动块，如此可以有效保护三相逆变模块。
S20：当碰撞成功时，控制所述电机运动块背离所述限位块运行，并实时检测是否接收到编码器发送的Z信号；
应理解的是，所述背离限位块运行指向限位块的方向的反方向运行，本实施例中不限定具体运行路径。
需要说明的是，为了控制产品成本及方便用户操作，所述编码器可以使用增量式编码器。增量式编码器是直接利用光电转换原理输出三组方波脉冲A、B和Z相，A、B两组脉冲相位差90，从而可方便的判断出旋转方向，而Z相为每转一个脉冲，用于零点定位。
S30：在检测到所述Z信号时从所述编码器读取第一编码器值，并控制所述电机运动块减速运行，以读取所述电机运动块停止时的第二编码器值；
具体地，在检测到第N个Z信号时判断检测到所述第N个Z信号的时间是否大于第二预设时间；其中，N为预设正整数；若是，则控制所述三相逆变模块关闭；若否，从所述编码器读取第一编码器值。
需要说明的是，Z信号在一圈内位置是零位，通过读取Z信号，可以在一圈内修正增量信号因脉冲丢失而产生的计数误差。本实施例中，工程人员可以根据伺服电机的具体硬件情况选取第N个Z信号时编码器的值作为第一编码器值。
当然，如果编码器出现故障，找不到信号或者找到第N个Z信号的时间过长时，为了保护驱动硬件，同样需要关闭三相逆变模块。
应当理解的是，此时电机运动块减速运行，是指电机运动块背离限位块减速运行。
在具体实现中，由于增量式编码器是将位移转换成周期性的电信号，再把这个电信号转变成计数脉冲，用脉冲的个数表示位移的大小，因此，通过第一编码器值及第二编码器值可以计算电机运动块在不同时间段的位移。
S40：基于预设算法根据所述第一编码器值及所述第二编码器值确定零点位置。
需要说明的是，从接收到第N个Z信号开始停车，到电机运动块完全停止，这期间存在一段停车距离。所述预设算法用于通过反向补偿方式对停车距离进行回补，消除电机运动块的停车误差，从而减少定位误差，完成精确定位。
本实施例通过控制电机运动块朝向限位块运行，并对电机运动块进行碰撞检测；当碰撞成功时，控制电机运动块背离限位块运行，并实时检测是否接收到编码器发送的Z信号；在检测到Z信号时从编码器读取第一编码器值，并控制电机运动块减速运行，以读取电机运动块停止时的第二编码器值；基于预设算法根据第一编码器值及第二编码器值确定零点位置。其中，通过Z信号检测及对电机运动块减速运行的距离补偿实现对零点的精确定位，取消了传统零点定位时使用的位置传感器，在降低成本的同时减小了零点定位的误差，提高了使用增量式编码器的伺服电机的精度。
进一步地，如图3所示，基于第一实施例提出本发明零点定位方法第二实施例，在本实施例中，步骤S40具体包括以下步骤：
S41：根据所述第二编码器值与所述第一编码器值的差值确定停车距离；
具体地，由于通过第一编码器值可以计算出找到第N个Z信号时电机运动块的位移，通过第二编码器值可以计算出电机运动块运行至减速时的位移，通过第二编码器值与所述第一编码器值的差值可以确定电机运动块减速过程中的停车距离。
S42：基于正弦S曲线算法对所述停车距离进行补偿，获得所述电机运动块停止时的实际位置；
具体地，基于正弦S曲线算法根据所述停车距离及预设目标速度获取所述电机运动块的加加速度；控制所述电机运动块以所述加加速度朝向限位块运行；当所述电机运动块的运行距离为所述停车距离时，记录所述电机运动块的当前位置，并将所述当前位置作为所述电机运动块停止时的实际位置。
其中，所述正弦S曲线算法为：
其中，Vp为预设目标速度，Sp为所述停车距离，t为运行时间，j(t)为所述电机运动块的加加速度。
需要说明的是，梯形、抛物线形加速曲线其加加速度为阶跃函数，存在阶跃变换，使得电机速度变化不够平稳，而正弦加速曲线，其加加速度为正弦函数，可连续求导，因此正弦曲线能更好地符合步进电机力矩随速度升高而减小的特点，充分地利用电机的有效转矩，同时能够减弱机械冲击。通过正弦S曲线算法控制电机运动块加减速，可以实现电机的平稳可靠的运行。
S43：将所述实际位置作为零点位置。
可理解的是，在对停车距离进行补偿后，电机运动块停止的实际位置才是真正的零点位置。在零点定位完成后，还可以向编码器发送回零完成信号，以同步编码器的当前采样值，并设置编码器的回零状态，等待上位机指令。
本实施例通过正弦S曲线算法规划运动路径控制电机动块的加减速运行，在对停车距离精准反向补偿的同时，保障了位置的准确性，实现了精准定位。
本发明进一步提供一种零点定位系统。
参照图4，图4为本发明零点定位系统第一实施例的功能模块图。
本实施例中，所述零点定位系统包括：
碰撞检测模块10，用于控制电机运动块朝向限位块运行，并对所述电机运动块进行碰撞检测；
可以理解的是，传统的零点定位方法是将传感器放置在零点附近，将电机运动块以某一恒定速度向着固定方向运动，当检测到传感器就减速停止，将电机运动块完全停止时的位置设置为零点。但是由于电机运动块停止需要时间，并会运行一段距离，因此，真正的零点与电机运动块完全停止的位置并不相同，导致零点定位存在较大误差。本实施例取消了传感器，利用伺服电机中的限位块、编码器及相应的程序控制实现精确的零点定位。
应理解的是，所述朝向限位块运行指向限位块的方向运行，本实施例中不限定具体运行路径。
需要说明的是，所述碰撞检测是对电机运动块是否碰撞到限位块进行检测，其检测方式有很多种。作为一优选实施例，在进行碰撞检测时分别对电机运动块的碰撞电流、碰撞时间及碰撞位移进行检测；只有同时满足三个条件，即当所述碰撞电流不小于预设电流，所述碰撞时间不小于第一预设时间且所述碰撞位置不大于预设位移时才判定碰撞成功，以保证碰撞充分。
在具体实现中，三相逆变模块是电机的驱动硬件，用于驱动电机运行。当碰撞电流不小于预设电流且碰撞时间不小于第一预设时间时，说明电流过大并且持续时间较长，此时需要控制三相逆变模块关闭，以使三相逆变模块停止驱动电机运动块，如此可以有效保护三相逆变模块。
信号检测模块20，用于当碰撞成功时，控制所述电机运动块背离所述限位块运行，并实时检测是否接收到编码器发送的Z信号；
应理解的是，所述背离限位块运行指向限位块的方向的反方向运行，本实施例中不限定具体运行路径。
需要说明的是，为了控制产品成本及方便用户操作，所述编码器可以使用增量式编码器。增量式编码器是直接利用光电转换原理输出三组方波脉冲A、B和Z相，A、B两组脉冲相位差90，从而可方便的判断出旋转方向，而Z相为每转一个脉冲，用于零点定位。
编码器读取模块30，用于在检测到所述Z信号时从所述编码器读取第一编码器值，并控制所述电机运动块减速运行，以读取所述电机运动块停止时的第二编码器值；
具体地，在检测到第N个Z信号时判断检测到所述第N个Z信号的时间是否大于第二预设时间；其中，N为预设正整数；若是，则控制所述三相逆变模块关闭；若否，从所述编码器读取第一编码器值。
需要说明的是，Z信号在一圈内位置是零位，通过读取Z信号，可以在一圈内修正增量信号因脉冲丢失而产生的计数误差。本实施例中，工程人员可以根据伺服电机的具体硬件情况选取第N个Z信号时编码器的值作为第一编码器值。
当然，如果编码器出现故障，找不到信号或者找到第N个Z信号的时间过长时，为了保护驱动硬件，同样需要关闭三相逆变模块。
应当理解的是，此时电机运动块减速运行，是指电机运动块背离限位块减速运行。
在具体实现中，由于增量式编码器是将位移转换成周期性的电信号，再把这个电信号转变成计数脉冲，用脉冲的个数表示位移的大小，因此，通过第一编码器值及第二编码器值可以计算电机运动块在不同时间段的位移。
距离补偿模块40，用于基于预设算法根据所述第一编码器值及所述第二编码器值确定零点位置。
需要说明的是，从接收到第N个Z信号开始停车，到电机运动块完全停止，这期间存在一段停车距离。所述预设算法用于通过反向补偿方式对停车距离进行回补，消除电机运动块的停车误差，从而减少定位误差，完成精确定位。
本实施例通过控制电机运动块朝向限位块运行，并对电机运动块进行碰撞检测；当碰撞成功时，控制电机运动块背离限位块运行，并实时检测是否接收到编码器发送的Z信号；在检测到Z信号时从编码器读取第一编码器值，并控制电机运动块减速运行，以读取电机运动块停止时的第二编码器值；基于预设算法根据第一编码器值及第二编码器值确定零点位置。其中，通过Z信号检测及对电机运动块减速运行的距离补偿实现对零点的精确定位，取消了传统零点定位时使用的位置传感器，在降低成本的同时减小了零点定位的误差，提高了使用增量式编码器的伺服电机的精度。
此外，本发明实施例还提出一种存储介质，所述存储介质上存储有零点定位程序，所述零点定位程序被处理器执行时实现如下操作：
控制电机运动块朝向限位块运行，并对所述电机运动块进行碰撞检测；
当碰撞成功时，控制所述电机运动块背离所述限位块运行，并实时检测是否接收到编码器发送的Z信号；
在检测到所述Z信号时从所述编码器读取第一编码器值，并控制所述电机运动块减速运行，以读取所述电机运动块停止时的第二编码器值；
基于预设算法根据所述第一编码器值及所述第二编码器值确定零点位置。
进一步地，所述零点定位程序被处理器执行时还实现如下操作：
根据所述第二编码器值与所述第一编码器值的差值确定停车距离；
基于正弦S曲线算法对所述停车距离进行补偿，获得所述电机运动块停止时的实际位置；
将所述实际位置作为零点位置。
进一步地，所述零点定位程序被处理器执行时还实现如下操作：
基于正弦S曲线算法根据所述停车距离及预设目标速度获取所述电机运动块的加加速度；
控制所述电机运动块以所述加加速度朝向限位块运行；
当所述电机运动块的运行距离为所述停车距离时，记录所述电机运动块的当前位置，并将所述当前位置作为所述电机运动块停止时的实际位置。
进一步地，所述零点定位程序被处理器执行时还实现如下操作：
分别对所述电机运动块的碰撞电流、碰撞时间及碰撞位移进行检测；
当所述碰撞电流不小于预设电流，所述碰撞时间不小于第一预设时间且所述碰撞位置不大于预设位移时判定碰撞成功。
进一步地，所述零点定位程序被处理器执行时还实现如下操作：
当所述碰撞电流不小于预设电流且所述碰撞时间不小于第一预设时间时，控制三相逆变模块关闭，以使所述三相逆变模块停止驱动所述电机运动块。
进一步地，所述零点定位程序被处理器执行时还实现如下操作：
在检测到第N个Z信号时判断检测到所述第N个Z信号的时间是否大于第二预设时间；其中，N为预设正整数；
若是，则控制所述三相逆变模块关闭；
若否，从所述编码器读取第一编码器值。
本发明计算机可读存储介质的具体实施例与上述零点定位方法各实施例基本相同，在此不作赘述。
需要说明的是，在本文中，术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含，从而使得包括一系列要素的过程、方法、物品或者系统不仅包括那些要素，而且还包括没有明确列出的其他要素，或者是还包括为这种过程、方法、物品或者系统所固有的要素。在没有更多限制的情况下，由语句“包括一个……”限定的要素，并不排除在包括该要素的过程、方法、物品或者系统中还存在另外的相同要素。
上述本发明实施例序号仅仅为了描述，不代表实施例的优劣。
通过以上的实施方式的描述，本领域的技术人员可以清楚地了解到上述实施例方法可借助软件加必需的通用硬件平台的方式来实现，当然也可以通过硬件，但很多情况下前者是更佳的实施方式。基于这样的理解，本发明的技术方案本质上或者说对现有技术做出贡献的部分可以以软件产品的形式体现出来，该计算机软件产品存储在如上所述的一个存储介质(如ROM/RAM、磁碟、光盘)中，包括若干指令用以使得一台终端设备(可以是手机，计算机，服务器，空调器，或者网络设备等)执行本发明各个实施例所述的方法。
以上仅为本发明的优选实施例，并非因此限制本发明的专利范围，凡是利用本发明说明书及附图内容所作的等效结构或等效流程变换，或直接或间接运用在其他相关的技术领域，均同理包括在本发明的专利保护范围内。
Claims (10)
1.一种零点定位方法，其特征在于，所述零点定位方法包括以下步骤：
控制电机运动块朝向限位块运行，并对所述电机运动块进行碰撞检测；
当碰撞成功时，控制所述电机运动块背离所述限位块运行，并实时检测是否接收到编码器发送的Z信号；
在检测到所述Z信号时从所述编码器读取第一编码器值，并控制所述电机运动块减速运行，以读取所述电机运动块停止时的第二编码器值；
基于预设算法根据所述第一编码器值及所述第二编码器值确定零点位置。
2.如权利要求1所述的零点定位方法，其特征在于，所述基于预设算法根据所述第一编码器值及所述第二编码器值确定零点位置的步骤，包括：
根据所述第二编码器值与所述第一编码器值的差值确定停车距离；
基于正弦S曲线算法对所述停车距离进行补偿，获得所述电机运动块停止时的实际位置；
将所述实际位置作为零点位置。
3.如权利要求2所述的零点定位方法，其特征在于，所述基于正弦S曲线算法对所述停车距离进行补偿，获得所述电机运动块停止时的实际位置的步骤，包括：
基于正弦S曲线算法根据所述停车距离及预设目标速度获取所述电机运动块的加加速度；
控制所述电机运动块以所述加加速度朝向限位块运行；
当所述电机运动块的运行距离为所述停车距离时，记录所述电机运动块的当前位置，并将所述当前位置作为所述电机运动块停止时的实际位置。
4.如权利要求3所述的零点定位方法，其特征在于，所述正弦S曲线算法为：
其中，Vp为预设目标速度，Sp为所述停车距离，t为运行时间，j(t)为所述电机运动块的加加速度。
5.如权利要求1～4中任一项所述的零点定位方法，其特征在于，所述对所述电机运动块进行碰撞检测的步骤，包括：
分别对所述电机运动块的碰撞电流、碰撞时间及碰撞位移进行检测；
当所述碰撞电流不小于预设电流，所述碰撞时间不小于第一预设时间且所述碰撞位置不大于预设位移时判定碰撞成功。
6.如权利要求5所述的零点定位方法，其特征在于，所述分别对所述电机运动块的碰撞电流、碰撞时间及碰撞位移进行检测的步骤之后，所述方法还包括：
当所述碰撞电流不小于预设电流且所述碰撞时间不小于第一预设时间时，控制三相逆变模块关闭，以使所述三相逆变模块停止驱动所述电机运动块。
7.如权利要求6所述的零点定位方法，其特征在于，所述在检测到所述Z信号时从所述编码器读取第一编码器值的步骤，包括：
在检测到第N个Z信号时判断检测到所述第N个Z信号的时间是否大于第二预设时间；其中，N为预设正整数；
若是，则控制所述三相逆变模块关闭；
若否，从所述编码器读取第一编码器值。
8.一种零点定位系统，其特征在于，所述零点定位系统包括：
碰撞检测模块，用于控制电机运动块朝向限位块运行，并对所述电机运动块进行碰撞检测；
信号检测模块，用于当碰撞成功时，控制所述电机运动块背离所述限位块运行，并实时检测是否接收到编码器发送的Z信号；
编码器读取模块，用于在检测到所述Z信号时从所述编码器读取第一编码器值，并控制所述电机运动块减速运行，以读取所述电机运动块停止时的第二编码器值；
距离补偿模块，用于基于预设算法根据所述第一编码器值及所述第二编码器值确定零点位置。
9.一种伺服电机，其特征在于，所述伺服电机包括：存储器、处理器及存储在所述存储器上并可在所述处理器上运行的零点定位程序，所述零点定位程序配置为实现如权利要求1至7中任一项所述的零点定位方法的步骤。
10.一种存储介质，其特征在于，所述存储介质上存储有零点定位程序，所述零点定位程序被处理器执行时实现如权利要求1至7中任一项所述的零点定位方法的步骤。
Priority Applications (2)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201911086041.6A CN110793553B (zh) | 2019-11-07 | 2019-11-07 | 零点定位方法、系统、伺服电机及存储介质 |
| PCT/CN2019/129089 WO2021088235A1 (zh) | 2019-11-07 | 2019-12-27 | 零点定位方法、系统、伺服电机及存储介质 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201911086041.6A CN110793553B (zh) | 2019-11-07 | 2019-11-07 | 零点定位方法、系统、伺服电机及存储介质 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN110793553A true CN110793553A (zh) | 2020-02-14 |
| CN110793553B CN110793553B (zh) | 2021-07-23 |
Family
ID=69443266
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201911086041.6A Active CN110793553B (zh) | 2019-11-07 | 2019-11-07 | 零点定位方法、系统、伺服电机及存储介质 |
Country Status (2)
| Country | Link |
|---|---|
| CN (1) | CN110793553B (zh) |
| WO (1) | WO2021088235A1 (zh) |
Cited By (12)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN111506121A (zh) * | 2020-05-26 | 2020-08-07 | 广州彩熠灯光股份有限公司 | 舞台灯具及其定位方法 |
| CN111521205A (zh) * | 2020-04-30 | 2020-08-11 | 苏州高之仙自动化科技有限公司 | 移动机器的方向调整方法、装置及系统 |
| CN112165278A (zh) * | 2020-09-02 | 2021-01-01 | 深圳众为兴技术股份有限公司 | 一种原点回归方法及装置 |
| CN113276985A (zh) * | 2021-06-10 | 2021-08-20 | 济南科亚电子科技有限公司 | 一种舵轮使用增量编码器电机自动寻零的驱动器控制方法 |
| CN113296472A (zh) * | 2021-05-25 | 2021-08-24 | 北京太尔时代科技有限公司 | 系统原点确认方法、装置、加工设备及可读存储介质 |
| CN113476111A (zh) * | 2021-07-08 | 2021-10-08 | 上海导向医疗系统有限公司 | 乳腺旋切系统及其电机控制系统、控制方法 |
| CN114262979A (zh) * | 2021-11-11 | 2022-04-01 | 佛山市睿宝智能科技有限公司 | 圆纬机上下提花的零点设置方法、存储介质及圆纬机 |
| CN114356255A (zh) * | 2021-12-31 | 2022-04-15 | 东莞市启思达智能技术有限公司 | 一种基于打印流程的插值表应用方法及系统 |
| CN114719799A (zh) * | 2022-03-04 | 2022-07-08 | 武汉海微科技有限公司 | 一种软性材质边界检测方法、装置以及存储介质 |
| CN116392259A (zh) * | 2023-04-28 | 2023-07-07 | 极限人工智能有限公司 | 同轨道双驱动模块的行程和防撞监测方法、系统和机器人 |
| WO2024000820A1 (zh) * | 2022-06-30 | 2024-01-04 | 瑞声光电科技(常州)有限公司 | 直驱传输系统的控制方法及相关设备 |
| CN116392259B (zh) * | 2023-04-28 | 2024-06-04 | 极限人工智能有限公司 | 同轨道双驱动模块的行程和防撞监测方法、系统和机器人 |
Citations (14)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS58118908A (ja) * | 1982-01-08 | 1983-07-15 | Fujitsu Ten Ltd | 磁気式回転角センサのノイズ信号除去回路 |
| US4519140A (en) * | 1981-11-07 | 1985-05-28 | Dr. Johannes Heidenhain Gmbh | System for identifying reference marks in a path measuring device |
| JPH06168030A (ja) * | 1992-11-30 | 1994-06-14 | Ricoh Co Ltd | 位置決め装置 |
| JPH09210728A (ja) * | 1996-02-01 | 1997-08-15 | Tamagawa Seiki Co Ltd | エンコーダ信号発生方法及び装置 |
| JPH10127082A (ja) * | 1996-10-14 | 1998-05-15 | Yaskawa Electric Corp | 同期電動機の磁極位置検出方法 |
| JP2005208028A (ja) * | 2003-12-22 | 2005-08-04 | Minebea Co Ltd | バリアブルリラクタンスレゾルバ用角度演算方法とそのための角度演算装置 |
| CN101603840A (zh) * | 2008-06-12 | 2009-12-16 | 佳能株式会社 | 位移检测方法、校正表制作方法、马达控制设备、加工机 |
| CN103825527A (zh) * | 2014-03-07 | 2014-05-28 | 东莞易步机器人有限公司 | 电机编码器定位方法及系统 |
| CN103994784A (zh) * | 2014-05-26 | 2014-08-20 | 天津大学 | 一种基于过零点分析的分布式光纤传感定位方法 |
| CN106052724A (zh) * | 2016-05-19 | 2016-10-26 | 深圳市越疆科技有限公司 | 一种机器人、旋转测量装置及方法 |
| CN108081255A (zh) * | 2016-11-23 | 2018-05-29 | 广州汽车集团乘用车有限公司 | 一种机器人零点校准方法及装置 |
| CN108801300A (zh) * | 2018-03-30 | 2018-11-13 | 安徽理工大学 | 一种接触式圆周运动精确定位装置和方法 |
| CN109108969A (zh) * | 2018-08-21 | 2019-01-01 | 珠海格力智能装备有限公司 | 机器人零点的处理方法及装置 |
| CN109849046A (zh) * | 2017-11-30 | 2019-06-07 | 深圳市优必选科技有限公司 | 一种舵机转子的回零方法、回零系统、舵机及机器人 |
Family Cites Families (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN102778251B (zh) * | 2012-07-18 | 2016-01-20 | 宁波海得工业控制系统有限公司 | 永磁交流伺服电机增量式编码器校对零位的方法 |
| CN204831346U (zh) * | 2015-06-12 | 2015-12-02 | 宁波安信数控技术有限公司 | 一种增量式光电编码器的相位零点调试仪 |
| CN106374791B (zh) * | 2015-07-23 | 2018-11-13 | 珠海格力电器股份有限公司 | 增量式编码器伺服电机的调零方法及装置 |
| CN110955274B (zh) * | 2019-11-27 | 2023-03-07 | 歌尔股份有限公司 | 位移控制方法、系统、伺服电机及存储介质 |
-
2019
- 2019-11-07 CN CN201911086041.6A patent/CN110793553B/zh active Active
- 2019-12-27 WO PCT/CN2019/129089 patent/WO2021088235A1/zh active Application Filing
Patent Citations (14)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US4519140A (en) * | 1981-11-07 | 1985-05-28 | Dr. Johannes Heidenhain Gmbh | System for identifying reference marks in a path measuring device |
| JPS58118908A (ja) * | 1982-01-08 | 1983-07-15 | Fujitsu Ten Ltd | 磁気式回転角センサのノイズ信号除去回路 |
| JPH06168030A (ja) * | 1992-11-30 | 1994-06-14 | Ricoh Co Ltd | 位置決め装置 |
| JPH09210728A (ja) * | 1996-02-01 | 1997-08-15 | Tamagawa Seiki Co Ltd | エンコーダ信号発生方法及び装置 |
| JPH10127082A (ja) * | 1996-10-14 | 1998-05-15 | Yaskawa Electric Corp | 同期電動機の磁極位置検出方法 |
| JP2005208028A (ja) * | 2003-12-22 | 2005-08-04 | Minebea Co Ltd | バリアブルリラクタンスレゾルバ用角度演算方法とそのための角度演算装置 |
| CN101603840A (zh) * | 2008-06-12 | 2009-12-16 | 佳能株式会社 | 位移检测方法、校正表制作方法、马达控制设备、加工机 |
| CN103825527A (zh) * | 2014-03-07 | 2014-05-28 | 东莞易步机器人有限公司 | 电机编码器定位方法及系统 |
| CN103994784A (zh) * | 2014-05-26 | 2014-08-20 | 天津大学 | 一种基于过零点分析的分布式光纤传感定位方法 |
| CN106052724A (zh) * | 2016-05-19 | 2016-10-26 | 深圳市越疆科技有限公司 | 一种机器人、旋转测量装置及方法 |
| CN108081255A (zh) * | 2016-11-23 | 2018-05-29 | 广州汽车集团乘用车有限公司 | 一种机器人零点校准方法及装置 |
| CN109849046A (zh) * | 2017-11-30 | 2019-06-07 | 深圳市优必选科技有限公司 | 一种舵机转子的回零方法、回零系统、舵机及机器人 |
| CN108801300A (zh) * | 2018-03-30 | 2018-11-13 | 安徽理工大学 | 一种接触式圆周运动精确定位装置和方法 |
| CN109108969A (zh) * | 2018-08-21 | 2019-01-01 | 珠海格力智能装备有限公司 | 机器人零点的处理方法及装置 |
Non-Patent Citations (3)
| Title |
|---|
| JIE XU ET.AL: "Control method of rotation angular position zero point transition of stabilization platform framework", 《2012 INTERNATIONAL CONFERENCE ON COMPUTER SCIENCE AND INFORMATION PROCESSING 》 * |
| 朱维杰: "仪表用小型步进电机零位标定方法", 《电机技术》 * |
| 王淑娴等: "伺服电机位置检测技术综述", 《仪器仪表学报》 * |
Cited By (17)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN111521205A (zh) * | 2020-04-30 | 2020-08-11 | 苏州高之仙自动化科技有限公司 | 移动机器的方向调整方法、装置及系统 |
| CN111506121A (zh) * | 2020-05-26 | 2020-08-07 | 广州彩熠灯光股份有限公司 | 舞台灯具及其定位方法 |
| CN111506121B (zh) * | 2020-05-26 | 2023-04-14 | 广州彩熠灯光股份有限公司 | 舞台灯具及其定位方法 |
| CN112165278A (zh) * | 2020-09-02 | 2021-01-01 | 深圳众为兴技术股份有限公司 | 一种原点回归方法及装置 |
| CN113296472A (zh) * | 2021-05-25 | 2021-08-24 | 北京太尔时代科技有限公司 | 系统原点确认方法、装置、加工设备及可读存储介质 |
| CN113276985B (zh) * | 2021-06-10 | 2022-08-23 | 济南科亚电子科技有限公司 | 一种舵轮使用增量编码器电机自动寻零的驱动器控制方法 |
| CN113276985A (zh) * | 2021-06-10 | 2021-08-20 | 济南科亚电子科技有限公司 | 一种舵轮使用增量编码器电机自动寻零的驱动器控制方法 |
| CN113476111A (zh) * | 2021-07-08 | 2021-10-08 | 上海导向医疗系统有限公司 | 乳腺旋切系统及其电机控制系统、控制方法 |
| CN113476111B (zh) * | 2021-07-08 | 2023-01-24 | 上海导向医疗系统有限公司 | 乳腺旋切系统及其电机控制系统、控制方法 |
| CN114262979A (zh) * | 2021-11-11 | 2022-04-01 | 佛山市睿宝智能科技有限公司 | 圆纬机上下提花的零点设置方法、存储介质及圆纬机 |
| CN114356255A (zh) * | 2021-12-31 | 2022-04-15 | 东莞市启思达智能技术有限公司 | 一种基于打印流程的插值表应用方法及系统 |
| CN114356255B (zh) * | 2021-12-31 | 2022-09-06 | 东莞市启思达智能技术有限公司 | 一种基于打印流程的插值表应用方法及系统 |
| CN114719799A (zh) * | 2022-03-04 | 2022-07-08 | 武汉海微科技有限公司 | 一种软性材质边界检测方法、装置以及存储介质 |
| CN114719799B (zh) * | 2022-03-04 | 2024-04-26 | 武汉海微科技股份有限公司 | 一种软性材质边界检测方法、装置以及存储介质 |
| WO2024000820A1 (zh) * | 2022-06-30 | 2024-01-04 | 瑞声光电科技(常州)有限公司 | 直驱传输系统的控制方法及相关设备 |
| CN116392259A (zh) * | 2023-04-28 | 2023-07-07 | 极限人工智能有限公司 | 同轨道双驱动模块的行程和防撞监测方法、系统和机器人 |
| CN116392259B (zh) * | 2023-04-28 | 2024-06-04 | 极限人工智能有限公司 | 同轨道双驱动模块的行程和防撞监测方法、系统和机器人 |
Also Published As
| Publication number | Publication date |
|---|---|
| WO2021088235A1 (zh) | 2021-05-14 |
| CN110793553B (zh) | 2021-07-23 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN110793553B (zh) | 零点定位方法、系统、伺服电机及存储介质 | |
| CN110955274B (zh) | 位移控制方法、系统、伺服电机及存储介质 | |
| US11358832B2 (en) | Method, a safety control unit and an elevator system for defining absolute position information of an elevator car | |
| EP3450990B1 (en) | System and method for speed detection of an object moving vertically within a hoistway of an elevator | |
| CN111376256A (zh) | 一种舵机角度校准方法、系统、机器人及存储介质 | |
| CN107529384B (zh) | 基于线性霍尔元件的微飞轮测速方法及装置 | |
| CN114296393B (zh) | 运动台回零方法、装置、电子设备和存储介质 | |
| CN111026130A (zh) | Agv定位偏差修正的控制方法、装置及可读存储介质 | |
| JPH06242830A (ja) | 位置制御システムの位置情報判別装置及びその判別方法 | |
| CN111628682B (zh) | 步进电机同步驱动方法、装置、终端及存储介质 | |
| JP2018200193A (ja) | モータ制御システム及びレゾルバ／デジタル変換器の異常検出方法 | |
| WO1986000401A1 (en) | Device for detecting absolute position | |
| JP2021163277A (ja) | 位置検出システム | |
| CN116073702A (zh) | 设备回零方法、装置、终端设备及介质 | |
| CN114268246B (zh) | 电机控制方法、装置、系统及计算机可读存储介质 | |
| CN117105132B (zh) | 一种叉车牙叉高度的控制方法及其控制系统 | |
| CN114200944B (zh) | 移动机器人的末端减速方法及系统 | |
| US20220244313A1 (en) | Motor demagnetization detection method and motor demagnetization detection device | |
| KR100405718B1 (ko) | 위치제어를 위한 원호 보간 방법 및 시스템 | |
| CN110045279B (zh) | 电机的力矩和电流的比例关系标定方法、系统及终端设备 | |
| CN114465533A (zh) | 一种无刷直流电机超低转速的测速方法及工具 | |
| JPH0348755B2 (zh) | ||
| CN116382355A (zh) | 一种反力块的回零控制方法及反力装置 | |
| CN115864912A (zh) | 步进电机的找零控制方法、装置、计算机设备和存储介质 | |
| KR100351298B1 (ko) | 자동화 시스템의 고속 원점 복귀 장치 및 방법 |
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 |