基于总线通讯的作业机器人多通道匹配控制方法与流程

摘要: 本发明属于机器人控制,具体地说是基于总线通讯的作业机器人多通道匹配控制方法。背景技术:1、在工业自动化作业场景中,plc与机器人控制器之间普遍采用总线方式实现数...
基于总线通讯的作业机器人多通道匹配控制方法与流程

本发明属于机器人控制,具体地说是基于总线通讯的作业机器人多通道匹配控制方法。

背景技术:

1、在工业自动化作业场景中,plc与机器人控制器之间普遍采用总线方式实现数据交互,现有控制方案大多采用单一通讯通道完成指令下发与状态回传,难以对控制指令、状态反馈、故障信号等不同类型数据做隔离处理,报文易互相干扰,缺少针对性的报文校验、时序管控机制,通讯数据可靠性不足。当总线发生故障时,传统方案仅能够处理整体链路断线问题,无法区分全局总线断线与单通道信号异常,故障定位精度低,多通道故障发生后缺少局部通道重建手段,往往需要整体重启通讯链路,会造成作业中断。同时,故障恢复后一般不具备断点续作业能力,需要工件重新返工处理,降低生产效率。刹车盘喷涂作为典型应用场景,工件尺寸存在差异,作业过程中需要同步调控电机转速与介质泵压力,对总线通讯的实时性、稳定性要求更高,现有通讯控制方式难以兼顾多类数据隔离传输、故障分类处置以及故障续作的实际需求,制约了自动化作业设备运行可靠性,因此亟需一种多通道匹配控制方法解决上述问题。

技术实现思路

1、针对现有技术的不足,本发明提出了基于总线通讯的作业机器人多通道匹配控制方法,建立plc与作业机器人控制器的点对点总线通讯链路,划分四类报文通道并配置独立存储区块与差异化校验规则;plc获取输送线输出的工件定位状态及外径尺寸参数,封装携带时序标定参数的同步通讯报文,经时序校验后触发机器人进行工艺作业;机器人回传实时作业数据,作业完成后执行双向通讯握手校验,校验通过驱动桁架移栽机构转运工件;系统周期性监测报文通道工况,区分全局总线断线与单通道异常故障,执行对应重连并上传故障信息,故障恢复后支持断点续作业;本发明实现多通道可靠通讯与故障自恢复,提升自动化作业稳定性。

2、为实现上述目的,本发明提供如下技术方案:

3、基于总线通讯的作业机器人多通道匹配控制方法,包括:

4、建立plc与作业机器人控制器的点对点总线通讯链路,将链路逻辑划分为四类报文通道,为每类报文通道配置存储区块与数据校验规则;

5、获取倍速线输出的工件定位完成状态信号及工件外径尺寸参数,将工件外径尺寸参数存入plc数据区,依据定位完成状态信号,通过启停控制报文通道封装搭载统一时序标定参数的同步通讯报文;

6、对同步通讯报文执行时序合规性校验,校验通过后触发机器人启动工艺作业,同步采集实时作业数据并对应传输至报文通道回传plc;

7、plc根据回传的实时作业数据及工件外径尺寸参数,输出自转变频电机转速调控指令及介质泵压力调节指令;

8、获取机器人反馈的工艺工序完成信号,依据点对点总线通讯链路执行plc与机器人的双向通讯握手校验,校验合规后触发桁架移栽机构完成工件转运;

9、实时监测报文通道的通讯工况数据,基于通讯工况数据区分全局总线断线故障与单通道信号异常故障,分别执行全链路重连或单通道局部重连,同步上传故障信息至plc。

10、具体地,所述将链路逻辑划分为四类报文通道,包括:

11、基于plc内部数据块的空闲地址区间,按照地址连续分配方式分别为介质流量报文通道、自转转速报文通道、启停控制报文通道及故障信号报文通道划分相互独立的存储区块,每个存储区块均包含用于标识报文有效性的状态标识子区、用于存放过程数据的数据值子区以及用于记录报文生成时间的时间戳子区;

12、为介质流量报文通道和自转转速报文通道配置基于循环冗余校验原理的十六位校验规则,为启停控制报文通道和故障信号报文通道配置基于循环冗余校验原理的八位校验规则;

13、完成存储区块划分及校验规则配置后,通过各报文通道向作业机器人控制器发送标准测试指令,根据作业机器人控制器回传的响应报文与标准测试指令的匹配结果,验证各报文通道配置的正确性。

14、具体地,所述获取倍速线输出的工件定位完成状态信号及工件外径尺寸参数,包括:

15、通过plc的数字量输入接口接收倍速线输送机构上安装的位置传感器输出的定位完成状态信号,所述定位完成状态信号在工件到达作业工位预定停止位置时由低电平切换为高电平;

