一种电机模糊控制的工业机器人制造技术

一种电机模糊控制的工业机器人，包括工业机器人控制系统、传感器系统、操控系统、网络集成控制系统、视觉跟踪系统以及执行机构，传感器系统与工业机器人控制系统连接，跟踪摄像机安装在末端执行器的正下方，实时观察并测量运动工件相对于执行机构的位置，利用跟踪摄像机对运动工件进行图像采集，利用图像处理对运动工件的形状进行识别并获取工件中心，与上一次识别的结果进行比对，生成误差信号，将获得运动工件的误差信号作为反馈信号，输入工控机的模糊控制装置中，利用模糊控制方法计算出相应的控制信号，并将控制信号以运动指令的形式发送到执行机构，对执行机构的动作进行跟踪。

An industrial robot with motor fuzzy control

【技术实现步骤摘要】
一种电机模糊控制的工业机器人
本专利技术属于工业机器人领域，特别涉及一种电机模糊控制的工业机器人。
技术介绍
随着当前工业自动化水平越来越高,在各行各业占有越来越重要的地位,它们能够娴熟、精准地执行多种复杂任务,这些任务由于环境或者其他因素的限制可能是人根本无法完成的。工业机器人的应用场景主要有汽车零部件制造和装配、机械自动化制造、有毒化工产品生产、标准流水线作业、高危环境设备安装、核辐射场地作业、极限环境作业等。对伺服电机的精确控制是工业机器人如何实现精密加工的关键。
技术实现思路
本专利技术要解决的技术问题是如何通过模糊控制实现对工业机器人伺服电机的精确控制，对此本专利技术提供一种电机模糊控制的工业机器人，本专利技术的技术方案为：一种电机模糊控制的工业机器人，包括工业机器人控制系统、传感器系统、操控系统、网络集成控制系统、视觉跟踪系统以及执行机构，传感器系统与工业机器人控制系统连接，操控系统通过网络集成控制系统接收传感器系统和视觉跟踪系统的数据并向工业机器人控制系统发送控制指令，工业机器人控制系统控制执行机构，传感器系统安装在执行机构上，实时监控执行机构的位姿状态，传感器系统、视觉跟踪系统还与工业机器人控制系统连接用于实时反馈执行机构的工作状态以及监控周围环境，其中，工业机器人控制系统包括示教器、运动控制器，其中，操控系统包括工控机，其中，视觉跟踪系统包括RGB摄像机、激光扫描仪、跟踪摄像机，射频收发射装置，其中，传感器系统包括多个六轴传感器、光学传感器、运动传感器、霍尔电流传感器，其中，执行机构包括机械部分和电力部分，机械部分包括底座、连接件、大臂、小臂、腕部、末端执行器以及旋转关节，其中，跟踪摄像机安装在末端执行器的正下方，实时观察并测量运动工件相对于执行机构的位置，利用跟踪摄像机对运动工件进行图像采集，利用图像处理对运动工件的形状进行识别并获取工件中心，与上一次识别的结果进行比对，生成误差信号，将获得运动工件的误差信号作为反馈信号，输入工控机的模糊控制装置中，利用模糊控制方法计算出相应的控制信号，并将控制信号以运动指令的形式发送到执行机构。本专利技术的有益效果：(1)通过模糊控制自动有效实现工业机器人伺服电机的精确控制，减少了人工设定的反复修改带来的效率上浪费以及精度的不准确；(2)使用光耦隔离电路极大提高了硬件的可靠性；(3)使用二级通信,实现了对工业机器人的灵活控制；(4)执行机构使用平行四边形，增加了整个结构刚度,增加系统稳定性；(5)使用图像处理算法精确获得工件的中心位置，便于机器人的准确抓取。附图说明图1为本专利技术的工业机器人系统框图；图2为本专利技术的执行机构的机械结构图；图3为本专利技术的电模糊控制方法流程图；图4为本专利技术的模糊控制方法原理图；图5为本专利技术的工件中心位置获取流程图；具体实施方式下面结合附图对本专利技术作进一步的说明。一种电机模糊控制的工业机器人，包括工业机器人控制系统、传感器系统、操控系统、网络集成控制系统、视觉跟踪系统以及执行机构，传感器系统与工业机器人控制系统连接，操控系统通过网络集成控制系统接收传感器系统和视觉跟踪系统的数据并向工业机器人控制系统发送控制指令，工业机器人控制系统控制执行机构，传感器系统安装在执行机构上，实时监控执行机构的位姿状态，传感器系统、视觉跟踪系统还与工业机器人控制系统连接用于实时反馈执行机构的工作状态以及监控周围环境，其中，工业机器人控制系统包括示教器、运动控制器，其中，操控系统包括工控机，其中，视觉跟踪系统包括RGB摄像机、激光扫描仪、跟踪摄像机，射频收发射装置，其中，传感器系统包括多个六轴传感器、光学传感器、运动传感器、霍尔电流传感器，其中，执行机构包括机械部分和电力部分，网络集成控制系统搜索局域网内存在的工业机器人并连接到相应的运动控制器，运行运动传感器并清零六轴传感器，运动传感器采集执行机构的末端执行器位姿信息来引导工业机器人的运动，并实时显示在示教器的屏幕上。工业机器人通信分为两级：第一级通信是操控系统与工业机器人控制系统的通信，采用串行通信技术或者网络通讯技术；第二级通信是工业机器人控制系统与传感器系统、视觉跟踪系统之间的通信，采用工业现场总线通信技术。其中，机械部分包括底座、连接件、大臂、小臂、腕部、末端执行器以及旋转关节，旋转关节分别位于底座与连接件之间、连接件与大臂之间、大臂与小臂之间以及腕部与末端执行器之间，底座是承重基础部件，固定在地面或支架上，连接件是大臂的支撑部件，实现机器人的回转功能，连接件在底座上进行旋转，大臂是小臂的支撑部件，大臂的摆动改变末端执行器在水平方向上的行程，小臂的俯仰实现末端执行器在垂直方向上的位置变换，腕部的末端执行器旋转关节调整承载目标的旋转角度和位置。底座的关节座与轴线垂直于地面的旋转关节联接，关节座安装在底座上，为大臂提供支撑，其上安装有大臂、小臂和保持腕部水平的连杆，大臂、小臂与连杆相互构成平行四边形，增加了整个臂部的刚度，通过串联平行四边形机构的叠加效应,满足腕部的易控性，腕部是法兰盘，根据用户的不同需要，在法兰盘上联接真空吸盘。该结构增加整个臂部的刚度，平行四边形的相互作用,增加了整个机器人传动系统的刚度,减小了启动与急停情况下造成的机器人颤动，行程放大，减小系统惯量，节约成本，同时增加了系统的稳定性，搬运机器人利用“平行四边形”原理简化了机器人位姿的控制,降低了过程控制的难度,可以缩短机器人的工作周期和研发设计成本。其中，电力部分包括编码器、解码电路、光耦隔离电路、永磁同步伺服电机(PMSM)、减速器以及智能功率控制模块(IPM)，霍尔电流传感器采集永磁同步伺服电机的U相和V相电流，反馈给运动控制器，编码器通过解码电路实时向运动控制器反馈永磁同步伺服电机实际位置，运动控制器通过串行总线接收目标位置信息，目标位置、实际位置和实际电流在运动控制器内做单轴逻辑控制，通过矢量控制的时序调度输出脉宽调制通过光耦隔离电路提供给智能功率控制模块并转换为功率控制信号，光耦隔离电路实现控制部分电路和功率部分电路完全隔离，极大提高了硬件的可靠性，智能功率控制模块驱动永磁同步伺服电机运转，永磁同步伺服电机输出轴与减速器，减速器与机械部分的旋转关节连接，减速器受运动控制器的控制，实现动作的精细化调整。其中，跟踪摄像机安装在末端执行器的正下方，实时观察并测量运动工件相对于执行机构的位置，利用跟踪摄像机对运动工件进行图像采集，利用图像处理对运动工件的形状进行识别并获取工件中心，与上一次识别的结果进行比对，生成误差信号，将获得运动工件的误差信号作为反馈信号，输入工控机的模糊控制装置中，利用模糊控制方法计算出相应的控制信号，并将控制信号以运动指令的形式发送到执行机构，对执行机构的动作进行跟踪，跟踪过程如下：步骤1，利用跟踪摄像机对运动工件进行图本文档来自技高网...

