一种采用EtherCAT协议的实时同步机器人扭矩扭力控制系统的制作方法

文档序号:12832472阅读:来源:国知局

技术特征:

1.一种采用EtherCAT协议的实时同步机器人扭矩扭力控制系统,其特征在于,包括管理主从站之间的数据通信的EtherCAT主站控制器,接收EtherCAT主站控制器发送的报文进行识别且发送至微处理器、接收微处理器发送信息发送报文至EtherCAT主站控制器的EtherCAT从站控制器,微控制器和扭矩扭力控制模块;EtherCAT主站控制器与EtherCAT从站控制器通过网线连接,EtherCAT从站控制器与微控制器通过串口/并口连接,

EtherCAT主站控制器采用搭载有倍福公司的TwinCAT开发平台的PC机;

EtherCAT从站控制器采用从站控制芯片ET1100;

扭矩扭力控制模块包括扭矩扭力输出单元和扭矩扭力输入单元,扭矩扭力输出单元包括DA转换单元和输出信号放大单元,扭矩扭力输入单元包括输入信号放大单元和AD转换单元;DA转换单元的输入端与微处理器的扭矩扭力数据输出端连接,DA转换单元的输出端与输出信号放大单元的数据输入端连接,输出信号放大单元的数据输出端与机器人处的伺服驱动器连接;输入信号放大单元的数据输入端与机器人处的伺服驱动器连接,输入信号放大单元的数据输出端与AD转换单元的输入端连接,AD转换单元的输出端与微处理器的扭矩扭力数据输入端连接。

2.如权利要求1所述的一种采用EtherCAT协议的实时同步机器人扭矩扭力控制系统,其特征在于,微处理器采用单片机芯片STM32F407ZET6,单片机芯片STM32F407ZET6外接时钟电路、复位电路、电源电路,所述电源电路包括24V转正负12V电源电路、24V转5V电源电路、5V转3.3V电源电路、5V转2.5V电源电路,24V转正负12V电源电路包括芯片U3,外部输入INPUT+24V经二极管D3后与芯片U3的引脚1连接,芯片U3的引脚3输出电压VCC-12V,芯片U3的引脚5输出电压VCC+12V;

24V转5V电源电路包括芯片U4,外部输入INPUT+24V与芯片U4的引脚1连接,芯片U4的引脚4输出电压VCC+5V;

5V转3.3V电源电路包括芯片U6,芯片U6的引脚1外接电压VCC+5V,芯片U6的引脚2与引脚4连接后输出电压V3.3V;

5V转2.5V电源电路包括芯片U5,芯片U5的引脚2输入电压VCC+5V,芯片U5的引脚6输出电压VCC jizhuan+2.5V。

3.如权利要求1所述的一种采用EtherCAT协议的实时同步机器人扭矩扭力控制系统,其特征在于,DA转换单元包括DA转换芯片U12、DA转换芯片U20,输出信号放大单元包括运放芯片U10、运放芯片U14、运放芯片U16、运放芯片U18、运放芯片U22、运放芯片U24;

DA转换芯片U12的输入端、DA转换芯片U20的输入端分别与单片机芯片STM32F407ZET6的扭矩扭力数据输出端连接,DA转换芯片U12的输出端分别与运放芯片U10、运放芯片U14、运放芯片U16、运放芯片U18的正输入端连接;DA转换芯片U20的输出端分别与运放芯片U22、运放芯片U24的正输入端连接;

AD转换单元包括AD转换芯片U13和AD转换芯片U21,输入信号放大单元包括运放芯片U11、运放芯片U15、运放芯片U17、运放芯片U19、运放芯片U23和运放芯片U25;

运放芯片U11、运放芯片U15、运放芯片U17、运放芯片U19的输出端分别与AD转换芯片U13的输入端连接,AD转换芯片U13的输出端与单片机芯片STM32F407ZET6的扭矩扭力数据输入端连接;运放芯片U23和运放芯片U25的输出端分别与AD转换芯片U21的输入端连接,AD转换芯片U21的输出端与单片机芯片STM32F407ZET6的扭矩扭力数据输入端连接。

当前第2页1 2 3 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1