基于TensorFlow的工业机器人动力学控制系统及方法技术方案

本发明专利技术涉及一种基于TensorFlow的工业机器人动力学控制系统及方法，系统包括：数据采集模块、控制器、PC服务器、显示器、电机驱动模块和伺服电机；控制器将数据采集模块采集到的工业机器人的关节位置、关节速度和关节力矩发送给PC服务器，由PC服务器进行数据处理并利用tensorflow构建卷积神经网络进行训练优化，根据实时的关节位置和关节速度输出工业机器人的关节力矩控制指令，控制器将关节力矩控制指令通过GPIO接口发送至电机驱动模块，控制伺服电机实现工业机器人的关节控制。本发明专利技术不需要额外去辨识惯性力、离心力、哥氏力、粘摩擦、静摩力等参数，就可以实现机器人的稳定的运动。

Dynamic control system and method of industrial robot based on TensorFlow

The invention relates to a dynamic control system and method of industrial robot based on TensorFlow, which includes data acquisition module, controller, PC server, display, motor drive module and servo motor. The controller takes the joint position, joint speed and joint force of the industrial robot to be collected by the data acquisition module. The moment is sent to the PC server, the data processing is carried out by the PC server and the convolution neural network is built with tensorflow to train and optimize. The joint torque control instruction is output according to the real-time joint position and joint speed. The controller sends the joint torque control instructions through the GPIO interface to the motor drive module. Control servo motor to realize joint control of industrial robot. The invention does not need to identify additional parameters such as inertia force, centrifugal force, Coriolis force, sticky friction, static force and so on, and can realize the stable movement of the robot.