【技术保护点】
1.一种电机模糊控制的工业机器人，包括工业机器人控制系统、传感器系统、操控系统、网络集成控制系统、视觉跟踪系统以及执行机构，传感器系统与工业机器人控制系统连接，/n工业机器人控制系统包括示教器、运动控制器，/n操控系统包括工控机，/n视觉跟踪系统包括RGB摄像机、激光扫描仪、跟踪摄像机，射频收发射装置，/n传感器系统包括多个六轴传感器、光学传感器、运动传感器、霍尔电流传感器，/n执行机构包括机械部分和电力部分，/n机械部分包括底座、连接件、大臂、小臂、腕部、末端执行器以及旋转关节，/n跟踪摄像机安装在末端执行器的正下方，实时观察并测量运动工件相对于执行机构的位置，利用跟踪摄像机对运动工件进行图像采集，利用图像处理对运动工件的形状进行识别并获取工件中心，与上一次识别的结果进行比对，生成误差信号，将获得运动工件的误差信号作为反馈信号，输入工控机的模糊控制装置中，利用模糊控制方法计算出相应的控制信号，并将控制信号以运动指令的形式发送到执行机构，对执行机构的动作进行跟踪。/n

【技术特征摘要】
20181107 CN 20181132142041.一种电机模糊控制的工业机器人，包括工业机器人控制系统、传感器系统、操控系统、网络集成控制系统、视觉跟踪系统以及执行机构，传感器系统与工业机器人控制系统连接，
工业机器人控制系统包括示教器、运动控制器，
操控系统包括工控机，
视觉跟踪系统包括RGB摄像机、激光扫描仪、跟踪摄像机，射频收发射装置，
传感器系统包括多个六轴传感器、光学传感器、运动传感器、霍尔电流传感器，
执行机构包括机械部分和电力部分，
机械部分包括底座、连接件、大臂、小臂、腕部、末端执行器以及旋转关节，
跟踪摄像机安装在末端执行器的正下方，实时观察并测量运动工件相对于执行机构的位置，利用跟踪摄像机对运动工件进行图像采集，利用图像处理对运动工件的形状进行识别并获取工件中心，与上一次识别的结果进行比对，生成误差信号，将获得运动工件的误差信号作为反馈信号，输入工控机的模糊控制装置中，利用模糊控制方法计算出相应的控制信号，并将控制信号以运动指令的形式发送到执行机构，对执行机构的动作进行跟踪。


