CN113910216B - 一种电机轴控制方法、***、机器人及存储介质 - Google Patents

一种电机轴控制方法、***、机器人及存储介质 Download PDF

Info

Publication number
CN113910216B
CN113910216B CN202010656899.8A CN202010656899A CN113910216B CN 113910216 B CN113910216 B CN 113910216B CN 202010656899 A CN202010656899 A CN 202010656899A CN 113910216 B CN113910216 B CN 113910216B
Authority
CN
China
Prior art keywords
motor shaft
data
reset
interpolation
position data
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
Application number
CN202010656899.8A
Other languages
English (en)
Other versions
CN113910216A (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.)
Beijing A&e Technologies Co ltd
Original Assignee
Beijing A&e Technologies Co ltd
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 Beijing A&e Technologies Co ltd filed Critical Beijing A&e Technologies Co ltd
Priority to CN202010656899.8A priority Critical patent/CN113910216B/zh
Publication of CN113910216A publication Critical patent/CN113910216A/zh
Application granted granted Critical
Publication of CN113910216B publication Critical patent/CN113910216B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1602Programme controls characterised by the control system, structure, architecture

Landscapes

  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Numerical Control (AREA)

Abstract

本申请公开了一种电机轴控制方法,所述电机轴控制方法包括若接收到复位指令,则利用伺服驱动器采集轴位置数据;将接收到所述复位指令后所述伺服驱动器首次采集的轴位置数据作为电机轴的当前位置数据;利用所述插补器根据所述电机轴的当前位置数据执行插补操作得到插补数据,并控制所述电机轴执行所述插补数据对应的操作。本申请能够避免电机轴在复位操作过程中产生抖动。本申请还公开了一种电机轴控制***、一种机器人及一种存储介质,具有以上有益效果。

Description

