CN112123341A - 机器人双臂协调运动控制方法、装置和电子设备 - Google Patents
机器人双臂协调运动控制方法、装置和电子设备 Download PDFInfo
- Publication number
- CN112123341A CN112123341A CN202011329284.0A CN202011329284A CN112123341A CN 112123341 A CN112123341 A CN 112123341A CN 202011329284 A CN202011329284 A CN 202011329284A CN 112123341 A CN112123341 A CN 112123341A
- Authority
- CN
- China
- Prior art keywords
- arm
- slave arm
- slave
- motion
- acquiring
- 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 47
- 239000011159 matrix material Substances 0.000 claims abstract description 92
- 230000003044 adaptive effect Effects 0.000 claims abstract description 63
- 230000009466 transformation Effects 0.000 claims abstract description 54
- 238000013528 artificial neural network Methods 0.000 claims abstract description 21
- 238000012937 correction Methods 0.000 claims description 32
- 239000013598 vector Substances 0.000 claims description 17
- 238000004590 computer program Methods 0.000 claims description 13
- 238000004364 calculation method Methods 0.000 claims description 9
- 238000013016 damping Methods 0.000 claims description 7
- 241000764238 Isis Species 0.000 claims description 3
- 238000010586 diagram Methods 0.000 description 6
- 238000012549 training Methods 0.000 description 4
- 230000008569 process Effects 0.000 description 3
- 238000006243 chemical reaction Methods 0.000 description 2
- 230000006870 function Effects 0.000 description 2
- 238000013507 mapping Methods 0.000 description 2
- 238000004088 simulation Methods 0.000 description 2
- 238000003491 array Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 239000002360 explosive Substances 0.000 description 1
- 238000003703 image analysis method Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- 238000011426 transformation method Methods 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1679—Programme controls characterised by the tasks executed
- B25J9/1682—Dual arm manipulator; Coordination of several manipulators
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
- B25J9/161—Hardware, e.g. neural networks, fuzzy logic, interfaces, processor
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- Artificial Intelligence (AREA)
- Evolutionary Computation (AREA)
- Fuzzy Systems (AREA)
- Mathematical Physics (AREA)
- Software Systems (AREA)
- Manipulator (AREA)
Abstract
本发明提供了一种机器人双臂协调运动控制方法、装置和电子设备,通过获取主臂和从臂的运动学模型;获取主臂和从臂的坐标转换矩阵;获取主臂的运动轨迹;由主臂的运动轨迹计算从臂的运动轨迹;获取六维力传感器测得的接触力数据;根据从臂的末端位置和接触力数据计算被搬运物体的刚度;根据刚度和BP神经网络预测模型,获取自适应力控制参数;在控制从臂沿从臂的运动轨迹运动时,根据预设的期望接触力、测得的接触力数据和自适应力控制参数,采用基于位置的自适应力控制方法来修正从臂的实际运动轨迹;从而可避免机器人的位置跟踪误差而导致两个机械臂对被搬运物体的作用力过大或不足。
Description
技术领域
本发明涉及机器人控制技术领域,尤其涉及一种机器人双臂协调运动控制方法、装置和电子设备。
背景技术
在一些危险的场合,如排爆、进入有险情的灾区进行救灾,为了保护救灾人员的生命安全,往往会使用双臂机器人进入现场进行作业,并由救灾人员远程对机器人进行遥控操作。
在救灾现场,常常需要双臂机器人的两个机械臂协同搬运一些物品,目前,在控制两个机械臂协同搬运物品时,一般是把其中一个机械臂设置为主臂,把另一个机械臂设置为从臂,然后对主臂的运动轨迹进行规划,再根据运动约束关系和主臂的运动轨迹计算出从臂的运动轨迹,从而实现两个机械臂的协同工作。
然而,机器人的位置跟踪精度是有限的,会存在一定的跟踪误差,容易导致两个机械臂对被搬运物体的作用力过大或不足,若作用力过大则容易损坏物体,若作用力不足则可能搬不起物体或使物体在搬运途中掉落。
发明内容
鉴于上述现有技术的不足之处,本申请实施例的目的在于提供一种机器人双臂协调运动控制方法、装置和电子设备,可避免机器人的位置跟踪误差而导致两个机械臂对被搬运物体的作用力过大或不足。
第一方面,本申请实施例提供一种机器人双臂协调运动控制方法,应用于双臂机器人,所述双臂机器人包括主臂和从臂,所述从臂的末端工具设置有六维力传感器,所述六维力传感器用于测量所述从臂末端工具的三个轴向力和三个轴向的力矩;包括步骤:
A1.获取所述主臂和从臂的运动学模型;
A2.获取所述主臂和从臂的坐标转换矩阵;
A3.获取所述主臂的运动轨迹;
A4.根据所述主臂和从臂的运动学模型、主臂和从臂的坐标转换矩阵以及从臂与主臂的运动约束关系,由所述主臂的运动轨迹计算所述从臂的运动轨迹;
A5.获取所述六维力传感器测得的接触力数据;
A6.根据所述从臂的末端位置和所述接触力数据计算被搬运物体的刚度;
A7.根据所述刚度和BP神经网络预测模型,获取自适应力控制参数;
A8.在控制所述从臂沿所述从臂的运动轨迹运动时,根据预设的期望接触力、测得的接触力数据和所述自适应力控制参数,采用基于位置的自适应力控制方法来修正从臂的实际运动轨迹。
所述的机器人双臂协调运动控制方法中,步骤A3包括:
获取待搬运物体的位置信息、尺寸信息和姿态信息;
获取目的地位置信息;
根据所述待搬运物体的位置信息、尺寸信息和姿态信息和目的地位置信息,规划所述主臂的运动轨迹。
所述的机器人双臂协调运动控制方法中,步骤A4中,根据以下公式计算由所述主臂的运动轨迹计算所述从臂的运动轨迹:
其中,表示主臂末端工具坐标系到工件坐标系的变换矩阵,是的逆矩
阵,表示从臂末端工具坐标系到工件坐标系的变换矩阵, 表示主臂坐标系到主
臂末端工具坐标系的变换矩阵, 表示从臂坐标系到从臂末端工具坐标系的变换矩
阵, 从臂坐标系到主臂坐标系的坐标系的变换矩阵。
所述的机器人双臂协调运动控制方法中,步骤A8中,根据以下公式修正所述从臂的实际运动轨迹:
其中,为从臂运动轨迹修正量,为自适应力控制器的期望惯性矩阵,为自适
应力控制器的期望阻尼矩阵,为自适应力控制器的期望刚度矩阵,为期望位置,为
实际位置,为预设的期望接触力,为六维力传感器测得的接触力数据,为自适应力
控制参数。
所述的机器人双臂协调运动控制方法中,步骤A8包括:
把所述从臂运动轨迹修正量分解为位置修正量和姿态修正量;
根据以下公式修正从臂的位置:
根据以下公式修正从臂的姿态:
第二方面,本申请实施例提供一种机器人双臂协调运动控制装置,包括:
第一获取模块,用于获取所述主臂和从臂的运动学模型;
第二获取模块,用于获取所述主臂和从臂的坐标转换矩阵;
第三获取模块,用于获取所述主臂的运动轨迹;
第一执行模块,用于根据所述主臂和从臂的运动学模型、主臂和从臂的坐标转换矩阵以及从臂与主臂的运动约束关系,由所述主臂的运动轨迹计算所述从臂的运动轨迹;
第四获取模块,用于获取所述六维力传感器测得的接触力数据;
第一计算模块,用于根据所述从臂的末端位置和所述接触力数据计算被搬运物体的刚度;
第五获取模块,用于根据所述刚度和BP神经网络预测模型,获取自适应力控制参数;
第二执行模块,用于在控制所述从臂沿所述从臂的运动轨迹运动时,根据预设的期望接触力、测得的接触力数据和所述自适应力控制参数,采用基于位置的自适应力控制方法来修正从臂的实际运动轨迹。
所述的机器人双臂协调运动控制装置中,所述第三获取模块在获取所述主臂的运动轨迹时,
获取待搬运物体的位置信息、尺寸信息和姿态信息;
获取目的地位置信息;
根据所述待搬运物体的位置信息、尺寸信息和姿态信息和目的地位置信息,规划所述主臂的运动轨迹。
所述的机器人双臂协调运动控制装置中,所述第二执行模块,根据以下公式修正所述从臂的实际运动轨迹:
其中,为从臂运动轨迹修正量,为自适应力控制器的期望惯性矩阵,为自适
应力控制器的期望阻尼矩阵,为自适应力控制器的期望刚度矩阵,为期望位置,为
实际位置,为预设的期望接触力,为六维力传感器测得的接触力数据,为自适应力
控制参数。
第三方面,本申请实施例提供一种电子设备,包括处理器和存储器,所述存储器中存储有计算机程序,所述处理器通过调用所述存储器中存储的所述计算机程序,用于执行所述的机器人双臂协调运动控制方法。
有益效果:
本申请实施例提供的一种机器人双臂协调运动控制方法、装置和电子设备,通过获取所述主臂和从臂的运动学模型;获取所述主臂和从臂的坐标转换矩阵;获取所述主臂的运动轨迹;根据所述主臂和从臂的运动学模型、主臂和从臂的坐标转换矩阵以及从臂与主臂的运动约束关系,由所述主臂的运动轨迹计算所述从臂的运动轨迹;获取所述六维力传感器测得的接触力数据;根据所述从臂的末端位置和所述接触力数据计算被搬运物体的刚度;根据所述刚度和BP神经网络预测模型,获取自适应力控制参数;在控制所述从臂沿所述从臂的运动轨迹运动时,根据预设的期望接触力、测得的接触力数据和所述自适应力控制参数,采用基于位置的自适应力控制方法来修正从臂的实际运动轨迹;从而可避免机器人的位置跟踪误差而导致两个机械臂对被搬运物体的作用力过大或不足。
附图说明
图1为本申请实施例提供的机器人双臂协调运动控制方法的流程图。
图2为本申请实施例提供的机器人双臂协调运动控制装置的模块图。
图3为本申请实施例提供的电子设备的结构示意图。
图4为主臂、从臂和物体之间的位置关系示意图。
图5为基于位置的自适应力控制模型的示意图。
图6为从臂末端工具接触力的仿真结果示意图。
具体实施方式
下面将结合本申请实施例中附图,对本申请实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本申请一部分实施例,而不是全部的实施例。通常在此处附图中描述和示出的本申请实施例的组件可以以各种不同的配置来布置和设计。因此,以下对在附图中提供的本申请的实施例的详细描述并非旨在限制要求保护的本申请的范围,而是仅仅表示本申请的选定实施例。基于本申请的实施例,本领域技术人员在没有做出创造性劳动的前提下所获得的所有其他实施例,都属于本申请保护的范围。
应注意到:相似的标号和字母在下面的附图中表示类似项,因此,一旦某一项在一个附图中被定义,则在随后的附图中不需要对其进行进一步定义和解释。同时,在本申请的描述中,术语“第一”、“第二”等仅用于区分描述,而不能理解为指示或暗示相对重要性。
请参阅图1,本申请实施例提供的一种机器人双臂协调运动控制方法,应用于双臂机器人,双臂机器人包括主臂和从臂,从臂的末端工具设置有六维力传感器,六维力传感器用于测量从臂末端工具的三个轴向力和三个轴向的力矩;其特征在于,包括步骤:
A1.获取主臂和从臂的运动学模型;
A2.获取主臂和从臂的坐标转换矩阵;
A3.获取主臂的运动轨迹;
A4.根据主臂和从臂的运动学模型、主臂和从臂的坐标转换矩阵以及从臂与主臂的运动约束关系,由主臂的运动轨迹计算从臂的运动轨迹;
A5.获取六维力传感器测得的接触力数据;
A6.根据所述从臂的末端位置和所述接触力数据计算被搬运物体的刚度;
A7.根据所述刚度和BP神经网络预测模型,获取自适应力控制参数;
A8.在控制所述从臂沿所述从臂的运动轨迹运动时,根据预设的期望接触力、测得的接触力数据和所述自适应力控制参数,采用基于位置的自适应力控制方法来修正从臂的实际运动轨迹。
该方法在获取主臂的运动轨迹后,根据从臂与主臂的运动约束关系计算从臂的运动轨迹,在控制从臂沿该从臂的运动轨迹运动时,根据六维力传感器事实测量的接触力数据,并根据接触力数据和从臂的末端位置计算被搬运物体的实际刚度,以输入BP神经网络预测模型来获取相匹配的自适应力控制参数,基于位置的自适应力控制,适当修正了从臂的轨迹,从而达到了作用力控制的目的,避免机器人的位置跟踪误差而导致两个机械臂对被搬运物体的作用力过大或不足。
实际上,在其它条件相同的情况下,被搬运物体的刚度不同的时候,机械臂对物体的作用力也应该不同,需要与被搬运物体的实际刚度相匹配,从而避免压坏被搬运物体和损坏机械臂本身,该方法能够根据不同刚度的物体自动调节自适应力控制参数,最终实现机械臂与不同刚度的物体接触的自适应力控制。
步骤A1中,可通过D-H坐标变换方法分别建立两条机械臂的运动学模型,并以此求解机械臂正运动学方程和逆运动学方程作为机器人控制的基础。
步骤A2中,主臂和从臂的坐标转换矩阵可通过预先标定得到,标定方法如下:通过
空间中不在同一直线上的三个空间点P1、P2、P3,获取该三个点在主臂坐标系下的坐标和在
从臂坐标系下的坐标,以P2为原点,(P1-P2)得到的向量为X轴,(P3-P2)得到的向量为Y轴,X
轴叉乘Y轴得到Z轴,由计算得到的X轴、Y轴和Z轴构建一个空间坐标系作为两条机械臂的公
共坐标系S,通过主臂的正运动学计算得到主臂座坐标系B1到公共坐标系S的变换矩阵为,通过从臂的正运动学计算得到从臂座坐标系B2到公共坐标系S的变换矩阵为,由
此来推导出主臂座坐标系到从臂座坐标系的变换矩阵关系为。
在一些实施方式中,步骤A3包括:
A301.获取待搬运物体的位置信息、尺寸信息和姿态信息;
A302.获取目的地位置信息;
A303.根据待搬运物体的位置信息、尺寸信息和姿态信息和目的地位置信息,规划主臂的运动轨迹。
例如,对于设置有双目视觉系统的机器人,可通过双目视觉系统获取待搬运物体的位置信息、尺寸信息和姿态信息;在A302中,可采集现场图像并发送至远端的机器人控制器,由操作人员根据现场图像选定物体搬运的目的地位并生成目的地位置信息发回机器人,或者在采集现场图像后通过图像分析方法获取适合放置待搬运物体的区域,并选取其中离物体初始位置最近的区域作为目的地,获取该区域的中心位置信息作为目的地位置信息;在A303中,可通过基于采样的运动规划方法,得到主臂的路点,该主臂的路点表示主臂运动轨迹上的点。 以上只是举例说明,步骤A301-A303的具体实施方式不限于此。
在本实施例中,步骤A4中,根据以下公式计算由主臂的运动轨迹计算从臂的运动轨迹:
其中,表示主臂末端工具坐标系到工件坐标系的变换矩阵,是的逆矩
阵,表示从臂末端工具坐标系到工件坐标系的变换矩阵, 表示主臂坐标系到主
臂末端工具坐标系的变换矩阵, 表示从臂坐标系到从臂末端工具坐标系的变换矩
阵, 从臂坐标系到主臂坐标系的坐标系的变换矩阵。
见图4,为搬运过程中主臂90、从臂91和物体92之间的位置关系示意图,其中,主臂90的坐标系为{R1},从臂91的坐标系为{R2},主臂90的末端工具坐标系为{E1},从臂91的末端工具坐标系为{E2},物体92的工件坐标系为{P},主臂和从臂在协同运动时有如下关系:
进一步的,由于在搬运过程中,主臂90的末端工具、从臂91的末端工具、物体92之
间是相对静止的(即相对位置固定),且物体92的尺寸是不变的,因此,主臂90末端工具坐标
系到从臂91末端工具坐标系之间的转换矩阵是不变的且为常变换矩阵,该常变换矩阵可预
先计算得到;所以,从臂与主臂的运动约束关系为为常变换矩阵。由于已经
通过预先标定得到,因此与之间的转换关系是确定的,从而可根据该转换关系
由主臂的运动轨迹计算从臂的运动轨迹。
在步骤A6中,可根据以下公式计算被搬运物体的刚度:
在一些实施方式中,见图5,可通过图5中的基于位置的自适应力控制模型(该模型为自适应自适应力控制模型)进行从臂的实际运动轨迹的修正,该基于位置的自适应力控制模型的数学表达式为:
其中,为自适应力控制器的期望惯性矩阵,为自适应力控制器的期望阻尼矩阵,为自适应力控制器的期望刚度矩阵,为期望位置,为实际位置,为预设的期望
接触力,为六维力传感器测得的接触力数据,为自适应力控制参数。其中,,、、分别为三个轴向的作用力,、、分别为三个轴向的力矩。
该基于位置的自适应力控制模型中,引入了实时的力偏差反馈闭环和自
适应力控制参数,一般地,被搬运物体刚度越大,自适应力控制参数应该越小,这样才
能保证不损坏机械臂。根据该原则,可设计被搬运物体的不同刚度和自适应力控制参数的
映射关系数据集,并把该数据集合作为BP神经网络训练的样本数据,经过BP神经网络训练
后,生成BP神经网络预测模型。在实际工作过程中,把步骤A6中计算得到的刚度值输入到该
BP神经网络预测模型中,得到对应的自适应力控制参数。因此,无需根据被搬运物体的实
际刚度预先设置(或修改)固定的自适应力控制参数,不但使用方便,且可适应不同刚度
的物体的搬运,适用性强。
通过对基于位置的自适应力控制模型的数学表达式进行积分可得到以下计算公式,可根据该公式修正从臂的实际运动轨迹:
在该基于位置的自适应力控制模型中,在自适应力控制中引入自适应调整刚度参数,在自适应力控制器中增加实时的力偏差反馈闭环,根据这个力偏差反馈来在线调整自适应力控制器的刚度参数,从而在无需修改任何参数的条件下能够适应不同刚度的物体的表面接触力控制。
进一步的,步骤A8包括:
其中,为6*1大小的向量,包括6个参数,分别为三个方向的坐标修正量和三个方向
的姿态角度修正量,可从其中把三个方向的坐标修正量提取出来形成位置修正量(即
为3*1大小的向量),从其中把三个方向的姿态角度修正量提取出来形成姿态修正量
(即为3*1大小的向量);
A802.根据以下公式修正从臂的位置:
A803.根据以下公式修正从臂的姿态:
其中,和是增益参数,为k时刻的姿态修正量(用欧拉角表示),是
k时刻的姿态(用旋转矩阵表示),为+1时刻的姿态(用旋转矩阵表示),
为k时刻的姿态修正量(用旋转矩阵表示),为转轴的轴向向量,为从臂绕所述向量旋
转的角度,为向量的反对称矩阵, 是单位矩阵,表示机器人姿态
(用旋转矩阵表示)。
根据上述方法进行如下仿真:
双臂机器人搬运工件的末端期望接触力设置为20N,自适应力控制器的期望惯性矩阵,自适应力控制器的期望阻尼矩阵,自适应力控制器的期望刚度矩
阵,此处的是单位矩阵,经仿真,得到的搬运过程中的法向接触力如图6
所示,可看到,实际接触力的峰值与期望接触力的偏差为,最大超调量为,接触力的稳态偏差为。从结果可以看出该自适应自适应力控制器
具有优秀的力控制效果。
由上可知,该机器人双臂协调运动控制方法,通过获取所述主臂和从臂的运动学模型;获取所述主臂和从臂的坐标转换矩阵;获取所述主臂的运动轨迹;根据所述主臂和从臂的运动学模型、主臂和从臂的坐标转换矩阵以及从臂与主臂的运动约束关系,由所述主臂的运动轨迹计算所述从臂的运动轨迹;获取所述六维力传感器测得的接触力数据;根据所述从臂的末端位置和所述接触力数据计算被搬运物体的刚度;根据所述刚度和BP神经网络预测模型,获取自适应力控制参数;在控制所述从臂沿所述从臂的运动轨迹运动时,根据预设的期望接触力、测得的接触力数据和所述自适应力控制参数,采用基于位置的自适应力控制方法来修正从臂的实际运动轨迹;从而可避免机器人的位置跟踪误差而导致两个机械臂对被搬运物体的作用力过大或不足。
请参阅图2,本申请实施例提供一种机器人双臂协调运动控制装置,包括第一获取模块1、第二获取模块2、第三获取模块3、第一执行模块4、第四获取模块5、第一计算模块6、第五获取模块7、第二执行模块8;
其中,第一获取模块1,用于获取主臂和从臂的运动学模型;
其中,第二获取模块2,用于获取主臂和从臂的坐标转换矩阵;
其中,第三获取模块3,用于获取主臂的运动轨迹;
其中,第一执行模块4,用于根据主臂和从臂的运动学模型、主臂和从臂的坐标转换矩阵以及从臂与主臂的运动约束关系,由主臂的运动轨迹计算从臂的运动轨迹;
其中,第四获取模块5,用于获取六维力传感器测得的接触力数据;
其中,第一计算模块6,用于根据所述从臂的末端位置和所述接触力数据计算被搬运物体的刚度;
其中,第五获取模块7,用于根据所述刚度和BP神经网络预测模型,获取自适应力控制参数;
其中,第二执行模块8,用于在控制所述从臂沿所述从臂的运动轨迹运动时,根据预设的期望接触力、测得的接触力数据和所述自适应力控制参数,采用基于位置的自适应力控制方法来修正从臂的实际运动轨迹。
在一些实施方式中,第三获取模块3在获取主臂的运动轨迹时,
获取待搬运物体的位置信息、尺寸信息和姿态信息;
获取目的地位置信息;
根据待搬运物体的位置信息、尺寸信息和姿态信息和目的地位置信息,规划主臂的运动轨迹。
在一些实施方式中,第一执行模块4根据以下公式计算由主臂的运动轨迹计算从臂的运动轨迹:
其中,表示主臂末端工具坐标系到工件坐标系的变换矩阵,是的逆矩
阵,表示从臂末端工具坐标系到工件坐标系的变换矩阵, 表示主臂坐标系到主
臂末端工具坐标系的变换矩阵, 表示从臂坐标系到从臂末端工具坐标系的变换矩
阵, 从臂坐标系到主臂坐标系的坐标系的变换矩阵。
在一些实施方式中,第一计算模块6根据以下公式计算被搬运物体的刚度:
在一些实施方式中,步骤A7包括:把第一计算模块6计算得到的刚度值输入到BP神经网络预测模型中,得到对应的自适应力控制参数。
可设计被搬运物体的不同刚度和自适应力控制参数的映射关系数据集,并把该数据集合作为BP神经网络训练的样本数据,经过BP神经网络训练后,生成BP神经网络预测模型。
在一些实施方式中,第二执行模块8,根据以下公式修正从臂的实际运动轨迹:
其中,为从臂运动轨迹修正量,为自适应力控制器的期望惯性矩阵,为自适
应力控制器的期望阻尼矩阵,为自适应力控制器的期望刚度矩阵,为期望位置,为
实际位置,为预设的期望接触力,为六维力传感器测得的接触力数据,为自适应力
控制参数。
进一步的,第二执行模块8在修正从臂的实际运动轨迹时,
根据以下公式修正从臂的位置:
根据以下公式修正从臂的姿态:
其中,和是增益参数,为k时刻的姿态修正量(用欧拉角表示),是
k时刻的姿态(用旋转矩阵表示),为+1时刻的姿态(用旋转矩阵表示),
为k时刻的姿态修正量(用旋转矩阵表示),为转轴的轴向向量,为从臂绕所述向量旋
转的角度,为向量的反对称矩阵, 是单位矩阵,表示机器人姿态
(用旋转矩阵表示)。
由上可知,该机器人双臂协调运动控制装置,通过获取所述主臂和从臂的运动学模型;获取所述主臂和从臂的坐标转换矩阵;获取所述主臂的运动轨迹;根据所述主臂和从臂的运动学模型、主臂和从臂的坐标转换矩阵以及从臂与主臂的运动约束关系,由所述主臂的运动轨迹计算所述从臂的运动轨迹;获取所述六维力传感器测得的接触力数据;根据所述从臂的末端位置和所述接触力数据计算被搬运物体的刚度;根据所述刚度和BP神经网络预测模型,获取自适应力控制参数;在控制所述从臂沿所述从臂的运动轨迹运动时,根据预设的期望接触力、测得的接触力数据和所述自适应力控制参数,采用基于位置的自适应力控制方法来修正从臂的实际运动轨迹;从而可避免机器人的位置跟踪误差而导致两个机械臂对被搬运物体的作用力过大或不足。
请参阅图3,本申请实施例还提供一种电子设备100,包括处理器101和存储器102,存储器102中存储有计算机程序,处理器101通过调用存储器102中存储的计算机程序,用于执行上述的机器人双臂协调运动控制方法。
其中,处理器101与存储器102电性连接。处理器101是电子设备100的控制中心,利用各种接口和线路连接整个电子设备的各个部分,通过运行或调用存储在存储器102内的计算机程序,以及调用存储在存储器102内的数据,执行电子设备的各种功能和处理数据,从而对电子设备进行整体监控。
存储器102可用于存储计算机程序和数据。存储器102存储的计算机程序中包含有可在处理器中执行的指令。计算机程序可以组成各种功能模块。处理器101通过调用存储在存储器102的计算机程序,从而执行各种功能应用以及数据处理。
在本实施例中,电子设备100中的处理器101会按照如下的步骤,将一个或一个以上的计算机程序的进程对应的指令加载到存储器102中,并由处理器101来运行存储在存储器102中的计算机程序,从而实现各种功能:获取所述主臂和从臂的运动学模型;获取所述主臂和从臂的坐标转换矩阵;获取所述主臂的运动轨迹;根据所述主臂和从臂的运动学模型、主臂和从臂的坐标转换矩阵以及从臂与主臂的运动约束关系,由所述主臂的运动轨迹计算所述从臂的运动轨迹;获取所述六维力传感器测得的接触力数据;根据所述从臂的末端位置和所述接触力数据计算被搬运物体的刚度;根据所述刚度和BP神经网络预测模型,获取自适应力控制参数;在控制所述从臂沿所述从臂的运动轨迹运动时,根据预设的期望接触力、测得的接触力数据和所述自适应力控制参数,采用基于位置的自适应力控制方法来修正从臂的实际运动轨迹。
由上可知,该电子设备,通过获取所述主臂和从臂的运动学模型;获取所述主臂和从臂的坐标转换矩阵;获取所述主臂的运动轨迹;根据所述主臂和从臂的运动学模型、主臂和从臂的坐标转换矩阵以及从臂与主臂的运动约束关系,由所述主臂的运动轨迹计算所述从臂的运动轨迹;获取所述六维力传感器测得的接触力数据;根据所述从臂的末端位置和所述接触力数据计算被搬运物体的刚度;根据所述刚度和BP神经网络预测模型,获取自适应力控制参数;在控制所述从臂沿所述从臂的运动轨迹运动时,根据预设的期望接触力、测得的接触力数据和所述自适应力控制参数,采用基于位置的自适应力控制方法来修正从臂的实际运动轨迹;从而可避免机器人的位置跟踪误差而导致两个机械臂对被搬运物体的作用力过大或不足。
综上所述,虽然本发明已以优选实施例揭露如上,但上述优选实施例并非用以限制本发明,本领域的普通技术人员,在不脱离本发明的精神和范围内,均可作各种更动与润饰,其方案与本发明实质上相同。
Claims (10)
1.一种机器人双臂协调运动控制方法,应用于双臂机器人,所述双臂机器人包括主臂和从臂,所述从臂的末端工具设置有六维力传感器,所述六维力传感器用于测量所述从臂末端工具的三个轴向力和三个轴向的力矩;其特征在于,包括步骤:
A1.获取所述主臂和从臂的运动学模型;
A2.获取所述主臂和从臂的坐标转换矩阵;
A3.获取所述主臂的运动轨迹;
A4.根据所述主臂和从臂的运动学模型、主臂和从臂的坐标转换矩阵以及从臂与主臂的运动约束关系,由所述主臂的运动轨迹计算所述从臂的运动轨迹;
A5.获取所述六维力传感器测得的接触力数据;
A6.根据所述从臂的末端位置和所述接触力数据计算被搬运物体的刚度;
A7.根据所述刚度和BP神经网络预测模型,获取自适应力控制参数;
A8.在控制所述从臂沿所述从臂的运动轨迹运动时,根据预设的期望接触力、测得的接触力数据和所述自适应力控制参数,采用基于位置的自适应力控制方法来修正从臂的实际运动轨迹。
2.根据权利要求1所述的机器人双臂协调运动控制方法,其特征在于,步骤A3包括:
获取待搬运物体的位置信息、尺寸信息和姿态信息;
获取目的地位置信息;
根据所述待搬运物体的位置信息、尺寸信息和姿态信息和目的地位置信息,规划所述主臂的运动轨迹。
7.一种机器人双臂协调运动控制装置,其特征在于,包括:
第一获取模块,用于获取所述主臂和从臂的运动学模型;
第二获取模块,用于获取所述主臂和从臂的坐标转换矩阵;
第三获取模块,用于获取所述主臂的运动轨迹;
第一执行模块,用于根据所述主臂和从臂的运动学模型、主臂和从臂的坐标转换矩阵以及从臂与主臂的运动约束关系,由所述主臂的运动轨迹计算所述从臂的运动轨迹;
第四获取模块,用于获取所述六维力传感器测得的接触力数据;
第一计算模块,用于根据所述从臂的末端位置和所述接触力数据计算被搬运物体的刚度;
第五获取模块,用于根据所述刚度和BP神经网络预测模型,获取自适应力控制参数;
第二执行模块,用于在控制所述从臂沿所述从臂的运动轨迹运动时,根据预设的期望接触力、测得的接触力数据和所述自适应力控制参数,采用基于位置的自适应力控制方法来修正从臂的实际运动轨迹。
8.根据权利要求7所述的机器人双臂协调运动控制装置,其特征在于,所述第三获取模块在获取所述主臂的运动轨迹时,
获取待搬运物体的位置信息、尺寸信息和姿态信息;
获取目的地位置信息;
根据所述待搬运物体的位置信息、尺寸信息和姿态信息和目的地位置信息,规划所述主臂的运动轨迹。
10.一种电子设备,其特征在于,包括处理器和存储器,所述存储器中存储有计算机程序,所述处理器通过调用所述存储器中存储的所述计算机程序,用于执行权利要求1-6任一项所述的机器人双臂协调运动控制方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011329284.0A CN112123341B (zh) | 2020-11-24 | 2020-11-24 | 机器人双臂协调运动控制方法、装置和电子设备 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011329284.0A CN112123341B (zh) | 2020-11-24 | 2020-11-24 | 机器人双臂协调运动控制方法、装置和电子设备 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112123341A true CN112123341A (zh) | 2020-12-25 |
CN112123341B CN112123341B (zh) | 2021-03-02 |
Family
ID=73852281
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011329284.0A Active CN112123341B (zh) | 2020-11-24 | 2020-11-24 | 机器人双臂协调运动控制方法、装置和电子设备 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112123341B (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113146615A (zh) * | 2021-01-29 | 2021-07-23 | 佛山树客智能机器人科技有限公司 | 一种多机器人协同搬运控制方法及装置 |
TWI742990B (zh) * | 2021-01-19 | 2021-10-11 | 財團法人工業技術研究院 | 機械手臂系統、其控制方法及其電腦程式產品 |
CN113664813A (zh) * | 2021-08-25 | 2021-11-19 | 深圳市优必选科技股份有限公司 | 双臂机器人控制方法、装置、双臂机器人和可读存储介质 |
CN113771044A (zh) * | 2021-10-09 | 2021-12-10 | 北京卫星环境工程研究所 | 一种机器人末端负载动态受力感知方法 |
CN117406667A (zh) * | 2023-11-20 | 2024-01-16 | 南京工程学院 | 一种基于数字孪生模型的拉弯机运动控制方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20160284968A1 (en) * | 2015-03-25 | 2016-09-29 | Seiko Epson Corporation | Piezoelectric drive device, driving method thereof, robot, and driving method thereof |
CN107921621A (zh) * | 2015-08-25 | 2018-04-17 | 川崎重工业株式会社 | 机器人系统 |
CN108515519A (zh) * | 2018-04-13 | 2018-09-11 | 珞石(山东)智能科技有限公司 | 一种基于力传感器的打磨路径自适应校正方法 |
CN111251297A (zh) * | 2020-02-20 | 2020-06-09 | 西北工业大学 | 一种基于随机采样的双臂空间机器人协调路径规划方法 |
CN111515949A (zh) * | 2020-04-23 | 2020-08-11 | 大连理工大学 | 一种双臂协作机器人的双臂传接位置选取方法 |
-
2020
- 2020-11-24 CN CN202011329284.0A patent/CN112123341B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20160284968A1 (en) * | 2015-03-25 | 2016-09-29 | Seiko Epson Corporation | Piezoelectric drive device, driving method thereof, robot, and driving method thereof |
CN107921621A (zh) * | 2015-08-25 | 2018-04-17 | 川崎重工业株式会社 | 机器人系统 |
CN108515519A (zh) * | 2018-04-13 | 2018-09-11 | 珞石(山东)智能科技有限公司 | 一种基于力传感器的打磨路径自适应校正方法 |
CN111251297A (zh) * | 2020-02-20 | 2020-06-09 | 西北工业大学 | 一种基于随机采样的双臂空间机器人协调路径规划方法 |
CN111515949A (zh) * | 2020-04-23 | 2020-08-11 | 大连理工大学 | 一种双臂协作机器人的双臂传接位置选取方法 |
Non-Patent Citations (2)
Title |
---|
庄照波: "双臂机器人协调运动规划研究", 《中国硕士学位论文全文数据库(电子期刊)信息科技辑》 * |
段奕林: "机器人视觉与柔顺控制的研究", 《万方数据知识服务平台》 * |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
TWI742990B (zh) * | 2021-01-19 | 2021-10-11 | 財團法人工業技術研究院 | 機械手臂系統、其控制方法及其電腦程式產品 |
US11951624B2 (en) | 2021-01-19 | 2024-04-09 | Industrial Technology Research Institute | Robotic arm system, control method thereof and computer program product thereof |
CN113146615A (zh) * | 2021-01-29 | 2021-07-23 | 佛山树客智能机器人科技有限公司 | 一种多机器人协同搬运控制方法及装置 |
CN113664813A (zh) * | 2021-08-25 | 2021-11-19 | 深圳市优必选科技股份有限公司 | 双臂机器人控制方法、装置、双臂机器人和可读存储介质 |
CN113664813B (zh) * | 2021-08-25 | 2022-07-29 | 深圳市优必选科技股份有限公司 | 双臂机器人控制方法、装置、双臂机器人和可读存储介质 |
CN113771044A (zh) * | 2021-10-09 | 2021-12-10 | 北京卫星环境工程研究所 | 一种机器人末端负载动态受力感知方法 |
CN113771044B (zh) * | 2021-10-09 | 2022-11-11 | 北京卫星环境工程研究所 | 一种机器人末端负载动态受力感知方法 |
CN117406667A (zh) * | 2023-11-20 | 2024-01-16 | 南京工程学院 | 一种基于数字孪生模型的拉弯机运动控制方法 |
CN117406667B (zh) * | 2023-11-20 | 2024-05-10 | 南京工程学院 | 一种基于数字孪生模型的拉弯机运动控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN112123341B (zh) | 2021-03-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112123341B (zh) | 机器人双臂协调运动控制方法、装置和电子设备 | |
JP4271232B2 (ja) | ロボットのオフラインプログラミングを実行するための装置、方法、プログラム及び記録媒体 | |
US9517563B2 (en) | Robot system using visual feedback | |
CN110662635B (zh) | 机器人的碰撞处理 | |
US9519736B2 (en) | Data generation device for vision sensor and detection simulation system | |
US11433537B2 (en) | Automatic path generation device | |
US20160039090A1 (en) | Robot program generation apparatus generating robot program for reducing jerks of joints of robot | |
CN110253574B (zh) | 一种多任务机械臂位姿检测和误差补偿方法 | |
CN113927599B (zh) | 绝对精度补偿方法及系统、设备和计算机可读存储介质 | |
JP2019014030A (ja) | ロボットの制御装置、ロボット、ロボットシステム、並びに、カメラの校正方法 | |
JPH01159186A (ja) | ロボット不正確度修正方法 | |
Trumić et al. | Adaptive control of soft robots based on an enhanced 3D augmented rigid robot matching | |
JP2019155556A (ja) | ロボットの制御装置、ロボット、ロボットシステム、並びに、カメラの校正方法 | |
JP5450242B2 (ja) | マニピュレータのキャリブレーション方法及びロボット制御システム | |
Lippiello et al. | A position-based visual impedance control for robot manipulators | |
CN116652939A (zh) | 一种并联机器人无标定视觉伺服柔顺控制方法 | |
Xu et al. | Uncalibrated visual servoing of mobile manipulators with an eye-to-hand camera | |
JP7523714B2 (ja) | 適応コンプライアンスに基づいたロボット組立のためのシステムおよび方法 | |
CN109311163B (zh) | 校正机器人的运动控制命令的方法及其相关设备 | |
CN112847362B (zh) | 一种基于图像矩的搬运机器人视觉伺服控制方法 | |
CN112847441B (zh) | 基于梯度下降法的六轴机器人坐标偏移检测方法和装置 | |
JP2014180726A (ja) | 多関節ロボットのバネ定数補正装置 | |
Muthusamy et al. | Investigation and design of robotic assistance control system for cooperative manipulation | |
JPS5958503A (ja) | ロボツトのツ−ルオフセツト教示方法 | |
Dastangoo et al. | Non-linear Parameter Identification for Humanoid Robot Components |
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 |