CN104440910B - 一种实现机器人双手臂同步控制的方法及*** - Google Patents
一种实现机器人双手臂同步控制的方法及*** Download PDFInfo
- Publication number
- CN104440910B CN104440910B CN201410624774.1A CN201410624774A CN104440910B CN 104440910 B CN104440910 B CN 104440910B CN 201410624774 A CN201410624774 A CN 201410624774A CN 104440910 B CN104440910 B CN 104440910B
- Authority
- CN
- China
- Prior art keywords
- speed
- drive motors
- value
- difference
- absolute
- 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
Landscapes
- Control Of Multiple Motors (AREA)
Abstract
本发明公开了一种实现机器人双手臂同步控制的方法及***,该方法包括,电控***中央处理单元接收速度采集器反馈的速度响应值,分别计算第一速度响应值、第二速度响应值与给定速度值的差值绝对值,对应得到第一差值绝对值和第二差值绝对值,当第一差值绝对值与第二差值绝对值均在第一误差范围内时,计算第一速度响应值与第二速度响应值之间的差值绝对值,得到相对差值绝对值,当相对差绝对值在第二误差范围内时,控制左手驱动电机和右手驱动电机运转。与现有技术相比,本发明有效地解决了机器人双手臂难以协调,同步率低的问题,提高了机器人双手臂的同步控制性能。
Description
技术领域
本发明涉及多电机同步控制领域,特别是涉及一种实现机器人双手臂同步控制的方法及***。
背景技术
多电机同步***是现代工业生产中应用比较广泛的电控***,它广泛应用于数控机床、工业缝纫机、机器人以及火控等领域。随着工业生产线自动化程度和控制精度要求的提高,对伺服控制***的实时性、协作性和精准性也提出了更高的要求,因此越来越多地场合需要两台或者多台电机同时工作来达到保证精度、提高性能的目的。这其中,多电机同步***最典型的应用就是工业机器人。
传统机器人同步控制中经常会出现机器人手臂难以协调、同步率低等问题。为此,现有技术对机器人的同步控制方法做了一些改进,现有机器人双手臂同步控制过程主要是:当多台电机需要做同步运动时,首先将信号给定于其中的某一台电机,且各电机采用串联运行方式,即前一台电机的输出速度作为下一台电机的速度给定。这种控制方法虽然简单易行,但在阶跃输入启动过程的升速阶段,后一台电机的转速要比前一台电机的转速稍有滞后,启动过程跟随性能不是很理想,抗干扰能力低,且当一台电机发生故障时,势必会影响其后的所有电机运行。可见,现有技术中的机器人的双手臂控制方法上存在的一些不足使得其双手臂仍然存在难以协调,同步率低的问题,同步控制性能不高。
因此,如何有效提高机器人双手臂的同步控制性能是本领域技术人员目前需要解决的技术问题。
发明内容
本发明的目的是提供一种实现机器人双手臂同步控制的方法,有效地解决了机器人双手臂难以协调,同步率低的问题,提高了机器人双手臂的同步控制性能;本发明的另一目的是提供一种实现机器人双手臂同步控制的***。
为解决上述技术问题,本发明提供了一种实现机器人双手臂同步控制的方法,该方法包括以下步骤:
步骤A:电控***中央处理单元接收上位机发送的给定速度值,向PLC发送控制左手驱动电机和右手驱动电机按照所述给定速度值进行运转的速度指令;
步骤B:所述PLC接收所述电控***中央处理单元发出的速度指令,控制所述左手驱动电机和所述右手驱动电机依据所述给定速度值进行运转;
步骤C:速度采集器采集所述左手驱动电机的第一速度响应值和所述右手驱动电机的第二速度响应值,并将所述速度响应值反馈给所述电控***中央处理单元;
步骤D:所述电控***中央处理单元分别计算所述第一速度响应值、所述第二速度响应值与所述给定速度值的差值绝对值,对应得到第一差值绝对值和第二差值绝对值;
步骤E:当所述第一差值绝对值和所述第二差值绝对值均在第一误差范围内时,计算所述第一速度响应值和所述第二速度响应值之间的差值绝对值,得到相对差值绝对值;
步骤F:当所述相对差值绝对值在第二误差范围内时,控制所述左手驱动电机和所述右手驱动电机运转。
优选的,还包括:
当所述第一差值绝对值和/或所述第二差值绝对值不在所述第一误差范围内,调整其差值绝对值不在所述第一误差范围内的驱动电机的运转速度,直到所述速度采集器采集到的所述驱动电机的速度响应值与所述给定速度值的差值绝对值在所述第一误差范围内,进入步骤E。
优选的,还包括:
当所述相对差值绝对值不在所述第二误差范围内,则调整所述左手驱动电机和/或所述右手驱动电机的运转速度,直到所述相对差值绝对值在所述第二误差范围内。
优选的,所述调整其差值绝对值不在所述第一误差范围内的驱动电机的运转速度的过程包括:
利用控制算法对差值绝对值不在所述第一误差范围内的驱动电机的速度调节参数进行整定,并用调整后的所述速度调节参数调节所述驱动电机的速度。
优选的,所述控制算法为基于BP神经网络的PID控制算法。
为解决上述技术问题,本发明还提供了一种实现机器人双手臂同步控制的***,该***包括上位机、左手驱动电机和右手驱动电机,该***还包括:电控***中央处理单元、可编程逻辑控制器PLC和速度采集器组,其中:
所述电控***中央处理单元的输入端与所述上位机相连,输出端与所述PLC相连,用于接收所述上位机发送的给定速度值,向PLC发送控制所述左手驱动电机和所述右手驱动电机按照所述给定速度值进行运转的速度指令;
所述PLC接收所述电控***中央处理单元发出的速度指令,控制所述左手驱动电机和所述右手驱动电机依据所述给定速度进行运转;
所述速度采集器组包含两个速度采集器,所述两个速度采集器分别采集所述左手驱动电机的第一速度响应值和所述右手驱动电机的第二速度响应值,并将所述速度响应值反馈给所述电控***中央处理单元;
所述电控***中央处理单元接收所述速度采集器组反馈的速度响应值,分别计算所述左手驱动电机、所述右手驱动电机的速度响应值与所述给定速度值的差值绝对值,对应得到第一差值绝对值和第二差值绝对值,当所述第一差值绝对值与所述第二差值绝对值均在第一误差范围内时,计算所述第一速度响应值与所述第二速度响应值之间的差值绝对值,得到相对差值绝对值,当所述相对差绝对值在第二误差范围内时,控制所述左手驱动电机和所述右手驱动电机运转。
优选的,所述电控***中央处理单元还用于,当所述第一差值绝对值和/或所述第二差值绝对值不在所述第一误差范围内,调整其差值绝对值不在所述第一误差范围内的驱动电机的运转速度,直到所述速度采集器采集到的所述驱动电机的速度响应值与所述给定速度值的差值绝对值在所述第一误差范围内,当所述相对差值绝对值不在所述第二误差范围内,则调整所述左手驱动电机和/或所述右手驱动电机的运转速度,直到所述相对差值绝对值在所述第二误差范围内。
优选的,所述速度采集器为光电编码器。
优选的,所述电控***中央处理单元的输出端与PWM门级驱动电路相连,所述PWM门级驱动电路通过第一智能功率模块IPM和第二智能功率模块IPM与所述PLC相连。
从上述技术方案可以看出,本发明提供了一种实现机器人双手臂同步控制的方法和***。在调节过程中,电控***中央处理单元分别计算左手驱动电机、右手驱动电机的速度响应值与给定速度值的差值绝对值,对应得到第一差值绝对值和第二差值绝对值;当第一差值绝对值和第二差值绝对值均在第一误差范围内时,计算左手驱动电机与右手驱动电机的速度值之间的差值绝对值,得到相对差值绝对值;当相对差值绝对值在第二误差范围内时,控制左手驱动电机和右手驱动电机运转。与现有技术相比,本发明不仅将速度采集器反馈的左手驱动电机、右手驱动电机的响应速度值与事先给定速度值作差值比较,还将左手驱动电机、右手驱动电机两者的响应速度值的差值作比较,若差值均在合理误差范围内,则控制左手驱动电机和右手驱动电机正常运转,有效地解决了机器人双手臂难以协调,同步率低的问题,提高了机器人双手臂的同步控制性能。
附图说明
为了更清楚地说明本发明实施例中的技术方案,下面将对现有技术和实施例中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为本发明实施例公开的实现机器人双手臂同步控制的方法的流程图;
图2为本发明实施例公开的又一实现机器人双手臂同步控制的方法的流程图;
图3为本发明实施例公开的调整其差值绝对值不在第一误差范围内的驱动电机的运转速度的过程的流程图;
图4为本发明实施例公开的调整相对差值绝对值不在第二误差范围内时驱动电机的运转速度的过程的流程图;
图5为本发明实施例公开的从左手驱动电机和右手驱动电机中选择一个作为基准电机的过程的流程图;
图6为本发明实施例公开的实现机器人双手臂同步控制的***的结构示意图;
图7为本发明实施例公开的电控***中央处理单元的结构示意图。
具体实施方式
本发明的核心是提供一种实现机器人双手臂同步控制的方法,有效地解决了机器人双手臂难以协调,同步率低的问题,提高了机器人双手臂的同步控制性能;本发明的另一核心是提供一种实现机器人双手臂同步控制的***。
为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
实施例一
请参照图1,图1为本发明实施例1公开的实现机器人双手臂同步控制的方法流程图,该方法包括:
步骤s101:电控***中央处理单元接收上位机发送的给定速度值,向PLC发送控制左手驱动电机和右手驱动电机按照给定速度值进行运转的速度指令;
可以理解的是,上位机首先设置机器人的左手驱动电机和右手驱动电机的控制模式为速度控制模式,然后通过总线将给定值速度值传送至电控***中央处理单元。电控***中央处理单元在接收到上位机传送的电机控制模式后,立即向PLC(ProgrammableLogicController,即可编程逻辑控制器)发出控制左手驱动电机和右手驱动电机按照给定速度值进行运转的速度指令。
步骤s102:PLC接收电控***中央处理单元发出的速度指令,控制左手驱动电机和右手驱动电机依据给定速度值进行运转;
可以理解的是,PLC在接收到电控***中央处理单元发送的速度指令后,将速度指令翻译成脉冲指令信号,然后再将脉冲指令信号分别发送至左手驱动电机和右手驱动电机,进而控制左手驱动电机和右手驱动电机开始运转。
步骤s103:速度采集器采集左手驱动电机的第一速度响应值和右手驱动电机的第二速度响应值,并将速度响应值反馈给电控***中央处理单元;
左手驱动电机和右手驱动电机开始运转后,与两个驱动电机对应的速度采集器分别采集左手驱动电机和右手驱动电机的速度响应值,并将速度响应值反馈给电控***中央处理单元。
值得注意的是,这里的速度采集器可以为光电编码器,那么速度响应值就是脉冲个数,将脉冲个数反馈给电控***中央处理单元。当然,这里并不仅限于光电编码器,还可以选用其他速度采集器来测量电机的速度,在此不做特别的限定,能实现此技术效果的不同类型的速度采集器均在本发明的保护范围之内。
步骤s104:电控***中央处理单元分别计算第一速度响应值、第二速度响应值与给定速度值的差值绝对值,对应得到第一差值绝对值和第二差值绝对值;
步骤s105:当第一差值绝对值和第二差值绝对值均在第一误差范围内时,计算第一速度响应值和第二速度响应值之间的差值绝对值,得到相对差值绝对值;
可以理解的是,当电控***中央处理单元判断得到第一差值绝对值和第二差值绝对值均在第一误差范围内时,再计算第一速度响应值和第二速度响应值之间的差值绝对值,得到相对差值绝对值。
值得注意的是,这里的第一差值绝对值和第二差值绝对值均在第一误差范围内是指第一差值绝对值和第二差值绝对值均小于等于一个非负常数,非负常数数值的大小是根据实际情况和具体精度要求来决定的,在此不做特别的限定,能实现此技术效果的不同数值的非负常数均在本发明的保护范围之内。
步骤s106:当相对差值绝对值在第二误差范围内时,控制左手驱动电机和右手驱动电机运转。
可以理解的是,当电控***中央处理单元判断得到相对差值绝对值在第二误差范围内时,电控***中央处理单元控制PLC发送脉冲指令信号给驱动电机,控制左手驱动电机和右手驱动电机正常运转。
值得注意的是,这里的相对差值绝对值在第二误差范围内是指相对差值绝对值小于等于一个非负常数,非负常数数值的大小是根据实际情况和具体精度要求来决定的,在此不做特别的限定,能实现此技术效果的不同数值的非负常数均在本发明的保护范围之内。
本发明实施例1提供了一种实现机器人双手臂同步控制的方法。在调节过程中,电控***中央处理单元接收速度采集器反馈的速度响应值,分别计算左手驱动电机、右手驱动电机的速度响应值与给定速度值的差值绝对值,对应得到第一差值绝对值和第二差值绝对值,当第一差值绝对值与第二差值绝对值均在第一误差范围内时,计算第一速度响应值与第二速度响应值之间的差值绝对值,得到相对差值绝对值,当相对差绝对值在第二误差范围内时,控制左手驱动电机和右手驱动电机运转。与现有技术相比,本发明不仅将速度采集器反馈的左手驱动电机、右手驱动电机的响应速度值与事先给定速度值作差值比较,还将左手驱动电机、右手驱动电机两者的响应速度值的差值作比较,若差值均在合理误差范围内,则控制左手驱动电机和右手驱动电机正常运转,有效地解决了机器人双手臂难以协调,同步率低的问题,提高了机器人双手臂的同步控制性能。
实施例二
请参照图2,图2为本发明实施例2公开的又一实现机器人双手臂同步控制的方法流程图,该方法包括:
步骤s201:电控***中央处理单元接收上位机发送的给定速度值,向PLC发送控制左手驱动电机和右手驱动电机按照给定速度值进行运转的速度指令;
步骤s202:PLC接收电控***中央处理单元发出的速度指令,控制左手驱动电机和右手驱动电机依据给定速度值进行运转;
步骤s203:速度采集器采集左手驱动电机的第一速度响应值和右手驱动电机的第二速度响应值,并将速度响应值反馈给电控***中央处理单元;
步骤s204:电控***中央处理单元分别计算第一速度响应值、第二速度响应值与给定速度值的差值绝对值,对应得到第一差值绝对值和第二差值绝对值;
步骤s205:判断第一差值绝对值和第二差值绝对值是否均在第一误差范围内,若否,则执行步骤s206,若是,则执行步骤s207;
步骤s206:调整其差值绝对值不在第一误差范围内的驱动电机的运转速度,返回执行步骤s205;
可以理解的是,当电控***中央处理单元判断得到第一差值绝对值和/或第二差值绝对值不在第一误差范围内时,需要对其差值绝对值不在第一误差范围内的驱动电机的运转速度进行调整,直到速度采集器采集到的驱动电机的运转速度与给定速度值的差值绝对值在第一误差范围内,重新进入步骤s205。
步骤s207:计算第一速度响应值和第二速度响应值之间的差值绝对值,得到相对差值绝对值;
可以理解的是,当电控***中央处理单元判断得到第一差值绝对值和第二差值绝对值均在第一误差范围内时,再计算第一速度响应值和第二速度响应值之间的差值绝对值,得到相对差值绝对值。
步骤s208:判断相对差值绝对值是否在第二误差范围内,若否,则执行步骤s209,若是,则执行步骤s210;
步骤s209:调整左手驱动电机和/或右手驱动电机的运转速度,返回执行步骤S208;
可以理解的是,当电控***中央处理单元判断得到相对差值绝对值不在第二误差范围内时,则需要先对左手驱动电机或右手驱动电机的运转速度进行调整,直到左手驱动电机和右手驱动电机的相对差值绝对值在第二误差范围内,重新进入步骤s208。
步骤s210:控制左手驱动电机和右手驱动电机运转。
可以理解的是,当电控***中央处理单元判断得到相对差值绝对值在第二误差范围内时,电控***中央处理单元控制PLC发送脉冲指令信号给驱动电机,控制左手驱动电机和右手驱动电机正常运转。
下面结合附图3对本实施例中,“调整其差值绝对值不在所述第一误差范围内的驱动电机的运转速度”这一步骤的一种可行方式进行说明。
请参照图3,调整过程如下:
步骤s301:利用控制算法对差值绝对值不在第一误差范围内的驱动电机的速度调节参数进行整定;
可以理解的是,此处的控制算法可以为基于BP神经网络的PID控制算法,当然这里也并不仅限于基于BP神经网络的PID控制算法,在此不做特别的限定,能实现此技术效果的不同类型的控制算法均在本发明的保护范围之内。
另外,这里的速度调节参数可以为比例调节参数、积分调节参数和微分调节参数,具体调整哪个参数或哪几种参数的组合由实际情况来决定,在此不做特别的限定,能实现此技术效果的不同组合的速度调节参数均在本发明的保护范围之内。
步骤s302:用调整后的速度调节参数调节驱动电机的速度。
可以理解的是,电控***中央处理单元在对速度调节参数进行调整后,控制PLC发送脉冲指令信号给驱动电机,控制左手驱动电机和右手驱动电机进行速度调整,实现对驱动电机的速度整定。
下面结合附图4对本实施例中步骤s209的一种可行方式进行说明。
请参照图4,调整过程如下:
步骤s401:从左手驱动电机和右手驱动电机选择一个作为基准电机;
可以理解的是,这里是将左手驱动电机和右手驱动电机中的速度选一个作为基准速度,另外一个驱动电机就将按照此基准速度来调整自己的速度。
步骤s402:调整另一驱动电机的运转速度,使得调整后的运转速度与基准电机的运转速度的相对差值绝对值在第二误差范围内。
可以理解的是,运用控制算法对要调整的驱动电机的速度进行调整,使得调整后的运转速度与基准电机的基准速度的相对差值绝对值在第二误差范围内。另外,本步骤中对左手驱动电机和/或右手驱动电机的速度的调整过程与附图3内描述的调整过程类似,在此不再赘述。
下面结合附图5对步骤s401的一种可行方式进行说明,其中图5为选取基准电机的过程流程图。
请参照图5,选取基准电机的过程如下:
步骤s501:比较第一差值绝对值和第二差值绝对值的大小;
步骤s502:确定两者中较小的一个对应的驱动电机作为基准电机。
值得注意的是,当电控***中央处理单元判断得到相对差值绝对值不在第二误差范围内时,还可以同时对左手驱动电机和右手驱动电机进行调整。例如,可以调整两驱动电机的运转速度到给定速度值合理误差范围内的某一固定值,这样可以使得左手驱动电机和右手驱动电机的相对差值绝对值为0,一定满足在第二误差范围内这一条件。
本发明实施例2提供了一种实现机器人双手臂同步控制的方法。在调节过程中,电控***中央处理单元分别计算左手驱动电机、右手驱动电机的速度响应值与给定速度值的差值绝对值,对应得到第一差值绝对值和第二差值绝对值;当第一差值绝对值和第二差值绝对值有至少一个不在第一误差范围内时,调整其差值绝对值不在第一误差范围内的驱动电机的运转速度,直到速度采集器采集到的所述驱动电机的运转速度与给定速度值的差值绝对值在第一误差范围内;当相对差值绝对值不在第二误差范围内时,将左手驱动电机和右手驱动电机中的速度选一个作为基准速度,另外一个驱动电机就将按照此基准速度来调整自己的速度,直到调整后的运转速度与基准电机的运转速度的相对差值绝对值在第二误差范围内。另外,当相对差值绝对值不在第二误差范围内时,还可以调整两驱动电机的运转速度到给定速度值合理误差范围内的某一固定值,这样可以使得左手驱动电机和右手驱动电机的相对差值绝对值为0,一定满足在第二误差范围内这一条件。本发明实施例2在实施例1的基础上,实现了当差值绝对值不在误差范围内时对差值绝对值不在误差范围内的驱动电机进行速度调整,直到差值绝对值在误差范围内,有效地解决了机器人双手臂难以协调,同步率低的问题,提高了机器人双手臂的同步控制性能。
与上述实施例相对应,本发明实施例还提供了一种实现机器人双手臂同步控制的***,机器人双手臂同步控制***的结构示意图,请参照图6,该***包括上位机100、左手驱动电机201和右手驱动电机202,该***还包括电控***中央处理单元300、可编程逻辑控制器PLC400和速度采集器组500,其中,
电控***中央处理单元300,电控***中央处理单元300的输入端与上位机100相连,输出端与PLC400相连,用于接收上位机100发送的给定速度值,向PLC400发送控制左手驱动电机201和右手驱动电机202按照给定速度值进行运转的速度指令;
电控***中央处理单元300,还用于接收速度采集器组500反馈的速度响应值,分别计算左手驱动电机201、右手驱动电机202的速度响应值与给定速度值的差值绝对值,对应得到第一差值绝对值和第二差值绝对值,当第一差值绝对值与第二差值绝对值均在第一误差范围内时,计算第一速度响应值与第二速度响应值之间的差值绝对值,得到相对差值绝对值,当相对差绝对值在第二误差范围内时,控制左手驱动电机201和右手驱动电机202运转。
可编程逻辑控制器PLC400,PLC400用于接收电控***中央处理单元300发出的速度指令,控制左手驱动电机201和右手驱动电机202依据给定速度进行运转;
速度采集器组500,速度采集器组500包含两个速度采集器501、502,两个速度采集器501、502分别用于采集左手驱动电机201的第一速度响应值和右手驱动电机202的第二速度响应值,并将速度响应值反馈给电控***中央处理单元300。
可以理解的是,这里的速度采集器可以为光电编码器,当然,并不仅限于光电编码器,还可以选用其他速度采集器来测量电机的速度,在此不做特别的限定,能实现此技术效果的不同类型的速度采集器均在本发明的保护范围之内。
进一步的,电控***中央处理单元300,还用于当第一差值绝对值和/或第二差值绝对值不在第一误差范围内,调整其差值绝对值不在第一误差范围内的驱动电机的运转速度,直到速度采集器组500采集到的驱动电机的速度响应值与给定速度值的差值绝对值在第一误差范围内,当相对差值绝对值不在第二误差范围内,则调整左手驱动电机201和/或右手驱动电机202的运转速度,直到相对差值绝对值在第二误差范围内。
此外,电控***中央处理单元300还可以采用如图7所示的结构示意图,可以包括:
差值第一计算模块310、差值第一判断模块320、速度第一处理模块330、差值第二计算模块340、差值第二判断模块350、速度第二处理模块360以及控制运行模块370;其中,速度第一处理模块330包括参数第一调整模块331和参数第一执行模块332,速度第二处理模块360包括基准电机模块361、参数第二调整模块362和参数第二执行模块363,其中,基准电机模块361包括差值绝对值比较模块3611和基准电机确定模块3612,其中:
差值第一计算模块310,用于分别计算第一速度响应值、第二速度响应值与给定速度值的差值绝对值,对应得到第一差值绝对值和第二差值绝对值;
差值第一判断模块320,用于判断第一差值绝对值和第二差值绝对值是否均在第一误差范围内;
速度第一处理模块330,用于调整其差值绝对值不在第一误差范围内的驱动电机的运转速度;
参数第一调整模块331,用于利用控制算法对差值绝对值不在第一误差范围内的驱动电机的速度调节参数进行整定;
参数第一执行模块332,用于用调整后的速度调节参数调节驱动电机的速度。
差值第二计算模块340,用于计算第一速度响应值和第二速度响应值之间的差值绝对值,得到相对差值绝对值;
差值第二判断模块350,用于判断相对差值绝对值是否在第二误差范围内;
速度第二处理模块360,用于调整左手驱动电机201和/或右手驱动电机202的运转速度,直到第一速度响应值和第二速度响应值之间的差值绝对值在第二误差范围内;
基准电机模块361,用于从左手驱动电机201和右手驱动电机202选择一个作为基准电机;
差值绝对值比较模块3611,用于比较第一差值绝对值和第二差值绝对值的大小;
基准电机确定模块3612,用于确定两者中较小的一个对应的驱动电机作为基准电机。
参数第二调整模块362,用于利用控制算法对相对差值绝对值不在第二误差范围内的驱动电机的速度调节参数进行整定;
参数第二执行模块363,用于用调整后的速度调节参数调节驱动电机的速度。
控制运行模块370,用于控制左手驱动电机201和右手驱动电机202运转。
进一步的,电控***中央处理单元的输出端与PWM(PulseWidthModulation,即脉冲宽度调制)门级驱动电路600相连,PWM门级驱动电路通过第一智能功率模块IPM701和第二智能功率模块IPM702与PLC400相连。
可以理解的是,智能功率模块IPM(IntelligentPowerModule)内部集成了驱动电路,同时具有过电压、过电流、过热等故障检测保护电路。
进一步的,左手驱动电机201和右手驱动电机202上分别设置有速度调整器,速度调整器与电控***中央处理单元相连。
可以理解的是,速度调整器可以实现速度的平稳过渡,提高了速度采集器的采集效率,具有稳定性高、可靠性以及抗干扰能力强的特点。
进一步的,左手驱动电机201、右手驱动电机202分别与同一供电模块相连。
可以理解的是,左手驱动电机201、右手驱动电机202共用同一供电模块,具有简单经济、速度反应好、低速同步协调能力强的优点,同时,驱动电机的的功率也能够得到充分的利用,当一个驱动电机处于减速运动时,多余的电流能够被另一驱动电机吸收。
进一步的,供电模块包括:
输入端与交流电源相连的滤波整流电路;
与滤波整流电路的输出端相连的制动电路。
进一步的,该***还包括,设置在第一智能功率模块IPM701与PLC400之间的第一电流采集器;设置在第二智能功率模块IPM702与PLC400之间的第二电流采集器,第一电流采集器和第二电流采集器的输出端与电控***中央处理单元300相连。
对应上述实现机器人双手臂同步控制的方法,每个模块执行的具体操作可以参考前述的方法实施例,在此不再赘述。
本说明书中各个实施例采用递进的方式描述,每个实施例重点说明的都是与其他实施例的不同之处,各个实施例之间相同相似部分互相参见即可。对于实施例公开的***而言,由于其与实施例公开的方法相对应,所以描述的比较简单,相关之处参见方法部分说明即可。
专业人员还可以进一步意识到,结合本文中所公开的实施例描述的各示例的单元及算法步骤,能够以电子硬件、计算机软件或者二者的结合来实现,为了清楚地说明硬件和软件的可互换性,在上述说明中已经按照功能一般性地描述了各示例的组成及步骤。这些功能究竟以硬件还是软件方式来执行,取决于技术方案的特定应用和设计约束条件。专业技术人员可以对每个特定的应用来使用不同方法来实现所描述的功能,但是这种实现不应认为超出本发明的范围。
结合本文中所公开的实施例描述的方法或算法的步骤可以直接用硬件、处理器执行的软件模块,或者二者的结合来实施。软件模块可以置于随机存储器(RAM)、内存、只读存储器(ROM)、电可编程ROM、电可擦除可编程ROM、寄存器、硬盘、可移动磁盘、CD-ROM、或技术领域内所公知的任意其它形式的存储介质中。
对所公开的实施例的上述说明,使本领域专业技术人员能够实现或使用本发明。对这些实施例的多种修改对本领域的专业技术人员来说将是显而易见的,本文中所定义的一般原理可以在不脱离本发明的精神或范围的情况下,在其它实施例中实现。因此,本发明将不会被限制于本文所示的这些实施例,而是要符合与本文所公开的原理和新颖特点相一致的最宽的范围。
Claims (9)
1.一种实现机器人双手臂同步控制的方法,其特征在于,该方法包括以下步骤:
步骤A:电控***中央处理单元接收上位机发送的给定速度值,向PLC发送控制左手驱动电机和右手驱动电机按照所述给定速度值进行运转的速度指令;
步骤B:所述PLC接收所述电控***中央处理单元发出的速度指令,控制所述左手驱动电机和所述右手驱动电机依据所述给定速度值进行运转;
步骤C:速度采集器采集所述左手驱动电机的第一速度响应值和所述右手驱动电机的第二速度响应值,并将所述速度响应值反馈给所述电控***中央处理单元;
步骤D:所述电控***中央处理单元分别计算所述第一速度响应值、所述第二速度响应值与所述给定速度值的差值绝对值,对应得到第一差值绝对值和第二差值绝对值;
步骤E:当所述第一差值绝对值和所述第二差值绝对值均在第一误差范围内时,计算所述第一速度响应值和所述第二速度响应值之间的差值绝对值,得到相对差值绝对值;
步骤F:当所述相对差值绝对值在第二误差范围内时,控制所述左手驱动电机和所述右手驱动电机运转;
其中,所述相对差值绝对值在第二误差范围内是指相对差值绝对值小于等于一个非负常数。
2.如权利要求1所述的实现机器人双手臂同步控制的方法,其特征在于,还包括:
当所述第一差值绝对值和/或所述第二差值绝对值不在所述第一误差范围内,调整其差值绝对值不在所述第一误差范围内的驱动电机的运转速度,直到所述速度采集器采集到的所述驱动电机的速度响应值与所述给定速度值的差值绝对值在所述第一误差范围内,进入步骤E。
3.如权利要求2所述的实现机器人双手臂同步控制的方法,其特征在于,还包括:
当所述相对差值绝对值不在所述第二误差范围内,则调整所述左手驱动电机和/或所述右手驱动电机的运转速度,直到所述相对差值绝对值在所述第二误差范围内。
4.如权利要求3所述的实现机器人双手臂同步控制的方法,其特征在于,所述调整其差值绝对值不在所述第一误差范围内的驱动电机的运转速度的过程包括:
利用控制算法对差值绝对值不在所述第一误差范围内的驱动电机的速度调节参数进行整定,并用调整后的所述速度调节参数调节所述驱动电机的速度。
5.如权利要求4所述的实现机器人双手臂同步控制的方法,其特征在于,所述控制算法为基于BP神经网络的PID控制算法。
6.一种实现机器人双手臂同步控制的***,该***包括上位机、左手驱动电机和右手驱动电机,其特征在于,该***还包括:电控***中央处理单元、可编程逻辑控制器PLC和速度采集器组,其中:
所述电控***中央处理单元的输入端与所述上位机相连,输出端与所述PLC相连,用于接收所述上位机发送的给定速度值,向PLC发送控制所述左手驱动电机和所述右手驱动电机按照所述给定速度值进行运转的速度指令;
所述PLC接收所述电控***中央处理单元发出的速度指令,控制所述左手驱动电机和所述右手驱动电机依据所述给定速度进行运转;
所述速度采集器组包含两个速度采集器,所述两个速度采集器分别采集所述左手驱动电机的第一速度响应值和所述右手驱动电机的第二速度响应值,并将所述速度响应值反馈给所述电控***中央处理单元;
所述电控***中央处理单元接收所述速度采集器组反馈的速度响应值,分别计算所述左手驱动电机、所述右手驱动电机的速度响应值与所述给定速度值的差值绝对值,对应得到第一差值绝对值和第二差值绝对值,当所述第一差值绝对值与所述第二差值绝对值均在第一误差范围内时,计算所述第一速度响应值与所述第二速度响应值之间的差值绝对值,得到相对差值绝对值,当所述相对差绝对值在第二误差范围内时,控制所述左手驱动电机和所述右手驱动电机运转;
其中,所述相对差值绝对值在第二误差范围内是指相对差值绝对值小于等于一个非负常数。
7.如权利要求6所述的实现机器人双手臂同步控制的***,其特征在于,所述电控***中央处理单元还用于,当所述第一差值绝对值和/或所述第二差值绝对值不在所述第一误差范围内,调整其差值绝对值不在所述第一误差范围内的驱动电机的运转速度,直到所述速度采集器采集到的所述驱动电机的速度响应值与所述给定速度值的差值绝对值在所述第一误差范围内,当所述相对差值绝对值不在所述第二误差范围内,则调整所述左手驱动电机和/或所述右手驱动电机的运转速度,直到所述相对差值绝对值在所述第二误差范围内。
8.如权利要求7所述的实现机器人双手臂同步控制的***,其特征在于,所述速度采集器为光电编码器。
9.如权利要求7所述的实现机器人双手臂同步控制的***,其特征在于,所述电控***中央处理单元的输出端与PWM门级驱动电路相连,所述PWM门级驱动电路通过第一智能功率模块IPM和第二智能功率模块IPM与所述PLC相连。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410624774.1A CN104440910B (zh) | 2014-11-07 | 2014-11-07 | 一种实现机器人双手臂同步控制的方法及*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410624774.1A CN104440910B (zh) | 2014-11-07 | 2014-11-07 | 一种实现机器人双手臂同步控制的方法及*** |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104440910A CN104440910A (zh) | 2015-03-25 |
CN104440910B true CN104440910B (zh) | 2016-05-04 |
Family
ID=52888058
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410624774.1A Active CN104440910B (zh) | 2014-11-07 | 2014-11-07 | 一种实现机器人双手臂同步控制的方法及*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104440910B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108858145A (zh) * | 2018-07-12 | 2018-11-23 | 华南理工大学 | 一种双柔性机器人同步运动控制装置与方法 |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104767427B (zh) * | 2015-04-20 | 2017-12-05 | 赛诺威盛科技(北京)有限公司 | 一种ct机中多电机的同步控制***及方法 |
CN106393119B (zh) * | 2016-11-25 | 2019-01-11 | 武汉华星光电技术有限公司 | 一种机器人双手臂的控制***及其方法 |
CN108776740B (zh) * | 2018-06-11 | 2020-06-16 | 浙江国自机器人技术有限公司 | 一种双驱车辆的速度变化曲率同步方法、***及相关组件 |
CN114789453B (zh) * | 2022-06-22 | 2022-09-30 | 季华实验室 | 机械臂动态pid控制方法、装置、电子设备及存储介质 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1468791A1 (en) * | 2001-11-07 | 2004-10-20 | Kawasaki Jukogyo Kabushiki Kaisha | Robot collaboration control system |
EP1602456A2 (de) * | 2004-06-02 | 2005-12-07 | KUKA Roboter GmbH | Verfahren und Vorrichtung zum Steuern von Handhabungsgeräten |
CN102004510A (zh) * | 2010-10-19 | 2011-04-06 | 上海海事大学 | 轨道式八轮拖动电动小车定位跟踪控制*** |
CN201854229U (zh) * | 2010-10-25 | 2011-06-01 | 四川省安普瑞自动化设备有限公司 | 一种带式运输机多电机同步控制*** |
CN102528809A (zh) * | 2010-11-05 | 2012-07-04 | 佳能株式会社 | 机器人控制设备 |
CN102985233A (zh) * | 2010-05-14 | 2013-03-20 | 史陶比尔法万举 | 控制自动化工作单元的方法 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0720915A (ja) * | 1993-07-06 | 1995-01-24 | Fanuc Ltd | ロボットの同期制御方法 |
US8731714B2 (en) * | 2010-09-22 | 2014-05-20 | GM Global Technology Operations LLC | Concurrent path planning with one or more humanoid robots |
-
2014
- 2014-11-07 CN CN201410624774.1A patent/CN104440910B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1468791A1 (en) * | 2001-11-07 | 2004-10-20 | Kawasaki Jukogyo Kabushiki Kaisha | Robot collaboration control system |
EP1602456A2 (de) * | 2004-06-02 | 2005-12-07 | KUKA Roboter GmbH | Verfahren und Vorrichtung zum Steuern von Handhabungsgeräten |
CN102985233A (zh) * | 2010-05-14 | 2013-03-20 | 史陶比尔法万举 | 控制自动化工作单元的方法 |
CN102004510A (zh) * | 2010-10-19 | 2011-04-06 | 上海海事大学 | 轨道式八轮拖动电动小车定位跟踪控制*** |
CN201854229U (zh) * | 2010-10-25 | 2011-06-01 | 四川省安普瑞自动化设备有限公司 | 一种带式运输机多电机同步控制*** |
CN102528809A (zh) * | 2010-11-05 | 2012-07-04 | 佳能株式会社 | 机器人控制设备 |
Non-Patent Citations (1)
Title |
---|
药品灌装生产线多电机协调控制研究;陈宏国;《中国优秀硕士学位论文全文数据库信息科技辑》;20110315;第15-20页,32-42页,43-55页 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108858145A (zh) * | 2018-07-12 | 2018-11-23 | 华南理工大学 | 一种双柔性机器人同步运动控制装置与方法 |
CN108858145B (zh) * | 2018-07-12 | 2023-09-26 | 华南理工大学 | 一种双柔性机器人同步运动控制装置与方法 |
Also Published As
Publication number | Publication date |
---|---|
CN104440910A (zh) | 2015-03-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104440910B (zh) | 一种实现机器人双手臂同步控制的方法及*** | |
CN106894977B (zh) | 多变频控制***及控制方法 | |
WO2021004218A1 (zh) | 机床运动轨迹的控制方法及装置、存储介质、处理器 | |
CN204229213U (zh) | 一种多轴联动伺服控制*** | |
CN102681487B (zh) | 数控***中操作设备的轨迹平滑方法和装置及数控机床 | |
CN103501136A (zh) | 一种多电机同步协调控制方法 | |
CN105450130A (zh) | 一种基于分段pi控制的低压直流伺服驱动器 | |
CN101572522B (zh) | 一种傻瓜式自学习的电机软性起停控制装置 | |
US20150012119A1 (en) | Machine controller | |
US20150177710A1 (en) | Motor Control Device | |
CN106522916A (zh) | 一种基于模糊pid控制的自动送钻装置及方法 | |
CN104753406A (zh) | 一种多电机协同控制方法 | |
EP3385631B1 (en) | Method and apparatus for controlling a photovoltaic air conditioning system | |
CN105281616A (zh) | 基于霍尔传感器的角度校正方法、装置及永磁同步电机 | |
CN104821751A (zh) | 一种变频器快速启停机控制*** | |
CN205754082U (zh) | 带双机位置环同步控制的数字式正弦波交流伺服驱动器 | |
CN105179215A (zh) | 一种基于modbus通信的现代水泵控制*** | |
CN207571563U (zh) | 玻璃生产线退火窑辊道速度控制*** | |
CN103326637B (zh) | 一种基于can总线的多电机控制方法 | |
CN207866916U (zh) | 电馈伺服节能设备节能率自动测试*** | |
CN201557069U (zh) | 傻瓜自学习电机软起动器 | |
CN205319985U (zh) | 一种开关磁阻电机的电压斩波控制装置 | |
US11817802B2 (en) | Vector control method and system of a permanent magnet motor operation | |
CN205540189U (zh) | 一种倒棱机自动控制装置 | |
CN204493191U (zh) | 一种永磁同步电机驱动的螺杆式空气压缩机控制*** |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |