一种基于EtherCAT通信的控制系统、方法及双轴驱动控制装置制造方法及图纸

本发明专利技术涉及机器人控制领域，具体涉及一种基于EtherCAT通信的控制系统、方法及双轴驱动控制装置，系统包括：主站和从站之间通过EtherCAT总线进行数据通信；主站包括上层控制器，上层控制器用于输出控制指令至从站，控制指令包括速度指令和角度位置指令；从站包括带有EtherCAT网络接口的双轴伺服驱动器和伺服电机，伺服电机包括转向电机和牵引电机，双轴伺服驱动器接收控制指令，并控制牵引电机和转向电机运行；双轴伺服驱动器还用于采集转向电机和牵引电机的速度和角度位置，并将速度和角度位置通过EtherCAT总线反馈至上层控制器。本发明专利技术可同时给牵引电机和转向电机发送控制指令，减少了通信延迟时间，提高整个控制系统的动态响应能力和数据传输能力。动态响应能力和数据传输能力。动态响应能力和数据传输能力。

【技术实现步骤摘要】
一种基于EtherCAT通信的控制系统、方法及双轴驱动控制装置


[0001]本专利技术涉及机器人控制领域，具体而言，涉及一种基于EtherCAT通信的控制系统、方法及双轴驱动控制装置。

技术介绍

[0002]在智能工厂和智能物流中，移动机器人是其重要组成部分，它能够轻松取代人工的重复搬运工作，不仅能够节约人工成本，而且设置柔性强，不占用固定地面面积，可合理利用通道等，提高空间利用率，是未来制造业研究工作的重中之重，具有十分广大的应用前景。
[0003]移动机器人由驱动系统、激光导引(磁导引)系统和控制系统三大部分组成。其中驱动系统所占成本比例最大。舵轮作为移动机器人的驱动和转向执行部件；现有的舵轮驱动结构中，分为牵引电机驱动和转向电机驱动，二者相互独立，拥有各自的驱动控制总成，无疑增加了舵轮的结构体积和制造成本，且使用不便、维护复杂。
[0004]牵引电机和转向电机在独立的硬件电路设计上，增大了相互干扰和布线风险。对移动机器人上层控制器而言，需要通过两路控制总线分别对牵引和转向控制系统发送上位机指令，使得舵轮的内部结构复杂混乱，不利于测试和错误排查，因其外围电路及电缆较多，布线复杂导致可靠性低。同时也使得上位机的通信控制程序复杂，至少需要两个通信周期，分别对二者发送指令，实时性能下降，通信延迟增大。

技术实现思路

