CN110497408B - 一种人机协作工业机器人驱控一体系统 - Google Patents
一种人机协作工业机器人驱控一体系统 Download PDFInfo
- Publication number
- CN110497408B CN110497408B CN201910758358.3A CN201910758358A CN110497408B CN 110497408 B CN110497408 B CN 110497408B CN 201910758358 A CN201910758358 A CN 201910758358A CN 110497408 B CN110497408 B CN 110497408B
- Authority
- CN
- China
- Prior art keywords
- robot
- module
- sensor
- man
- control chip
- 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
- 238000006243 chemical reaction Methods 0.000 claims abstract description 18
- 239000000284 extract Substances 0.000 claims description 3
- 238000012544 monitoring process Methods 0.000 claims description 3
- 238000000034 method Methods 0.000 description 5
- 230000009471 action Effects 0.000 description 3
- 230000008569 process Effects 0.000 description 3
- 230000003466 anti-cipated effect Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000004044 response Effects 0.000 description 2
- 230000004075 alteration Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000008034 disappearance Effects 0.000 description 1
- 230000009977 dual effect Effects 0.000 description 1
- 239000012636 effector Substances 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000009776 industrial production Methods 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 238000006467 substitution reaction 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/1602—Programme controls characterised by the control system, structure, architecture
-
- 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
-
- 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/1694—Programme controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
- Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
- Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Manipulator (AREA)
- Numerical Control (AREA)
Abstract
本发明公开了一种人机协作工业机器人驱控一体系统,包括电机电流采集模块、DA转换模块、控制芯片、驱动电机和人机协作模块,所述电机电流采集模块的输出端与DA转换模块的输入端电性连接,所述DA转换模块的输出端和人机协作模块的输出端均与控制芯片的输入端电性连接,所述控制芯片的输出端与驱动电机的输入端电性连接,所述人机协作模块包括传感器一、传感器二、目标识别定位模块、意图预测器、意图知识库和预期运动规划器。本发明通过设置电机电流采集模块、DA转换模块、控制芯片、驱动电机和人机协作模块,提高了机器人的安全性,并且可以进行人机协作作业,操作人员可以与工业机器人进行协同工作,可以对机器人进行拖动示教。
Description
技术领域
本发明涉及工业机器人技术领域,具体为一种人机协作工业机器人驱控一体系统。
背景技术
随着我国人口红利的消失,机器人取代工人显得越来越迫切,它在工业生产中所扮演的角色越来越重要,机器人顺利工作前的重要步骤是机器人的示教,目前,机器人的示教工作主要是依赖于工人操作示教器来完成的,然而,这种方式的缺陷很多,如示教效率低,示教过程复杂,并且需要操作员掌握一定的机器人使用知识,机器人拖动示教,就是操作员可以直接拖着机器人各关节,运动到理想的姿态,记录下来,但是现有的工业机器人驱控系统在使用时不方便,机器与操作人员之间难以交互协作,且示教的精确性不够,局限性较大,因此有必要对现有技术进行改进,以解决上述问题。
发明内容
(一)解决的技术问题
本发明的目的在于提供一种人机协作工业机器人驱控一体系统,以解决上述背景技术中提出的机器与操作人员之间难以交互协作,且示教的精确性不够,局限性较大的问题。
(二)技术方案
为实现上述目的,本发明提供如下技术方案:一种人机协作工业机器人驱控一体系统,包括电机电流采集模块、DA转换模块、控制芯片、驱动电机和人机协作模块,所述电机电流采集模块的输出端与DA转换模块的输入端电性连接,所述DA转换模块的输出端和人机协作模块的输出端均与控制芯片的输入端电性连接,所述控制芯片的输出端与驱动电机的输入端电性连接,所述人机协作模块包括传感器一、传感器二、目标识别定位模块、意图预测器、意图知识库和预期运动规划器。
优选的,所述人机协作模块进行人机协作作业的步骤设置为:
S1:操作人员进行拖动示教,通过传感器一监测机器人关节的力矩信息,通过传感器二捕捉操作人员的肢体信息,并将其传给目标识别定位模块;
S2:目标识别定位模块提取传感器信息并进行定位,将两个传感器的监测信息整合起来,并将数据传给意图预测器,意图预测器将数据与意图知识库内的数据进行比对,从而可确定人体所要表达的命令信息,并将命令信息传给预期运动规划器;
S3:预期运动规划器生成运动规划命令,并传给控制芯片,控制芯片再控制机器人进行动作,从而可完成人机协作作业。
优选的,所述控制芯片设置为单芯多核异构SoC芯片。
优选的,所述传感器一设置为力矩传感器,安装在机器人关节处,所述传感器一设置有若干个,若干个所述传感器一分散设置在机器人的各个关节处。
优选的,所述传感器二设置为惯性传感器,佩戴在操作人员的肢体上,所述传感器二设置有若干个,若干个所述传感器二分散佩戴在操作人员的各个部位。
(三)有益效果
与现有技术相比,本发明的有益效果是:
(1)本发明通过设置电机电流采集模块、DA转换模块、控制芯片和驱动电机,通过电机电流采集模块进行电流信息采集并传给DA转换模块进行数据转换,然后再反馈到控制芯片,控制芯片根据反馈的电流计算出施加在机械臂上的外力,并以单芯多核异构SoC芯片的62.5us的周期响应,若外力超过机器人的承受范围,则控制芯片控制驱动电机停止运动,从而可提高机器人的安全性。
(2)本发明通过设置传感器一和传感器二,传感器一监测机器人关节的力矩信息,传感器二捕捉操作人员的肢体信息,通过传感器一和传感器二的双重作用,使得拖动示教的精确性得到大大提高,机器人与操作人员之间相交互,协同工作。
附图说明
图1为本发明整体原理框图;
图2为本发明人机协作模块原理图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
请参阅图1-2,本发明提供的一种实施例:一种人机协作工业机器人驱控一体系统,包括电机电流采集模块、DA转换模块、控制芯片、驱动电机和人机协作模块,所述电机电流采集模块的输出端与DA转换模块的输入端电性连接,所述DA转换模块的输出端和人机协作模块的输出端均与控制芯片的输入端电性连接,所述控制芯片的输出端与驱动电机的输入端电性连接,所述人机协作模块包括传感器一、传感器二、目标识别定位模块、意图预测器、意图知识库和预期运动规划器。
进一步,人机协作模块进行人机协作作业的步骤设置为:
S1:操作人员进行拖动示教,通过传感器一监测机器人关节的力矩信息,通过传感器二捕捉操作人员的肢体信息,并将其传给目标识别定位模块;
S2:目标识别定位模块提取传感器信息并进行定位,将两个传感器的监测信息整合起来,并将数据传给意图预测器,意图预测器将数据与意图知识库内的数据进行比对,从而可确定人体所要表达的命令信息,并将命令信息传给预期运动规划器;
S3:预期运动规划器生成运动规划命令,并传给控制芯片,控制芯片再控制机器人进行动作,从而可完成人机协作作业。
进一步,控制芯片设置为单芯多核异构SoC芯片,单芯多核异构SoC芯片,具有很高的系统响应速度,电流环响应周期达到62.5us。
进一步,传感器一设置为力矩传感器,安装在机器人关节处,所述传感器一设置有若干个,若干个所述传感器一分散设置在机器人的各个关节处,力矩传感器配合控制芯片中的算法,操作人员牵引机器人末端执行器做线性或者旋转的运动,检测出用户施加在该处的外力信息。
进一步,传感器二设置为惯性传感器,佩戴在操作人员的肢体上,所述传感器二设置有若干个,若干个所述传感器二分散佩戴在操作人员的各个部位,利用每个传感器二传来的数据,系统算法计算处每个传感器二的相对三维位置,进而可提取操作人员的肢体信息。
工作原理:机器人驱动电机的电流通过电机电流采集模块进行采集并传给DA转换模块进行转换,然后再反馈到控制芯片,控制芯片根据反馈的电流计算出施加在机械臂上的外力,并以62.5us的周期响应,若外力超过机器人的承受范围,则控制芯片控制驱动电机停止运动,从而可提高机器人的安全性,通过设置人机协作模块使得可以进行人机协作作业,操作人员可以与工业机器人进行协同工作,亦可以对机器人进行拖动示教,通过传感器一监测机器人关节的力矩信息,通过传感器二捕捉操作人员的肢体信息,然后控制系统整合多个传感器的数据,并与意图知识库内的命令信息进行比对,进而可确定操作人员所要表达的操作意图,通过预期运动规划器规划处机器人将要执行的运动轨迹,最后控制芯片根据运动轨迹控制机器人开始运动。
需要说明的是,在本文中,诸如第一和第二等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来,而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。而且,术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、物品或者设备不仅包括那些要素,而且还包括没有明确列出的其他要素,或者是还包括为这种过程、方法、物品或者设备所固有的要素。
尽管已经示出和描述了本发明的实施例,对于本领域的普通技术人员而言,可以理解在不脱离本发明的原理和精神的情况下可以对这些实施例进行多种变化、修改、替换和变型,本发明的范围由所附权利要求及其等同物限定。
Claims (4)
1.一种人机协作工业机器人驱控一体系统,包括电机电流采集模块、DA转换模块、控制芯片、驱动电机和人机协作模块,其特征在于:所述电机电流采集模块的输出端与DA转换模块的输入端电性连接,所述DA转换模块的输出端和人机协作模块的输出端均与控制芯片的输入端电性连接,所述控制芯片的输出端与驱动电机的输入端电性连接,所述人机协作模块包括传感器一、传感器二、目标识别定位模块、意图预测器、意图知识库和预期运动规划器;所述人机协作模块进行人机协作作业的步骤设置为:
S1:操作人员进行拖动示教,通过传感器一监测机器人关节的力矩信息,通过传感器二捕捉操作人员的肢体信息,并将其传给目标识别定位模块;
S2:目标识别定位模块提取传感器信息并进行定位,将两个传感器的监测信息整合起来,并将数据传给意图预测器,意图预测器将数据与意图知识库内的数据进行比对,从而可确定人体所要表达的命令信息,并将命令信息传给预期运动规划器;
S3:预期运动规划器生成运动规划命令,并传给控制芯片,控制芯片再控制机器人进行动作,从而可完成人机协作作业。
2.根据权利要求1所述的一种人机协作工业机器人驱控一体系统,其特征在于:所述控制芯片设置为单芯多核异构SoC芯片。
3.根据权利要求1所述的一种人机协作工业机器人驱控一体系统,其特征在于:所述传感器一设置为力矩传感器,安装在机器人关节处,所述传感器一设置有若干个,若干个所述传感器一分散设置在机器人的各个关节处。
4.根据权利要求1所述的一种人机协作工业机器人驱控一体系统,其特征在于:所述传感器二设置为惯性传感器,佩戴在操作人员的肢体上,传感器二设置有若干个,若干个传感器二分散佩戴在操作人员的各个部位。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910758358.3A CN110497408B (zh) | 2019-08-16 | 2019-08-16 | 一种人机协作工业机器人驱控一体系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910758358.3A CN110497408B (zh) | 2019-08-16 | 2019-08-16 | 一种人机协作工业机器人驱控一体系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110497408A CN110497408A (zh) | 2019-11-26 |
CN110497408B true CN110497408B (zh) | 2022-08-16 |
Family
ID=68588127
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910758358.3A Active CN110497408B (zh) | 2019-08-16 | 2019-08-16 | 一种人机协作工业机器人驱控一体系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110497408B (zh) |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO1997010080A1 (fr) * | 1995-09-14 | 1997-03-20 | Kabushiki Kaisha Yaskawa Denki | Unite d'enseignement pour robots |
CN105058396A (zh) * | 2015-07-31 | 2015-11-18 | 深圳先进技术研究院 | 机器人示教系统及其控制方法 |
JP6392910B2 (ja) * | 2017-01-13 | 2018-09-19 | ファナック株式会社 | ロボットの安全確保動作機能を備えた人間協働ロボットシステム |
CN108789408A (zh) * | 2018-06-20 | 2018-11-13 | 上海交通大学 | 基于力矩传感器的协作机器人驱控一体化控制系统 |
CN109129417A (zh) * | 2018-08-13 | 2019-01-04 | 深圳市智能机器人研究院 | 基于压力传感器阵列的协作机器人系统及其实现方法 |
-
2019
- 2019-08-16 CN CN201910758358.3A patent/CN110497408B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN110497408A (zh) | 2019-11-26 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107891425B (zh) | 智能双臂安全协作人机共融型机器人系统的控制方法 | |
CN103398702B (zh) | 一种移动机器人远程操控装置及其操控技术 | |
CN203266646U (zh) | 四自由度重载关节机器人控制系统 | |
CN102179815B (zh) | 基于CANopen的分布式模块化机械臂系统 | |
CN105033996B (zh) | 基于手推示教式五轴水平关节机器人的控制系统 | |
CN101504546B (zh) | 一种儿童机器人的体位跟踪装置 | |
CN102176222A (zh) | 多传感器信息采集分析系统及自闭症儿童监护辅助系统 | |
CN110497405B (zh) | 用于驱控一体化控制系统的力反馈人机协作防碰撞检测方法及模块 | |
CN104997262A (zh) | 一种智能助力行李箱及其控制方法 | |
CN105643607A (zh) | 一种具备感知和认知能力的智能工业机器人 | |
CN103412492B (zh) | 多机电系统分布式智能同步控制装置及方法 | |
CN102819272A (zh) | 一种遥操作机器人力反馈控制系统及控制方法 | |
CN110181521A (zh) | 确定机器人轨迹的操作控制方法及其控制系统 | |
CN103056883B (zh) | 一种双机械臂协调控制系统及控制方法 | |
CN113183147A (zh) | 一种具有远距离接近觉的大面积覆盖电子皮肤系统 | |
CN111309152A (zh) | 一种基于意图识别和阻抗匹配的人机柔性交互系统及方法 | |
CN110497408B (zh) | 一种人机协作工业机器人驱控一体系统 | |
CN105904456A (zh) | 手持式力反馈装置以及利用该装置实现力觉再现的方法 | |
CN201410665Y (zh) | 基于机器视觉的工业机器人运动控制装置 | |
CN206484559U (zh) | 基于三维力传感器的机器人示教系统 | |
CN103495969A (zh) | 一种基于接触式传感器的柔性铰链并联机器人控制装置 | |
CN107717983A (zh) | 一种仿人机械臂示教控制方法 | |
CN202677196U (zh) | 一种基于fpga的agv接口板 | |
CN110293565A (zh) | 一种远程操控工业机器人作业的控制系统 | |
CN216442542U (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 | ||
CP03 | Change of name, title or address |
Address after: 518000, Building 9, 101, 102, 201, 202, 301, 302, Yunli Intelligent Park, Shutianpu Community, Matian Street, Guangming District, Shenzhen City, Guangdong Province Patentee after: SHENZHEN HUAZHONG NUMERICAL CONTROL Co.,Ltd. Address before: 518000 floor 11, block a, Shenzhen industry university research base, Huazhong University of science and technology, South District, high tech Zone, Nanshan District, Shenzhen, Guangdong Patentee before: SHENZHEN HUASHU ROBOT Co.,Ltd. |
|
CP03 | Change of name, title or address |