当前位置: 首页 > 专利查询>同济大学专利>正文

一种机器人的分布式控制系统总线结构技术方案

技术编号:8300488 阅读:179 留言:0更新日期:2013-02-07 03:35
本发明专利技术涉及一种用于机器人分布式控制系统的总线结构,该总线结构包括电源总线、数据总线、地线和接口电路,所述的接口电路与控制系统的主机或从机连接,所述的接口电路控制数据流向,所述的总线结构的总线协议为主从应答式,信息以帧为单位,主机信息帧由同步头、帧长度、目标ID、操作码、数据类别、数据内容和效验码组成,从机信息帧由同步头、帧长度、目标ID、数据内容、错误类型字节和效验码组成。与现有技术相比,本发明专利技术具有实用性强、可靠性高、通讯速率4MBPS以上,且简化机器人的布线等优点。

【技术实现步骤摘要】

本专利技术涉及机器人控制系统领域,尤其是涉及一种机器人的分布式控制系统总线结构
技术介绍
在生广自动化领域,有集中式控制系统和分布式控制系统。在机器人控制系统中,这两种控制系统都得到了应用。集中式控制系统的优点是结构简单、整体性和协调性好、集中式的数据容易管理并容易保证数据的一致性。但其缺点也很多,如软件系统庞大复杂,可扩展性差。如果机器人的关节多,自由度数量大,采取分布式控制系统是比较合理的选择。典型的机器人分布式控制系统采用分层控制的方法,如下所述第一层为上位机,·主要进行步态规划,动作编排并下传至机器人控制器;第二层为机器人控制器,用于接收上位机下传的动作,并向总线发送命令控制各电机模块和传感器模块;第三层为电机控制模块和传感器模块,电机控制模块内含微控制器和直流电机,它从总线接收主控器的命令,控制内部直流电机的速度、角度等。目前有多种总线在机器人分布式控制系统中应用。其中以CAN总线的应用最为广泛。CAN协议的一个最大特点是废除了传统的站地址编码,而代之以对通信数据块进行编码。但是CAN总线布线复杂,而且随着机器人技术的不断进步,对总线通信速度也有了新的要求,传统的CAN总线已不能满足需要。
技术实现思路
本专利技术的目的就是为了克服上述现有技术存在的缺陷而提供一种可靠性高、通讯速率4M以上,且简化机器人的布线的机器人的分布式控制系统总线结构。本专利技术的目的可以通过以下技术方案来实现一种用于机器人分布式控制系统的总线结构,其特征在于,该总线结构包括电源总线、数据总线、地线和接口电路,所述的接口电路与控制系统的主机或从机连接,所述的接口电路控制数据流向,所述的总线结构的总线协议为主从应答式,信息以帧为单位,主机信息帧由同步头、帧长度、目标ID、操作码、数据类别、数据内容和效验码组成,从机信息帧由同步头、帧长度、目标ID、数据内容、错误类型字节和效验码组成。所述的接口电路包括电阻R1、三极管Q1、电阻R2、总线驱动器U1、总线驱动器U2和电阻RO ;所述的电阻Rl —端接主机/从机的单片机的高低电平输出端口,另一端接三极管Ql的基极;所述的三极管Ql的集电极通过电阻R2与电源连接,三极管Ql的发射极接地;所述的总线驱动器Ul的的数据输入端与主机/从机的单片机的发送引脚连接,总线驱动器Ul的的数据输出端与数据总线连接,总线驱动器Ul的的输出允许控制端连接在三极管Ql与电阻R2之间;所述的总线驱动器U2的数据输出端与主机/从机的单片机的接收引脚连接,总线驱动器U2的数据输入端与数据总线连接,总线驱动器U2的输出允许控制端连接在主机/从机的单片机的高低电平输出端口与电阻Rl之间;所述的电阻RO的一端连接电源,另一端分别连接总线驱动器Ul的数据输出端和总线驱动器U2的数据输入端。所述的三极管Ql为NPN型三极管。所述的总线驱动器Ul和总线驱动器U2均为74HC126芯片。所述的主机/从机的单片机采用基于ARM C0RTEX-M3内核的STM32系列单片机。所述的数据总线采用TTL电平格式,高电平为3. 3V,低电平为0V,总线空闲时保持高电平。与现有技术相比,本专利技术具有以下优点I、可使网络内的节点个数在理论上不受限制; 2、具有很强的实用性,很高的可靠性;3、具有比CAN总线更快的通讯速率,可具有达4MBPS以上的波特率;5、该三线制总线将电源总线和数据总线合为一体,简化了机器人的布线,在多关节、多模块机器人中具有很好的应用前景。附图说明图I为本专利技术的总线物理接口图;图2为以STM32单片机为例的实现单线数据总线图;图3为机器人整体结构示意图。具体实施例方式下面结合附图和具体实施例对本专利技术进行详细说明。实施例一种机器人的分布式控制系统总线结构,该总线结构采用三线制总线,其包括电源总线、数据总线、地线和接口电路。如图I所示,总线的对外物理接口采用2. 54mm间距的三插针,从左至右,依次为电源、数据、地。电源总线的电压可为3.0V-40V(依关节驱动电压定);该总线的电源总线不仅为总线上所有的数字舵机内部的电机提供电压支持,也为数字舵机内部的控制芯片提供电压支持,将电源总线电压通过开关电源芯片或者线性电源芯片可获得5V、3. 3V等电压。数据总线采用TTL电平格式,高电平为3. 3V,低电平为0V。接口电路包括电阻R1、三极管Q1、电阻R2、总线驱动器Ul、总线驱动器U2和电阻R0。电阻Rl —端接主机/从机的单片机的高低电平输出端口,另一端接三极管Ql的基极。三极管Ql的集电极通过电阻R2与电源连接,三极管Ql的发射极接地。总线驱动器Ul的的数据输入端与主机/从机的单片机的发送引脚连接,总线驱动器Ul的的数据输出端与数据总线连接,总线驱动器Ul的的输出允许控制端连接在三极管Ql与电阻R2之间。总线驱动器U2的数据输出端与主机/从机的单片机的接收引脚连接,总线驱动器U2的数据输入端与数据总线连接,总线驱动器U2的输出允许控制端连接在主机/从机的单片机的高低电平输出端口与电阻Rl之间。电阻RO的一端连接电源,另一端分别连接总线驱动器Ul的数据输出端和总线驱动器U2的数据输入端。如图2所示,为了使数据总线达到4MBPS以上的波特率,选择适宜的微控制器十分必要,采用基于ARM C0RTEX-M3内核的STM32系列单片机可达到要求。本专利技术以STM32单片机为例实现单线数据的连接。其中接口电路的电阻Rl阻值1000欧姆,三极管Ql为NPN型三极管,电阻R2阻值为1000欧姆;总线驱动器Ul和总线驱动器U2均采用74HC126 ;电阻RO阻值为4700欧姆。接口电路的A点接STM32单片机的PA8端口,当PA8输出低电平时,三极管Ql工作于截止状态,B点输出高电平;iPA8输出高电平时,三极管Ql工作于饱和状态,B点输出低电平。总线驱动器Ul和U2,当其I号引脚(即输出允许控制端)输入低电平时,3号引脚(即数据输出端)呈高阻态;当其I号引脚输入高电平时,3号引脚输出等于2号引脚(即数据输入端)输入。数据总线通过电阻RO上拉至3. 3V,确保了当总线空闲时,总线保持高电平3. 3V。如图2所示,所有主机和从机均采用此接口电路,主控制器为主机,关节舵机以及传感器模块为从机。当PA8输出低电平时,U2的输出呈高阻态,单片机的串口接收引脚不接收数据总线的数据,B点呈高电平,Ul输出等于Ul输入,由于Ul的2号引脚与STM32单片机的串口发送引脚相连,此时单片机将向数据总线发送数据;iPA8输出高电平时,B点呈低电平,Ul的输出呈高阻态,此时单片机不能向数据总线发送数据,U2输出等于U2输入,由于U2的3号引脚与STM32单片机的串口接收引脚相连,单片机的串口接收引脚开始接收数据总线的数据。由此可见,通过改变PA8的输出电平,将数据总线的收发过程分离开来, 实现了单数据线的半双工串行通信。PA8默认处于高电平,无论主机还是从机默认均处于接收状态(总线监听状态)。总线结构的总线协议采用主从问答式方式进行通讯,主控制器为主机,关节舵机以及传感器模块为从机;数据总线波特率达到4M BPS以上,起始位为0,停止位为I ;从机的数目可达256 (协议经扩展可支持更大数量的从机);主机既可以单独向某一从机发送,也可以进行广播式发送;主本文档来自技高网...

【技术保护点】
一种用于机器人分布式控制系统的总线结构,其特征在于,该总线结构包括电源总线、数据总线、地线和接口电路,所述的接口电路与控制系统的主机或从机连接,所述的接口电路控制数据流向,所述的总线结构的总线协议为主从应答式,信息以帧为单位,主机信息帧由同步头、帧长度、目标ID、操作码、数据类别、数据内容和效验码组成,从机信息帧由同步头、帧长度、目标ID、数据内容、错误类型字节和效验码组成。

【技术特征摘要】

【专利技术属性】
技术研发人员:何斌王锋张洪涛刘超群蒙伟斌李强
申请(专利权)人:同济大学
类型:发明
国别省市:

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1