2.根据权利要求1所述的一种电机模糊控制的工业机器人，其特征在于工控机的模糊控制装置具体为：模糊控制装置包括差分器、微分器、模糊化接口、输出量转换模块、推理机、知识库，负载估计模块将测得的伺服电机的测量负载电压通过带通滤波器提供给差分器，差分器将操作人员输入的设定负载电压与测量负载电压相减得到误差值E，误差值E经过微分器得到误差变化率dE/dt，误差值E和误差变化率dE/dt提供给模糊化接口，对误差值E和误差变化率dE/dt进行模糊化赋值，分别得到模糊化误差值ME和模糊化误差变化值MEC，模糊化误差值ME和模糊化误差变化值MEC提供给推理机，推理机根据知识库中的输入输出隶属度矢量值以及逻辑推理规则对模糊化误差值ME和模糊化误差变化值MEC进行模糊推理得到模糊控制量MU，输出量转换模块将模糊控制量MU转换为实际控制量U，根据实际控制量U控制电源向伺服电机提供电压。


3.根据权利要求2所述的一种电机模糊控制的工业机器人，其特征在于模糊控制装置为可编程逻辑控制器，可编程逻辑控制器与主控器的处理器之间采用RS232通信。


4.根据权利要求1所述的一种电机模糊控制的工业机器人，其特征在于模糊控制方法具体为：按照操作人员的语言变量的选取参量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。


5.根据权利要求2所述的一种电机模糊控制的工业机器人，其特征在于：其中，...

【专利技术属性】
技术研发人员：孙法君，
申请(专利权)人：宁波赛朗科技有限公司，
类型：发明
国别省市：浙江;33