机器人多总线实时控制系统技术方案

本发明专利技术的机器人多总线实时控制系统涉及机器人控制领域，目的是为了克服现有机器人控制系统使用不同总线，导致目前机器人控制器多总线通信数据实时性差，以及数据采集困难的问题，包括数据采集模块、数据处理模块和命令输出模块；数据采集模块，与数据处理模块连接，用于通过多种总线实时采集机器人的运行数据，并将运行数据发送至数据处理模块；数据处理模块，与命令输出模块连接，用于将运行数据处理生成执行命令，并将执行命令发送至命令输出模块；命令输出模块，用于通过多种总线将执行命令发送至相应的执行机构，使相应的执行机构根据执行命令做出相应的动作。

【技术实现步骤摘要】
机器人多总线实时控制系统
本专利技术涉及机器人控制领域，具体涉及一种基于多种现场总线接入、多路径数据实时解析和多路径数据命令下发的机器人控制系统。
技术介绍
当前机器人控制系统随着近几年各种设备完善、不同传感器设备使用不同总线，不同总线设备通信需要各种转换接口，造成设备维护麻烦。且目前机器人集成多种不同总线模块，由电机、多种位移传感器、多种力传感器等模块组成，总线种类多、通信协复杂，在通信调试上会浪费很多精力和时间，导致目前机器人控制器多总线通信数据实时性差，以及数据采集困难。
技术实现思路
本专利技术的目的是为了克服现有机器人控制系统使用不同总线，导致目前机器人控制器多总线通信数据实时性差，以及数据采集困难的问题，提供了一种机器人多总线实时控制系统。本专利技术的机器人多总线实时控制系统，包括数据采集模块、数据处理模块和命令输出模块；数据采集模块，与数据处理模块连接，用于通过多种总线实时采集机器人的运行数据，并将运行数据发送至数据处理模块；数据处理模块，与命令输出模块连接，用于将运行数据处理生成执行命令，并将执行命令发送至命令输出模块；命令输出模块，用于通过多种总线将执行命令发送至相应的执行机构，使相应的执行机构根据执行命令做出相应的动作。本专利技术的有益效果是：本专利技术实现了多总线机器人控制系统，该系统基于多种现场总线接入、多路径数据实时解析和多路径数据命令下发。本专利技术在不改变现有机器人网络环境下，可以实时查询分析相关数据，进而提高机器人可靠性和稳定性。并且由于该系统集成多类型总线，所以能兼容多个总线设备，有很强的兼容性，设备维护简单。附图说明图1为本专利技术机器人多总线实时控制系统的框图。具体实施方式具体实施方式一，本实施方式的机器人多总线实时控制系统，包括数据采集模块1、数据处理模块2和命令输出模块3；数据采集模块1，与数据处理模块2连接，用于通过多种总线实时采集机器人的运行数据，并将运行数据发送至数据处理模块2；数据处理模块2，与命令输出模块3连接，用于将运行数据处理生成执行命令，并将执行命令发送至命令输出模块3；命令输出模块3，用于通过多种总线将执行命令发送至相应的执行机构，使相应的执行机构根据执行命令做出相应的动作。具体地，本实施方式的机器人多总线实时控制系统可以被配置为一个基于现场多总线实时数据处理的系统软件，能兼容多个总线设备，有很强的兼容性，实现了多总线实时采集，多总线数据实时处理，多总线数据实时输出的功能。不同的总线，采用模块化设计，每个模块可以单独提出来，作为独立应用模块使用；支持跨平台，支持window和Linux等多种操作系统，还可以基于QNX6.5系统，微内核方式，方便移植、二次开发。不同操作系统都可以运行。系统包括数据采集模块1、数据处理模块2和命令输出模块3。数据采集模块1通过CAN总线、ECAT总线、串口总线和AD总线可以实时接收外部通信数据；数据处理模块2根据核心算法，加工各个总线传输过来的通信数据，命令输出模块3实时把加工后的数据发送到各个总线上。该系统实时处理数据延迟在1ms内，保证机器人运动流畅，动作迅速。在不改变现有机器人网络环境下，实现了多总线数据分析、处理及数据输出，可以实时分析相关数据，进而提高机器人控制的可靠性和稳定性。本系统在使用时与各种外接设备相连接，外接设备包括液压伺服驱动模块(关节伺服驱动模块)、IMU、遥控器、电机驱动器(平衡电机所配置的电机驱动器)、机器人电池和视觉设备等，外接设备将自身工作状态数据通过不同的工业总线发给本系统，本系统设计为通过不同工业总线获取工业设备工作状态信息，并对数据进行解析、分析、处理、打包，最后将打包后的数据通过输出接口模块(命令输出模块3)传递给各个总线设备。多总线机器人控制器包括处理器板卡、CAN总线采集卡、ECAT主站板卡、AD采集板卡、电源卡。控制器各种板卡通过PC104总线通信，控制器结构采用堆栈式结构设计，有很好扩展性、体积小、有丰富外设接口。处理器板卡对外接口有串口1、串口2、网口A、网口B，其中串口1连接到遥控器，遥控器通过串口通信控制机器人运动，网口A挂载无限路由器可以和PC机通信。CAN卡对外有CAN1、CAN2。ECAT主站板卡控制电机驱动器从站。AD采集卡有20路AD采集通道，可以采集机器人油源电机温度、机器人油源高压、油源低压、机器人电池剩余电量。电源卡能提供24V、12V、5V电压，供各种板卡使用。数据采集模块1启动多线采集数据，CAN1、CAN2启动两个线程采集两路CAN总线数据。ECAT总线启动一个线程采集ECAT总线数据。AD总线启动一个线程机器人高低压和温度。串口总线启动一个线程采集遥控串口数据。线程间的数据访问通过线程锁和信号量，保证正确读写数据。数据处理模块2启动一个线程处理各个数据采集模块1的数据。命令输出模块3启动一个线程将加工好的数据下发到机器人各个运动关节。最佳实施例，本实施例是对实施方式的进一步说明，数据采集模块1包括关节位移数据采集模块1-1、机器人姿态数据采集模块1-2、平衡电机数据采集模块1-3和控制命令采集模块1-4；控制命令采集模块1-4，通过串口总线与控制命令生成模块连接，用于采集控制命令；关节位移数据采集模块1-1，通过第一CAN总线与机器人关节伺服模块连接，用于采集机器人各关节的位移数据；机器人姿态数据采集模块1-2，通过第二CAN总线与惯性测量单元IMU连接，用于采集机器人的姿态数据；平衡电机数据采集模块1-3，通过ECAT总线与机器人平衡电机连接，用于采集机器人平衡电机的参数；机器人的运行数据包括控制命令、机器人各关节的位移数据、机器人的姿态数据、机器人平衡电机的参数。具体地，该系统的总线至少包括CAN总线、ECAT总线、串口总线和AD总线，4种总线相互通信、相互融合，利用每种通信优点，实现了一个实时数据处理的系统软件。数据采集模块1的具体工作流程如下：关节位移数据采集模块1-1通过第一CAN总线实时采集动力单元、大腿、小腿、腰、大臂、小臂等关节当前的位移CAN数据(即，机器人各关节的位移数据)，每个关节都有一个液压驱动器，液压驱动器5ms周期向控制系统上报各个关节当前实际位移，每个关节的位移数据长度为2个字节，通过系统中断保证数据完整性。每个关节都作为第一CAN总线节点，通过第一CAN总线实时控制，关节到实时系统的数据延迟控制在1ms内，各个关节运动流畅，反应迅速。机器人姿态数据采集模块1-2通过第二CAN总线实时采集机器人的姿态数据，该机器人的姿态数据由IMU模块检测取得，以5ms周期上报三轴加速度、三轴角速度和三轴角速度3组CAN数据，这3组CAN数据保证机器人平衡，实时调整机器人的姿态。平衡电机数据采集模块1-3通过ECAT总线，采集电机驱动器(机器人平衡电机所配置的电机驱动器)反馈的当前机器人本文档来自技高网...

