CN110666800A - 一种具有多线程策略示教器的工业机器人 - Google Patents
一种具有多线程策略示教器的工业机器人 Download PDFInfo
- Publication number
- CN110666800A CN110666800A CN201911019396.3A CN201911019396A CN110666800A CN 110666800 A CN110666800 A CN 110666800A CN 201911019396 A CN201911019396 A CN 201911019396A CN 110666800 A CN110666800 A CN 110666800A
- Authority
- CN
- China
- Prior art keywords
- industrial robot
- demonstrator
- interface
- control
- control system
- 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.)
- Pending
Links
- 230000007246 mechanism Effects 0.000 claims abstract description 35
- 230000000007 visual effect Effects 0.000 claims abstract description 21
- 238000004891 communication Methods 0.000 claims description 46
- 230000006870 function Effects 0.000 claims description 24
- 230000005540 biological transmission Effects 0.000 claims description 15
- 239000012636 effector Substances 0.000 claims description 13
- 230000008859 change Effects 0.000 claims description 12
- 230000003993 interaction Effects 0.000 claims description 12
- 210000000707 wrist Anatomy 0.000 claims description 12
- 230000001360 synchronised effect Effects 0.000 claims description 11
- 230000003287 optical effect Effects 0.000 claims description 10
- 238000004422 calculation algorithm Methods 0.000 claims description 9
- 238000005516 engineering process Methods 0.000 claims description 9
- 239000003638 chemical reducing agent Substances 0.000 claims description 8
- 230000008878 coupling Effects 0.000 claims description 7
- 238000010168 coupling process Methods 0.000 claims description 7
- 238000005859 coupling reaction Methods 0.000 claims description 7
- 238000002955 isolation Methods 0.000 claims description 6
- 238000000034 method Methods 0.000 claims description 6
- 238000013139 quantization Methods 0.000 claims description 6
- 230000004044 response Effects 0.000 claims description 6
- 238000004458 analytical method Methods 0.000 claims description 5
- 238000012544 monitoring process Methods 0.000 claims description 5
- 238000006243 chemical reaction Methods 0.000 claims description 4
- 238000007726 management method Methods 0.000 claims description 4
- 238000012545 processing Methods 0.000 claims description 4
- 230000008901 benefit Effects 0.000 claims description 3
- 238000001514 detection method Methods 0.000 claims description 3
- 238000007667 floating Methods 0.000 claims description 3
- 238000012423 maintenance Methods 0.000 claims description 3
- 239000011159 matrix material Substances 0.000 claims description 3
- 230000002093 peripheral effect Effects 0.000 claims description 3
- 238000004088 simulation Methods 0.000 claims description 3
- 230000009471 action Effects 0.000 claims description 2
- 238000004364 calculation method Methods 0.000 claims description 2
- 238000012937 correction Methods 0.000 claims description 2
- 230000000694 effects Effects 0.000 claims description 2
- 230000009466 transformation Effects 0.000 claims description 2
- 238000010586 diagram Methods 0.000 description 6
- 238000004519 manufacturing process Methods 0.000 description 3
- 230000004048 modification Effects 0.000 description 3
- 238000012986 modification Methods 0.000 description 3
- 230000001133 acceleration Effects 0.000 description 2
- 239000002699 waste material Substances 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 231100000481 chemical toxicant Toxicity 0.000 description 1
- 239000013078 crystal Substances 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 229920005994 diacetyl cellulose Polymers 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 230000007774 longterm Effects 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 238000004886 process control Methods 0.000 description 1
- 230000005855 radiation Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 239000003440 toxic substance Substances 0.000 description 1
- 238000012546 transfer 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
- B25J13/00—Controls for manipulators
- B25J13/02—Hand grip control means
- B25J13/025—Hand grip control means comprising haptic means
-
- 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/10—Programme-controlled manipulators characterised by positioning means for manipulator elements
- B25J9/106—Programme-controlled manipulators characterised by positioning means for manipulator elements with articulated links
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Human Computer Interaction (AREA)
- Automation & Control Theory (AREA)
- Numerical Control (AREA)
Abstract
一种具有多线程策略示教器的工业机器人,包括工业机器人控制***、传感器***、操控***、网络集成控制***、视觉跟踪***以及执行机构,传感器***与工业机器人控制***连接,工业机器人控制***包括示教器、运动控制器,示教器由手轮、钥匙开关、USB接口、指示灯、按键、急停开关、触摸笔、触摸屏、以太网接口、手托、安全开关、处理器组成,通过触摸屏可进行相关参数进行设置和编程,触摸屏上同时显示执行机构和运动控制器的当前状态信息,执行机构的手动和自动功能则通过示教器面板上的按键操作实现。
Description
技术领域
本发明属于工业机器人领域,特别涉及一种具有多线程策略示教器的工业机器人。
背景技术
随着当前工业自动化水平越来越高,在各行各业占有越来越重要的地位,它们能够娴熟、精准地执行多种复杂任务,这些任务由于环境或者其他因素的限制可能是人根本无法完成的。工业机器人的应用场景主要有汽车零部件制造和装配、机械自动化制造、有毒化工产品生产、标准流水线作业、高危环境设备安装、核辐射场地作业、极限环境作业等。
现有技术中示教器传输速率慢、安全性不高,无法实时实现对工业机器人的示教,并且容易被网络攻击。
发明内容
本发明要解决的技术问题是如何快速实时安全的实现对工业机器人的示教,对此本发明提供一种具有多线程策略示教器的工业机器人,
本发明的技术方案为:
一种具有多线程策略示教器的工业机器人,包括工业机器人控制***、传感器***、操控***、网络集成控制***、视觉跟踪***以及执行机构,传感器***与工业机器人控制***连接,
操控***通过网络集成控制***接收传感器***和视觉跟踪***的数据并向工业机器人控制***发送控制指令,工业机器人控制***控制执行机构,传感器***安装在执行机构上,实时监控执行机构的位姿状态,传感器***、视觉跟踪***还与工业机器人控制***连接用于实时反馈执行机构的工作状态以及监控周围环境,
其中,工业机器人控制***包括示教器、运动控制器,
其中,操控***包括工控机,
其中,视觉跟踪***包括RGB摄像机、激光扫描仪、跟踪摄像机,射频收发射装置,
其中,传感器***包括多个六轴传感器、光学传感器、运动传感器、霍尔电流传感器,
其中,执行机构包括机械部分和电力部分,
网络集成控制***搜索局域网内存在的工业机器人并连接到相应的运动控制器,运行运动传感器并清零六轴传感器,运动传感器采集执行机构的末端执行器位姿信息来引导工业机器人的运动,并实时显示在示教器的屏幕上。
工业机器人通信分为两级:第一级通信是操控***与工业机器人控制***的通信,采用串行通信技术或者网络通讯技术;第二级通信是工业机器人控制***与传感器***、视觉跟踪***之间的通信,采用工业现场总线通信技术。
其中,示教器由手轮、钥匙开关、USB接口、指示灯、按键、急停开关、触摸笔、触摸屏、以太网接口、手托、安全开关、处理器组成,通过触摸屏可进行相关参数进行设置和编程,触摸屏上同时显示执行机构和运动控制器的当前状态信息,执行机构的手动和自动功能则通过示教器面板上的按键操作实现。
示教器通过以太网与运动控制器连接,以太网的连接使用Socket套接字来实现通信,待传输数据组织成符合制定协议的工作交给Socket来完成,实现机器人示教器与运动控制器之间跨平台的分布式处理***,Socket通信具有的传输速率快、性能高、安全性强等优点,能够满足机器人示教器与控制器的通信要求。
示教器的处理器采用多线程策略,按照功能将其主要划分为以下四个部分:
通信部分,负责传递示教器和运动控制器之间的信息传输,示教器向运动控制器发送指令来控制机器人运动,从运动控制器获取各个关节当前的转角大小信息,通信部分封装了Socket的创建连接模块、网络检测维护模块、传输数据组包解析模块、接收发送模块及数据缓存区;
数据接口部分,封装了传输数据读写操作模块;
人机交互界面显示部分(HMI),定义了示教***运行的各种界面,包括主界面、手动操作界面、自动操作界面、回零操作界面、参数设置界面、历史状态信息查询界面;
按键响应部分,对示教器面板上的按键、指示灯、手轮和蜂鸣器等的响应进行了定义和设置;参数设置部分,对***速度、工具坐标、***时间、运动参数、各转轴极限角度进行设置;
程序编辑部分,包含了程序指令的***、修改、删除、复制和剪切功能。为了满足仿真***的应用需求,应按照实际的程序和指令格式来进行相关的操作;
程序解释部分,用于示教器的核记,负责解释机器人程序,获得程序中的指令类型以及路径点信息;
文件管理部分,负责程序的创建、删除、复制、重命名操作;
辅助功能部分,实现帮助信息、指令说明、安全保护功能;
信息提示功能部分,包括操作信息提示以及错误警告信息提示,方便操作者的使用并保障操作安全。
本发明的有益效果:;
(1)示教器使用多线程策略,传输速率快、性能高、安全性好;
(2)示教器与运动控制器之间为跨平台的分布式处理***,能够满足机器人示教器与运动控制器的实时通信要求。
(3)使用光耦隔离电路极大提高了硬件的可靠性;
(4)使用二级通信,实现了对工业机器人的灵活控制;
(5)执行机构使用平行四边形,增加了整个结构刚度,增加***稳定性;
(6)运动控制器包括容错控制层,对算法控制层进行实时监控,保证***安全可靠性运作;
(7)通过模糊控制自动有效实现工业机器人伺服电机的精确控制,减少了人工设定的反复修改带来的效率上浪费以及精度的不准确。
附图说明
图1为本发明的工业机器人***框图;
图2为本发明的执行机构的机械结构图;
图3为本发明的示教器组成结构图;
图4为本发明的示教器工作原理图;
图5为本发明的运动控制器结构示意图;
图6为本发明的模糊控制方法原理图;
具体实施方式
下面结合附图对本发明作进一步的说明。
一种具有多线程策略示教器的工业机器人,包括工业机器人控制***、传感器***、操控***、网络集成控制***、视觉跟踪***以及执行机构,传感器***与工业机器人控制***连接,
操控***通过网络集成控制***接收传感器***和视觉跟踪***的数据并向工业机器人控制***发送控制指令,工业机器人控制***控制执行机构,传感器***安装在执行机构上,实时监控执行机构的位姿状态,传感器***、视觉跟踪***还与工业机器人控制***连接用于实时反馈执行机构的工作状态以及监控周围环境,
其中,工业机器人控制***包括示教器、运动控制器,
其中,操控***包括工控机,
其中,视觉跟踪***包括RGB摄像机、激光扫描仪、跟踪摄像机,射频收发射装置,
其中,传感器***包括多个六轴传感器、光学传感器、运动传感器、霍尔电流传感器,
其中,执行机构包括机械部分和电力部分,
网络集成控制***搜索局域网内存在的工业机器人并连接到相应的运动控制器,运行运动传感器并清零六轴传感器,运动传感器采集执行机构的末端执行器位姿信息来引导工业机器人的运动,并实时显示在示教器的屏幕上。
工业机器人通信分为两级:第一级通信是操控***与工业机器人控制***的通信,采用串行通信技术或者网络通讯技术;第二级通信是工业机器人控制***与传感器***、视觉跟踪***之间的通信,采用工业现场总线通信技术。
其中,机械部分包括底座、连接件、大臂、小臂、腕部、末端执行器以及旋转关节,旋转关节分别位于底座与连接件之间、连接件与大臂之间、大臂与小臂之间以及腕部与末端执行器之间,底座是承重基础部件,固定在地面或支架上,连接件是大臂的支撑部件,实现机器人的回转功能,连接件在底座上进行旋转,大臂是小臂的支撑部件,大臂的摆动改变末端执行器在水平方向上的行程,小臂的俯仰实现末端执行器在垂直方向上的位置变换,腕部的末端执行器旋转关节调整承载目标的旋转角度和位置。
底座的关节座与轴线垂直于地面的旋转关节联接,关节座安装在底座上,为大臂提供支撑,其上安装有大臂、小臂和保持腕部水平的连杆,大臂、小臂与连杆相互构成平行四边形,增加了整个臂部的刚度,通过串联平行四边形机构的叠加效应,满足腕部的易控性,腕部是法兰盘,根据用户的不同需要,在法兰盘上联接真空吸盘。
该结构增加整个臂部的刚度,平行四边形的相互作用,增加了整个机器人传动***的刚度,减小了启动与急停情况下造成的机器人颤动,行程放大,减小***惯量,节约成本,同时增加了***的稳定性,搬运机器人利用“平行四边形”原理简化了机器人位姿的控制,降低了过程控制的难度,可以缩短机器人的工作周期和研发设计成本。
其中,电力部分包括编码器、解码电路、光耦隔离电路、永磁同步伺服电机(PMSM)、减速器以及智能功率控制模块(IPM),霍尔电流传感器采集永磁同步伺服电机的U相和V相电流,反馈给运动控制器,编码器通过解码电路实时向运动控制器反馈永磁同步伺服电机实际位置,运动控制器通过串行总线接收目标位置信息,目标位置、实际位置和实际电流在运动控制器内做单轴逻辑控制,通过矢量控制的时序调度输出脉宽调制通过光耦隔离电路提供给智能功率控制模块并转换为功率控制信号,光耦隔离电路实现控制部分电路和功率部分电路完全隔离,极大提高了硬件的可靠性,智能功率控制模块驱动永磁同步伺服电机运转,永磁同步伺服电机输出轴与减速器,减速器与机械部分的旋转关节连接,减速器受运动控制器的控制,实现动作的精细化调整。
其中,示教器由手轮、钥匙开关、USB接口、指示灯、按键、急停开关、触摸笔、触摸屏、以太网接口、手托、安全开关、处理器组成,通过触摸屏可进行相关参数进行设置和编程,触摸屏上同时显示执行机构和运动控制器的当前状态信息,执行机构的手动和自动功能则通过示教器面板上的按键操作实现。
示教器通过以太网与运动控制器连接,以太网的连接使用Socket套接字来实现通信,待传输数据组织成符合制定协议的工作交给Socket来完成,实现机器人示教器与运动控制器之间跨平台的分布式处理***,Socket通信具有的传输速率快、性能高、安全性强等优点,能够满足机器人示教器与控制器的通信要求。
示教器的处理器采用多线程策略,按照功能将其主要划分为以下几个个部分:
通信部分,负责传递示教器和运动控制器之间的信息传输,示教器向运动控制器发送指令来控制机器人运动,从运动控制器获取各个关节当前的转角大小信息,通信部分封装了Socket的创建连接模块、网络检测维护模块、传输数据组包解析模块、接收发送模块及数据缓存区;
数据接口部分,封装了传输数据读写操作模块;
人机交互界面显示部分(HMI),定义了示教***运行的各种界面,包括主界面、手动操作界面、自动操作界面、回零操作界面、参数设置界面、历史状态信息查询界面;
按键响应部分,对示教器面板上的按键、指示灯、手轮和蜂鸣器等的响应进行了定义和设置;参数设置部分,对***速度、工具坐标、***时间、运动参数、各转轴极限角度进行设置;
程序编辑部分,包含了程序指令的***、修改、删除、复制和剪切功能。为了满足仿真***的应用需求,应按照实际的程序和指令格式来进行相关的操作;
程序解释部分,用于示教器的核记,负责解释机器人程序,获得程序中的指令类型以及路径点信息;
文件管理部分,负责程序的创建、删除、复制、重命名操作;
辅助功能部分,实现帮助信息、指令说明、安全保护功能;
信息提示功能部分,包括操作信息提示以及错误警告信息提示,方便操作者的使用并保障操作安全。
其中,运动控制器连接工控机和执行机构,运动控制器为半封装的微型计算机***,集成了二字符指令集及其解析功能,利用与运动控制器配套的辅助工具,能够进行***设置,运动控制器由处理器、看门狗、通信接口和电机控制模块组成,
处理器为片上***(SOC),包括接口层、算法控制层以及容错控制层,其中接口层为FPGA结构,负责与电机控制模块进行信息交互,控制伺服装置,算法控制层为ARM和DSP双核结构,ARM核负责各类外设驱动,DSP端负责运动学建模、轨迹规划等大量矩阵浮点类计算,容错控制层使用32位控制器,对接口层、算法控制层进行实时监控,并根据反馈、操作命令对故障进行容错规划,保证***安全可靠性运作,容错控制层使用伺服定标方法,同时扩展视觉反馈接口,实现了后期视觉反馈的二次修正;
其中,接口层设置有***接口电路,实现了与伺服装置进行包括指令发送、反馈数据接收在内的数据交互,采用总线收发器增强端口驱动力;设置EMIF接口与算法控制层完成信息交互;设置UART接口与容错控制层建立通信,完成监控交互;设置FPGA时钟,外部时钟选择有源40Mhz晶振,为了进行FPGA调试、加载程序这里同时引入JTAG和AS两种模式。
算法控制层包括电源管理模块、时钟模块、内存电路、闪存电路、外设SATA接口、接口电路6部分组成,算法控制层与容错控制层完成信息交互确保***可靠性工作,接收接口层发送的交流伺服位置信息,进行工业机器人正逆运动学建模,进行矩阵浮点类运算,驱动外部设备,与视觉跟踪***完成信息交互。
通信接口包括RS-232端口和以太网端口;
电机控制模块以最高12MHz的频率对输入的正弦方波信号进行处理,产生1个±10V的模拟量;对于弦波整流操作,使用2个DACs来产生2个±10V电压模拟信号;
看门狗的定时器绑定了放大器使能输出,一旦运动控制器由于内部或外部因素导致出现***错误时,看门狗就会将放大器关闭,通常情况下看门狗输出的是高电平,上电运行期间如果处理器功能紊乱,看门狗输出低电平,看门狗定时器检测到之后就会复位运动控制器。
运动控制器接收到工控机经过网络集成控制***发来的控制指令后,根据控制指令执行相对应的程序生成速度信号、计数信号以及加减速度信号,向永磁同步伺服电机发送转动的速度信号,向减速器发送计数信号和加减速度信号,永磁同步伺服电机的伺服装置收到信号之后,对其进行调整、放大处理,生成转动信号发送至电机,电机驱动旋转关节转动,运动控制器将安装在各个旋转关节的永磁同步伺服电机的编码器的反馈信号经过网络集成控制***回传给工控机,反馈信号用于在工控机上的人机交互界面中实时地监控工业机器人的状态并显示数据。
运动控制器设定机器人各关节的零点位姿,零点位姿决定于工业机器人在初始状态时时各个永磁同步伺服电机的位置,零点位姿被运动控制器记录,在工业机器人完成作业后,通过发送零位指令使工业机器人回到零点位姿,从而完成回零。
其中,工控机包括模糊控制装置,模糊控制装置具体为:模糊控制装置包括差分器、微分器、模糊化接口、输出量转换模块、推理机、知识库,负载估计模块将测得的伺服电机的测量负载电压通过带通滤波器提供给差分器,差分器将操作人员输入的设定负载电压与测量负载电压相减得到误差值E,误差值E经过微分器得到误差变化率dE/dt,误差值E和误差变化率dE/dt提供给模糊化接口,对误差值E和误差变化率dE/dt进行模糊化赋值,分别得到模糊化误差值ME和模糊化误差变化值MEC,模糊化误差值ME和模糊化误差变化值MEC提供给推理机,推理机根据知识库中的输入输出隶属度矢量值以及逻辑推理规则对模糊化误差值ME和模糊化误差变化值MEC进行模糊推理得到模糊控制量MU,输出量转换模块将模糊控制量MU转换为实际控制量U,根据实际控制量U控制电源向伺服电机提供电压。
模糊控制装置为可编程逻辑控制器,可编程逻辑控制器与主控器的处理器之间采用RS232通信。
其中,模糊控制方法具体为:按照操作人员的语言变量的选取参量PL、PB、PM、PS、ZO、NS、NM、NB、BL分别表示正超大、正大、正中、正小、零、负小、负中、负大、负超大,对应的模糊集{-n,-n+1,......,0,......,n-1,n},n=4,n为初级模糊集变量;
确定量化因子,ke=n/e,其中,ke为误差值量化因子,e为测量的最大误差值,kec=n/ec,kec为误差变化率量化因子,ec为测量的最大误差变化率,
如果m≤keE≤m+1,m<n,则模糊化误差值ME为经过四舍五入的keE,m为次级模糊集变量;
如果keE<-n,则模糊化误差值ME为-n;
如果keE>n,则模糊化误差值ME为n;
如果m≤kecE≤m+1,m<n,则模糊化误差变化值MEC为经过四舍五入的kecE;
如果kecE<-n,则模糊化误差变化值MEC为-n;
如果kecE>n,则模糊化误差变化值MEC为n。
进一步的说,知识库包括数据库以及规则库,
数据库中存放输入、输出变量的模糊隶属度矢量值,此矢量值是输入、输出量经过对应论域等离散化后所对应值的集合,所对应论域若是连续的,则可作为为隶属度函数,对于输入的模糊变量,隶属度函数保存于数据库中,在模糊推理关系中向推理机提供数据。
规则库中存储有模糊规则,模糊规则是操作人员长期积累的经验并结合专家知识的基础上形成的,由相关的逻辑关系的词汇来表达,例如if-then、else、end、and、or等。
通过模糊控制可以自动有效实现工业机器人伺服电机的精确控制,减少了人工设定的反复修改带来的效率上浪费以及精度的不准确。
以上所述实施方式仅表达了本发明的一种实施方式,但并不能因此而理解为对本发明范围的限制。应当指出,对于本领域的普通技术人员来说,在不脱离本发明构思的前提下,还可以做出若干变形和改进,这些都属于本发明的保护范围。
Claims (11)
1.一种具有多线程策略示教器的工业机器人,包括工业机器人控制***、传感器***、操控***、网络集成控制***、视觉跟踪***以及执行机构,传感器***与工业机器人控制***连接,
其中,工业机器人控制***包括示教器、运动控制器,
其中,操控***包括工控机,
其中,视觉跟踪***包括RGB摄像机、激光扫描仪、跟踪摄像机,射频收发射装置,
其中,传感器***包括多个六轴传感器、光学传感器、运动传感器、霍尔电流传感器,
其中,执行机构包括机械部分和电力部分,
其中,示教器由手轮、钥匙开关、USB接口、指示灯、按键、急停开关、触摸笔、触摸屏、以太网接口、手托、安全开关、处理器组成,通过触摸屏可进行相关参数进行设置和编程,触摸屏上同时显示执行机构和运动控制器的当前状态信息,执行机构的手动和自动功能则通过示教器面板上的按键操作实现。
2.根据权利要求1所述的一种具有多线程策略示教器的工业机器人,其特征在于:示教器通过以太网与运动控制器连接,以太网的连接使用Socket套接字来实现通信,待传输数据组织成符合制定协议的工作交给Socket来完成,实现机器人示教器与运动控制器之间跨平台的分布式处理***,Socket通信具有的传输速率快、性能高、安全性强等优点,能够满足机器人示数器与控制器的通信要求。
3.根据权利要求1所述的一种具有多线程策略示教器的工业机器人,其特征在于:示教器的处理器采用多线程策略,按照功能将其主要划分为以下几个个部分:
通信部分,负责传递示教器和运动控制器之间的信息传输,示教器向运动控制器发送指令来控制机器人运动,从运动控制器获取各个关节当前的转角大小信息,通信部分封装了Socket的创建连接模块、网络检测维护模块、传输数据组包解析模块、接收发送模块及数据缓存区;
数据接口部分,封装了传输数据读写操作模块;
人机交互界面显示部分(HMI),定义了示教***运行的各种界面,包括主界面、手动操作界面、自动操作界面、回零操作界面、参数设置界面、历史状态信息查询界面;
按键响应部分,对示教器面板上的按键、指示灯、手轮和蜂鸣器等的响应进行了定义和设置;
参数设置部分,对***速度、工具坐标、***时间、运动参数、各转轴极限角度进行设置;
程序编辑部分,包含了程序指令的***、修改、删除、复制和剪切功能。为了满足仿真***的应用需求,应按照实际的程序和指令格式来进行相关的操作;
程序解释部分,用于示教器的核记,负责解释机器人程序,获得程序中的指令类型以及路径点信息;
文件管理部分,负责程序的创建、删除、复制、重命名操作;
辅助功能部分,实现帮助信息、指令说明、安全保护功能;
信息提示功能部分,包括操作信息提示以及错误警告信息提示,方便操作者的使用并保障操作安全。
4.根据权利要求1所述的一种具有多线程策略示教器的工业机器人,其特征在于:运动控制器连接工控机和执行机构,运动控制器为半封装的微型计算机***,集成了二字符指令集及其解析功能,利用与运动控制器配套的辅助工具,能够进行***设置,运动控制器由处理器、看门狗、通信接口和电机控制模块组成,处理器为片上***(SOC),包括接口层、算法控制层以及容错控制层,其中接口层为FPGA结构,负责与电机控制模块进行信息交互,控制伺服装置,算法控制层为ARM和DSP双核结构,ARM核负责各类外设驱动,DSP端负责运动学建模、轨迹规划等大量矩阵浮点类计算,容错控制层使用32位控制器,对接口层、算法控制层进行实时监控,并根据反馈、操作命令对故障进行容错规划,保证***安全可靠性运作,容错控制层使用伺服定标方法,同时扩展视觉反馈接口,实现了后期视觉反馈的二次修正。
5.根据权利要求1所述的一种具有多线程策略示教器的工业机器人,其特征在于:工控机包括模糊控制装置,模糊控制装置具体为:模糊控制装置包括差分器、微分器、模糊化接口、输出量转换模块、推理机、知识库,负载估计模块将测得的伺服电机的测量负载电压通过带通滤波器提供给差分器,差分器将操作人员输入的设定负载电压与测量负载电压相减得到误差值E,误差值E经过微分器得到误差变化率dE/dt,误差值E和误差变化率dE/dt提供给模糊化接口,对误差值E和误差变化率dE/dt进行模糊化赋值,分别得到模糊化误差值ME和模糊化误差变化值MEC,模糊化误差值ME和模糊化误差变化值MEC提供给推理机,推理机根据知识库中的输入输出隶属度矢量值以及逻辑推理规则对模糊化误差值ME和模糊化误差变化值MEC进行模糊推理得到模糊控制量MU,输出量转换模块将模糊控制量MU转换为实际控制量U,根据实际控制量U控制电源向伺服电机提供电压。
6.根据权利要求5所述的一种具有多线程策略示教器的工业机器人,其特征在于模糊控制方法具体为:按照操作人员的语言变量的选取参量PL、PB、PM、PS、ZO、NS、NM、NB、BL分别表示正超大、正大、正中、正小、零、负小、负中、负大、负超大,对应的模糊集{-n,-n+1,......,0,......,n-1,n},n=4,n为初级模糊集变量;
确定量化因子,ke=n/e,其中,ke为误差值量化因子,e为测量的最大误差值,kec=n/ec,kec为误差变化率量化因子,ec为测量的最大误差变化率,
如果m≤keE≤m+1,m<n,则模糊化误差值ME为经过四舍五入的keE,m为次级模糊集变量;
如果keE<-n,则模糊化误差值ME为-n;
如果keE>n,则模糊化误差值ME为n;
如果m≤kecE≤m+1,m<n,则模糊化误差变化值MEC为经过四舍五入的kecE;
如果kecE<-n,则模糊化误差变化值MEC为-n;
如果kecE>n,则模糊化误差变化值MEC为n。
7.根据权利要求1所述的一种具有多线程策略示教器的工业机器人,其特征在于:其中,机械部分包括底座、连接件、大臂、小臂、腕部、末端执行器以及旋转关节,旋转关节分别位于底座与连接件之间、连接件与大臂之间、大臂与小臂之间以及腕部与末端执行器之间,底座是承重基础部件,固定在地面或支架上,连接件是大臂的支撑部件,实现机器人的回转功能,连接件在底座上进行旋转,大臂是小臂的支撑部件,大臂的摆动改变末端执行器在水平方向上的行程,小臂的俯仰实现末端执行器在垂直方向上的位置变换,腕部的末端执行器旋转关节调整承载目标的旋转角度和位置。
8.根据权利要求7所述的一种具有多线程策略示教器的工业机器人,其特征在于:底座的关节座与轴线垂直于地面的旋转关节联接,关节座安装在底座上,为大臂提供支撑,其上安装有大臂、小臂和保持腕部水平的连杆,大臂、小臂与连杆相互构成平行四边形,增加了整个臂部的刚度,通过串联平行四边形机构的叠加效应,满足腕部的易控性,腕部是法兰盘,根据用户的不同需要,在法兰盘上联接真空吸盘。
9.根据权利要求1所述的一种具有多线程策略示教器的工业机器人,其特征在于电力部分包括编码器、解码电路、光耦隔离电路、永磁同步伺服电机(PMSM)、减速器以及智能功率控制模块(IPM),霍尔电流传感器采集永磁同步伺服电机的U相和V相电流,反馈给运动控制器,编码器通过解码电路实时向运动控制器反馈永磁同步伺服电机实际位置,运动控制器通过串行总线接收目标位置信息,目标位置、实际位置和实际电流在运动控制器内做单轴逻辑控制,通过矢量控制的时序调度输出脉宽调制通过光耦隔离电路提供给智能功率控制模块并转换为功率控制信号,光耦隔离电路实现控制部分电路和功率部分电路完全隔离,极大提高了硬件的可靠性,智能功率控制模块驱动永磁同步伺服电机运转,永磁同步伺服电机输出轴与减速器,减速器与机械部分的旋转关节连接,减速器受运动控制器的控制,实现动作的精细化调整。
10.根据权利要求1所述的一种具有多线程策略示教器的工业机器人,其特征在于:操控***通过网络集成控制***接收传感器***和视觉跟踪***的数据并向工业机器人控制***发送控制指令,工业机器人控制***控制执行机构,传感器***安装在执行机构上,实时监控执行机构的位姿状态,传感器***、视觉跟踪***还与工业机器人控制***连接用于实时反馈执行机构的工作状态以及监控周围环境。
11.根据权利要求1所述的一种具有多线程策略示教器的工业机器人,其特征在于:网络集成控制***搜索局域网内存在的工业机器人并连接到相应的运动控制器,运行运动传感器并清零六轴传感器,运动传感器采集执行机构的末端执行器位姿信息来引导工业机器人的运动,并实时显示在示教器的屏幕上;
工业机器人通信分为两级:第一级通信是操控***与工业机器人控制***的通信,采用串行通信技术或者网络通讯技术;第二级通信是工业机器人控制***与传感器***、视觉跟踪***之间的通信,采用工业现场总线通信技术。
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811320524 | 2018-11-07 | ||
CN2018113205243 | 2018-11-07 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN110666800A true CN110666800A (zh) | 2020-01-10 |
Family
ID=69084419
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911019396.3A Pending CN110666800A (zh) | 2018-11-07 | 2019-10-24 | 一种具有多线程策略示教器的工业机器人 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110666800A (zh) |
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111459574A (zh) * | 2020-02-25 | 2020-07-28 | 季华实验室 | 数据的传输方法、装置、设备及存储介质 |
CN111624893A (zh) * | 2020-06-10 | 2020-09-04 | 杭州凯尔达机器人科技股份有限公司 | 示教器、示教器信号传输方法及*** |
CN111843997A (zh) * | 2020-07-29 | 2020-10-30 | 上海大学 | 一种机械臂手持通用示教***及其操作方法 |
CN112454317A (zh) * | 2020-11-20 | 2021-03-09 | 爱佩仪测量设备有限公司 | 用于三坐标测量划线机的助力划线模块 |
CN112621767A (zh) * | 2021-01-07 | 2021-04-09 | 重庆智能机器人研究院 | 一种人工智能示教器 |
CN112847300A (zh) * | 2020-12-19 | 2021-05-28 | 北京工业大学 | 一种基于移动工业机器人示教器的示教***及其示教方法 |
CN113910245A (zh) * | 2021-11-17 | 2022-01-11 | 珠海格力智能装备有限公司 | 基于大数据聚类的工业机器人控制方法 |
CN114347048A (zh) * | 2020-10-14 | 2022-04-15 | 达明机器人股份有限公司 | 具有手拉功能的机器人*** |
CN114619425A (zh) * | 2020-12-08 | 2022-06-14 | 山东新松工业软件研究院股份有限公司 | 一种示教器主控板及新型洁净机器人示教器 |
CN115151888A (zh) * | 2020-02-19 | 2022-10-04 | 发那科株式会社 | 具备项目显示迁移功能的显示*** |
CN115847431A (zh) * | 2023-02-27 | 2023-03-28 | 深圳市越疆科技股份有限公司 | 机械臂的路点设置方法、装置、电子设备及存储介质 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105945950A (zh) * | 2016-06-03 | 2016-09-21 | 广东伊雪松机器人设备有限公司 | 便于搬运工件的夹具及码垛机器人及其操作方法 |
CN106179625A (zh) * | 2016-07-09 | 2016-12-07 | 青岛大学 | 一种对主轴电机模糊控制的研磨化工机械*** |
CN206484557U (zh) * | 2017-01-13 | 2017-09-12 | 东莞市申易达工业机器人有限公司 | 一种关节式机器人 |
US20170305014A1 (en) * | 2016-04-25 | 2017-10-26 | Kindred Systems Inc. | Facilitating device control |
CN108567543A (zh) * | 2018-04-11 | 2018-09-25 | 韩姝 | 一种具有智能调速的综合口腔治疗*** |
-
2019
- 2019-10-24 CN CN201911019396.3A patent/CN110666800A/zh active Pending
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20170305014A1 (en) * | 2016-04-25 | 2017-10-26 | Kindred Systems Inc. | Facilitating device control |
CN105945950A (zh) * | 2016-06-03 | 2016-09-21 | 广东伊雪松机器人设备有限公司 | 便于搬运工件的夹具及码垛机器人及其操作方法 |
CN106179625A (zh) * | 2016-07-09 | 2016-12-07 | 青岛大学 | 一种对主轴电机模糊控制的研磨化工机械*** |
CN206484557U (zh) * | 2017-01-13 | 2017-09-12 | 东莞市申易达工业机器人有限公司 | 一种关节式机器人 |
CN108567543A (zh) * | 2018-04-11 | 2018-09-25 | 韩姝 | 一种具有智能调速的综合口腔治疗*** |
Non-Patent Citations (5)
Title |
---|
周伟: "基于虚拟现实的工业机器人仿真***的研究与开发", 《中国优秀硕士学位论文全文数据库 信息科技辑》 * |
夏飞虎: "基于以太网和WinCE的工业机器人示教器***研究与设计", 《中国优秀硕士学位论文全文数据库 信息科技辑》 * |
姚绪梁: "《电伺服***及其在船舶运动控制中的应用》", 31 July 2009, 哈尔滨工程大学出版社 * |
施文龙: "六轴工业机器人控制***的研究与实现", 《中国优秀硕士学位论文全文数据库 信息科技辑》 * |
李钟: "基于DSP_ARM的工业机器人控制***设计与实现", 《中国优秀硕士学位论文全文数据库 信息科技辑》 * |
Cited By (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115151888A (zh) * | 2020-02-19 | 2022-10-04 | 发那科株式会社 | 具备项目显示迁移功能的显示*** |
CN111459574A (zh) * | 2020-02-25 | 2020-07-28 | 季华实验室 | 数据的传输方法、装置、设备及存储介质 |
CN111459574B (zh) * | 2020-02-25 | 2024-03-08 | 季华实验室 | 数据的传输方法、装置、设备及存储介质 |
CN111624893A (zh) * | 2020-06-10 | 2020-09-04 | 杭州凯尔达机器人科技股份有限公司 | 示教器、示教器信号传输方法及*** |
CN111843997A (zh) * | 2020-07-29 | 2020-10-30 | 上海大学 | 一种机械臂手持通用示教***及其操作方法 |
CN114347048A (zh) * | 2020-10-14 | 2022-04-15 | 达明机器人股份有限公司 | 具有手拉功能的机器人*** |
CN112454317A (zh) * | 2020-11-20 | 2021-03-09 | 爱佩仪测量设备有限公司 | 用于三坐标测量划线机的助力划线模块 |
CN114619425A (zh) * | 2020-12-08 | 2022-06-14 | 山东新松工业软件研究院股份有限公司 | 一种示教器主控板及新型洁净机器人示教器 |
CN112847300A (zh) * | 2020-12-19 | 2021-05-28 | 北京工业大学 | 一种基于移动工业机器人示教器的示教***及其示教方法 |
CN112621767A (zh) * | 2021-01-07 | 2021-04-09 | 重庆智能机器人研究院 | 一种人工智能示教器 |
CN113910245A (zh) * | 2021-11-17 | 2022-01-11 | 珠海格力智能装备有限公司 | 基于大数据聚类的工业机器人控制方法 |
CN115847431A (zh) * | 2023-02-27 | 2023-03-28 | 深圳市越疆科技股份有限公司 | 机械臂的路点设置方法、装置、电子设备及存储介质 |
CN115847431B (zh) * | 2023-02-27 | 2023-05-09 | 深圳市越疆科技股份有限公司 | 机械臂的路点设置方法、装置、电子设备及存储介质 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110666800A (zh) | 一种具有多线程策略示教器的工业机器人 | |
CN110666802A (zh) | 一种具有双核运动控制器工业机器人平台 | |
CN102581745B (zh) | 一种化学机械抛光传输机器人*** | |
CN105033996B (zh) | 基于手推示教式五轴水平关节机器人的控制*** | |
CN110640742A (zh) | 一种多模态监控的工业机器人平台 | |
CN103786157A (zh) | 基于上肢外骨骼助力机器人的嵌入式控制*** | |
Cai et al. | Modeling Method of Autonomous Robot Manipulator Based on D‐H Algorithm | |
Zhonglin et al. | Design and function realization of nuclear power inspection robot system | |
Xu et al. | Nonlinear sliding mode control of manipulator based on iterative learning algorithm. | |
CN102841558B (zh) | 五轴全自动高速点胶机器人伺服控制*** | |
CN117047774A (zh) | 基于滑膜自适应的多关节液压机械臂伺服控制方法及*** | |
CN110666803A (zh) | 一种rf中心定位工件的抓取工业机器人 | |
Ma et al. | Plantbot: A new ROS-based robot platform for fast building and developing | |
Pan et al. | Control system of a small intelligent inspection robot for nuclear power plant use | |
CN106003029A (zh) | 一种教学用三核快速关节机器人控制*** | |
CN110640740A (zh) | 一种具有两级减速减速器的工业机器人平台 | |
Feng et al. | Mechanical Design Method and Joint Simulation Analysis of Industrial Robots Based on Trajectory Planning Algorithm and Kinematics | |
Li et al. | Design of a Control system Based on Beck Hoff TwinCAT Nursing Robot | |
Chen | Research on the design of mechanical robot control system for industrial PC in the context of big data | |
Lei et al. | Vision-based position/impedance control for robotic assembly task | |
CN211639921U (zh) | 一种基于引导式dqn控制的机械臂控制器 | |
Zheng et al. | Design of Control System for Power Supply Aerial Work Equipment Loading Device Based on Intelligent Algorithm | |
You et al. | Design of dsp-based open control system for industrial robot | |
Guo et al. | Hardware Design and Realization of the Motion Controller of Industrial Robot with Six Degrees of Freedom | |
Wang | Research on kinematic parameter calibration technology of industrial robot |
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 | ||
TA01 | Transfer of patent application right |
Effective date of registration: 20200805 Address after: Room 1207, building 8, block B, R & D Park, Ningbo, Zhejiang Province, 315000 Applicant after: Zhang Huanhuan Address before: 315000 No.014, 3 / F, building 2, No.128 Jingyuan Road, Ningbo hi tech Zone, Zhejiang Province Applicant before: NINGBO SAILANG TECHNOLOGY Co.,Ltd. |
|
TA01 | Transfer of patent application right | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20200110 |
|
RJ01 | Rejection of invention patent application after publication |