CN110955274B - 位移控制方法、系统、伺服电机及存储介质 - Google Patents
位移控制方法、系统、伺服电机及存储介质 Download PDFInfo
- Publication number
- CN110955274B CN110955274B CN201911209990.9A CN201911209990A CN110955274B CN 110955274 B CN110955274 B CN 110955274B CN 201911209990 A CN201911209990 A CN 201911209990A CN 110955274 B CN110955274 B CN 110955274B
- Authority
- CN
- China
- Prior art keywords
- displacement
- motion block
- motor motion
- encoder
- motor
- 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.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D13/00—Control of linear speed; Control of angular speed; Control of acceleration or deceleration, e.g. of a prime mover
- G05D13/62—Control of linear speed; Control of angular speed; Control of acceleration or deceleration, e.g. of a prime mover characterised by the use of electric means, e.g. use of a tachometric dynamo, use of a transducer converting an electric value into a displacement
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Control Of Electric Motors In General (AREA)
- Control Of Position Or Direction (AREA)
Abstract
本发明公开了一种位移控制方法、系统、伺服电机及存储介质。本发明通过控制电机运动块朝向限位块运行，并对电机运动块进行碰撞检测；当碰撞成功时，控制电机运动块背离限位块运行，并实时检测是否接收到编码器发送的Z信号；在检测到Z信号时从编码器读取第一编码器值，并控制电机运动块减速运行，以读取电机运动块停止时的第二编码器值；基于预设算法根据第一编码器值及第二编码器值确定零点位置；根据零点位置确定电机运动块的运行位移。其中，通过Z信号检测及对电机运动块减速运行的距离补偿实现对零点的精确定位，进而实现对电机运动块位移的精确控制，降低了位移控制误差，提高了使用增量式编码器的伺服电机的精度。
Description
技术领域
本发明涉及电机控制技术领域，尤其涉及一种位移控制方法、系统、伺服电机及存储介质。
背景技术
在现代工业生产的很多领域中，都需要高精度误差为微米的位置动作，该功能主要依靠伺服电机实现。目前伺服电机通常使用高精度绝对式编码器或增量式编码器，其中，增量式编码器因其成本适中，操作方便等优势成为主流，但是使用增量式编码器的伺服电机的精度较低。
为了提高伺服电机的精度，通常需要精确地对电机的运动位移进行控制。现有技术中大部分使用外接的定位传感器，如霍尔传感器、光电开关等位置传感器，将传感器放置在零点附近作为伺服电机回零点的定位基准，再根据回零点确定伺服电机的运动位移。具体地为，将运动块以某一恒定速度向着某方向运行，行进过程中如果位置传感器检测到运动块，伺服电机就控制运动块减速停止，当运动块完全停止时，运动块所处的位置就设定为零点，然后以零点为基础控制运动块运行至需要的位置。
上述位移控制方法，在检测到位置传感器开始减速停止时，受到电机转速控制误差、传感器响应误差以及机械传动结构几大因素的影响(如加工装配误差，结构磨合程度等)，停止位置误差较大，导致零点定位不准确，进而导致位移控制不准确。
发明内容
本发明的主要目的在于提供一种位移控制方法、系统、伺服电机及存储介质，旨在解决现有技术中电机运行时位移控制不准确的技术问题。
为实现上述目的，本发明提供一种位移控制方法，所述方法包括以下步骤：
控制电机运动块朝向限位块运行，并对所述电机运动块进行碰撞检测；
当碰撞成功时，控制所述电机运动块背离所述限位块运行，并实时检测是否接收到编码器发送的Z信号；
在检测到所述Z信号时从所述编码器读取第一编码器值，并控制所述电机运动块减速运行，以读取所述电机运动块停止时的第二编码器值；
基于预设算法根据所述第一编码器值及所述第二编码器值确定零点位置；
根据所述零点位置确定所述电机运动块的运行位移。
优选地，所述根据所述零点位置确定所述电机运动块的运行位移的步骤，包括：
根据所述零点位置建立电机运动块的位移坐标系；
根据预设位置补偿表获得各位移坐标对应的位移补偿值；
将所述各位移坐标对应的位移补偿值作为校正值对应校正各位移坐标的位移，获得电机运动块的运行位移。
优选地，所述根据预设位置补偿表对所述位移坐标系进行补偿的步骤之前，所述方法还包括：
建立训练位移坐标系；
重复执行训练步骤；其中，所述训练步骤包括：从所述训练位移坐标系中读取位移坐标，在所述电机运动块到达所述位移坐标时，控制所述电机运动块以位移指令值运行，并测量所述电机运动块的实际位移值；
检测所述训练位移坐标系中所有的位移坐标是否读取完毕；
若是，对应将所述训练位移坐标系中的各位移坐标、位移指令值和实际位移值保存至所述预设位置补偿表中。
优选地，所述基于预设算法根据所述第一编码器值及所述第二编码器值确定零点位置的步骤，包括：
根据所述第二编码器值与所述第一编码器值的差值确定停车距离；
基于正弦S曲线算法对所述停车距离进行补偿，获得所述电机运动块停止时的实际位置；
将所述实际位置作为零点位置。
优选地，所述基于正弦S曲线算法对所述停车距离进行补偿，获得所述电机运动块停止时的实际位置的步骤，包括：
基于正弦S曲线算法根据所述停车距离及预设目标速度获取所述电机运动块的加加速度；
控制所述电机运动块以所述加加速度朝向限位块运行；
当所述电机运动块的运行距离为所述停车距离时，记录所述电机运动块的当前位置，并将所述当前位置作为所述电机运动块停止时的实际位置。
优选地，所述正弦S曲线算法为：
其中，Vp为预设目标速度，Sp为所述停车距离，t为运行时间，j(t)为所述电机运动块的加加速度。
优选地，所述对所述电机运动块进行碰撞检测的步骤，包括：
分别对所述电机运动块的碰撞电流、碰撞时间及碰撞位移进行检测；
当所述碰撞电流不小于预设电流，所述碰撞时间不小于第一预设时间且所述碰撞位置不大于预设位移时判定碰撞成功。
此外，为实现上述目的，本发明还提供一种位移控制系统，所述位移控制系统包括：
碰撞检测模块，用于控制电机运动块朝向限位块运行，并对所述电机运动块进行碰撞检测；
信号检测模块，用于当碰撞成功时，控制所述电机运动块背离所述限位块运行，并实时检测是否接收到编码器发送的Z信号；
编码器读取模块，用于在检测到所述Z信号时从所述编码器读取第一编码器值，并控制所述电机运动块减速运行，以读取所述电机运动块停止时的第二编码器值；
零点确定模块，用于基于预设算法根据所述第一编码器值及所述第二编码器值确定零点位置；
位移补偿模块，用于根据所述零点位置确定所述电机运动块的运行位移。
此外，为实现上述目的，本发明还提供一种伺服电机，所述伺服电机包括：存储器、处理器及存储在所述存储器上并可在所述处理器上运行的位移控制程序，所述位移控制程序配置为实现如上所述的位移控制方法的步骤。
此外，为实现上述目的，本发明还提供一种存储介质，所述存储介质上存储有位移控制程序，所述位移控制程序被处理器执行时实现如上所述的位移控制方法的步骤。
本发明通过控制电机运动块朝向限位块运行，并对电机运动块进行碰撞检测；当碰撞成功时，控制电机运动块背离限位块运行，并实时检测是否接收到编码器发送的Z信号；在检测到Z信号时从编码器读取第一编码器值，并控制电机运动块减速运行，以读取电机运动块停止时的第二编码器值；基于预设算法根据第一编码器值及第二编码器值确定零点位置；根据零点位置确定电机运动块的运行位移。其中，通过Z信号检测及对电机运动块减速运行的距离补偿实现对零点的精确定位，进而实现对电机运动块位移的精确控制，降低了位移控制误差，提高了使用增量式编码器的伺服电机的精度。
附图说明
图1是本发明实施例方案涉及的硬件运行环境的伺服电机结构示意图；
图2为本发明位移控制方法第一实施例的流程示意图；
图3为本发明位移控制方法第二实施例的流程示意图；
图4为本发明位移控制方法第三实施例的流程示意图；
图5为本发明位移控制系统第一实施例的功能模块图。
本发明目的的实现、功能特点及优点将结合实施例，参照附图做进一步说明。
具体实施方式
应当理解，此处所描述的具体实施例仅仅用以解释本发明，并不用于限定本发明。
参照图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中存储的位移控制程序，还执行以下操作：
根据所述零点位置建立电机运动块的位移坐标系；
根据预设位置补偿表获得各位移坐标对应的位移补偿值；
将所述各位移坐标对应的位移补偿值作为校正值对应校正各位移坐标的位移，获得电机运动块的运行位移。
进一步地，处理器1001可以调用存储器1005中存储的位移控制程序，还执行以下操作：
建立训练位移坐标系；
重复执行训练步骤；其中，所述训练步骤包括：从所述训练位移坐标系中读取位移坐标，在所述电机运动块到达所述位移坐标时，控制所述电机运动块以位移指令值运行，并测量所述电机运动块的实际位移值；
检测所述训练位移坐标系中所有的位移坐标是否读取完毕；
若是，对应将所述训练位移坐标系中的各位移坐标、位移指令值和实际位移值保存至所述预设位置补偿表中。
进一步地，处理器1001可以调用存储器1005中存储的位移控制程序，还执行以下操作：
根据所述第二编码器值与所述第一编码器值的差值确定停车距离；
基于正弦S曲线算法对所述停车距离进行补偿，获得所述电机运动块停止时的实际位置；
将所述实际位置作为零点位置。
进一步地，处理器1001可以调用存储器1005中存储的位移控制程序，还执行以下操作：
基于正弦S曲线算法根据所述停车距离及预设目标速度获取所述电机运动块的加加速度；
控制所述电机运动块以所述加加速度朝向限位块运行；
当所述电机运动块的运行距离为所述停车距离时，记录所述电机运动块的当前位置，并将所述当前位置作为所述电机运动块停止时的实际位置。
进一步地，处理器1001可以调用存储器1005中存储的位移控制程序，还执行以下操作：
分别对所述电机运动块的碰撞电流、碰撞时间及碰撞位移进行检测；
当所述碰撞电流不小于预设电流，所述碰撞时间不小于第一预设时间且所述碰撞位置不大于预设位移时判定碰撞成功。
本实施例通过控制电机运动块朝向限位块运行，并对电机运动块进行碰撞检测；当碰撞成功时，控制电机运动块背离限位块运行，并实时检测是否接收到编码器发送的Z信号；在检测到Z信号时从编码器读取第一编码器值，并控制电机运动块减速运行，以读取电机运动块停止时的第二编码器值；基于预设算法根据第一编码器值及第二编码器值确定零点位置；根据零点位置确定电机运动块的运行位移。其中，通过Z信号检测及对电机运动块减速运行的距离补偿实现对零点的精确定位，进而实现对电机运动块位移的精确控制，降低了位移控制误差，提高了使用增量式编码器的伺服电机的精度。
基于上述硬件结构，提出本发明位移控制方法实施例。
参照图2，图2为本发明位移控制方法第一实施例的流程示意图。
在第一实施例中，所述位移控制方法包括以下步骤：
S10：控制电机运动块朝向限位块运行，并对所述电机运动块进行碰撞检测；
可以理解的是，传统的零点定位方法是将传感器放置在零点附近，将电机运动块以某一恒定速度向着固定方向运动，当检测到传感器就减速停止，将电机运动块完全停止时的位置设置为零点。但是由于电机运动块停止需要时间，并会运行一段距离，因此，真正的零点与电机运动块完全停止的位置并不相同，导致零点定位存在较大误差，进而影响位移控制的准确性。本实施例取消了传感器，利用伺服电机中的限位块、编码器及相应的程序控制实现精确的零点定位，最终实现伺服电机运动位移的精确控制。
应理解的是，所述朝向限位块运行指向限位块的方向运行，本实施例中不限定具体运行路径。
需要说明的是，所述碰撞检测是对电机运动块是否碰撞到限位块进行检测，其检测方式有很多种。作为一优选实施例，在进行碰撞检测时分别对电机运动块的碰撞电流、碰撞时间及碰撞位移进行检测；只有同时满足三个条件，即当所述碰撞电流不小于预设电流，所述碰撞时间不小于第一预设时间且所述碰撞位置不大于预设位移时才判定碰撞成功，以保证碰撞充分。
在具体实现中，三相逆变模块是电机的驱动硬件，用于驱动电机运行。当碰撞电流不小于预设电流且碰撞时间不小于第一预设时间时，说明电流过大并且持续时间较长，此时需要控制三相逆变模块关闭，以使三相逆变模块停止驱动电机运动块，如此可以有效保护三相逆变模块。
S20：当碰撞成功时，控制所述电机运动块背离所述限位块运行，并实时检测是否接收到编码器发送的Z信号；
应理解的是，所述背离限位块运行指向限位块的方向的反方向运行，本实施例中不限定具体运行路径。
需要说明的是，为了控制产品成本及方便用户操作，所述编码器可以使用增量式编码器，如ABZ信号的增量式编码器。增量式编码器是直接利用光电转换原理输出三组方波脉冲A、B和Z相，A、B两组脉冲相位差90，从而可方便的判断出旋转方向，而Z相为每转一个脉冲，用于零点定位。
S30：在检测到所述Z信号时从所述编码器读取第一编码器值，并控制所述电机运动块减速运行，以读取所述电机运动块停止时的第二编码器值；
具体地，在检测到第N个Z信号时判断检测到所述第N个Z信号的时间是否大于第二预设时间；其中，N为预设正整数；若是，则控制所述三相逆变模块关闭；若否，从所述编码器读取第一编码器值。
需要说明的是，Z信号在一圈内位置是零位，通过读取Z信号，可以在一圈内修正增量信号因脉冲丢失而产生的计数误差。本实施例中，工程人员可以根据伺服电机的具体硬件情况选取第N个Z信号时编码器的值作为第一编码器值。
当然，如果编码器出现故障，找不到信号或者找到第N个Z信号的时间过长时，为了保护驱动硬件，同样需要关闭三相逆变模块。
应当理解的是，此时电机运动块减速运行，是指电机运动块背离限位块减速运行。
在具体实现中，由于增量式编码器是将位移转换成周期性的电信号，再把这个电信号转变成计数脉冲，用脉冲的个数表示位移的大小，因此，通过第一编码器值及第二编码器值可以计算电机运动块在不同时间段的位移。
S40：基于预设算法根据所述第一编码器值及所述第二编码器值确定零点位置；
需要说明的是，从接收到第N个Z信号开始停车，到电机运动块完全停止，这期间存在一段停车距离。所述预设算法用于通过反向补偿方式对停车距离进行回补，消除电机运动块的停车误差，从而减少定位误差，完成精确定位。
S50：根据所述零点位置确定所述电机运动块的运行位移。
应当理解的是，根据该精确的零点位置建立位移坐标系，覆盖电机运动块行程的所有位移，根据该位移坐标系对电机运动块进行控制，可以有效提高位移控制的准确性。
本实施例通过控制电机运动块朝向限位块运行，并对电机运动块进行碰撞检测；当碰撞成功时，控制电机运动块背离限位块运行，并实时检测是否接收到编码器发送的Z信号；在检测到Z信号时从编码器读取第一编码器值，并控制电机运动块减速运行，以读取电机运动块停止时的第二编码器值；基于预设算法根据第一编码器值及第二编码器值确定零点位置；根据零点位置确定电机运动块的运行位移。其中，通过Z信号检测及对电机运动块减速运行的距离补偿实现对零点的精确定位，进而实现对电机运动块位移的精确控制，降低了位移控制误差，提高了使用增量式编码器的伺服电机的精度。
进一步地，如图3所示，基于第一实施例提出本发明位移控制方法第二实施例，在本实施例中，步骤S50具体包括以下步骤：
S51：根据所述零点位置建立电机运动块的位移坐标系；
需要说明的是，垂直运动系统一般由负载、编码器、驱动器与电机本体组成，电机与上述设备之间通过运动控制卡或PLC利用线缆连接来控制。其中，电机本体结构包含运动块以及限位块。本实施例在电机运动块行程范围内的任意位置，接收到命令后，可以自动寻找零点位置，并确保回零点的精度高，由此建立的位移坐标系，覆盖零点位置到电机运动块行程的所有位移，且在实际运动中，采用对传动结构误差的补偿方式，来保证运行位移的准确性。
S52：根据预设位置补偿表获得各位移坐标对应的位移补偿值；
应当理解的是，由于电机运行时通过传动结构传递给负载的运动存在结构误差(如背隙)，这会导致命令位置与实际位置存在误差，所以，为有效消除此类误差，采用一个电机自学习的软件流程来加以克服。具体流程如下：
建立训练位移坐标系；重复执行训练步骤；其中，所述训练步骤包括：从所述训练位移坐标系中读取位移坐标，在所述电机运动块到达所述位移坐标时，控制所述电机运动块以位移指令值运行，并测量所述电机运动块的实际位移值；检测所述训练位移坐标系中所有的位移坐标是否读取完毕；若是，对应将所述训练位移坐标系中的各位移坐标、位移指令值和实际位移值保存至所述预设位置补偿表中。
其中，训练位移坐标系根据实际应用场景的需要建立，建立训练位移坐标系的方法可以是将整个行程分成若干段，每段选取一个点作为位移坐标，当然，本实施例对此不加以限制。
建立完训练位移坐标系后，通过发送位移指令值的方式，令电机运动块在全行程中运行，实时获取各位移坐标对应的位移指令值及测量到的实际位移值值，比较命令值与实际测量值的差异，将这些数值形成预设位置补偿表导入到驱动器程序中，通过程序来添加相应补偿，最终保证位移精准。
S53：将所述各位移坐标对应的位移补偿值作为校正值对应校正各位移坐标的位移，获得电机运动块的运行位移。
应当理解的是，当启动正常业务运行电机运动块时，在位移坐标系中实时比较预设位置补偿表中的数值，并进行位置补偿，将补偿的数据作为校正值发送电机，完成运行动作。
本实施例通过建立覆盖电机运动块行程所有位移的位移坐标系，并根据传动机构的误差对位移进行补偿，保障了电机运动块的运行位移的准确性。
进一步地，如图4所示，基于第一实施例提出本发明位移控制方法第三实施例，在本实施例中，步骤S40具体包括以下步骤：
S41：根据所述第二编码器值与所述第一编码器值的差值确定停车距离；
具体地，由于通过第一编码器值可以计算出找到第N个Z信号时电机运动块的位移，通过第二编码器值可以计算出电机运动块运行至减速时的位移，通过第二编码器值与所述第一编码器值的差值可以确定电机运动块减速过程中的停车距离。
S42：基于正弦S曲线算法对所述停车距离进行补偿，获得所述电机运动块停止时的实际位置；
具体地，基于正弦S曲线算法根据所述停车距离及预设目标速度获取所述电机运动块的加加速度；控制所述电机运动块以所述加加速度朝向限位块运行；当所述电机运动块的运行距离为所述停车距离时，记录所述电机运动块的当前位置，并将所述当前位置作为所述电机运动块停止时的实际位置。
其中，所述正弦S曲线算法为：
其中，Vp为预设目标速度，Sp为所述停车距离，t为运行时间，j(t)为所述电机运动块的加加速度。
需要说明的是，梯形、抛物线形加速曲线其加加速度为阶跃函数，存在阶跃变换，使得电机速度变化不够平稳，而正弦加速曲线，其加加速度为正弦函数，可连续求导，因此正弦曲线能更好地符合步进电机力矩随速度升高而减小的特点，充分地利用电机的有效转矩，同时能够减弱机械冲击。通过正弦S曲线算法控制电机运动块加减速，可以实现电机的平稳可靠的运行。
S43：将所述实际位置作为零点位置。
可理解的是，在对停车距离进行补偿后，电机运动块停止的实际位置才是真正的零点位置。在零点定位完成后，还可以向编码器发送回零完成信号，以同步编码器的当前采样值，并设置编码器的回零状态，等待上位机指令。
本实施例通过正弦S曲线算法规划运动路径控制电机动块的加减速运行，在对停车距离精准反向补偿的同时，保障了位置的准确性，实现了精准定位。
本发明进一步提供一种位移控制系统。
参照图5，图5为本发明位移控制系统第一实施例的功能模块图。
本实施例中，所述位移控制系统包括：
碰撞检测模块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信号开始停车，到电机运动块完全停止，这期间存在一段停车距离。所述预设算法用于通过反向补偿方式对停车距离进行回补，消除电机运动块的停车误差，从而减少定位误差，完成精确定位。
位移确定模块50，用于根据所述零点位置确定所述电机运动块的运行位移。
应当理解的是，根据该精确的零点位置建立位移坐标系，覆盖电机运动块行程的所有位移，根据该位移坐标系对电机运动块进行控制，可以有效提高位移控制的准确性。
本实施例通过控制电机运动块朝向限位块运行，并对电机运动块进行碰撞检测；当碰撞成功时，控制电机运动块背离限位块运行，并实时检测是否接收到编码器发送的Z信号；在检测到Z信号时从编码器读取第一编码器值，并控制电机运动块减速运行，以读取电机运动块停止时的第二编码器值；基于预设算法根据第一编码器值及第二编码器值确定零点位置；根据零点位置确定电机运动块的运行位移。其中，通过Z信号检测及对电机运动块减速运行的距离补偿实现对零点的精确定位，进而实现对电机运动块位移的精确控制，降低了位移控制误差，提高了使用增量式编码器的伺服电机的精度。
此外，本发明实施例还提出一种存储介质，所述存储介质上存储有位移控制程序，所述位移控制程序被处理器执行时实现如下操作：
控制电机运动块朝向限位块运行，并对所述电机运动块进行碰撞检测；
当碰撞成功时，控制所述电机运动块背离所述限位块运行，并实时检测是否接收到编码器发送的Z信号；
在检测到所述Z信号时从所述编码器读取第一编码器值，并控制所述电机运动块减速运行，以读取所述电机运动块停止时的第二编码器值；
基于预设算法根据所述第一编码器值及所述第二编码器值确定零点位置；
根据所述零点位置确定所述电机运动块的运行位移。
进一步地，所述位移控制程序被处理器执行时还实现如下操作：
根据所述零点位置建立电机运动块的位移坐标系；
根据预设位置补偿表获得各位移坐标对应的位移补偿值；
将所述各位移坐标对应的位移补偿值作为校正值对应校正各位移坐标的位移，获得电机运动块的运行位移。
进一步地，所述位移控制程序被处理器执行时还实现如下操作：
建立训练位移坐标系；
重复执行训练步骤；其中，所述训练步骤包括：从所述训练位移坐标系中读取位移坐标，在所述电机运动块到达所述位移坐标时，控制所述电机运动块以位移指令值运行，并测量所述电机运动块的实际位移值；
检测所述训练位移坐标系中所有的位移坐标是否读取完毕；
若是，对应将所述训练位移坐标系中的各位移坐标、位移指令值和实际位移值保存至所述预设位置补偿表中。
进一步地，所述位移控制程序被处理器执行时还实现如下操作：
根据所述第二编码器值与所述第一编码器值的差值确定停车距离；
基于正弦S曲线算法对所述停车距离进行补偿，获得所述电机运动块停止时的实际位置；
将所述实际位置作为零点位置。
进一步地，所述位移控制程序被处理器执行时还实现如下操作：
基于正弦S曲线算法根据所述停车距离及预设目标速度获取所述电机运动块的加加速度；
控制所述电机运动块以所述加加速度朝向限位块运行；
当所述电机运动块的运行距离为所述停车距离时，记录所述电机运动块的当前位置，并将所述当前位置作为所述电机运动块停止时的实际位置。
进一步地，所述位移控制程序被处理器执行时还实现如下操作：
分别对所述电机运动块的碰撞电流、碰撞时间及碰撞位移进行检测；
当所述碰撞电流不小于预设电流，所述碰撞时间不小于第一预设时间且所述碰撞位置不大于预设位移时判定碰撞成功。
本发明计算机可读存储介质的具体实施例与上述位移控制方法各实施例基本相同，在此不作赘述。
需要说明的是，在本文中，术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含，从而使得包括一系列要素的过程、方法、物品或者系统不仅包括那些要素，而且还包括没有明确列出的其他要素，或者是还包括为这种过程、方法、物品或者系统所固有的要素。在没有更多限制的情况下，由语句“包括一个……”限定的要素，并不排除在包括该要素的过程、方法、物品或者系统中还存在另外的相同要素。
上述本发明实施例序号仅仅为了描述，不代表实施例的优劣。
通过以上的实施方式的描述，本领域的技术人员可以清楚地了解到上述实施例方法可借助软件加必需的通用硬件平台的方式来实现，当然也可以通过硬件，但很多情况下前者是更佳的实施方式。基于这样的理解，本发明的技术方案本质上或者说对现有技术做出贡献的部分可以以软件产品的形式体现出来，该计算机软件产品存储在如上所述的一个存储介质(如ROM/RAM、磁碟、光盘)中，包括若干指令用以使得一台终端设备(可以是手机，计算机，服务器，空调器，或者网络设备等)执行本发明各个实施例所述的方法。
以上仅为本发明的优选实施例，并非因此限制本发明的专利范围，凡是利用本发明说明书及附图内容所作的等效结构或等效流程变换，或直接或间接运用在其他相关的技术领域，均同理包括在本发明的专利保护范围内。
Claims (8)
1.一种位移控制方法，其特征在于，所述位移控制方法包括以下步骤：
控制电机运动块朝向限位块运行，并对所述电机运动块进行碰撞检测；
当碰撞成功时，控制所述电机运动块背离所述限位块运行，并实时检测是否接收到编码器发送的Z信号；
在检测到所述Z信号时从所述编码器读取第一编码器值，并控制所述电机运动块减速运行，以读取所述电机运动块停止时的第二编码器值；
基于预设算法根据所述第一编码器值及所述第二编码器值确定零点位置；
根据所述零点位置确定所述电机运动块的运行位移；
所述基于预设算法根据所述第一编码器值及所述第二编码器值确定零点位置的步骤，包括：
根据所述第二编码器值与所述第一编码器值的差值确定停车距离；
基于正弦S曲线算法对所述停车距离进行补偿，获得所述电机运动块停止时的实际位置；
将所述实际位置作为零点位置；
所述正弦S曲线算法为：
其中，Vp为预设目标速度，Sp为所述停车距离，t为运行时间，j(t)为所述电机运动块的加加速度。
2.如权利要求1所述的位移控制方法，其特征在于，所述根据所述零点位置确定所述电机运动块的运行位移的步骤，包括：
根据所述零点位置建立电机运动块的位移坐标系；
根据预设位置补偿表获得各位移坐标对应的位移补偿值；
将所述各位移坐标对应的位移补偿值作为校正值对应校正各位移坐标的位移，获得电机运动块的运行位移。
3.如权利要求2所述的位移控制方法，其特征在于，所述根据预设位置补偿表对所述位移坐标系进行补偿的步骤之前，所述方法还包括：
建立训练位移坐标系；
重复执行训练步骤；其中，所述训练步骤包括：从所述训练位移坐标系中读取位移坐标，在所述电机运动块到达所述位移坐标时，控制所述电机运动块以位移指令值运行，并测量所述电机运动块的实际位移值；
检测所述训练位移坐标系中所有的位移坐标是否读取完毕；
若是，对应将所述训练位移坐标系中的各位移坐标、位移指令值和实际位移值保存至所述预设位置补偿表中。
4.如权利要求1所述的位移控制方法，其特征在于，所述基于正弦S曲线算法对所述停车距离进行补偿，获得所述电机运动块停止时的实际位置的步骤，包括：
基于正弦S曲线算法根据所述停车距离及预设目标速度获取所述电机运动块的加加速度；
控制所述电机运动块以所述加加速度朝向限位块运行；
当所述电机运动块的运行距离为所述停车距离时，记录所述电机运动块的当前位置，并将所述当前位置作为所述电机运动块停止时的实际位置。
5.如权利要求1～4中任一项所述的位移控制方法，其特征在于，所述对所述电机运动块进行碰撞检测的步骤，包括：
分别对所述电机运动块的碰撞电流、碰撞时间及碰撞位移进行检测；
当所述碰撞电流不小于预设电流，所述碰撞时间不小于第一预设时间且所述碰撞位移不大于预设位移时判定碰撞成功。
6.一种位移控制系统，其特征在于，所述位移控制系统包括：
碰撞检测模块，用于控制电机运动块朝向限位块运行，并对所述电机运动块进行碰撞检测；
信号检测模块，用于当碰撞成功时，控制所述电机运动块背离所述限位块运行，并实时检测是否接收到编码器发送的Z信号；
编码器读取模块，用于在检测到所述Z信号时从所述编码器读取第一编码器值，并控制所述电机运动块减速运行，以读取所述电机运动块停止时的第二编码器值；
距离补偿模块，用于基于预设算法根据所述第一编码器值及所述第二编码器值确定零点位置；
位移确定模块，用于根据所述零点位置确定所述电机运动块的运行位移；
所述距离补偿模块还用于：
根据所述第二编码器值与所述第一编码器值的差值确定停车距离；
基于正弦S曲线算法对所述停车距离进行补偿，获得所述电机运动块停止时的实际位置；
将所述实际位置作为零点位置；
所述正弦S曲线算法为：
其中，Vp为预设目标速度，Sp为所述停车距离，t为运行时间，j(t)为所述电机运动块的加加速度。
7.一种伺服电机，其特征在于，所述伺服电机包括：存储器、处理器及存储在所述存储器上并可在所述处理器上运行的位移控制程序，所述位移控制程序配置为实现如权利要求1至5中任一项所述的位移控制方法的步骤。
8.一种存储介质，其特征在于，所述存储介质上存储有位移控制程序，所述位移控制程序被处理器执行时实现如权利要求1至5中任一项所述的位移控制方法的步骤。
Priority Applications (2)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201911209990.9A CN110955274B (zh) | 2019-11-27 | 2019-11-27 | 位移控制方法、系统、伺服电机及存储介质 |
| PCT/CN2019/129085 WO2021103254A1 (zh) | 2019-11-27 | 2019-12-27 | 位移控制方法、系统、伺服电机及存储介质 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201911209990.9A CN110955274B (zh) | 2019-11-27 | 2019-11-27 | 位移控制方法、系统、伺服电机及存储介质 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN110955274A CN110955274A (zh) | 2020-04-03 |
| CN110955274B true CN110955274B (zh) | 2023-03-07 |
Family
ID=69979156
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201911209990.9A Active CN110955274B (zh) | 2019-11-27 | 2019-11-27 | 位移控制方法、系统、伺服电机及存储介质 |
Country Status (2)
| Country | Link |
|---|---|
| CN (1) | CN110955274B (zh) |
| WO (1) | WO2021103254A1 (zh) |
Families Citing this family (10)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN110793553B (zh) * | 2019-11-07 | 2021-07-23 | 歌尔股份有限公司 | 零点定位方法、系统、伺服电机及存储介质 |
| CN113552835B (zh) * | 2020-04-23 | 2022-08-19 | 德律科技股份有限公司 | 适用于具有输送带的自动化机台的自动控制系统及方法 |
| CN113820994B (zh) * | 2021-08-17 | 2023-08-22 | 华能澜沧江水电股份有限公司 | 筒阀控制方法、装置、计算机设备及计算机可读存储介质 |
| CN113682988A (zh) * | 2021-08-31 | 2021-11-23 | 深圳市海浦蒙特科技有限公司 | 一种塔式起重机及其防冲顶保护方法、系统和装置 |
| CN114296393B (zh) * | 2021-12-29 | 2024-01-16 | 北京半导体专用设备研究所（中国电子科技集团公司第四十五研究所） | 运动台回零方法、装置、电子设备和存储介质 |
| CN114741925B (zh) * | 2022-04-15 | 2023-12-29 | 中铁大桥勘测设计院集团有限公司 | 杆件伸缩量的计算方法、装置、设备及可读存储介质 |
| CN115503629B (zh) * | 2022-10-27 | 2024-04-09 | 常州星宇车灯股份有限公司 | 一种汽车车灯als和afs自动校正系统及校正方法 |
| CN116392259B (zh) * | 2023-04-28 | 2024-06-04 | 极限人工智能有限公司 | 同轨道双驱动模块的行程和防撞监测方法、系统和机器人 |
| CN116857247A (zh) * | 2023-07-01 | 2023-10-10 | 广州达蒙安防科技有限公司 | 一种控制爬架动态平衡的方法 |
| CN117555292B (zh) * | 2024-01-11 | 2024-04-09 | 南京德克威尔自动化有限公司 | 基于协同控制的伺服驱动控制方法、系统、设备及介质 |
Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US4849678A (en) * | 1986-06-19 | 1989-07-18 | Fanuc Ltd | Method of automatic zero adjustment of an injection-molding machine and an apparatus therefor |
| WO2017113331A1 (zh) * | 2015-12-31 | 2017-07-06 | 深圳配天智能技术研究院有限公司 | 一种主轴定向方法、数控装置及数控机床 |
| WO2019210854A1 (zh) * | 2018-05-03 | 2019-11-07 | 杭州瑞拉腾电气科技有限公司 | 一种同步磁阻电机的位置传感器的零位自学习方法 |
Family Cites Families (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP3593383B2 (ja) * | 1995-06-08 | 2004-11-24 | 株式会社アマダ | 位置決め装置の原点設定方法およびその装置 |
| JPH09138706A (ja) * | 1995-11-15 | 1997-05-27 | Denso Corp | 可動体の自動原点校正装置 |
| CN109656130B (zh) * | 2017-10-10 | 2022-06-07 | 北京京东乾石科技有限公司 | 搬运机器人运行控制方法、装置、机器人以及存储介质 |
| KR102418451B1 (ko) * | 2017-12-27 | 2022-07-07 | 주식회사 한화 | 로봇 제어 시스템 |
-
2019
- 2019-11-27 CN CN201911209990.9A patent/CN110955274B/zh active Active
- 2019-12-27 WO PCT/CN2019/129085 patent/WO2021103254A1/zh active Application Filing
Patent Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US4849678A (en) * | 1986-06-19 | 1989-07-18 | Fanuc Ltd | Method of automatic zero adjustment of an injection-molding machine and an apparatus therefor |
| WO2017113331A1 (zh) * | 2015-12-31 | 2017-07-06 | 深圳配天智能技术研究院有限公司 | 一种主轴定向方法、数控装置及数控机床 |
| WO2019210854A1 (zh) * | 2018-05-03 | 2019-11-07 | 杭州瑞拉腾电气科技有限公司 | 一种同步磁阻电机的位置传感器的零位自学习方法 |
Non-Patent Citations (2)
| Title |
|---|
| 仪表用小型步进电机零位标定方法;朱维杰;《电机技术》;20090825(第04期);全文 * |
| 步进电机变速控制系统设计;桑鹏等;《电子设计工程》;20131120(第22期);全文 * |
Also Published As
| Publication number | Publication date |
|---|---|
| CN110955274A (zh) | 2020-04-03 |
| WO2021103254A1 (zh) | 2021-06-03 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN110955274B (zh) | 位移控制方法、系统、伺服电机及存储介质 | |
| CN110793553B (zh) | 零点定位方法、系统、伺服电机及存储介质 | |
| EP3580161B1 (en) | A method and an elevator system for performing a synchronization run of an elevator car | |
| TWI839158B (zh) | 測試裝置 | |
| US11753275B2 (en) | Method for preventive maintenance of an elevator and an elevator system | |
| CN105764826A (zh) | 用于使电梯控制装置运行的方法 | |
| CN114296393B (zh) | 运动台回零方法、装置、电子设备和存储介质 | |
| JPS6294251A (ja) | 位置制御装置 | |
| CN108683384B (zh) | 多起重变频器同步控制方法和系统 | |
| US8121711B2 (en) | System and method for controlling movement of a measurement machine | |
| US9035589B2 (en) | Method and processing unit for determining the position of the armature of a synchronous machine relative to the stator of the synchronous machine | |
| KR0168068B1 (ko) | 위치제어시스템의 위치정보 판별장치 및 그 판별방법 | |
| US6318508B1 (en) | Elevating system control method and apparatus synchronizing plural elevating devices | |
| CN116161551A (zh) | 用于吊钩高度的检测方法、起重机、存储介质及控制器 | |
| CN111026130A (zh) | Agv定位偏差修正的控制方法、装置及可读存储介质 | |
| CN111766887B (zh) | 一种升降机构的控制系统以及用于该系统的控制方法 | |
| JP2018200193A (ja) | モータ制御システム及びレゾルバ／デジタル変換器の異常検出方法 | |
| CN117105132B (zh) | 一种叉车牙叉高度的控制方法及其控制系统 | |
| CN117375462B (zh) | 步进电机校准方法、装置、设备及计算机存储介质 | |
| CN103576605B (zh) | 数值控制装置以及螺距误差计算方法 | |
| CN118009864B (zh) | 动子控制方法、装置、电子设备及存储介质 | |
| CN114268246B (zh) | 电机控制方法、装置、系统及计算机可读存储介质 | |
| KR0129944B1 (ko) | 스태커 크레인의 위치이동 제어방법 및 그 장치 | |
| JPS6320750B2 (zh) | ||
| CN118539795A (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 | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |