五轴装卸机器人的逆解方法、装置及可读介质

    公开(公告)号:CN116442216A

    公开(公告)日:2023-07-18

    申请号:CN202310275627.7

    申请日:2023-03-16

    IPC分类号: B25J9/16

    摘要: 本发明公开了一种五轴装卸机器人的逆解方法、装置及可读介质,涉及物流自动化装备领域,通过基于五轴装卸机器人的机械臂三维模型建立其连杆坐标系,并建立各坐标系之间的转换矩阵;在机器人基坐标系{OB}下设定第一控制点和第一控制方向,在第五关节轴动坐标系{OJ5d}下设定第二控制点和第二控制方向,根据转换矩阵建立第二控制点和第二控制方向与第一控制点和第一控制方向之间转换的运动学关系;根据等式关系采用几何法求解出θ1、θ2、θ3、θ4、θ5,其中,θn为第n个旋转轴的旋转角,根据θ2和θ3计算出第一支撑臂和第二支撑臂的臂长,实现末端旋转臂在笛卡尔空间中五自由度的运动。本发明可解决箱包难以自动化装卸的问题,提高了装卸效率,并降低了人工成本。