16、在接收到定位完成状态信号后,通过plc的模拟量输入接口读取倍速线侧方安装的测距传感器输出的距离模拟信号,将所述距离模拟信号经模数转换后得到的数字距离值与预先存储于plc数据块中的传感器标定参数执行换算,得到工件外径尺寸参数;

17、将所述工件外径尺寸参数存入plc数据块中的工件参数存储地址,同时将定位完成状态信号的电平状态写入plc内部辅助继电器区的对应位地址。

18、具体地,所述依据定位完成状态信号,通过启停控制报文通道封装搭载统一时序标定参数的同步通讯报文,包括:

19、plc在每个固定扫描周期内读取内部辅助继电器区中定位完成状态信号的当前电平值,当检测到定位完成状态信号由低电平跳变为高电平时,触发同步通讯报文封装进程;

20、在所述同步通讯报文封装进程中,从plc的系统时钟寄存器中读取当前系统时间作为统一时序标定参数,从工件参数存储地址中读取工件外径尺寸参数作为工艺作业的目标工艺参数;

21、按照启停控制报文通道的预定报文帧结构,将统一时序标定参数写入报文帧的时序标签字段,将预设的作业启动指令代码写入报文帧的指令字段,将工件外径尺寸参数写入报文帧的数据载荷字段,完成同步通讯报文的封装。

22、具体地,所述对同步通讯报文执行时序合规性校验,包括:

23、plc的通讯处理器从封装完毕的同步通讯报文中提取统一时序标定参数,并将所述统一时序标定参数与当前系统时钟的当前时间执行差值计算,得到报文从封装到校验时刻的驻留时长值;

24、将所述驻留时长值与预先存储于plc内部寄存器中的最大允许驻留时长门限值执行比较,若驻留时长值小于或等于最大允许驻留时长门限值,则判定时序合规性校验通过;若驻留时长值大于最大允许驻留时长门限值,则判定时序合规性校验不通过;

25、在判定时序合规性校验不通过时,plc丢弃当前同步通讯报文并返回同步通讯报文封装步骤重新执行,直至封装后的同步通讯报文通过时序合规性校验。

26、具体地,所述校验通过后触发机器人启动工艺作业的具体过程为:

27、plc在判定时序合规性校验通过后,通过启停控制报文通道将经过时序合规性校验的同步通讯报文发送至作业机器人控制器;

28、作业机器人控制器接收到同步通讯报文后,从报文帧的数据载荷字段中解析出工件外径尺寸参数,将所述工件外径尺寸参数输入至作业机器人控制器内置的轨迹规划模块;

29、所述轨迹规划模块依据工件外径尺寸参数从预先存储的多个作业轨迹模板中选取对应尺寸区间的目标模板,根据目标模板生成作业机器人各运动关节的驱动指令序列,作业机器人控制器执行所述驱动指令序列以启动工艺作业。

30、具体地,所述作业机器人控制器在工艺作业启动的同时开启实时作业数据采集线程,所述实时作业数据采集线程在每个采样周期内执行以下采集操作:

31、通过安装于工艺介质管路处的压力传感器采集工艺执行压力模拟信号,将所述工艺执行压力模拟信号经模数转换后量化为工艺执行压力数字值;通过作业机器人控制器内部运行的软件计数器对已完成作业循环的次数进行累加计数,每次完成一个完整的轨迹循环后软件计数器加1,生成工艺作业次数计数值;通过作业机器人控制器读取各运动关节伺服驱动器的角度反馈值,将各角度反馈值组合为反映机器人末端位姿的运行姿态向量。

32、具体地,所述对应传输至报文通道回传plc的具体过程包括:

33、作业机器人控制器将工艺执行压力数字值按照介质流量报文通道的帧格式封装为介质流量回传报文,将运行姿态向量中的自转轴角度值按照自转转速报文通道的帧格式封装为自转转速回传报文,将工艺作业次数计数值按照故障信号报文通道的帧格式封装为作业状态回传报文;

34、作业机器人控制器将介质流量回传报文、自转转速回传报文和作业状态回传报文依次发送至点对点总线通讯链路,每个回传报文均携带由作业机器人控制器本地时钟生成的时间戳;

35、plc的通讯处理器从点对点总线通讯链路上接收各回传报文,对各回传报文分别执行对应报文通道的校验规则,校验通过后将各回传报文中的数据值存入plc数据块中对应存储区块的数据值子区。

36、具体地,所述plc根据回传的实时作业数据及工件外径尺寸参数,输出自转变频电机转速调控指令及介质泵压力调节指令,包括:

37、plc从介质流量回传报文中提取工艺执行压力数字值,将工艺执行压力数字值与内部存储的工艺执行压力目标值执行偏差计算得到工艺执行压力偏差值,采用pid算法对所述工艺执行压力偏差值进行运算得到介质泵压力调节量,将介质泵压力调节量转换为模拟量控制信号输出至介质泵的变频驱动器作为介质泵压力调节指令;