[0005]本专利技术实施例提供了一种基于EtherCAT通信的控制系统、方法及双轴驱动控制装置，可同时给牵引电机和转向电机发送控制指令，减少了通信延迟时间，提高整个控制系统的动态响应能力和数据传输能力。
[0006]根据本专利技术的一实施例，提供了一种基于EtherCAT通信的控制系统，包括：主站和从站，主站和从站之间通过EtherCAT总线进行数据通信；主站包括上层控制器，上层控制器用于输出控制指令至从站，控制指令包括速度指令和角度位置指令；从站包括带有EtherCAT网络接口的双轴伺服驱动器和伺服电机，伺服电机包括转向电机和牵引电机，双轴伺服驱动器接收控制指令，并控制牵引电机和转向电机运行；双轴伺服驱动器还用于采集转向电机和牵引电机的速度和角度位置，并将速度和角度位置通过EtherCAT总线反馈至上层控制器。
[0007]进一步地，双轴伺服驱动器包括用于采集牵引电机的速度和角度位置的增量式编码器、用于采集的转向电机的速度和角度位置的绝对式编码器；增量式编码器和绝对式编码器将采集的牵引电机的速度和角度位置及转向电机的速度和角度位置反馈至上层控制器。
[0008]进一步地，双轴伺服驱动器包括第一路处理电路和第二路处理电路，第一路处理
电路和第二路处理电路分别同时控制牵引电机和转向电机运行。
[0009]进一步地，第一路处理电路包括第一速度控制器和第一电流控制器，上层控制器通过EtherCAT总线输出的速度指令与增量式编码器采集的牵引电机的速度反馈作为第一速度控制器的输入信号；第一速度控制器的输出信号与第一处理电路的第一电流反馈作为第一电流控制器的输入信号。
[0010]进一步地，第二路处理电路包括位置控制器、第二速度控制器及第二电流控制器，上层控制器通过EtherCAT总线输出的角度位置指令与绝对式式编码器采集的转向电机的角度位置反馈作为位置控制器的输入信号；位置控制器的输出信号与绝对式编码器采集的转向电机的速度反馈作为第二速度控制器的输入信号；第二速度控制器的输出信号与第二处理电路的第二电流反馈作为第二电流控制器的输入信号。
[0011]本申请通过的一种基于EtherCAT通信的控制方法，包括以下步骤：
[0012]上层控制器通过EthertCAT总线输出控制指令至双轴伺服驱动器，控制指令包括速度指令和角度位置指令；
[0013]双轴伺服驱动器根据控制指令控制牵引电机和转向电机转动；
[0014]双轴伺服驱动器采集牵引电机和转向电机转动的速度及角度位置；
[0015]将采集到的牵引电机和转向电机的速度及角度位置通过EthertCAT总线反馈至上层控制器。
[0016]进一步地，在上层控制器通过EthertCAT总线输出速度指令和位置指令至双轴伺服驱动器之前还包括：
[0017]对速度指令和位置指令轨迹进行规划；
[0018]将规划后的速度指令和位置指令编辑在EthertCAT总线数据帧上。
[0019]进一步地，双轴伺服驱动器包括用于采集牵引电机的速度和角度位置的增量式编码器、用于采集的转向电机的速度和角度位置的绝对式编码器；增量式编码器将采集的牵引电机的速度和角度位置及绝对式编码器将采集的转向电机的速度和角度位置反馈至上层控制器。
[0020]本申请提供一种双轴驱动控制装置，包括：依次分布的双轴伺服驱动器、转向齿轮、轴承座、转向电机及牵引电机；双轴伺服驱动器分别同时控制牵引电机和转向电机的转动；牵引电机上安装有用于反馈牵引电机转动速度及角度位置的增量式编码器，转向电机上安装有用于反馈转向电机转动速度及角度位置的绝对值编码器。
[0021]进一步地，双轴伺服驱动器、转向齿轮、轴承座、转向电机及牵引电机集成在一块控制板卡中。
[0022]本专利技术的有益效果至少包括：
[0023]1.本专利技术基于EtherCAT，实现主站和从站之间的数据通信；基于EtherCAT通信的控制端和发起端，能够在每个网络周期中接收从站数据帧，并对这些数据帧进行处理，然后上层控制器通过EtherCAT总线把处理过的包括控制指令的数据帧发给双轴伺服驱动器，双轴伺服驱动器分别同时控制转向电机和牵引电机转动，并且将该两个电机的转动速度和角度位置反馈至上层控制器，从而实现主站与从站之间的数据通信；
[0024]传统电机驱动的一对一控制改为一对多控制，在双轴协调控制下，双轴伺服驱动器发出电机控制指令，同时控制转向电机和牵引电机转动，有效提高双电机转动在系统中
协同控制的效果；
[0025]选用EtherCAT总线通信方式具有可靠性高、技术成熟、开放方便等优点，与普通现场总线相比，带宽利用率更高，响应速度更快，抗干扰能力强。同时EtherCAT灵活的拓扑结构，能实现双电机同步实时控制。
[0026]2.本专利技术设计根据驱动器控制实际应用中的工况需求，采用两种不同的控制策略，一种为位置闭环控制，一种为速度闭环控制。对转向电机的控制采用位置闭环控制，并结合绝对式编码器，准确定位任意时刻的转角信号，上电时刻不需要寻零操作；在保证转角精度的同时，加强了转向柔顺行，并保证了转向电机的转向姿态连续和稳定性。对牵引电机的控制采用速度闭环控制，并结合增量式编码器，速度闭环响应更快，实时执行来自上层控制器的速度指令，实现转速的平稳运行和快速调节，保证了牵引电机的目标运行轨迹。
[0027]3.通过牵引电机采用增量式编码器作为位置和速度的反馈装置，转向电机采用绝对值编码器作为位置反馈装置，能够在系统启动时刻检测到该两电机的转向角度，有利于提高轨迹指令在起始阶段的精度，消除轨迹偏移。
本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种基于EtherCAT通信的控制系统，其特征在于，包括：主站和从站，所述主站和所述从站之间通过EtherCAT总线进行数据通信；所述主站包括上层控制器，所述上层控制器用于输出控制指令至所述从站，所述控制指令包括速度指令和角度位置指令；所述从站包括带有EtherCAT网络接口的双轴伺服驱动器和伺服电机，所述伺服电机包括转向电机和牵引电机，所述双轴伺服驱动器接收所述控制指令，并控制所述牵引电机和所述转向电机运行；所述双轴伺服驱动器还用于采集所述转向电机和所述牵引电机的速度和角度位置，并将所述速度和所述角度位置通过EtherCAT总线反馈至所述上层控制器。2.根据权利要求1所述的基于EtherCAT通信的控制系统，其特征在于，所述双轴伺服驱动器包括用于采集所述牵引电机的速度和角度位置的增量式编码器、用于采集的所述转向电机的速度和角度位置的绝对式编码器；所述增量式编码器和所述绝对式编码器将采集的所述牵引电机的速度和角度位置及所述转向电机的速度和角度位置反馈至所述上层控制器。3.根据权利要求1所述的基于EtherCAT通信的控制系统，其特征在于，所述双轴伺服驱动器包括第一路处理电路和第二路处理电路，所述第一路处理电路和第二路处理电路分别同时控制所述所述牵引电机和所述转向电机运行。4.根据权利要求3所述的基于EtherCAT通信的控制系统，其特征在于，所述第一路处理电路包括第一速度控制器和第一电流控制器，所述上层控制器通过所述EtherCAT总线输出的所述速度指令与所述增量式编码器采集的所述牵引电机的速度反馈作为所述第一速度控制器的输入信号；所述第一速度控制器的输出信号与所述第一处理电路的第一电流反馈作为所述第一电流控制器的输入信号。5.根据权利要求3所述的基于EtherCAT通信的控制系统，其特征在于，所述第二路处理电路包括位置控制器、第二速度控制器及第二电流控制器，所述上层控制器通过所述EtherCAT总线输出的所述角度位置指令与所述绝对式式编码器采集的所述转向电机的角度位置反馈作为所述位置控制...

【专利技术属性】
技术研发人员：栾显晔，刘洋，赵晨，宛月，王冬雷，马壮，
申请(专利权)人：山东新松工业软件研究院股份有限公司，
类型：发明
国别省市：