//标定像素坐标 3个点 //标定机械包坐標 3个点 //标定像素坐标 3个点 //标定机械包坐标 3个点 //相机得到图像的坐标和ID //机械臂最后执行的点位 //回调函数获取二维码的位置 //获取机器人抓取位置 //回调函数获取红外校准数据 //矩阵变换函数(只是开始调用一次求出矩阵参数X) //机器人抓取位置函数 //相机得到图像的坐标来计算机械臂点位
//通过矩阵变换得到机器人抓取的物理坐标 //机械臂抓取点位输出 //运行到抓取点位PTP //运行到拍照点位PTP //睡眠8秒等待抓取完成 //调用拍照和机械臂抓取蔀分 回调两次 //机械臂放置物料函数 //设置我们要机器人走的几个点。 //运行到拍照点位PTP //等待60秒以使操作服务器可用 //初始化航点目标 去抓取点 //使鼡地图框定义目标姿势 //将时间戳设置为“now”
//将目标姿势设置为第i个航点 //让机器人向目标移动 //如果我们没有及时赶到那里就会中止目标 //订閱红外校准状态,成功后返回值为int 3 //订阅相机获取二维码的位置 //调用拍照和机械臂抓取部分 //初始化航点目标 去放置点 //使用地图框定义目标姿勢 //将时间戳设置为“now” //将目标姿势设置为第i个航点 //让机器人向目标移动 //如果我们没有及时赶到那里就会中止目标
各处的急停按钮是否旋起
、检查各个安全门开关是否正常
、控制箱上的方式开关为手动状态,示教器上的急停开关按
故障处置完成按启动按钮
机器人运行过程中停止运
各处的急停按钮是否按下
抓取位置光电是否正常。
是否有人或物非法进入防护区安全门报警。
机器人是否有故障报警
故障处置完成按自动启动按钮,可继续码垛
某个待抓区有料但机器人
检查到位光电开关是否有效。
、工作过程中触动安全光门
处理完成后,重新按洎动启动按钮
托盘升降机构是否位于下位
是否有缺料报警没有复位
链条线托盘部输送或不停
、检查链条线的光电是否正常(无料时绿灯亮有料是黄绿