CN106113043A - 机器人控制系统及方法 - Google Patents
机器人控制系统及方法 Download PDFInfo
- Publication number
- CN106113043A CN106113043A CN201610637990.9A CN201610637990A CN106113043A CN 106113043 A CN106113043 A CN 106113043A CN 201610637990 A CN201610637990 A CN 201610637990A CN 106113043 A CN106113043 A CN 106113043A
- Authority
- CN
- China
- Prior art keywords
- robot
- matrix
- driver
- servo
- control module
- 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
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/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
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/16—Matrix or vector computation, e.g. matrix-matrix or matrix-vector multiplication, matrix factorization
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- General Physics & Mathematics (AREA)
- Pure & Applied Mathematics (AREA)
- Mathematical Analysis (AREA)
- Theoretical Computer Science (AREA)
- Software Systems (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Computational Mathematics (AREA)
- Data Mining & Analysis (AREA)
- Automation & Control Theory (AREA)
- Mathematical Optimization (AREA)
- Fuzzy Systems (AREA)
- Artificial Intelligence (AREA)
- Algebra (AREA)
- Computing Systems (AREA)
- Databases & Information Systems (AREA)
- General Engineering & Computer Science (AREA)
- Evolutionary Computation (AREA)
- Manipulator (AREA)
Abstract
本发明涉及机器人控制技术领域,特别涉及一种机器人控制系统及方法。本发明中机器人控制系统包括:控制器、第一机器人与第二机器人;控制器获取第一矩阵变换到第二矩阵的变换矩阵;第一矩阵表征第一机器人相对于预设参照物的初始位置和初始姿态,第二矩阵表征第一机器人相对于预设参照物的目标位置与目标姿态;变换矩阵表征第一机器人从初始位置和初始姿态移动至目标位置与目标姿态的过程中执行的动作;控制器根据第一矩阵变换、变换矩阵控制第一机器人运动,根据第三矩阵与变换矩阵控制第二机器人运动;第三矩阵表征第二机器人相对于第一机器人的目标位置和目标姿态。这样,使得一个机器人可以跟随运动的另一个机器人并相对其做出预设的动作。
Description
技术领域
本发明涉及机器人的控制技术领域,特别涉及一种机器人控制系统及方法。
背景技术
随着机器人技术的发展,智能机器人产品已经越来越多地深入到人们生活的各个方面,机器人不只用来帮助用户高效地完成指定的工作,更被设计为能够为用户提供娱乐的伙伴。
然而在现有技术中,机器人只能单独的执行指定的任务,无法实现与其他机器人之间的高实时交互,比如说,机器人A无法跟随机器人B并相对随机器人B做出预设的动作,限制了机器人的应用范围,降低了机器人的用户体验。
发明内容
本发明实施方式的目的在于提供一种机器人控制系统及方法,使得一个机器人可以跟随运动的另一个机器人并相对其做出预设的动作。
为解决上述技术问题,本发明的实施方式提供了一种机器人控制系统,包括:控制器、第一机器人与第二机器人;所述控制器分别与所述第一机器人、所述第二机器人通信连接;所述控制器获取第一矩阵变换到第二矩阵的变换矩阵;其中,所述第一矩阵用于表征所述第一机器人相对于预设参照物的初始位置和初始姿态,所述第二矩阵用于表征所述第一机器人相对于所述预设参照物的目标位置与目标姿态;所述变换矩阵用于表征所述第一机器人从所述初始位置和所述初始姿态移动至所述目标位置与所述目标姿态的过程中执行的动作;所述控制器根据所述第一矩阵变换、所述变换矩阵控制所述第一机器人运动,根据第三矩阵与所述变换矩阵控制所述第二机器人运动;其中,所述第三矩阵用于表征所述第二机器人相对于所述第一机器人的目标位置和目标姿态。
本发明的实施方式还提供了一种机器人控制方法,应用于上述的机器人控制系统,包括:获取第一矩阵变换到第二矩阵的变换矩阵;其中,所述第一矩阵用于表征所述第一机器人相对于预设参照物的初始位置和初始姿态,所述第二矩阵用于表征所述第一机器人相对于所述预设参照物的目标位置与目标姿态;所述变换矩阵用于表征所述第一机器人从所述初始位置和所述初始姿态移动至所述目标位置与所述目标姿态的过程中执行的动作;根据所述第一矩阵变换、所述变换矩阵控制所述第一机器人运动,根据第三矩阵与所述变换矩阵控制所述第二机器人运动;其中,所述第三矩阵用于表征所述第二机器人相对于所述第一机器人的目标位置和目标姿态。
本发明实施方式相对于现有技术而言,通过第一机器人的初始位置和初始姿态,以及第一机器人的目标位置与目标姿态,可以获取第一机器人运动过程中的变换矩阵,然后根据该变换矩阵控制第二机器人的运动,使得第二机器人可以跟随第一机器人并相对其做出预设的动作,拓展了机器人的应用范围。
另外,所述控制器具体包括:解算模块、第一机器人控制模块与第二机器人控制模块;所述解算模块与所述第一机器人控制模块、所述第二机器人控制模块均相连;所述解算模块根据所述第三矩阵与所述变换矩阵,得到第四矩阵;所述第四矩阵用于表征所述第二机器人相对于所述预设参照物的目标位置与目标姿态;所述解算模块还根据所述第二矩阵解算出所述第一机器人的各个关节轴的角度,根据所述第四矩阵解算出所述第二机器人的各个关节轴的角度;所述第一机器人控制模块,用于根据解算出的所述第一机器人的各个关节轴的角度,控制所述第一机器人的各个关节轴转动;所述第二机器人控制模块,用于根据解算出的所述第二机器人的各个关节轴的角度,控制所述第二机器人的各个关节轴转动。通过解算模块解算出的机器人的各个关节轴的角度,可以控制机器人动作,同时,两个以及两个以上的机器人采用同一个解算模块,可以降低系统功耗。
另外,所述第一机器人控制模块包括:轴控模块与虚拟轴;其中,所述轴控模块的数目等于所述虚拟轴的数目;所述轴控模块与所述虚拟轴一一对应连接;所述第一机器人包括伺服驱动器;所述伺服驱动器的数目等于所述第一机器人的关节轴的数目;所述虚拟轴与所述伺服驱动器通过实时现场总线通信连接;在所述机器人控制系统启动时,所述轴控模块,用于根据连接到所述第一机器人控制模块的所述伺服驱动器的数目,初始化虚拟轴;其中,初始化的虚拟轴的数目等于所述第一机器人的伺服驱动器的数目;所述轴控模块,还用于通过所述虚拟轴将指令发送至所述伺服驱动器;其中,所述指令包括所述第一机器人的各个关节轴的角度。这样,可以根据机器人的关节轴的数目为其配置相应的虚拟轴,每个虚拟轴对应一个轴控模块和伺服驱动器,实施起来灵活、方便,更利于仿真。
另外,所述第二机器人控制模块包括:轴控模块与虚拟轴;其中,所述轴控模块的数目等于所述虚拟轴的数目;所述轴控模块与所述虚拟轴一一对应连接;所述第二机器人包括伺服驱动器;所述伺服驱动器的数目等于所述第二机器人的关节轴的数目;所述虚拟轴与所述伺服驱动器通过实时现场总线通信连接;在所述机器人控制系统启动时,所述轴控模块,用于根据连接到所述第二机器人控制模块的所述伺服驱动器的数目,初始化虚拟轴;其中,初始化的虚拟轴的数目等于所述第二机器人的伺服驱动器的数目;所述轴控模块,还用于通过所述虚拟轴将指令发送至所述伺服驱动器;其中,所述指令包括所述第二机器人的各个关节轴的角度。这样,可以根据机器人的关节轴的数目为其配置相应的虚拟轴,每个虚拟轴对应一个轴控模块和伺服驱动器,实施起来灵活、方便。
另外,所述解算模块根据所述第二机器人的最大加速度、最大速度规划所述第一机器人的运动;所述解算模块,还根据规划的所述第一机器人的运动,获取所述变换矩阵。这样可以保证第二机器人在跟随第一机器人做动作时不会超过加速度与速度的限制。
附图说明
图1是根据本发明第一实施方式的机器人控制系统结构示意图;
图2是根据本发明第二实施方式的机器人控制系统结构示意图;
图3是根据本发明第三实施方式的机器人控制方法流程图;
图4是根据本发明第四实施方式的机器人控制方法流程图。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚,下面将结合附图对本发明的各实施方式进行详细的阐述。然而,本领域的普通技术人员可以理解,在本发明各实施方式中,为了使读者更好地理解本申请而提出了许多技术细节。但是,即使没有这些技术细节和基于以下各实施方式的种种变化和修改,也可以实现本申请所要求保护的技术方案。
本发明的第一实施方式涉及一种机器人控制系统,如图1所示,包含:控制器、第一机器人与第二机器人。其中控制器分别与第一机器人、第二机器人通信连接。
具体的说,控制器获取第一矩阵变换到第二矩阵的变换矩阵;其中,第一矩阵用于表征第一机器人相对于预设参照物的初始位置和初始姿态,第二矩阵用于表征第一机器人相对于预设参照物的目标位置与目标姿态;变换矩阵用于表征第一机器人从初始位置和初始姿态移动至目标位置与目标姿态的过程中执行的动作。
控制器根据第一矩阵变换、变换矩阵控制第一机器人运动,根据第三矩阵与变换矩阵控制第二机器人运动;其中,第三矩阵用于表征第二机器人相对于第一机器人的目标位置和目标姿态。
比如说,预设的参照物可以选取地面,表征第一机器人的初始位置和初始姿态的第一矩阵可以为T1,表征第一机器人的目标位置与目标姿态的第二矩阵可以为T2,表征第一机器人从初始位置和初始姿态移动至目标位置与目标姿态的过程中执行的动作的变换矩阵可以为T,则T1*T=T2,这样,就可以根据第一矩阵T1、变换矩阵T控制第一机器人运动至目标位置与目标姿态。同样,表征第二机器人相对于第一机器人的目标位置和目标姿态的第三矩阵可以用T3表示,可以根据第三矩阵T3与变换矩阵T控制第二机器人运动,实现第二机器人可以跟随运动的第一机器人并相对其做出预设的动作(T3)。
本实施方式相对于现有技术而言,通过第一机器人的初始位置和初始姿态,以及第一机器人的目标位置与目标姿态,可以获取第一机器人运动过程中的变换矩阵,然后根据该变换矩阵控制第二机器人的运动,使得第二机器人可以跟随第一机器人的运动并相对其做出预设的动作,拓展了机器人的应用范围。
本发明的第二实施方式涉及一种机器人控制系统。本实施方式中的控制器具体可以包括:解算模块、第一机器人控制模块与第二机器人控制模块,如图2所示,其中,解算模块与第一机器人控制模块、第二机器人控制模块均相连。
具体的说,本实施方式中同样可以选取底面为预设参照物,表征第二机器人相对于地面的目标位置与目标姿态的第四矩阵可以用T4表示,设T5用于表征第二机器人相对于第一机器人的初始位置和初始姿态,T6用于表征第二机器人相对于第一机器人的预设的动作;根据运动学可知,T4=T5*T6*T;其中,T3=T5*T6,所以,可得T4=T3*T。故而,解算模块可以根据第三矩阵与变换矩阵,得到第四矩阵。
由于T3为表征第二机器人相对于第一机器人的目标位置和目标姿态,因此可以根据第三矩阵T3与变换矩阵T控制第二机器人运动,实现第二机器人可以跟随第一机器人的运动并相对其做出预设的动作。
更具体地说,解算模块还可以根据第二矩阵解算出第一机器人的各个关节轴的角度,根据第四矩阵解算出第二机器人的各个关节轴的角度。然后,第一机器人控制模块根据解算出的第一机器人的各个关节轴的角度,控制第一机器人的各个关节轴转动;第二机器人控制模块根据解算出的第二机器人的各个关节轴的角度,控制第二机器人的各个关节轴转动。
在实际应用中,第一机器人控制模块还可以包含轴控模块与虚拟轴,其中,轴控模块的数目等于虚拟轴的数目,且轴控模块与虚拟轴一一对应连接,轴控模块的数目与虚拟轴的数目均可以设置多个。第一机器人包括伺服驱动器,该伺服驱动器的数目等于第一机器人的关节轴的数目,也就是说,第一机器人每个关节轴配备一个伺服驱动器,伺服驱动器与虚拟轴可以通过实时现场总线(比如Ethernet Powerlink、EtherCAT)通信连接。在机器人控制系统启动时,轴控模块可以根据连接到第一机器人控制模块的伺服驱动器的数目,初始化虚拟轴;其中,初始化的虚拟轴的数目等于第一机器人的伺服驱动器的数目。在解算模块解算出第一机器人的各个关节轴的角度之后,轴控模块通过虚拟轴向各个关节轴对应的伺服驱动器发送指令,其中,该指令包括第一机器人的各个关节轴的角度,用于控制第一机器人动作。
同样的,第二机器人控制模块也可以包含轴控模块与虚拟轴,其中,轴控模块的数目等于虚拟轴的数目,且轴控模块与虚拟轴一一对应连接。第二机器人也包括伺服驱动器,该伺服驱动器的数目等于第二机器人的关节轴的数目,也就是说,第二机器人每个关节轴配备一个伺服驱动器,且伺服驱动器与虚拟轴也可以通过实时现场总线(比如EthernetPowerlink、EtherCAT)通信连接。在机器人控制系统启动时,轴控模块可以根据连接到第二机器人控制模块的伺服驱动器的数目,初始化虚拟轴;其中,初始化的虚拟轴的数目等于第二机器人的伺服驱动器的数目。在解算模块解算出第二机器人的各个关节轴的角度之后,轴控模块通过虚拟轴向各个关节轴对应的伺服驱动器发送指令,其中,该指令包括第二机器人的各个关节轴的角度,用于控制第二机器人动作。
本实施方式中,根据机器人的关节轴的数目为其配置相应的虚拟轴,每个虚拟轴对应一个轴控模块和伺服驱动器,实施起来灵活、方便,更利于仿真。另外,通过解算模块解算出的机器人的各个关节轴的角度,并通过虚拟轴将包含各个关节轴角度的指令发送至各个对应的伺服驱动器,可以控制机器人动作,从而可以根据第一机器人位置变化来控制第二机器人动作,使得第二机器人可以跟随第一机器人的动作而做出相应的动作,拓展机器人的应用范围。
需要说明的是,在实际应用中,解算模块可以根据第二机器人的最大加速度、最大速度规划第一机器人的运动,并根据规划的第一机器人的运动,获取变换矩阵,这样可以保证第二机器人在跟随第一机器人做动作时不会超过加速度与速度的限制。另外,本实施方式的机器人控制系统同样适用于多个机器人的跟随动作,比如说,还可以包括第三机器人,第三机器人可以跟随第一机器人,也可以跟随第二机器人。
本发明第三实施方式涉及一种机器人控制方法,应用于第一或者第二实施方式中的机器人控制系统,本实施方式中机器人控制方法的流程如图3所示,具体如下:
在步骤301中,获取第一矩阵变换到第二矩阵的变换矩阵。具体的说,第一矩阵用于表征第一机器人相对于预设参照物的初始位置和初始姿态。第二矩阵用于表征第一机器人相对于预设参照物的目标位置与目标姿态;变换矩阵用于表征第一机器人从初始位置和初始姿态移动至目标位置与目标姿态的过程中执行的动作。
在步骤302中,根据第一矩阵变换、变换矩阵控制第一机器人运动。
在步骤303中,根据第三矩阵与变换矩阵控制第二机器人运动。具体的说,第三矩阵用于表征第二机器人相对于第一机器人的目标位置和目标姿态。
需要说明的是,步骤302与303也可以同时执行。
不难发现,本实施方式为与第一实施方式相对应的方法实施例,本实施方式可与第一实施方式互相配合实施。第一实施方式中提到的相关技术细节在本实施方式中依然有效,为了减少重复,这里不再赘述。相应地,本实施方式中提到的相关技术细节也可应用在第一实施方式中。
本发明第四实施方式涉及一种机器人控制方法。其流程如图4所示,具体如下:
在步骤401中,判断机器人控制系统是否启动。若是则进入步骤402,否则继续执行本步骤。
在步骤402中,根据连接到机器人控制系统的机器人的伺服驱动器的数目初始化虚拟轴。具体的说,根据连接到机器人控制系统的第一机器人的伺服驱动器的数目,初始化虚拟轴;其中,初始化的虚拟轴的数目等于第一机器人的伺服驱动器的数目。同时,还可以根据连接到机器人控制系统的第二机器人的伺服驱动器的数目,初始化虚拟轴;其中,初始化的虚拟轴的数目等于第二机器人的伺服驱动器的数目。
在步骤403中,获取第一矩阵变换到第二矩阵的变换矩阵。具体的说,第一矩阵用于表征第一机器人相对于预设参照物的初始位置和初始姿态。第二矩阵用于表征第一机器人相对于预设参照物的目标位置与目标姿态;变换矩阵用于表征第一机器人从初始位置和初始姿态移动至目标位置与目标姿态的过程中执行的动作。
在步骤404中,根据第二矩阵解算出第一机器人的各个关节轴的角度。
在步骤405中,根据解算出的第一机器人的各个关节轴的角度控制第一机器人的各个关节轴转动。具体的说,可以通过虚拟轴向第一机器人的伺服驱动器发送包括第一机器人的各个关节轴角度的指令,来控制第一机器人的各个关节轴转动。
在步骤406中,根据第三矩阵与变换矩阵得到第四矩阵。具体的说,第四矩阵用于表征第二机器人相对于预设参照物的目标位置与目标姿态。
在步骤407中,根据解算出的第二机器人的各个关节轴的角度,控制第二机器人的各个关节轴转动。具体的说,可以通过虚拟轴向第二机器人的伺服驱动器发送包括第二机器人的各个关节轴角度的指令,来控制第二机器人的各个关节轴转动。
需要说明的是,在实际应用中,解算模块可以根据第二机器人的最大加速度、最大速度规划第一机器人的运动,并根据规划的第一机器人的运动,获取变换矩阵,这样可以保证第二机器人在跟随第一机器人做动作时不会超过加速度与速度的限制。
另外,本实施方式的机器人控制系统同样适用于多个机器人的跟随动作,比如说,还可以包括第三机器人,第三机器人可以跟随第一机器人,也可以跟随第二机器人。
由于第二实施方式与本实施方式相互对应,因此本实施方式可与第二实施方式互相配合实施。第二实施方式中提到的相关技术细节在本实施方式中依然有效,在第二实施方式中所能达到的技术效果在本实施方式中也同样可以实现,为了减少重复,这里不再赘述。相应地,本实施方式中提到的相关技术细节也可应用在第二实施方式中。
本领域技术人员可以理解实现上述实施例方法中的全部或部分步骤是可以通过程序来指令相关的硬件来完成,该程序存储在一个存储介质中,包括若干指令用以使得一个设备(可以是单片机,芯片等)或处理器(processor)执行本申请各个实施例所述方法的全部或部分步骤。而前述的存储介质包括:U盘、移动硬盘、只读存储器(ROM,Read-OnlyMemory)、随机存取存储器(RAM,Random Access Memory)、磁碟或者光盘等各种可以存储程序代码的介质。
本领域的普通技术人员可以理解,上述各实施方式是实现本发明的具体实施例,而在实际应用中,可以在形式上和细节上对其作各种改变,而不偏离本发明的精神和范围。
Claims (10)
1.一种机器人控制系统,其特征在于,包括:控制器、第一机器人与第二机器人;所述控制器分别与所述第一机器人、所述第二机器人通信连接;
所述控制器获取第一矩阵变换到第二矩阵的变换矩阵;其中,所述第一矩阵用于表征所述第一机器人相对于预设参照物的初始位置和初始姿态,所述第二矩阵用于表征所述第一机器人相对于所述预设参照物的目标位置与目标姿态;所述变换矩阵用于表征所述第一机器人从所述初始位置和所述初始姿态移动至所述目标位置与所述目标姿态的过程中执行的动作;
所述控制器根据所述第一矩阵变换、所述变换矩阵控制所述第一机器人运动,根据第三矩阵与所述变换矩阵控制所述第二机器人运动;其中,所述第三矩阵用于表征所述第二机器人相对于所述第一机器人的目标位置和目标姿态。
2.根据权利要求1所述的机器人控制系统,其特征在于,所述控制器具体包括:解算模块、第一机器人控制模块与第二机器人控制模块;
所述解算模块与所述第一机器人控制模块、所述第二机器人控制模块均相连;
所述解算模块根据所述第三矩阵与所述变换矩阵,得到第四矩阵;所述第四矩阵用于表征所述第二机器人相对于所述预设参照物的目标位置与目标姿态;
所述解算模块还根据所述第二矩阵解算出所述第一机器人的各个关节轴的角度,根据所述第四矩阵解算出所述第二机器人的各个关节轴的角度;
所述第一机器人控制模块,用于根据解算出的所述第一机器人的各个关节轴的角度,控制所述第一机器人的各个关节轴转动;
所述第二机器人控制模块,用于根据解算出的所述第二机器人的各个关节轴的角度,控制所述第二机器人的各个关节轴转动。
3.根据权利要求2所述的机器人控制系统,其特征在于,所述第一机器人控制模块包括:轴控模块与虚拟轴;其中,所述轴控模块的数目等于所述虚拟轴的数目;所述轴控模块与所述虚拟轴一一对应连接;
所述第一机器人包括伺服驱动器;所述伺服驱动器的数目等于所述第一机器人的关节轴的数目;
所述虚拟轴与所述伺服驱动器通过实时现场总线通信连接;
在所述机器人控制系统启动时,所述轴控模块,用于根据连接到所述第一机器人控制模块的所述伺服驱动器的数目,初始化虚拟轴;其中,初始化的虚拟轴的数目等于所述第一机器人的伺服驱动器的数目;
所述轴控模块,还用于通过所述虚拟轴将指令发送至所述伺服驱动器;其中,所述指令包括所述第一机器人的各个关节轴的角度。
4.根据权利要求2所述的机器人控制系统,其特征在于,所述第二机器人控制模块包括:轴控模块与虚拟轴;其中,所述轴控模块的数目等于所述虚拟轴的数目;所述轴控模块与所述虚拟轴一一对应连接;
所述第二机器人包括伺服驱动器;所述伺服驱动器的数目等于所述第二机器人的关节轴的数目;
所述虚拟轴与所述伺服驱动器通过实时现场总线通信连接;
在所述机器人控制系统启动时,所述轴控模块,用于根据连接到所述第二机器人控制模块的所述伺服驱动器的数目,初始化虚拟轴;其中,初始化的虚拟轴的数目等于所述第二机器人的伺服驱动器的数目;
所述轴控模块,还用于通过所述虚拟轴将指令发送至所述伺服驱动器;其中,所述指令包括所述第二机器人的各个关节轴的角度。
5.根据权利要求2所述的机器人控制系统,其特征在于,所述解算模块根据所述第二机器人的最大加速度、最大速度规划所述第一机器人的运动;
所述解算模块,还根据规划的所述第一机器人的运动,获取所述变换矩阵。
6.一种机器人控制方法,其特征在于,应用于权利要求1至5任一项所述的机器人控制系统;所述机器人控制方法,包括:
获取第一矩阵变换到第二矩阵的变换矩阵;其中,所述第一矩阵用于表征所述第一机器人相对于预设参照物的初始位置和初始姿态,所述第二矩阵用于表征所述第一机器人相对于所述预设参照物的目标位置与目标姿态;所述变换矩阵用于表征所述第一机器人从所述初始位置和所述初始姿态移动至所述目标位置与所述目标姿态的过程中执行的动作;
根据所述第一矩阵变换、所述变换矩阵控制所述第一机器人运动,根据第三矩阵与所述变换矩阵控制所述第二机器人运动;其中,所述第三矩阵用于表征所述第二机器人相对于所述第一机器人的目标位置和目标姿态。
7.根据权利要求6所述的机器人控制方法,其特征在于,在根据所述第一矩阵变换、所述变换矩阵控制所述第一机器人运动中,具体包括:
根据所述第二矩阵解算出所述第一机器人的各个关节轴的角度;
根据解算出的所述第一机器人的各个关节轴的角度,控制所述第一机器人的各个关节轴转动;
在所述根据第三矩阵与所述变换矩阵控制所述第二机器人运动中,具体包括:
根据所述第三矩阵与所述变换矩阵,得到第四矩阵;所述第四矩阵用于表征所述第二机器人相对于所述预设参照物的目标位置与目标姿态;
根据解算出的所述第二机器人的各个关节轴的角度,控制所述第二机器人的各个关节轴转动。
8.根据权利要求7所述的机器人控制方法,其特征在于,还包括:
在所述机器人控制系统启动时,根据连接到所述机器人控制系统的所述第一机器人的伺服驱动器的数目,初始化虚拟轴;其中,初始化的虚拟轴的数目等于所述第一机器人的伺服驱动器的数目;
通过所述虚拟轴将指令发送至所述第一机器人的伺服驱动器;其中,所述指令包括所述第一机器人的各个关节轴的角度。
9.根据权利要求7所述的机器人控制方法,其特征在于,还包括:
在所述机器人控制系统启动时,根据连接到所述机器人控制系统的所述第二机器人的伺服驱动器的数目,初始化虚拟轴;其中,初始化的虚拟轴的数目等于所述第二机器人的伺服驱动器的数目;
通过所述虚拟轴将指令发送至所述第二机器人的伺服驱动器;其中,所述指令包括所述第二机器人的各个关节轴的角度。
10.根据权利要求7所述的机器人控制方法,其特征在于,在所述获取第一矩阵变换到第二矩阵的变换矩阵中,具体包括:
根据所述第二机器人的最大加速度、最大速度规划所述第一机器人的运动;
根据规划的所述第一机器人的运动,获取所述变换矩阵。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610637990.9A CN106113043B (zh) | 2016-08-06 | 2016-08-06 | 机器人控制系统及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610637990.9A CN106113043B (zh) | 2016-08-06 | 2016-08-06 | 机器人控制系统及方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106113043A true CN106113043A (zh) | 2016-11-16 |
CN106113043B CN106113043B (zh) | 2018-09-21 |
Family
ID=57254776
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610637990.9A Active CN106113043B (zh) | 2016-08-06 | 2016-08-06 | 机器人控制系统及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106113043B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107877513A (zh) * | 2017-10-18 | 2018-04-06 | 北京爱接力科技发展有限公司 | 一种机器人功能获取方法、服务器以及机器人 |
CN113276105A (zh) * | 2020-02-19 | 2021-08-20 | 苏州极智嘉机器人有限公司 | 一种机器人控制方法及装置 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2003181785A (ja) * | 2001-12-20 | 2003-07-02 | Yaskawa Electric Corp | 遠隔操作装置 |
US20100145521A1 (en) * | 2005-12-20 | 2010-06-10 | Intuitive Surgical, Inc. | Robotic surgical system with joint motion controller adapted to reduce instrument tip vibrations |
CN104116598A (zh) * | 2014-08-12 | 2014-10-29 | 上海申磬产业有限公司 | 机器人护理床、力觉康复系统及其主从控制方法 |
CN104440864A (zh) * | 2014-12-04 | 2015-03-25 | 深圳先进技术研究院 | 一种主从式遥操作工业机器人系统及其控制方法 |
CN105073349A (zh) * | 2013-03-19 | 2015-11-18 | 松下知识产权经营株式会社 | 机器人系统的控制方法以及机器人系统 |
CN105751196A (zh) * | 2016-04-12 | 2016-07-13 | 华南理工大学 | 一种基于主从式的工业机器人协作作业方法 |
-
2016
- 2016-08-06 CN CN201610637990.9A patent/CN106113043B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2003181785A (ja) * | 2001-12-20 | 2003-07-02 | Yaskawa Electric Corp | 遠隔操作装置 |
US20100145521A1 (en) * | 2005-12-20 | 2010-06-10 | Intuitive Surgical, Inc. | Robotic surgical system with joint motion controller adapted to reduce instrument tip vibrations |
CN105073349A (zh) * | 2013-03-19 | 2015-11-18 | 松下知识产权经营株式会社 | 机器人系统的控制方法以及机器人系统 |
CN104116598A (zh) * | 2014-08-12 | 2014-10-29 | 上海申磬产业有限公司 | 机器人护理床、力觉康复系统及其主从控制方法 |
CN104440864A (zh) * | 2014-12-04 | 2015-03-25 | 深圳先进技术研究院 | 一种主从式遥操作工业机器人系统及其控制方法 |
CN105751196A (zh) * | 2016-04-12 | 2016-07-13 | 华南理工大学 | 一种基于主从式的工业机器人协作作业方法 |
Non-Patent Citations (1)
Title |
---|
徐志峰: "主从式远程操作机器人系统研究", 《中国优秀博硕士学位论文全文数据库(硕士) 信息科技辑》 * |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107877513A (zh) * | 2017-10-18 | 2018-04-06 | 北京爱接力科技发展有限公司 | 一种机器人功能获取方法、服务器以及机器人 |
CN107877513B (zh) * | 2017-10-18 | 2020-11-03 | 北京爱接力科技发展有限公司 | 一种机器人功能获取方法、服务器以及机器人 |
CN113276105A (zh) * | 2020-02-19 | 2021-08-20 | 苏州极智嘉机器人有限公司 | 一种机器人控制方法及装置 |
CN113276105B (zh) * | 2020-02-19 | 2022-12-30 | 苏州极智嘉机器人有限公司 | 一种机器人控制方法及装置 |
Also Published As
Publication number | Publication date |
---|---|
CN106113043B (zh) | 2018-09-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Dietrich et al. | Extensions to reactive self-collision avoidance for torque and position controlled humanoids | |
CN106737662A (zh) | 机器人系统 | |
CN111309039A (zh) | 一种四足机器人姿态控制方法和装置 | |
JP6696465B2 (ja) | コントロールシステム、コントローラ及び制御方法 | |
CN109870648A (zh) | 舵机堵转检测方法、装置及舵机 | |
CN106113043A (zh) | 机器人控制系统及方法 | |
CN106527439A (zh) | 一种运动控制方法和装置 | |
CN106625687A (zh) | 一种关节机器人运动学建模方法 | |
CN109311155B (zh) | 一种工业机器人的工具坐标系原点的标定方法及装置 | |
CN110039546A (zh) | 用于控制机器人动作的方法及机器人 | |
Zhiyong et al. | Picking robot arm trajectory planning method | |
Murakami et al. | Motion planning for catching a light-weight ball with high-speed visual feedback | |
CN107520838A (zh) | 机械手臂及其控制方法和装置 | |
EP3784448A1 (en) | Method and control system for controlling movement trajectories of a robot | |
Nardi et al. | Art azzurra robot team | |
CN106573379A (zh) | 机器人控制器、机器人单元和用于控制机器人单元的操作的方法 | |
CN109807891A (zh) | 设备运动处理方法及装置 | |
Ha et al. | Wireless-communicated computed-torque control of a SCARA robot and two-dimensional input shaping for a spherical pendulum | |
Fabregas et al. | Two Mobile Robots Platforms for Experimentation: Comparison and Synthesis. | |
CN110253569B (zh) | 用于控制机器人运动的运动控制部件、系统以及方法 | |
Charitkhuan et al. | FPGA implementation of closed-loop control system for small-sized RoboCup | |
RU2019125003A (ru) | Способ приведения в движение экзоскелета | |
Munoz-Vazquez et al. | Passive force/velocity field control for contour tracking of constrained robots | |
Choi et al. | Software platform for the Industrial Dual-arm Robot | |
Ata et al. | Soft motion trajectory for planar redundant manipulator |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |