[发明专利]机器人运行系统的控制方法和装置有效
申请号: | 202011262738.7 | 申请日: | 2020-11-12 |
公开(公告)号: | CN112440279B | 公开(公告)日: | 2022-03-22 |
发明(设计)人: | 陈海波;其他发明人请求不公开姓名 | 申请(专利权)人: | 深兰科技(上海)有限公司 |
主分类号: | B25J9/16 | 分类号: | B25J9/16;B25J19/06 |
代理公司: | 常州佰业腾飞专利代理事务所(普通合伙) 32231 | 代理人: | 陈红桥 |
地址: | 200336 上海市长宁区威*** | 国省代码: | 上海;31 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 机器人 运行 系统 控制 方法 装置 | ||
1.一种机器人运行系统的控制方法,其特征在于,所述系统包括:上位机、下位机和电机驱动器,所述控制方法包括以下步骤:
接收所述上位机发送的速度控制指令;
延时第一预设时间,判断所述下位机是否接收到所述速度控制指令;
确定所述下位机未接收到所述速度控制指令,则控制所述下位机发送急停控制指令至所述电机驱动器;
延时第二预设时间,判断所述电机控制器是否接收到所述急停控制指令;
确定所述电机驱动器未接收到所述急停控制指令,则控制所述电机驱动器停止运行,
所述的机器人运行系统的控制方法还包括:
确定所述下位机接收到所述速度控制指令,则将所述速度控制指令发送至所述电机驱动器;
延时所述第二预设时间,确定所述电机驱动器接收到所述速度控制指令,则控制所述电机驱动器按照所述速度控制指令运行,
所述确定所述下位机接收到所述速度控制指令之后,还包括:
获取所述驱动电机的里程数据,并控制所述下位机将所述里程数据发送至所述上位机;
延时第三预设时间,确定所述上位机接收到所述里程数据,则更新里程数据,
所述的机器人运行系统的控制方法还包括:
确定所述上位机未接收到所述里程数据,控制所述上位机发送急停控制指令至所述电机驱动控制器。
2.根据权利要求1所述的机器人运行系统的控制方法,其特征在于,还包括:确定所述下位机接收到报警触发指令,则控制所述下位机发送所述急停控制指令至所述电机驱动器。
3.根据权利要求2所述的机器人运行系统的控制方法,其特征在于,所述报警触发指令包括:急停触发指令、防碰撞触发指令、防跌落触发指令、超声波近距离触发指令中的一种或多种。
4.一种机器人运行系统的控制装置,其特征在于,所述系统包括:上位机、下位机和电机驱动器,所述控制装置包括:
接收模块,用于接收所述上位机发送的速度控制指令;
第一判断模块,用于在延时第一预设时间时,判断所述下位机是否接收到所述速度控制指令;
控制模块,用于确定所述下位机未接收到所述速度控制指令,控制所述下位机发送急停控制指令至所述电机驱动器;
第二判断模块,用于在延时第二预设时间时,判断所述电机控制器是否接收到所述急停控制指令;
控制模块,还用于确定所述电机控制器未接收到所述急停控制指令,控制所述电机控制器停止运行,
所述控制模块包括:
速度控制模块,用于确定所述下位机接收到所述速度控制指令,则将所述速度控制指令发送至所述电机驱动器;
电机驱动模块,用于延时所述第二预设时间,确定所述电机驱动器接收到所述速度控制指令,则控制所述电机驱动器按照所述速度控制指令运行;
所述速度控制模块,还包括:
里程数据发送子模块,用于确定所述下位机接收到所述速度控制指令,则获取所述驱动电机的里程数据,并控制所述下位机将所述里程数据发送至所述上位机;
以及里程更新子模块,用于延时第三预设时间,确定所述上位机接收到所述里程数据,则更新里程数据;
驱动控制模块,用于确定所述上位机未接收到所述里程数据,则控制所述上位机发送急停控制指令至所述电机驱动控制器。
5.一种计算机设备,包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,其特征在于,所述处理器执行所述程序时,实现根据权利要求1-3中任一项所述的机器人运行系统的控制方法。
6.一种非临时性计算机可读存储介质,其上存储有计算机程序,其特征在于,该程序被处理器执行时实现根据权利要求1-3中任一项所述的机器人运行系统的控制方法。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于深兰科技(上海)有限公司,未经深兰科技(上海)有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202011262738.7/1.html,转载请声明来源钻瓜专利网。