CN110666802A - 一种具有双核运动控制器工业机器人平台 - Google Patents
一种具有双核运动控制器工业机器人平台 Download PDFInfo
- Publication number
- CN110666802A CN110666802A CN201911019912.2A CN201911019912A CN110666802A CN 110666802 A CN110666802 A CN 110666802A CN 201911019912 A CN201911019912 A CN 201911019912A CN 110666802 A CN110666802 A CN 110666802A
- Authority
- CN
- China
- Prior art keywords
- motion controller
- industrial robot
- control
- interface
- dual
- 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 24
- 230000000007 visual effect Effects 0.000 claims abstract description 22
- 230000003993 interaction Effects 0.000 claims abstract description 18
- 238000004422 calculation algorithm Methods 0.000 claims abstract description 16
- 238000007667 floating Methods 0.000 claims abstract description 6
- 239000011159 matrix material Substances 0.000 claims abstract description 6
- 230000002093 peripheral effect Effects 0.000 claims abstract description 6
- 238000004364 calculation method Methods 0.000 claims abstract description 3
- 238000012937 correction Methods 0.000 claims abstract description 3
- 238000004891 communication Methods 0.000 claims description 34
- 239000003638 chemical reducing agent Substances 0.000 claims description 18
- 230000001360 synchronised effect Effects 0.000 claims description 17
- 230000006870 function Effects 0.000 claims description 15
- 239000012636 effector Substances 0.000 claims description 12
- 230000008859 change Effects 0.000 claims description 11
- 230000003287 optical effect Effects 0.000 claims description 10
- 238000002955 isolation Methods 0.000 claims description 9
- 210000000707 wrist Anatomy 0.000 claims description 9
- 238000000034 method Methods 0.000 claims description 8
- 230000005540 biological transmission Effects 0.000 claims description 7
- 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
- 238000012544 monitoring process Methods 0.000 claims description 6
- 238000013139 quantization Methods 0.000 claims description 6
- 230000001133 acceleration Effects 0.000 claims description 4
- 238000004458 analytical method Methods 0.000 claims description 4
- 238000006243 chemical reaction Methods 0.000 claims description 4
- 238000007726 management method Methods 0.000 claims description 3
- 230000009471 action Effects 0.000 claims description 2
- 230000008901 benefit Effects 0.000 claims description 2
- 239000013078 crystal Substances 0.000 claims description 2
- 229920005994 diacetyl cellulose Polymers 0.000 claims description 2
- 230000008569 process Effects 0.000 claims description 2
- 238000012545 processing Methods 0.000 claims description 2
- 230000009466 transformation Effects 0.000 claims description 2
- 230000009977 dual effect Effects 0.000 claims 3
- 238000010586 diagram Methods 0.000 description 6
- 238000005516 engineering process 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
- 230000004044 response 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
- 238000013461 design Methods 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000000694 effects Effects 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
- 238000012423 maintenance Methods 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
- 238000004088 simulation 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)
- Automation & Control Theory (AREA)
- Human Computer Interaction (AREA)
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
一种具有双核运动控制器工业机器人平台,包括工业机器人控制系统、传感器系统、操控系统、网络集成控制系统、视觉跟踪系统以及执行机构,传感器系统与工业机器人控制系统连接,处理器为片上系统,包括接口层、算法控制层以及容错控制层,其中接口层为FPGA结构,负责与电机控制模块进行信息交互,控制伺服装置,算法控制层为ARM和DSP双核结构,ARM核负责各类外设驱动,DSP端负责运动学建模、轨迹规划等大量矩阵浮点类计算,容错控制层使用32位控制器,对接口层、算法控制层进行实时监控,并根据反馈、操作命令对故障进行容错规划,保证系统安全可靠性运作,容错控制层使用伺服定标方法,同时扩展视觉反馈接口,实现了后期视觉反馈的二次修正。
Description
技术领域
本发明属于工业机器人领域,特别涉及一种具有双核运动控制器工业机器人平台。
背景技术
随着当前工业自动化水平越来越高,在各行各业占有越来越重要的地位,它们能够娴熟、精准地执行多种复杂任务,这些任务由于环境或者其他因素的限制可能是人根本无法完成的。工业机器人的应用场景主要有汽车零部件制造和装配、机械自动化制造、有毒化工产品生产、标准流水线作业、高危环境设备安装、核辐射场地作业、极限环境作业等。
现有技术中运动控制器为单核结构,控制不够精确和稳定。
发明内容
本发明要解决的技术问题是如何稳定精确控制工业机器人,对此本发明提供一种具有双核运动控制器工业机器人平台,
本发明的技术方案为:一种具有双核运动控制器工业机器人平台,包括工业机器人控制系统、传感器系统、操控系统、网络集成控制系统、视觉跟踪系统以及执行机构,传感器系统与工业机器人控制系统连接,
操控系统通过网络集成控制系统接收传感器系统和视觉跟踪系统的数据并向工业机器人控制系统发送控制指令,工业机器人控制系统控制执行机构,传感器系统安装在执行机构上,实时监控执行机构的位姿状态,传感器系统、视觉跟踪系统还与工业机器人控制系统连接用于实时反馈执行机构的工作状态以及监控周围环境,
其中,工业机器人控制系统包括示教器、运动控制器,
其中,操控系统包括工控机,
其中,视觉跟踪系统包括RGB摄像机、激光扫描仪、跟踪摄像机,射频收发射装置,
其中,传感器系统包括多个六轴传感器、光学传感器、运动传感器、霍尔电流传感器,
其中,执行机构包括机械部分和电力部分,
网络集成控制系统搜索局域网内存在的工业机器人并连接到相应的运动控制器,运行运动传感器并清零六轴传感器,运动传感器采集执行机构的末端执行器位姿信息来引导工业机器人的运动,并实时显示在示教器的屏幕上。
工业机器人通信分为两级:第一级通信是操控系统与工业机器人控制系统的通信,采用串行通信技术或者网络通讯技术;第二级通信是工业机器人控制系统与传感器系统、视觉跟踪系统之间的通信,采用工业现场总线通信技术。
其中,运动控制器连接工控机和执行机构,运动控制器为半封装的微型计算机系统,集成了二字符指令集及其解析功能,利用与运动控制器配套的辅助工具,能够进行系统设置,运动控制器由处理器、看门狗、通信接口和电机控制模块组成,
处理器为片上系统(SOC),包括接口层、算法控制层以及容错控制层,其中接口层为FPGA结构,负责与电机控制模块进行信息交互,控制伺服装置,算法控制层为ARM和DSP双核结构,ARM核负责各类外设驱动,DSP端负责运动学建模、轨迹规划等大量矩阵浮点类计算,容错控制层使用32位控制器,对接口层、算法控制层进行实时监控,并根据反馈、操作命令对故障进行容错规划,保证系统安全可靠性运作,容错控制层使用伺服定标方法,同时扩展视觉反馈接口,实现了后期视觉反馈的二次修正。
本发明的有益效果:
(1)使用了具备ARM和DSP的结构的双核结构的运动控制器,实现了对工业机器人的精确稳定控制;
(2)使用光耦隔离电路极大提高了硬件的可靠性;
(3)使用二级通信,实现了对工业机器人的灵活控制;
(4)执行机构使用平行四边形,增加了整个结构刚度,增加系统稳定性;
(5)通过模糊控制自动有效实现工业机器人减速器的精确控制,减少了人工设定的反复修改带来的效率上浪费以及精度的不准确;
(6)使用多线程策略示教器,传输速率快、性能高、安全性好。
附图说明
图1为本发明的工业机器人系统框图;
图2为本发明的执行机构的机械结构图;
图3为为本发明的运动控制器结构示意图;
图4为本发明的模糊控制方法原理图;
图5为本发明的示教器组成结构图;
图6为本发明的示教器工作原理图;
具体实施方式
下面结合附图对本发明作进一步的说明。
一种具有双核运动控制器工业机器人平台,包括工业机器人控制系统、传感器系统、操控系统、网络集成控制系统、视觉跟踪系统以及执行机构,传感器系统与工业机器人控制系统连接,
操控系统通过网络集成控制系统接收传感器系统和视觉跟踪系统的数据并向工业机器人控制系统发送控制指令,工业机器人控制系统控制执行机构,传感器系统安装在执行机构上,实时监控执行机构的位姿状态,传感器系统、视觉跟踪系统还与工业机器人控制系统连接用于实时反馈执行机构的工作状态以及监控周围环境,
其中,工业机器人控制系统包括示教器、运动控制器,
其中,操控系统包括工控机,
其中,视觉跟踪系统包括RGB摄像机、激光扫描仪、跟踪摄像机,射频收发射装置,
其中,传感器系统包括多个六轴传感器、光学传感器、运动传感器、霍尔电流传感器,
其中,执行机构包括机械部分和电力部分,
网络集成控制系统搜索局域网内存在的工业机器人并连接到相应的运动控制器,运行运动传感器并清零六轴传感器,运动传感器采集执行机构的末端执行器位姿信息来引导工业机器人的运动,并实时显示在示教器的屏幕上。
工业机器人通信分为两级:第一级通信是操控系统与工业机器人控制系统的通信,采用串行通信技术或者网络通讯技术;第二级通信是工业机器人控制系统与传感器系统、视觉跟踪系统之间的通信,采用工业现场总线通信技术。
其中,机械部分包括底座、连接件、大臂、小臂、腕部、末端执行器以及旋转关节,旋转关节分别位于底座与连接件之间、连接件与大臂之间、大臂与小臂之间以及腕部与末端执行器之间,底座是承重基础部件,固定在地面或支架上,连接件是大臂的支撑部件,实现机器人的回转功能,连接件在底座上进行旋转,大臂是小臂的支撑部件,大臂的摆动改变末端执行器在水平方向上的行程,小臂的俯仰实现末端执行器在垂直方向上的位置变换,腕部的末端执行器旋转关节调整承载目标的旋转角度和位置。
底座的关节座与轴线垂直于地面的旋转关节联接,关节座安装在底座上,为大臂提供支撑,其上安装有大臂、小臂和保持腕部水平的连杆,大臂、小臂与连杆相互构成平行四边形,增加了整个臂部的刚度,通过串联平行四边形机构的叠加效应,满足腕部的易控性,腕部是法兰盘,根据用户的不同需要,在法兰盘上联接真空吸盘。
该结构增加整个臂部的刚度,平行四边形的相互作用,增加了整个机器人传动系统的刚度,减小了启动与急停情况下造成的机器人颤动,行程放大,减小系统惯量,节约成本,同时增加了系统的稳定性,搬运机器人利用“平行四边形”原理简化了机器人位姿的控制,降低了过程控制的难度,可以缩短机器人的工作周期和研发设计成本。
其中,电力部分包括编码器、解码电路、光耦隔离电路、永磁同步伺服电机(PMSM)、减速器以及智能功率控制模块(IPM),霍尔电流传感器采集永磁同步伺服电机的U相和V相电流,反馈给运动控制器,编码器通过解码电路实时向运动控制器反馈永磁同步伺服电机实际位置,运动控制器通过串行总线接收目标位置信息,目标位置、实际位置和实际电流在运动控制器内做单轴逻辑控制,通过矢量控制的时序调度输出脉宽调制通过光耦隔离电路提供给智能功率控制模块并转换为功率控制信号,光耦隔离电路实现控制部分电路和功率部分电路完全隔离,极大提高了硬件的可靠性,智能功率控制模块驱动永磁同步伺服电机运转,永磁同步伺服电机输出轴与减速器,减速器与机械部分的旋转关节连接,减速器受运动控制器的控制,实现动作的精细化调整。
其中,运动控制器连接工控机和执行机构,运动控制器为半封装的微型计算机系统,集成了二字符指令集及其解析功能,利用与运动控制器配套的辅助工具,能够进行系统设置,运动控制器由处理器、看门狗、通信接口和电机控制模块组成,
处理器为片上系统(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等。
通过模糊控制可以自动有效实现工业机器人减速器的精确控制,减少了人工设定的反复修改带来的效率上浪费以及精度的不准确。
其中,示教器由手轮、钥匙开关、USB接口、指示灯、按键、急停开关、触摸笔、触摸屏、以太网接口、手托、安全开关、处理器组成,通过触摸屏可进行相关参数进行设置和编程,触摸屏上同时显示执行机构和运动控制器的当前状态信息,执行机构的手动和自动功能则通过示教器面板上的按键操作实现。
示教器通过以太网与运动控制器连接,以太网的连接使用Socket套接字来实现通信,待传输数据组织成符合制定协议的工作交给Socket来完成,实现机器人示教器与运动控制器之间跨平台的分布式处理系统,Socket通信具有的传输速率快、性能高、安全性强等优点,能够满足机器人示教器与控制器的通信要求。
示教器的处理器采用模块化、多线程的策略进行开发,按照功能将其主要划分为以下四个部分:
通信部分,负责传递示教器和运动控制器之间的信息传输,示教器向运动控制器发送指令来控制机器人运动,从运动控制器获取各个关节当前的转角大小信息,通信部分封装了Socket的创建连接模块、网络检测维护模块、传输数据组包解析模块、接收发送模块及数据缓存区;
数据接口部分,封装了传输数据读写操作模块;
人机交互界面显示部分(HMI),定义了示教系统运行的各种界面,包括主界面、手动操作界面、自动操作界面、回零操作界面、参数设置界面、历史状态信息查询界面;
按键响应部分,对示教器面板上的按键、指示灯、手轮和蜂鸣器等的响应进行了定义和设置;参数设置部分,对系统速度、工具坐标、系统时间、运动参数、各转轴极限角度进行设置;
程序编辑部分,包含了程序指令的插入、修改、删除、复制和剪切功能。为了满足仿真系统的应用需求,应按照实际的程序和指令格式来进行相关的操作;
程序解释部分,用于示教器的核记,负责解释机器人程序,获得程序中的指令类型以及路径点信息;
文件管理部分,负责程序的创建、删除、复制、重命名操作;
辅助功能部分,实现帮助信息、指令说明、安全保护功能;
信息提示功能部分,包括操作信息提示以及错误警告信息提示,方便操作者的使用并保障操作安全。
以上所述实施方式仅表达了本发明的一种实施方式,但并不能因此而理解为对本发明范围的限制。应当指出,对于本领域的普通技术人员来说,在不脱离本发明构思的前提下,还可以做出若干变形和改进,这些都属于本发明的保护范围。
Claims (10)
1.一种具有双核运动控制器工业机器人平台,包括工业机器人控制系统、传感器系统、操控系统、网络集成控制系统、视觉跟踪系统以及执行机构,传感器系统与工业机器人控制系统连接,工业机器人控制系统包括示教器、运动控制器,操控系统包括工控机,视觉跟踪系统包括RGB摄像机、激光扫描仪、跟踪摄像机,射频收发射装置,传感器系统包括多个六轴传感器、光学传感器、运动传感器、霍尔电流传感器,执行机构包括机械部分和电力部分,
运动控制器连接工控机和执行机构,运动控制器为半封装的微型计算机系统,集成了二字符指令集及其解析功能,利用与运动控制器配套的辅助工具,能够进行系统设置,运动控制器包括处理器、看门狗、通信接口和电机控制模块,
处理器为片上系统,包括接口层、算法控制层以及容错控制层,其中接口层为FPGA结构,负责与电机控制模块进行信息交互,控制伺服装置,算法控制层为ARM和DSP双核结构,ARM核负责各类外设驱动,DSP端负责运动学建模、轨迹规划等大量矩阵浮点类计算,容错控制层使用32位控制器,对接口层、算法控制层进行实时监控,并根据反馈、操作命令对故障进行容错规划,保证系统安全可靠性运作,容错控制层使用伺服定标方法,同时扩展视觉反馈接口,实现了后期视觉反馈的二次修正。
2.根据权利要求1所述的一种具有双核运动控制器工业机器人平台,其特征在于接口层设置有外围接口电路,实现了与伺服装置进行包括指令发送、反馈数据接收在内的数据交互,采用总线收发器增强端口驱动力;设置EMIF接口与算法控制层完成信息交互;设置UART接口与容错控制层建立通信,完成监控交互;设置FPGA时钟,外部时钟选择有源40Mhz晶振,为了进行FPGA调试、加载程序这里同时引入JTAG和AS两种模式。
算法控制层包括电源管理模块、时钟模块、内存电路、闪存电路、外设SATA接口、接口电路6部分组成,算法控制层与容错控制层完成信息交互确保系统可靠性工作,接收接口层发送的交流伺服位置信息,进行工业机器人正逆运动学建模,进行矩阵浮点类运算,驱动外部设备,与视觉跟踪系统完成信息交互。
3.根据权利要求2所述的一种具有双核运动控制器工业机器人平台,其特征在于:通信接口包括RS-232端口和以太网端口;
电机控制模块以最高12MHz的频率对输入的正弦方波信号进行处理,产生1个±10V的模拟量;对于弦波整流操作,使用2个DACs来产生2个±10V电压模拟信号;
看门狗的定时器绑定了放大器使能输出,一旦运动控制器由于内部或外部因素导致出现系统错误时,看门狗就会将放大器关闭,通常情况下看门狗输出的是高电平,上电运行期间如果处理器功能紊乱,看门狗输出低电平,看门狗定时器检测到之后就会复位运动控制器。
4.根据权利要求3所述的一种具有双核运动控制器工业机器人平台,其特征在于运动控制器接收到工控机经过网络集成控制系统发来的控制指令后,根据控制指令执行相对应的程序生成速度信号、计数信号以及加减速度信号,向永磁同步伺服电机发送转动的速度信号,向减速器发送计数信号和加减速度信号,永磁同步伺服电机的伺服装置收到信号之后,对其进行调整、放大处理,生成转动信号发送至电机,电机驱动旋转关节转动,运动控制器将安装在各个旋转关节的永磁同步伺服电机的编码器的反馈信号经过网络集成控制系统回传给工控机,反馈信号用于在工控机上的人机交互界面中实时地监控工业机器人的状态并显示数据。
运动控制器设定机器人各关节的零点位姿,零点位姿决定于工业机器人在初始状态时时各个永磁同步伺服电机的位置,零点位姿被运动控制器记录,在工业机器人完成作业后,通过发送零位指令使工业机器人回到零点位姿,从而完成回零。
5.根据权利要求1所述的一种具有双核运动控制器工业机器人平台,其特征在于运动控制器还包括模糊控制装置,其对减速器进行模糊控制,模糊控制装置包括差分器、微分器、模糊化接口、输出量转换模块、推理机、知识库,负载估计模块将测得的减速器的测量负载电压通过带通滤波器提供给差分器,差分器将操作人员输入的设定负载电压与测量负载电压相减得到误差值E,误差值E经过微分器得到误差变化率dE/dt,误差值E和误差变化率dE/dt提供给模糊化接口,对误差值E和误差变化率dE/dt进行模糊化赋值,分别得到模糊化误差值ME和模糊化误差变化值MEC,模糊化误差值ME和模糊化误差变化值MEC提供给推理机,推理机根据知识库中的输入输出隶属度矢量值以及逻辑推理规则对模糊化误差值ME和模糊化误差变化值MEC进行模糊推理得到模糊控制量MU,输出量转换模块将模糊控制量MU转换为实际控制量U,根据实际控制量U控制电源向减速器提供电压,
模糊控制装置为可编程逻辑控制器,可编程逻辑控制器与主控器的处理器之间采用RS232通信。
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.根据权利要求6所述的一种具有双核运动控制器工业机器人平台,其特征在于:进一步的说,知识库包括数据库以及规则库,
数据库中存放输入、输出变量的模糊隶属度矢量值,此矢量值是输入、输出量经过对应论域等离散化后所对应值的集合,所对应论域若是连续的,则可作为为隶属度函数,对于输入的模糊变量,隶属度函数保存于数据库中,在模糊推理关系中向推理机提供数据。
8.根据权利要求1所述的一种具有双核运动控制器工业机器人平台,其特征在于示教器通过以太网与运动控制器连接,以太网的连接使用Socket套接字来实现通信,待传输数据组织成符合制定协议的工作交给Socket来完成,实现机器人示教器与运动控制器之间跨平台的分布式处理系统,Socket通信具有的传输速率快、性能高、安全性强等优点,能够满足机器人示教器与控制器的通信要求。
9.根据权利要求1所述的一种具有双核运动控制器工业机器人平台,其特征在于机械部分包括底座、连接件、大臂、小臂、腕部、末端执行器以及旋转关节,旋转关节分别位于底座与连接件之间、连接件与大臂之间、大臂与小臂之间以及腕部与末端执行器之间,底座是承重基础部件,固定在地面或支架上,连接件是大臂的支撑部件,实现机器人的回转功能,连接件在底座上进行旋转,大臂是小臂的支撑部件,大臂的摆动改变末端执行器在水平方向上的行程,小臂的俯仰实现末端执行器在垂直方向上的位置变换,腕部的末端执行器旋转关节调整承载目标的旋转角度和位置。
10.根据权利要求1所述的一种具有双核运动控制器工业机器人平台,其特征在于电力部分包括编码器、解码电路、光耦隔离电路、永磁同步伺服电机、减速器以及智能功率控制模块,霍尔电流传感器采集永磁同步伺服电机的U相和V相电流,反馈给运动控制器,编码器通过解码电路实时向运动控制器反馈永磁同步伺服电机实际位置,运动控制器通过串行总线接收目标位置信息,目标位置、实际位置和实际电流在运动控制器内做单轴逻辑控制,通过矢量控制的时序调度输出脉宽调制通过光耦隔离电路提供给智能功率控制模块并转换为功率控制信号,光耦隔离电路实现控制部分电路和功率部分电路完全隔离,极大提高了硬件的可靠性,智能功率控制模块驱动永磁同步伺服电机运转,永磁同步伺服电机输出轴与减速器,减速器与机械部分的旋转关节连接,减速器受运动控制器的控制,实现动作的精细化调整。
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811321399 | 2018-11-07 | ||
CN2018113213998 | 2018-11-07 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN110666802A true CN110666802A (zh) | 2020-01-10 |
Family
ID=69084061
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911019912.2A Pending CN110666802A (zh) | 2018-11-07 | 2019-10-24 | 一种具有双核运动控制器工业机器人平台 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110666802A (zh) |
Cited By (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111230885A (zh) * | 2020-03-03 | 2020-06-05 | 中山早稻田科技有限公司 | 一种智能协作机器人控制系统、方法及存储介质 |
CN111360795A (zh) * | 2020-03-31 | 2020-07-03 | 研祥智能科技股份有限公司 | 一种六自由度并联机器人的控制系统及其控制方法 |
CN111421547A (zh) * | 2020-04-13 | 2020-07-17 | 深圳市强华科技发展有限公司 | 一种工业机器人控制系统及其控制方法 |
CN111624926A (zh) * | 2020-06-15 | 2020-09-04 | 深圳市优必选科技股份有限公司 | 一种机器人控制器和机器人 |
CN112015118A (zh) * | 2020-08-31 | 2020-12-01 | 浙江水晶光电科技股份有限公司 | 自动化设备的运动控制方法、装置、控制器及存储介质 |
CN113263503A (zh) * | 2021-07-19 | 2021-08-17 | 上海捷勃特机器人有限公司 | 一种机器人系统的控制单元、机器人系统及机器人系统的控制方法 |
CN113274242A (zh) * | 2021-04-21 | 2021-08-20 | 上海大学 | 一种小型智能上肢康复机器人 |
CN113482528A (zh) * | 2021-08-18 | 2021-10-08 | 中建安装集团有限公司 | 一种基于隧道轨行式全向内壁钻孔机器人的施工方法 |
CN113848812A (zh) * | 2021-09-03 | 2021-12-28 | 珠海格力智能装备有限公司 | 机器人的控制方法、控制装置以及控制系统 |
WO2022166067A1 (zh) * | 2021-02-04 | 2022-08-11 | 武汉工程大学 | 一种多机重载搬运机器人协同牵引的系统与方法 |
CN115026820A (zh) * | 2022-06-09 | 2022-09-09 | 天津大学 | 人机协作装配机器人控制系统及控制方法 |
CN116088363A (zh) * | 2022-11-25 | 2023-05-09 | 合肥中科深谷科技发展有限公司 | 一种基于模型设计的机器人驱控一体化控制系统 |
CN118550262A (zh) * | 2024-07-29 | 2024-08-27 | 江苏协航能源科技有限公司 | 基于模糊控制的光伏组件生产控制方法及系统 |
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 | 青岛大学 | 一种对主轴电机模糊控制的研磨化工机械系统 |
CN106475996A (zh) * | 2016-10-20 | 2017-03-08 | 广州长仁工业科技有限公司 | 一种重载荷机器人 |
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 CN201911019912.2A patent/CN110666802A/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 | 青岛大学 | 一种对主轴电机模糊控制的研磨化工机械系统 |
CN106475996A (zh) * | 2016-10-20 | 2017-03-08 | 广州长仁工业科技有限公司 | 一种重载荷机器人 |
CN108567543A (zh) * | 2018-04-11 | 2018-09-25 | 韩姝 | 一种具有智能调速的综合口腔治疗系统 |
Non-Patent Citations (5)
Title |
---|
周伟: "基于虚拟现实的工业机器人仿真系统的研究与开发", 《中国优秀硕士学位论文全文数据库 信息科技辑》 * |
夏飞虎: "基于以太网和WinCE的工业机器人示教器系统研究与设计", 《中国优秀硕士学位论文全文数据库 信息科技辑》 * |
姚绪梁: "《电伺服系统及其在船舶运动控制中的应用》", 31 July 2009 * |
施文龙: "六轴工业机器人控制系统的研究与实现", 《中国优秀硕士学位论文全文数据库 信息科技辑》 * |
李钟: "基于DSP_ARM的工业机器人控制系统设计与实现", 《中国优秀硕士学位论文全文数据库 信息科技辑》 * |
Cited By (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111230885A (zh) * | 2020-03-03 | 2020-06-05 | 中山早稻田科技有限公司 | 一种智能协作机器人控制系统、方法及存储介质 |
CN111360795A (zh) * | 2020-03-31 | 2020-07-03 | 研祥智能科技股份有限公司 | 一种六自由度并联机器人的控制系统及其控制方法 |
CN111421547A (zh) * | 2020-04-13 | 2020-07-17 | 深圳市强华科技发展有限公司 | 一种工业机器人控制系统及其控制方法 |
CN111624926A (zh) * | 2020-06-15 | 2020-09-04 | 深圳市优必选科技股份有限公司 | 一种机器人控制器和机器人 |
CN112015118A (zh) * | 2020-08-31 | 2020-12-01 | 浙江水晶光电科技股份有限公司 | 自动化设备的运动控制方法、装置、控制器及存储介质 |
WO2022166067A1 (zh) * | 2021-02-04 | 2022-08-11 | 武汉工程大学 | 一种多机重载搬运机器人协同牵引的系统与方法 |
CN113274242A (zh) * | 2021-04-21 | 2021-08-20 | 上海大学 | 一种小型智能上肢康复机器人 |
CN113263503B (zh) * | 2021-07-19 | 2021-11-09 | 上海捷勃特机器人有限公司 | 一种机器人系统的控制单元、机器人系统及机器人系统的控制方法 |
CN113263503A (zh) * | 2021-07-19 | 2021-08-17 | 上海捷勃特机器人有限公司 | 一种机器人系统的控制单元、机器人系统及机器人系统的控制方法 |
CN113482528A (zh) * | 2021-08-18 | 2021-10-08 | 中建安装集团有限公司 | 一种基于隧道轨行式全向内壁钻孔机器人的施工方法 |
CN113848812A (zh) * | 2021-09-03 | 2021-12-28 | 珠海格力智能装备有限公司 | 机器人的控制方法、控制装置以及控制系统 |
CN113848812B (zh) * | 2021-09-03 | 2023-12-08 | 珠海格力智能装备有限公司 | 机器人的控制方法、控制装置以及控制系统 |
CN115026820A (zh) * | 2022-06-09 | 2022-09-09 | 天津大学 | 人机协作装配机器人控制系统及控制方法 |
CN116088363A (zh) * | 2022-11-25 | 2023-05-09 | 合肥中科深谷科技发展有限公司 | 一种基于模型设计的机器人驱控一体化控制系统 |
CN116088363B (zh) * | 2022-11-25 | 2023-11-14 | 合肥中科深谷科技发展有限公司 | 一种基于模型设计的机器人驱控一体化控制系统 |
CN118550262A (zh) * | 2024-07-29 | 2024-08-27 | 江苏协航能源科技有限公司 | 基于模糊控制的光伏组件生产控制方法及系统 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110666802A (zh) | 一种具有双核运动控制器工业机器人平台 | |
CN110666800A (zh) | 一种具有多线程策略示教器的工业机器人 | |
Di Castro et al. | CERNTAURO: A modular architecture for robotic inspection and telemanipulation in harsh and semi-structured environments | |
CN102581745B (zh) | 一种化学机械抛光传输机器人系统 | |
CN105033996B (zh) | 基于手推示教式五轴水平关节机器人的控制系统 | |
CN110640742A (zh) | 一种多模态监控的工业机器人平台 | |
CN102642207A (zh) | 核电站作业多功能执行器及其控制方法 | |
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. | |
CN104626139A (zh) | 一种组态机器人 | |
Pan et al. | Control system of a small intelligent inspection robot for nuclear power plant use | |
CN110666803A (zh) | 一种rf中心定位工件的抓取工业机器人 | |
Ma et al. | Plantbot: A new ROS-based robot platform for fast building and developing | |
CN110640740A (zh) | 一种具有两级减速减速器的工业机器人平台 | |
Caccavale et al. | RePLiCS: An environment for open real-time control of a dual-arm industrial robotic cell based on RTAI-Linux | |
Feng et al. | Mechanical Design Method and Joint Simulation Analysis of Industrial Robots Based on Trajectory Planning Algorithm and Kinematics | |
Lei et al. | Vision-based position/impedance control for robotic assembly task | |
Harrigan | Automating the operation of robots in hazardous environments | |
Cong | Design and Development of a Costefficiency Robot Arm with a PLC-based Robot Controller. | |
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 | |
CN221696931U (zh) | 一种机械手控制系统 | |
Feng et al. | Research on motion control and trajectory planning algorithm of mobile manipulator based on deep learning | |
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 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
TA01 | Transfer of patent application right |
Effective date of registration: 20200730 Address after: Room 1207, building 8, block B, R & D Park, Ningbo, Zhejiang Province, 315000 Applicant after: Zhang Huanhuan Address before: 315000 room 014, floor 3, building 2, No.128, Jingyuan Road, hi tech Zone, Ningbo City, Zhejiang Province Applicant before: NINGBO SAILANG TECHNOLOGY Co.,Ltd. |
|
TA01 | Transfer of patent application right | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20200110 |
|
RJ01 | Rejection of invention patent application after publication |