一种电机轴控制方法、***、机器人及存储介质
技术领域
本申请涉及机器人控制技术领域,特别涉及一种电机轴控制方法、***、一种机器人及一种存储介质。
背景技术
随着经济的快速发展,机器人在工业现场的应用越来越广泛,已经成为了降低生产成本,提高生产效率和提升工业制造能力,实现智能制造的重要推动力。工业机器人是面向工业领域的多关节机械手或多自由度的机器装置,它能自动执行工作,是靠自身动力和控制能力来实现各种功能的一种机器。
当用户主动控制机器人的电机轴执行复位时,机器人先从伺服通信卡中将反馈的轴位置数据读取出来,更新到当前轴位置数据中,这样如果驱动的参数调节不是最优的,那么读取到的位置数据就会有些许的变化,这样每次的一点偏差就会由通信卡又下发到伺服驱动中,于是反复执行复位操作的时候,会发现电机轴抖动或者发出异响。
因此,如何避免电机轴在复位操作过程中产生抖动是本领域技术人员目前需要解决的技术问题。
发明内容
本申请的目的是提供一种电机轴控制方法、一种电机轴控制***、一种机器人及一种存储介质,能够避免电机轴在复位操作过程中产生抖动。
为解决上述技术问题,本申请提供一种电机轴控制方法,该电机轴控制方法包括:
若接收到复位指令,则利用伺服驱动器采集轴位置数据;
将接收到所述复位指令后所述伺服驱动器首次采集的轴位置数据作为电机轴的当前位置数据;
利用所述插补器根据所述电机轴的当前位置数据执行插补操作得到插补数据,并控制所述电机轴执行所述插补数据对应的操作。
可选的,控制所述电机轴执行所述插补数据对应的操作,包括:
将所述插补数据存储至指令位置缓存中;
当接收到通讯卡发送的触发信号时,从所述指令位置缓存中将所述插补数据通过通讯卡下发至所述伺服驱动器,以便所述伺服驱动器控制所述电机轴执行所述插补数据对应的操作。
可选的,将所述插补数据存储至指令位置缓存中,包括:
将所述插补数据转化为对应的脉冲数据,并将所述脉冲数据存储至所述指令位置缓存中;
相应的,从所述指令位置缓存中将所述插补数据通过通讯卡下发至伺服驱动器,包括:
从所述指令位置缓存中将所述插补数据对应的脉冲数据通过所述通讯卡下发至所述伺服驱动器。
可选的,利用所述插补器根据所述电机轴的当前位置数据执行插补操作得到插补数据,包括:
根据所述当前位置数据和复位目标位置数据生成复位运动轨迹数据;
利用所述插补器对所述复位运动轨迹数据执行插补操作得到所述插补数据。
可选的,在利用所述插补器根据所述电机轴的当前位置数据执行插补操作得到插补数据之前,还包括:
将所述插补器的复位调用标志位由第一预设值修改为第二预设值;其中,当所述复位调用标志位为第二预设值时,所述插补器执行根据所述电机轴的当前位置数据生成所述插补数据的操作,当所述复位调用标志位为第一预设值时,所述插补器忽略所述伺服驱动器采集的轴位置数据。
可选的,在控制所述电机轴执行所述插补数据对应的操作之后,还包括:
将所述将插补器的复位调用标志位由所述第二预设值恢复为所述第一预设值。
可选的,还包括:
若接收到急停指令,则停止所述伺服驱动器对所述电机轴的控制操作并停止所述插补器的插补数据下发操作;
利用伺服驱动器采集所述电机轴的急停位置,并根据所述急停位置更新待下发插补数据;
若接收到急停恢复指令,则将更新后的待下发插补数据发送至所述伺服驱动器,以便所述伺服驱动器根据更新后的待下发插补数据对所述电机轴执行控制操作。
本申请还提供了一种电机轴控制***,该电机轴控制***包括:
轴位置数据采集模块,用于若接收到复位指令,则利用伺服驱动器采集轴位置数据;
当前位置数据确定模块,用于将接收到所述复位指令后所述伺服驱动器首次采集的轴位置数据作为电机轴的当前位置数据;
插补控制模块,用于利用所述插补器根据所述电机轴的当前位置数据执行插补操作得到插补数据,并控制所述电机轴执行所述插补数据对应的操作。
本申请还提供了一种存储介质,其上存储有计算机程序,所述计算机程序执行时实现上述电机轴控制方法执行的步骤。
本申请还提供了一种机器人,包括存储器和处理器,所述存储器中存储有计算机程序,所述处理器调用所述存储器中的计算机程序时实现上述电机轴控制方法执行的步骤。
本申请提供了一种电机轴控制方法,包括若接收到复位指令,则利用伺服驱动器采集轴位置数据;将接收到所述复位指令后所述伺服驱动器首次采集的轴位置数据作为电机轴的当前位置数据;利用所述插补器根据所述电机轴的当前位置数据执行插补操作得到插补数据,并控制所述电机轴执行所述插补数据对应的操作。
本申请在接收到复位指令之后,根据伺服驱动器采集的轴位置数据确定电机轴的当前位置数据。受伺服驱动器的调节参数影响,伺服驱动器每次采集的轴位置数据可能不相同,本申请仅将接收到复位指令之后伺服驱动器首次采集的轴位置数据作为电机轴的当前位置数据,插补器只响应第一次的复位动作,避免了由于电机轴的当前位置数据的反复变化导致的电机轴的抖动现象。可见,本申请能够避免电机轴在复位操作过程中产生的抖动和异响。本申请同时还提供了一种电机轴控制***、一种机器人和一种存储介质,具有上述有益效果,在此不再赘述。
附图说明
为了更清楚地说明本申请实施例,下面将对实施例中所需要使用的附图做简单的介绍,显而易见地,下面描述中的附图仅仅是本申请的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为本申请实施例所提供的一种电机轴控制方法的流程图;
图2为相关技术中调用resetprogram函数实现复位的原理示意图;
图3为本申请实施例所提供的调用resetprogram函数实现复位的原理示意图;
图4为本申请实施例所提供的复位过程中插补数据生成方法的原理示意图;
图5为本申请实施例所提供的一种电机轴控制***的结构示意图。
具体实施方式
为使本申请实施例的目的、技术方案和优点更加清楚,下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本申请一部分实施例,而不是全部的实施例。基于本申请中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本申请保护的范围。
下面请参见图1,图1为本申请实施例所提供的一种电机轴控制方法的流程图。
具体步骤可以包括:
S101:若接收到复位指令,则利用伺服驱动器采集轴位置数据;
其中,本实施例可以应用于机器人,机器人通过伺服驱动器控制电机轴按照预设轨迹运动实现各种动作。具体的,机器人***在实现控制功能的过程如下:插补器线程在控制***启动后一直循环执行,每个插补周期都会对控制程序(控制程序为控制***软件提供的供用户使用的程序,用于控制机器人运动以及执行逻辑和IO操作)中的运动指令转换生成的轨迹进行插补,然后将插补数据存入指令位置缓存(buffer)中,当通讯卡(通讯卡为用于连接控制***软件和伺服驱动以及外部IO设备)每个周期发出触发信号时候,控制***软件将插补数据通过通讯卡下发到伺服驱动器中,以便伺服驱动器控制电机轴转动到指定的位置,从而控制机器人本体运动。
在本步骤之前还可以存在接收复位指令的操作,复位指令可以为用户下发的指令,也可以为机器人在运行过程中见检测到特定触发条件(如急停操作后预设时间内未检测到继续执行操作的指令)后由处理器下发的指令。在控制程序中的运动指令已经插补下发完成后,若控制***检查到指令位置数据没有发生变化,则不再将新的插补数据下发给伺服驱动。当接收到复位指令时,插补器不会再发当时插补点的位置数据(即插补数据),可以直接返回;在执行复位程序的时候,插补器可以从伺服驱动中重新获取当时轴的位置,并更新电机轴的当前位置数据,以便在执行复位操作时不会因为上一次插补的最终位置和复位时候的位置不一致而导致电机轴位置跳动。本实施例在接收到复位指令之后,先获取伺服驱动器采集的轴位置数据。
S102:将接收到所述复位指令后所述伺服驱动器首次采集的轴位置数据作为电机轴的当前位置数据;
其中,伺服驱动器可以实时采集电机轴的轴位置数据,插补器可以从伺服驱动器的通信卡中将反馈的轴位置数据读取出来,更新到当前轴位置数据中。若伺服驱动器的参数调节不是最优的,那么伺服驱动器每次读取到的位置数据可能存在变化,这样每次的一点偏差就会由插补器进行插补并通过通信卡下发到伺服驱动中,这样反复执行复位操作的时候,会出现电机轴抖动或者发出异响。为了解决该问题,本实施例提出在执行复位操作的时候,如果存在多次频繁操作复位,那么只响应第一次的复位动作,之后的复位操作仍然执行,但是对于插补器中的复位动作不再执行,这样就能保证其他程序解析器等的复位操作仍然正常执行。
本申请可以记录接收到复位指令的时刻,将伺服驱动器反馈的轴位置数据中采集时刻在复位指令接收时刻之后且距离复位指令接收时刻最近的轴位置数据作为电机轴的当前位置数据。上述过程中插补器不会多次获取伺服轴中反馈的轴位置数据,可以避免出现上面所述的因为驱动参数问题,而导致的位置数据不稳定引起的电机轴抖动或者发出异响。
S103:利用所述插补器根据所述电机轴的当前位置数据执行插补操作得到插补数据,并控制所述电机轴执行所述插补数据对应的操作。
其中,本实施例在确定电机轴的当前位置数据之后,利用插补器基于电机轴的当前位置数据执行插补操作得到插补数据。在接收到复位指令之前,插补器中存有电机轴的位置数据,为了避免复位过程中电机轴的位置跳动,本实施例在接收到复位指令之后,更新电机轴的位置数据(即,电机轴的当前位置数据)。具体的,根据当前位置数据执行插补操作得到插补数据的过程可以为:根据所述当前位置数据和复位目标位置数据生成复位运动轨迹数据;利用所述插补器对所述复位运动轨迹数据执行插补操作得到所述插补数据。复位目标位置为电机轴执行复位操作后最终停留的位置,根据当前位置数据和复位目标位置数据生成复位运动轨迹数据,通过对复位运动轨迹数据进行插补得到用于控制电机轴运动的插补数据。
本实施例在接收到复位指令之后,根据伺服驱动器采集的轴位置数据确定电机轴的当前位置数据。受伺服驱动器的调节参数影响,伺服驱动器每次采集的轴位置数据可能不相同,本实施例仅将接收到复位指令之后伺服驱动器首次采集的轴位置数据作为电机轴的当前位置数据,插补器只响应第一次的复位动作,避免了由于电机轴的当前位置数据的反复变化导致的电机轴的抖动现象。可见,本实施例能够避免电机轴在复位操作过程中产生的抖动和异响。在本实施例中若检测到多次频繁操作复位,可以只响应第一次的复位动作,之后的复位操作只是执行复位程序解析器等的相关动作,对于插补器中的复位动作不再执行。在本实施例中插补器可以仅在第一次复位的时候,插补器会去获取伺服轴中反馈的位置数据,并将其更新到当前轴位置,之后的频繁复位就不再去执行该操作,这样就不会出现因为驱动参数调节不合适,而导致不停调用复位函数resetprogram()的时候,伺服电机轴的位置数据不稳定,进而引起电机轴抖动或者发出异响。
作为对于图1对应实施例的进一步补充,S103中控制所述电机轴执行所述插补数据对应的操作,包括:将所述插补数据存储至指令位置缓存中;当接收到通讯卡发送的触发信号时,从所述指令位置缓存中将所述插补数据通过通讯卡下发至所述伺服驱动器,以便所述伺服驱动器控制所述电机轴执行所述插补数据对应的操作。
具体的,将所述插补数据存储至指令位置缓存中的过程可以为:将所述插补数据转化为对应的脉冲数据,并将所述脉冲数据存储至所述指令位置缓存中。相应的,还可以从所述指令位置缓存中将所述插补数据对应的脉冲数据通过所述通讯卡下发至所述伺服驱动器。
请参见图2、图3和图4,图2为相关技术中调用resetprogram函数实现复位的原理示意图,图3为本申请实施例所提供的调用resetprogram函数实现复位的原理示意图,图4为本申请实施例所提供的复位过程中插补数据生成方法的原理示意图。复位操作可以通过RCS(Robot Control Software)提供的接口函数resetprogram()来实现的,无论是通过示教器的显示界面操作复位图标,或是通过外部控制IO来实现复位。该函数中除了要复位插补器,还要对程序解析器做一些复位操作。本实施例在每次操作该函数的时候,添加一个复位调用标志reset_label默认true,如果调用到该函数则将该标志设置成false,然后程序开始的时候,在将该标志设置成true,这样就能保证每次程序开始后,用户在调用复位的时候,插补器的复位操作,一定会被执行一次,然后在频繁多次复位的时候,由于标志已经变成false,那么也就不再响应复位插补的动作。本实施例提出在主动执行复位程序的时候,如果多次频繁操作复位,那么只响应第一次的复位动作,之后的复位操作只是执行复位程序解析器等的相关动作,对于插补器中的复位动作不再执行,这样只有第一次复位的时候,插补器会去获取伺服轴中反馈的位置数据,并将其更新到当前轴位置,之后的频繁复位就不再去执行该操作,这样就不会出现因为驱动参数调节不合适,而导致不停调用复位函数resetprogram()的时候,伺服电机轴的位置数据不稳定,进而引起电机轴抖动或者发出异响。
具体的,在利用所述插补器根据所述电机轴的当前位置数据执行插补操作得到插补数据之前,将所述插补器的复位调用标志位由第一预设值(如:ture)修改为第二预设值(如:false);其中,当所述复位调用标志位为第二预设值时,所述插补器执行根据所述电机轴的当前位置数据生成所述插补数据的操作,当所述复位调用标志位为第一预设值时,所述插补器忽略所述伺服驱动器采集的轴位置数据(即插补器不执行伺服驱动器采集的轴位置数据对应的操作)。在控制所述电机轴执行所述插补数据对应的操作之后,还可以将所述将插补器的复位调用标志位由所述第二预设值恢复为所述第一预设值。上述实施方式提出机器人控制***在多次频繁执行复位程序的时候,通过添加复位调用标志位,从而实现不会每次都执行插补复位操作(就是从伺服驱动中读取当时的轴位置数据,然后更新到当前轴位置数据中),而只是在第一次复位程序的时候仅执行一次该操作,可以避免多次执行复位时候,由于驱动参数调节不合适而导致轴位置出现偏差,然后又将该偏差重新通过通信卡下发给伺服驱动器,最终导致轴位置在不停的抖动,并发出吱吱的异响。
上述实施例提出在执行复位程序的时候,如果多次频繁操作复位,程序复位流程中的其他复位操作仍然执行,但是对于插补器中则只响应第一次的复位动作,获取伺服轴中反馈的位置数据,并将该数据转换成脉冲数,在通信卡的每个触发信号产生的时候,将该数据下发给伺服和驱动器。这样既保证了出现急停的时候复位程序的需要,也就是经由通信卡从伺服驱动中重新获取当时轴的位置,更新当前轴位置,这样下次重新开始执行运动的时候,不会因为上一次插补的最终位置和紧急停止时候的位置不一致,进而导致下次启动机器人运动时候,机器人本体轴位置跳动。因为正常程序出现错误,紧急停止的时候复位只需要执行一次复位程序就可以了。如果用户要主动不停的复位程序,那么也只响应第一次的复位动作,之后的复位都可以认为是重复且无效的操作,可以不用响应插补中的复位动作,这样也解决了上面提到的不停复位时候,由于驱动器的参数调节的不合适,而导致的轴抖动或异响。
作为对于图1对应实施例的进一步介绍,在控制所述电机轴执行所述插补数据对应的操作的过程中,还可以存在以下操作:若接收到急停指令,则停止所述伺服驱动器对所述电机轴的控制操作并停止所述插补器的插补数据下发操作;利用伺服驱动器采集所述电机轴的急停位置,并根据所述急停位置更新待下发插补数据;若接收到急停恢复指令,则将更新后的待下发插补数据发送至所述伺服驱动器,以便所述伺服驱动器根据更新后的待下发插补数据对所述电机轴执行控制操作。
上述实施例在机器人出现告警紧急停止的时候,插补器不会再发当时插补点的位置数据直接返回,如果不从伺服驱动中重新获取轴位置,下次启动时候,当时轴的位置和紧急停止位置不一致,那么就会出现指令位置和本体轴位置差距较大从而引起位置跳动问题。本实施例通过在执行复位程序时从伺服驱动中重新获取当时轴的位置,以便更新当前轴位置,这样下次重新开始执行运动的时候,不会因为上一次插补的最终位置和紧急停止时候的位置不一致,进而导致下次启动机器人运动时候,机器人电机轴位置跳动。
请参见图5,图5为本申请实施例所提供的一种电机轴控制***的结构示意图;
该***可以包括:
轴位置数据采集模块100,用于若接收到复位指令,则利用伺服驱动器采集轴位置数据;
当前位置数据确定模块200,用于将接收到所述复位指令后所述伺服驱动器首次采集的轴位置数据作为电机轴的当前位置数据;
插补控制模块300,用于利用所述插补器根据所述电机轴的当前位置数据执行插补操作得到插补数据,并控制所述电机轴执行所述插补数据对应的操作。
本实施例在接收到复位指令之后,根据伺服驱动器采集的轴位置数据确定电机轴的当前位置数据。受伺服驱动器的调节参数影响,伺服驱动器每次采集的轴位置数据可能不相同,本实施例仅将接收到复位指令之后伺服驱动器首次采集的轴位置数据作为电机轴的当前位置数据,插补器只响应第一次的复位动作,避免了由于电机轴的当前位置数据的反复变化导致的电机轴的抖动现象。可见,本实施例能够避免电机轴在复位操作过程中产生的抖动和异响。
进一步的,插补控制模块300包括:
缓存单元,用于将所述插补数据存储至指令位置缓存中;
数据下发单元,用于当接收到通讯卡发送的触发信号时,从所述指令位置缓存中将所述插补数据通过通讯卡下发至所述伺服驱动器,以便所述伺服驱动器控制所述电机轴执行所述插补数据对应的操作。
进一步的,缓存单元具体为用于将所述插补数据转化为对应的脉冲数据,并将所述脉冲数据存储至所述指令位置缓存中的单元;
数据下发单元具体为用于从所述指令位置缓存中将所述插补数据对应的脉冲数据通过所述通讯卡下发至所述伺服驱动器的单元。
进一步的,插补控制模块300用于根据所述当前位置数据和复位目标位置数据生成复位运动轨迹数据;还用于利用所述插补器对所述复位运动轨迹数据执行插补操作得到所述插补数据。
进一步的,还包括:
标志位设置模块,用于在利用所述插补器根据所述电机轴的当前位置数据执行插补操作得到插补数据之前,将所述插补器的复位调用标志位由第一预设值修改为第二预设值;其中,当所述复位调用标志位为第二预设值时,所述插补器执行根据所述电机轴的当前位置数据生成所述插补数据的操作,当所述复位调用标志位为第一预设值时,所述插补器忽略所述伺服驱动器采集的轴位置数据;还用于在控制所述电机轴执行所述插补数据对应的操作之后,
将所述将插补器的复位调用标志位由所述第二预设值恢复为所述第一预设值。
进一步的,还包括:
急停控制模块,用于若接收到急停指令,则停止所述伺服驱动器对所述电机轴的控制操作并停止所述插补器的插补数据下发操作;还用于利用伺服驱动器采集所述电机轴的急停位置,并根据所述急停位置更新待下发插补数据;还用于若接收到急停恢复指令,则将更新后的待下发插补数据发送至所述伺服驱动器,以便所述伺服驱动器根据更新后的待下发插补数据对所述电机轴执行控制操作。
由于***部分的实施例与方法部分的实施例相互对应,因此***部分的实施例请参见方法部分的实施例的描述,这里暂不赘述。
本申请还提供了一种存储介质,其上存有计算机程序,该计算机程序被执行时可以实现上述实施例所提供的步骤。该存储介质可以包括:U盘、移动硬盘、只读存储器(Read-Only Memory,ROM)、随机存取存储器(Random Access Memory,RAM)、磁碟或者光盘等各种可以存储程序代码的介质。
本申请还提供了一种机器人,可以包括存储器和处理器,所述存储器中存有计算机程序,所述处理器调用所述存储器中的计算机程序时,可以实现上述实施例所提供的步骤。当然所述机器人还可以包括各种网络接口,电源等组件。
说明书中各个实施例采用递进的方式描述,每个实施例重点说明的都是与其他实施例的不同之处,各个实施例之间相同相似部分互相参见即可。对于实施例公开的***而言,由于其与实施例公开的方法相对应,所以描述的比较简单,相关之处参见方法部分说明即可。应当指出,对于本技术领域的普通技术人员来说,在不脱离本申请原理的前提下,还可以对本申请进行若干改进和修饰,这些改进和修饰也落入本申请权利要求的保护范围内。
还需要说明的是,在本说明书中,诸如第一和第二等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来,而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。而且,术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、物品或者设备不仅包括那些要素,而且还包括没有明确列出的其他要素,或者是还包括为这种过程、方法、物品或者设备所固有的要素。在没有更多限制的状况下,由语句“包括一个……”限定的要素,并不排除在包括所述要素的过程、方法、物品或者设备中还存在另外的相同要素。