【技术保护点】
1.机器人多总线实时控制系统，其特征在于，包括数据采集模块(1)、数据处理模块(2)和命令输出模块(3)；/n所述数据采集模块(1)，与数据处理模块(2)连接，用于通过多种总线实时采集机器人的运行数据，并将运行数据发送至数据处理模块(2)；/n所述数据处理模块(2)，与命令输出模块(3)连接，用于将运行数据处理生成执行命令，并将执行命令发送至命令输出模块(3)；/n所述命令输出模块(3)，用于通过多种总线将执行命令发送至相应的执行机构，使相应的执行机构根据执行命令做出相应的动作。/n

【技术特征摘要】
1.机器人多总线实时控制系统，其特征在于，包括数据采集模块(1)、数据处理模块(2)和命令输出模块(3)；
所述数据采集模块(1)，与数据处理模块(2)连接，用于通过多种总线实时采集机器人的运行数据，并将运行数据发送至数据处理模块(2)；
所述数据处理模块(2)，与命令输出模块(3)连接，用于将运行数据处理生成执行命令，并将执行命令发送至命令输出模块(3)；
所述命令输出模块(3)，用于通过多种总线将执行命令发送至相应的执行机构，使相应的执行机构根据执行命令做出相应的动作。


2.根据权利要求1所述的机器人多总线实时控制系统，其特征在于，所述数据采集模块(1)包括关节位移数据采集模块(1-1)、机器人姿态数据采集模块(1-2)、平衡电机数据采集模块(1-3)和控制命令采集模块(1-4)；
所述控制命令采集模块(1-4)，通过串口总线与控制命令生成模块连接，用于采集控制命令；
所述关节位移数据采集模块(1-1)，通过第一CAN总线与机器人关节伺服模块连接，用于采集机器人各关节的位移数据；
所述机器人姿态数据采集模块(1-2)，通过第二CAN总线与惯性测量单元IMU连接，用于采集机器人的姿态数据；
所述平衡电机数据采集模块(1-3)，通过ECAT总线与机器人平衡电机连接，用于采集机器人平衡电机的参数；
机器人的运行数据包括控制命令、机器人各关节的位移数据、机器人的姿态数据、机器人平衡电机的参数。


