[发明专利]机器人的控制方法、装置、计算机可读存储介质及处理器有效
申请号: | 202110500836.8 | 申请日: | 2021-05-08 |
公开(公告)号: | CN113119131B | 公开(公告)日: | 2022-08-16 |
发明(设计)人: | 魏晓晨 | 申请(专利权)人: | 北京壹点灵动科技有限公司 |
主分类号: | B25J9/16 | 分类号: | B25J9/16 |
代理公司: | 北京康信知识产权代理有限责任公司 11240 | 代理人: | 霍文娟 |
地址: | 102200 北京市昌平*** | 国省代码: | 北京;11 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 机器人 控制 方法 装置 计算机 可读 存储 介质 处理器 | ||
本发明公开了一种机器人的控制方法、装置、计算机可读存储介质及处理器。其中,该方法包括:确定七轴机器人在跟随过程中的最优轴位置逆解;对最优轴位置逆解关联的运动过程进行约束检测,得到约束检测结果;判断约束检测结果是否合格;若判断结果为是,则将获取的轴位置指令下发至七轴机器人,并控制七轴机器人按照轴位置指令运行;若判断结果为否,则重新规划七轴机器人的轴位置,并继续求解最优轴位置逆解。本发明解决了相关技术中所求的各轴位置逆解值会导致单独的轴运动范围过大,容易造成机器人跟随过程中机械臂本体与周围环境的干涉的技术问题。
技术领域
本发明涉及机器人控制技术领域,具体而言,涉及一种机器人的控制方法、装置、计算机可读存储介质及处理器。
背景技术
对于七轴机器人而言,通常情况下,通过锁定3轴空间使七轴机器人退变为六轴机器人,采用六轴机器人逆解解法进行轴空间位置逆解,但此种方法的所求的逆解值(各轴位置)会导致单独的轴运动范围过大,以至于造成机器人跟随过程中机械臂本体与周围环境的干涉。
针对上述的问题,目前尚未提出有效的解决方案。
发明内容
本发明实施例提供了一种机器人的控制方法、装置、计算机可读存储介质及处理器,以至少解决相关技术中所求的各轴位置逆解值会导致单独的轴运动范围过大,容易造成机器人跟随过程中机械臂本体与周围环境的干涉的技术问题。
根据本发明实施例的一个方面,提供了一种机器人的控制方法,包括:确定七轴机器人在跟随过程中的最优轴位置逆解;对所述最优轴位置逆解关联的运动过程进行约束检测,得到约束检测结果;判断所述约束检测结果是否合格;若判断结果为是,则将获取的轴位置指令下发至所述七轴机器人,并控制所述七轴机器人按照所述轴位置指令运行;若判断结果为否,则重新规划所述七轴机器人的轴位置,并继续求解所述最优轴位置逆解。
可选地,确定七轴机器人在跟随过程中的最优轴位置逆解包括:锁定所述七轴机器人的三轴冗余轴,得到六轴机器人;确定所述六轴机器人的多组轴位置逆解;依据不同轴的运动角度以及所述不同轴的运动角度对应的权重系数,从所述多组轴位置逆解筛选出所述最优轴位置逆解。
可选地,所述约束检测包括以下至少之一:轴位置检测、臂角角度检测、肘关节路径距离检测、腕关节路径距离检测。
可选地,对所述最优轴位置逆解关联的运动过程进行约束检测,得到约束检测结果包括:获取所述最优轴位置逆解;依据所述最优轴位置逆解依次进行所述轴位置检测、所述臂角角度检测、所述肘关节路径距离检测以及所述腕关节路径距离检测。
可选地,依据所述最优轴位置逆解依次进行所述轴位置检测、所述臂角角度检测、所述肘关节路径距离检测、所述腕关节路径距离检测,包括:依据所述最优轴位置确定单轴运动距离;在所述单轴运动距离的绝对值小于等于预设单轴运动阈值时,则通过所述轴位置检测;在所述单轴运动距离的绝对值大于所述预设单轴运动阈值时,则未通过所述轴位置检测;依据所述最优轴位置确定臂角转动角度;在所述臂角转动角度的绝对值小于等于预设臂角转动角度阈值时,则通过所述臂角角度检测;在所述臂角转动角度的绝对值大于所述预设臂角转动角度阈值时,则未通过所述臂角角度检测;依据所述最优轴位置确定运动距离;在所述运动距离小于等于预设运动距离阈值时,则通过所述肘关节路径距离检测;在所述运动距离大于所述预设运动距离阈值时,则未通过所述肘关节路径距离检测;依据所述最优轴位置确定腕关节运动距离;在所述腕关节运动距离小于等于预设腕关节运动距离阈值时,则通过所述腕关节路径距离检测;在所述腕关节运动距离大于所述预设腕关节运动距离阈值时,则未通过所述腕关节路径距离检测。
可选地,重新规划所述七轴机器人的轴位置包括:确定所述七轴机器人的三轴冗余轴的预定角度,其中,第一角度值≤预定角度≤第二角度值,所述第一角度值为所述三轴冗余轴的最小运动度数,或者,所述三轴冗余轴的初始角度减去角度阈值,所述第一角度值为所述三轴冗余轴的最大运动度数,或者,所述三轴冗余轴的初始角度加上角度阈值;遍历所述预定角度,确定所述七轴机器人的轴位置。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于北京壹点灵动科技有限公司,未经北京壹点灵动科技有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202110500836.8/2.html,转载请声明来源钻瓜专利网。