Claims (10)

1.一种电机轴控制方法,其特征在于,包括:
若接收到复位指令,则利用伺服驱动器采集轴位置数据;
将接收到所述复位指令后所述伺服驱动器首次采集的轴位置数据作为电机轴的当前位置数据,以使在检测到多次复位操作时插补器只响应第一次的复位动作;
利用所述插补器根据所述电机轴的当前位置数据执行插补操作得到插补数据,并控制所述电机轴执行所述插补数据对应的操作。
2.根据权利要求1所述电机轴控制方法,其特征在于,控制所述电机轴执行所述插补数据对应的操作,包括:
将所述插补数据存储至指令位置缓存中;
当接收到通讯卡发送的触发信号时,从所述指令位置缓存中将所述插补数据通过通讯卡下发至所述伺服驱动器,以便所述伺服驱动器控制所述电机轴执行所述插补数据对应的操作。
3.根据权利要求2所述电机轴控制方法,其特征在于,将所述插补数据存储至指令位置缓存中,包括:
将所述插补数据转化为对应的脉冲数据,并将所述脉冲数据存储至所述指令位置缓存中;
相应的,从所述指令位置缓存中将所述插补数据通过通讯卡下发至伺服驱动器,包括:
从所述指令位置缓存中将所述插补数据对应的脉冲数据通过所述通讯卡下发至所述伺服驱动器。
4.根据权利要求1所述电机轴控制方法,其特征在于,利用所述插补器根据所述电机轴的当前位置数据执行插补操作得到插补数据,包括:
根据所述当前位置数据和复位目标位置数据生成复位运动轨迹数据;
利用所述插补器对所述复位运动轨迹数据执行插补操作得到所述插补数据。
5.根据权利要求1所述电机轴控制方法,其特征在于,在利用所述插补器根据所述电机轴的当前位置数据执行插补操作得到插补数据之前,还包括:
将所述插补器的复位调用标志位由第一预设值修改为第二预设值;其中,当所述复位调用标志位为第二预设值时,所述插补器执行根据所述电机轴的当前位置数据生成所述插补数据的操作,当所述复位调用标志位为第一预设值时,所述插补器忽略所述伺服驱动器采集的轴位置数据。
6.根据权利要求5所述电机轴控制方法,其特征在于,在控制所述电机轴执行所述插补数据对应的操作之后,还包括:
将所述插补器的复位调用标志位由所述第二预设值恢复为所述第一预设值。
7.根据权利要求1至6任一项所述电机轴控制方法,其特征在于,还包括:
若接收到急停指令,则停止所述伺服驱动器对所述电机轴的控制操作并停止所述插补器的插补数据下发操作;
利用伺服驱动器采集所述电机轴的急停位置,并根据所述急停位置更新待下发插补数据;
若接收到急停恢复指令,则将更新后的待下发插补数据发送至所述伺服驱动器,以便所述伺服驱动器根据更新后的待下发插补数据对所述电机轴执行控制操作。
8.一种电机轴控制***,其特征在于,包括:
轴位置数据采集模块,用于若接收到复位指令,则利用伺服驱动器采集轴位置数据;
当前位置数据确定模块,用于将接收到所述复位指令后所述伺服驱动器首次采集的轴位置数据作为电机轴的当前位置数据,以使在检测到多次复位操作时插补器只响应第一次的复位动作;
插补控制模块,用于利用所述插补器根据所述电机轴的当前位置数据执行插补操作得到插补数据,并控制所述电机轴执行所述插补数据对应的操作。
9.一种机器人,其特征在于,包括存储器和处理器,所述存储器中存储有计算机程序,所述处理器调用所述存储器中的计算机程序时实现如权利要求1至7任一项所述电机轴控制方法的步骤。
10.一种存储介质,其特征在于,所述存储介质中存储有计算机可执行指令,所述计算机可执行指令被处理器加载并执行时,实现如上权利要求1至7任一项所述电机轴控制方法的步骤。
CN202010656899.8A 2020-07-09 2020-07-09 一种电机轴控制方法、***、机器人及存储介质 Active CN113910216B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010656899.8A CN113910216B (zh) 2020-07-09 2020-07-09 一种电机轴控制方法、***、机器人及存储介质

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010656899.8A CN113910216B (zh) 2020-07-09 2020-07-09 一种电机轴控制方法、***、机器人及存储介质