3.根据权利要求2所述的机器人多总线实时控制系统，其特征在于，所述数据处理模块(2)包括关节位移数据处理模块(2-1)、机器人姿态数据处理模块(2-2)、平衡电机数据处理模块(2-3)和控制命令处理模块(2-4)；
所述控制命令处理模块(2-4)，同时与控制命令采集模块(1-4)和关节位移数据处理模块(2-1)连接，用于解析控制命令，并将解析后的控制命令发送至关节位移数据处理模块(2-1)；
所述关节位移数据处理模块(2-1)，同时与关节位移数据采集模块(1-1)连接，用于根据控制命令和机器人各关节的位移数据得到机器人各关节的位移期望值，并发送至命令输出模块(3)；
所述机器人姿态数据处理模块(2-2)，与机器人姿态数据采集模块(1-2)连接，用于根据姿态数据得到平衡调整命令；
所述平衡电机数据处理模块(2-3)，同时与机器人姿态数据处理模块(2-2)和平衡电机数据采集模块(1-3)连接，用于根据平衡调整命令和机器人平衡电机当前的参数得到平衡电机参数调节信号，...

【专利技术属性】
技术研发人员：付宜利，李旭，郝国栋，
申请(专利权)人：哈尔滨工业大学，
类型：发明
国别省市：黑龙江;23