作业控制方法、装置、五轴码垛机器人及存储介质制造方法及图纸

技术编号:40909409 阅读:23 留言:0更新日期:2024-04-18 14:38
本发明专利技术提供的一种作业控制方法、装置、五轴码垛机器人及存储介质,涉及机器人控制技术领域。该方法通过在五轴码垛机器人的第三个关节与第四个关节之间假设虚拟关节,进行运动学建模,得到五个关节各自对应的DH参数;基于五轴码垛机器人的基坐标系与末端法兰坐标系之间的期望位置关系和首关节对应的DH参数,对基坐标系与末端法兰坐标系之间的期望姿态关系进行修正,得到基坐标系与末端法兰坐标系之间的可达姿态关系;利用每个关节对应的DH参数、五轴码垛机器人的基坐标系与末端法兰坐标系之间的期望位置关系和可达姿态关系,获得每个关节的关节角度,从而根据五个关节各自的关节角度,控制五轴码垛机器人进行码垛作业。

【技术实现步骤摘要】

本专利技术涉及机器人控制,具体而言,涉及一种作业控制方法、装置、五轴码垛机器人及存储介质


技术介绍

1、五轴码垛机器人的结构源于同型号的六轴球形手腕机器人的衍生,即将六轴机器人的关节j4的电机和减速器去掉,用连接件替代,保留关节j1、j2、j3、j5、j6,使其构成五轴码垛机器人。相较于六轴球形手腕机器人,在成本有一定程度降低的同时,又兼容水平面码垛和非水平面码垛(限制在一定范围内)两种场景。

2、针对水平面码垛的场景,需要3个自由度保证到达空间任意点,需要2个自由度保证末端夹爪水平朝下以及夹爪在水平面的姿态,即一共需要5个自由度,刚好等于五轴机器人的自由度数目,传统六轴球形手腕机器人的逆解算法,求解得到的关节j4的关节角度恒定为0,可以适用于五轴码垛机器人。

3、针对非水平面码垛的场景,需要3个自由度到达空间任意点,需要3个自由度保证姿态,一共需要6个自由度,大于五轴机器人的自由度数目,如果采用传统六轴球形手腕机器人的逆解算法,求解得到的关节j4的关节角度一定不为0,无法适用于五轴码垛机器人。


>

技术实本文档来自技高网...

【技术保护点】

1.一种五轴码垛机器人的作业控制方法,其特征在于,所述五轴码垛机器人的基座到末端依次分布了五个关节,最靠近所述五轴码垛机器人的基座的关节为首关节,所述方法包括:

2.如权利要求1所述的方法,其特征在于,所述五轴码垛机器人的基坐标系与所述首关节的关节坐标系重合,最靠近所述首关节的关节为第一中间关节;

3.如权利要求2所述的方法,其特征在于,所述基于所述五轴码垛机器人的基坐标系与所述第一中间关节的关节坐标系之间的姿态关系,修正所述五轴码垛机器人的基坐标系与末端法兰坐标系之间的期望姿态关系,得到所述五轴码垛机器人的基坐标系与末端法兰坐标系之间的可达姿态关系的步骤,包括:...

【技术特征摘要】

1.一种五轴码垛机器人的作业控制方法,其特征在于,所述五轴码垛机器人的基座到末端依次分布了五个关节,最靠近所述五轴码垛机器人的基座的关节为首关节,所述方法包括:

2.如权利要求1所述的方法,其特征在于,所述五轴码垛机器人的基坐标系与所述首关节的关节坐标系重合,最靠近所述首关节的关节为第一中间关节;

3.如权利要求2所述的方法,其特征在于,所述基于所述五轴码垛机器人的基坐标系与所述第一中间关节的关节坐标系之间的姿态关系,修正所述五轴码垛机器人的基坐标系与末端法兰坐标系之间的期望姿态关系,得到所述五轴码垛机器人的基坐标系与末端法兰坐标系之间的可达姿态关系的步骤,包括:

4.如权利要求3所述的方法,其特征在于,所述对所述第一中间关节的关节坐标系与末端法兰坐标系之间的期望姿态关系进行修正,得到所述第一中间关节的关节坐标系与末端法兰坐标系之间的可达姿态关系的步骤,包括:

5.如权利要求4所述的方法,其特征在于,所述根据所述五轴码垛机器人的基坐标系与所述第一中间关节的关节坐标系之间的姿态关系和所述第一中间关节的关节坐标系与末端法兰坐标系之间的可达姿态关系,得到所述五轴码垛机器人的基坐标系与末端法兰坐标系之间的可达姿态关系的步骤,包括:

6.如权利要求1所述的方法,其特征在于,最靠近所述五轴...

【专利技术属性】
技术研发人员:杨金桥谷菲
申请(专利权)人:成都卡诺普机器人技术股份有限公司
类型:发明
国别省市:

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1