Publications (2)

Publication Number Publication Date
CN113910216A CN113910216A (zh) 2022-01-11
CN113910216B true CN113910216B (zh) 2023-01-24

Family

ID=79231953

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010656899.8A Active CN113910216B (zh) 2020-07-09 2020-07-09 一种电机轴控制方法、***、机器人及存储介质

Country Status (1)

Country Link
CN (1) CN113910216B (zh)

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5858609A (ja) * 1981-10-05 1983-04-07 Hitachi Ltd 産業用ロボツト軌跡補間方法
JP2006059037A (ja) * 2004-08-18 2006-03-02 Daihen Corp 溶接ロボット制御装置
CN103941649A (zh) * 2014-03-07 2014-07-23 东莞市升力智能科技有限公司 多轴运动卡控制***的控制方法
CN107908191A (zh) * 2017-12-20 2018-04-13 芜湖哈特机器人产业技术研究院有限公司 一种串并联机器人的运动控制***和方法

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5858609A (ja) * 1981-10-05 1983-04-07 Hitachi Ltd 産業用ロボツト軌跡補間方法
JP2006059037A (ja) * 2004-08-18 2006-03-02 Daihen Corp 溶接ロボット制御装置
CN103941649A (zh) * 2014-03-07 2014-07-23 东莞市升力智能科技有限公司 多轴运动卡控制***的控制方法
CN107908191A (zh) * 2017-12-20 2018-04-13 芜湖哈特机器人产业技术研究院有限公司 一种串并联机器人的运动控制***和方法

