2301_79115162的博客

原创 三菱机器人自动回原点程序

在GLOBAL程序下创建一个Pos类型的点位，一个Jnt类型的点位。获取机器人当前的笛卡尔坐标系的位姿，机器人系统变量为P_Curr。获取机器人当前的关节角的位姿，机器人系统变量为J_Curr。对机器人需要释放的关节角进行赋值，关节运动机器人。对机器人高度Z进行对应的赋值，并运动至该高度。首先要新建一个程序存储全局变量如GLOBAL。在程序文件夹下创建一个名为GOHOME的程序。创建两个全局变量分别用于储存。的笛卡尔姿态与关节角姿态。