38、plc从自转转速回传报文中提取自转轴角度值,对相邻采样时刻的自转轴角度值执行差分计算得到自转轴实际转速值,将自转轴实际转速值与内部存储的自转轴转速目标值执行偏差计算得到转速偏差值,采用pi控制算法对所述转速偏差值进行运算得到变频电机频率调节量,将变频电机频率调节量转换为模拟量控制信号输出至自转变频电机的变频驱动器作为自转变频电机转速调控指令。

39、具体地,所述依据点对点总线通讯链路执行plc与机器人的双向通讯握手校验,包括:

40、作业机器人控制器在判定驱动指令序列中所有指令均已执行完毕后生成作业工序完成标志位,通过故障信号报文通道将包含作业工序完成标志位的完成信号报文发送至plc;

41、plc从故障信号报文通道接收到完成信号报文并经校验通过后,通过启停控制报文通道向作业机器人控制器发送包含随机校验数的握手请求报文;

42、作业机器人控制器接收握手请求报文后提取随机校验数,对随机校验数执行预设的逻辑变换运算得到变换响应值,通过故障信号报文通道向plc回传包含变换响应值的握手应答报文;

43、plc接收握手应答报文后提取变换响应值,同时对本地缓存的随机校验数执行相同的预设逻辑变换运算得到本地校验值,将变换响应值与本地校验值执行一致性判定,若一致则确认双向通讯握手校验合规。

44、具体地,所述校验合规后触发桁架移栽机构完成工件转运,包括:

45、plc在双向通讯握手校验合规后生成桁架移栽启动指令,通过数字量输出接口将桁架移栽启动指令输出至桁架移栽机构的运动控制器;所述桁架移栽启动指令包含目标接收工位的地址编码信息;

46、桁架移栽机构的运动控制器根据接收到的桁架移栽启动指令驱动桁架移栽机构的水平轴伺服电机和升降轴伺服电机按照预定移栽轨迹联动运行,将作业完毕的工件从作业工位移送至下一工序的接收工位;

47、桁架移栽机构的运动控制器在移栽动作完成后向plc回传移栽完成确认信号,plc接收到移栽完成确认信号后将内部辅助继电器区中的定位完成状态信号和作业工序完成标志位均复位至初始状态。

48、具体地,所述实时监测报文通道的通讯工况数据,基于通讯工况数据区分全局总线断线故障与单通道信号异常故障,包括:

49、每个监测周期内plc依次通过介质流量报文通道、自转转速报文通道、启停控制报文通道和故障信号报文通道向作业机器人控制器发送心跳检测报文;

50、作业机器人控制器在接收到各报文通道的心跳检测报文后,通过对应的报文通道向plc回传心跳响应报文;

51、plc在每个监测周期内统计各报文通道接收到的心跳响应报文的数量及各心跳响应报文的接收时刻与对应心跳检测报文发送时刻之间的时间延迟值,将各报文通道的心跳响应报文数量和接收时间延迟值作为通讯工况数据存入plc内部的状态监测存储区;

52、同时将各报文通道的心跳响应报文数量分别与预设的期望响应数量执行比较;若所有报文通道的心跳响应报文数量均为零,则判定为全局总线断线故障;若仅部分报文通道的心跳响应报文数量为零而其余报文通道的心跳响应报文数量正常,则判定心跳响应报文数量为零的报文通道存在单通道信号异常故障;

53、在判定为单通道信号异常故障后,plc读取异常通道的接收时间延迟值,若所述接收时间延迟值持续大于预设的最大允许延迟值,则确认对应通道处于信号异常故障状态。

54、与现有技术相比,本发明的有益效果是:

55、1.本发明通过设置四类相互独立的报文通道,搭配差异化的存储区块与crc校验规则,实现指令、工艺数据、故障信息的分类隔离传输,配合同步通讯报文时序合规校验以及plc与机器人控制器之间双向通讯握手校验,有效规避不同类型报文相互干扰、报文超时失效的问题,提升plc与作业机器人控制器之间总线通讯的数据完整性与时序可靠性;基于工件外形尺寸参数匹配机器人作业轨迹模板,结合pid、pi闭环算法对自转变频电机、介质泵进行联动调节,能够适配不同规格工件的工艺生产需求;该通用控制框架可向下兼容刹车盘喷涂工况,保障压力、转速等工艺参数动态匹配,提升工艺执行一致性。

56、2.本发明对各报文通道开展心跳监测,能够区分全局总线断线故障与单通道信号异常故障,针对不同故障类型分别执行全链路重连或者单通道局部重建,无需整体重启整套通讯系统,缩小故障影响范围;故障记录保存至非易失性存储区并上传至上位机,便于运维人员快速定位问题;链路恢复后可执行断点续作业,无需工件返工或从头启动作业流程,减少生产停机时间,强化了通讯故障的识别、修复能力,提高设备容错能力,降低故障带来的产能损耗。