【技术实现步骤摘要】
基于TensorFlow的工业机器人动力学控制系统及方法
本专利技术涉及机器人
，具体涉及一种基于TensorFlow的工业机器人动力学控制系统及方法。
技术介绍
基于工业机器人动力学模型的控制器---动力学控制器，具体实现方式因系统结构不同而有所不同。传统应用、中小公司、国内公司、大牌公司老型号机器人产品都是位置控制；新兴应用、大牌公司的新型号产品都是力矩控制。四大家族：发那科（Fanuc）、ABB、安川电机（Yaskawa）、库卡（kuka）的机器人伺服驱动器目前都只做纯力矩控制。图1是KUKA公司典型的三闭环控制示意图。除三闭环控制方式外，目前常用的控制方法还有动力学模型的参数辨识法。作为新兴的小型工业机器人公司要研发出一套能和四大家族机器人公司相媲美的机器人需要投入大量的时间和金钱成本。
技术实现思路
针对现有技术的不足，本专利技术提供一种基于TensorFlow的工业机器人动力学控制系统及方法，抛开以往的速度环、位置环、电流环的束缚，也刨去动力学模型参数识别的难点问题，引入机器学习工具---TensorFlow，运用全新的思维设计可准确跟踪路径、性能稳定的动力学控制系统。为实现上述目的，本专利技术的技术方案是：一种基于TensorFlow的工业机器人动力学控制系统，包括：数据采集模块、控制器、PC服务器、显示器、电机驱动模块和伺服电机；所述数据采集模块通过I2C与控制单元通信，用于为控制器提供数据来源；所述显示器通过HDMI接口与控制器连接，用于查看控制系统的运行状态；所述控制器通过电机驱动模块与伺服电机连接，通过有线网络与PC服务器连接；所述控制器将数据采集模块采集到的工业机器人的关节位置、关节速度和关节力矩发送给PC服务器，由PC服务器进行数据处理并利用tensorflow构建卷积神经网络进行训练优化，根据实时的关节位置和关节速度输出工业机器人的关节力矩控制指令，控制器将关节力矩控制指令通过GPIO接口发送至电机驱动模块，控制伺服电机实现工业机器人的关节控制。进一步地，所述数据采集模块包括：位置传感器、陀螺仪传感器和力矩传感器。进一步地，所述控制器包括安装有Androidthings系统的RaspberryPi3开发板。进一步地，所述PC服务器安装有Androidstudio开发平台。基于上述的工业机器人动力学控制系统的控制方法，包括：步骤S1：控制器将数据采集模块采集到的工业机器人的关节位置、关节速度和关节力矩发送给PC服务器；步骤S2：PC服务器读入控制器传入的数据进行滤波处理，转换为tensorflow能识别的bin格式数据并保存；步骤S3：将数据分为训练集和测试集，利用tensorflow搭建卷积神经网络，包括10层卷积计算层conv、1层激励层RELU，5层池化层，1层FC全连接层，初始化参数为神经网络神经元间的连接权值、神经元的偏置和学习率，选择均方差函数作为损失函数；步骤S4：通过训练集的关节位置、关节速度和期望输出的关节力矩数据来优化训练连接权值和偏置值，通过测试集的数据来验证训练好的连接权值和偏置值是否达到要求，如满足要求，则将训练好的卷积神经网络进行在线应用，实时根据输入的关节位置和关节速度，输出关节力矩控制指令；步骤S5：控制器将关节力矩控制指令通过GPIO接口发送至电机驱动模块，控制伺服电机实现工业机器人的关节控制。与现有技术相比，本专利技术的有益效果是：（1）本专利技术开发周期短、投入少；（2）参数的调整不需要投入太多的精力，控制系统会自动寻优；（3）系统模型架构调整方便，不需要很复杂的代码，后期维护和扩展方便。附图说明图1是KUKA的速度、位置、电流三闭环控制器示意图；图2是本专利技术基于TensorFlow的工业机器人动力学控制系统结构图；图3是本专利技术卷积神经网络训练流程图。具体实施方式下面结合说明书附图和实施例对本
技术实现思路
进行详细说明：如图2所示，一种基于TensorFlow的工业机器人动力学控制系统，包括：数据采集模块、控制器、PC服务器、显示器、电机驱动模块和伺服电机；所述数据采集模块通过I2C与控制单元通信，用于为控制器提供数据来源；所述显示器通过HDMI接口与控制器连接，用于查看控制系统的运行状态；所述控制器通过电机驱动模块与伺服电机连接，通过有线网络与PC服务器连接；所述控制器将数据采集模块采集到的工业机器人的关节位置、关节速度和关节力矩发送给PC服务器，由PC服务器进行数据处理并利用tensorflow构建卷积神经网络进行训练优化，根据实时的关节位置和关节速度输出工业机器人的关节力矩控制指令，控制器将关节力矩控制指令通过GPIO接口发送至电机驱动模块，控制伺服电机实现工业机器人的关节控制。动力学模型的标准形式为：要实现力矩模式控制，且实现精确控制，理论上需要最大可能地识别出惯性力、离心力、哥氏力、粘摩擦、静摩擦、重力及外力，但以上参数的识别一直是工业机器人控制器研究的难点，至今没有一套完全有效的辨识方法。在本实施例中，所述数据采集模块包括：位置传感器、陀螺仪传感器和力矩传感器。仅检测工业机器人的关节位置、关节速度和关节力矩，而不需要额外去辨识惯性力、离心力、哥氏力、粘摩擦、静摩力等参数，就可以实现机器人的稳定的运动，如准确实现轨迹跟踪控制。在本实施例中，所述控制器包括安装有Androidthings系统的RaspberryPi3开发板。RaspberryPi3是AndroidThings目前支持的四大开发板之一，兼顾ARM和X86架构，也兼顾32位和64位的系统，更支持支持WIFI和蓝牙。使用该板设计可以缩短开发周期。AndroidThings不仅仅是一个物联网操作系统，还是一个可以快速做智能硬件开发的平台。它支持多种开发语言：C、C++、java；它支持通过GoogleCloud使用Firebase，极大的加快了数据的处理速度；它集成Weave协议，可以方便的实现各种无线协议的连接。在本实施例中，所述PC服务器安装有Androidstudio开发平台，它兼容RaspberryPi3开发板上的AndroidThings系统，可以很方便地实现与RaspberryPi3开发板硬件系统的通信。基于上述工业机器人动力学控制系统的控制方法，包括：步骤S1：控制器将数据采集模块采集到的工业机器人的关节位置、关节速度和关节力矩发送给PC服务器；步骤S2：PC服务器读入控制器传入的数据进行滤波处理，转换为tensorflow能识别的bin格式数据并保存；步骤S3：如图3所示，将数据分为训练集和测试集，利用tensorflow搭建卷积神经网络，包括10层卷积计算层conv、1层激励层RELU，5层池化层，1层FC全连接层，初始化参数为神经网络神经元间的连接权值、神经元的偏置和学习率，选择均方差函数作为损失函数；步骤S4：通过训练集的关节位置、关节速度和期望输出的关节力矩数据来优化训练连接权值和偏置值，通过测试集的数据来验证训练好的连接权值和偏置值是否达到要求，如满足要求，则将训练好的卷积神经网络进行在线应用，实时根据输入的关节位置和关节速度，输出关节力矩控制指令；步骤S5：控制器将关节力矩控制指令通过GPIO接口发送至电机驱动模块，控制伺服电机实现工业机器人的关节控制。本文档来自技高网...