Also Published As

Publication number Publication date
CN113910216A (zh) 2022-01-11

Similar Documents

Publication Publication Date Title
JP3504222B2 (ja) ロボット制御装置
US8803667B2 (en) Systems and methods for notifying multiple hosts from an industrial controller
US6330493B1 (en) Control system for synchronously cooperative operation of plurality of robots
CN109807903B (zh) 一种机器人控制方法、装置、设备和介质
JP4271159B2 (ja) 対話形数値制御装置
US9122269B2 (en) Method and system for operating a machine from the field of automation engineering
US20080103625A1 (en) Numerical controller with machining resume function
JP2018153883A (ja) コントロールシステム、コントローラ及び制御方法
CN113910216B (zh) 一种电机轴控制方法、***、机器人及存储介质
JP2001150372A (ja) 複数ロボットの同期又は協調動作制御装置
JP3369470B2 (ja) サーボシステムコントローラ
EP3831544A1 (en) Method, device and system for correcting offline programming program, medium, and terminal
JPH09128255A (ja) プログラマブル論理制御器
JP3937244B2 (ja) サーボシステムコントローラ
WO2009141006A1 (en) A method and a system for controlling an industrial robot in accordance with a set of motion control parameters
US20220397880A1 (en) Control device
CN112936294A (zh) 一种机器人轨迹插补方法、装置及相关组件
JP3423536B2 (ja) 系統間軸交換制御機能を有する多系統数値制御装置
JP3719044B2 (ja) 位置決め制御装置
CN106965181B (zh) 基于ros和orocos的机器人控制方法和***
JP3875140B2 (ja) 数値制御装置
WO2022168336A1 (ja) 制御装置、制御方法および制御プログラム
CN117434907B (zh) 基于CoDeSys控制器的伺服驱动器数量控制方法及设备
JPH08106320A (ja) 自動機械及び自動機械の制御方法
JP3460747B2 (ja) 数値制御装置

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