【技术保护点】
一种基于TensorFlow的工业机器人动力学控制系统，其特征在于，包括：数据采集模块、控制器、PC服务器、显示器、电机驱动模块和伺服电机；所述数据采集模块通过I2C与控制单元通信，用于为控制器提供数据来源；所述显示器通过HDMI接口与控制器连接，用于查看控制系统的运行状态；所述控制器通过电机驱动模块与伺服电机连接，通过有线网络与PC服务器连接；所述控制器将数据采集模块采集到的工业机器人的关节位置、关节速度和关节力矩发送给PC服务器，由PC服务器进行数据处理并利用TensorFlow构建卷积神经网络进行训练优化，根据实时的关节位置和关节速度输出工业机器人的关节力矩控制指令，控制器将关节力矩控制指令通过GPIO接口发送至电机驱动模块，控制伺服电机实现工业机器人的关节控制。

【技术特征摘要】
1.一种基于TensorFlow的工业机器人动力学控制系统，其特征在于，包括：数据采集模块、控制器、PC服务器、显示器、电机驱动模块和伺服电机；所述数据采集模块通过I2C与控制单元通信，用于为控制器提供数据来源；所述显示器通过HDMI接口与控制器连接，用于查看控制系统的运行状态；所述控制器通过电机驱动模块与伺服电机连接，通过有线网络与PC服务器连接；所述控制器将数据采集模块采集到的工业机器人的关节位置、关节速度和关节力矩发送给PC服务器，由PC服务器进行数据处理并利用TensorFlow构建卷积神经网络进行训练优化，根据实时的关节位置和关节速度输出工业机器人的关节力矩控制指令，控制器将关节力矩控制指令通过GPIO接口发送至电机驱动模块，控制伺服电机实现工业机器人的关节控制。2.根据权利要求1所述的工业机器人动力学控制系统，其特征在于，所述数据采集模块包括：位置传感器、陀螺仪传感器和力矩传感器。3.根据权利要求1所述的工业机器人动力学控制系统，其特征在于，所述控制器包括安装有Androidthings系统的RaspberryPi3开发板。4.根据权利要求1所述的工业机器人动力学控制系统，其特征在于，所述PC服务器安装有Androidstudio开发平台。5.基于权利要求1所述的工业机器人动力学控制系统的控制方法，其特征在于，包括：步骤S...

【专利技术属性】
技术研发人员：刘萍，周牡丹，高凤强，郭娟，王海玲，吴晓敏，刘哲浩，
申请(专利权)人：厦门大学嘉庚学院，
类型：发明
国别省市：福建,35