YAMAHA机器人视觉程序

发布时间:2024-8-30 12:03:23|来源: 雅马哈/YAMAHA

  [PGM]

  NAME=SHIFT

  PGN=1

  '===================声明数组============

  DIM PPS$(5)

  DIM PPX$(5)

  DIM PPY$(5)

  DIM PPR$(5)

  DIM PPX!(5)

  DIM PPY!(5)

  DIM PPR!(5)

  A%=1

  '=======================================

  *A:

  DO2()=0

  MOVE P,P0,Z=0.00

  WAIT ARM

  '======================================

  MOVE P,P101,Z=0.00    '1拍照位置

  WAIT ARM

  '======================================

  *PAIZHAO1:

  SEND "AA" TO GP1

  SEND GP1 TO DATA$

  PRINT "DATA$=",DATA$

  PPS$(1)=MID$(DATA$,1,2)

  IF PPS$(1)="OK" THEN

  GOTO *PAIZHAOOK1

  ENDIF

  IF PPS$(1)="NG" THEN

  DELAY 100

  GOTO *PAIZHAO1

  ENDIF

  '======================================

  *PAIZHAOOK1:

  PPX$(1)=MID$(DATA$,3,8)

  PPY$(1)=MID$(DATA$,11,8)

  PPR$(1)=MID$(DATA$,19,8)

  PPX!(1)=VAL(PPX$(1))

  PPY!(1)=VAL(PPX$(1))

  PPR!(1)=VAL(PPX$(1))

  LOC1(P11)=PPX!(1)

  LOC2(P11)=PPY!(1)

  LOC4(P11)=PPR!(1)

  LOC3(P11)=20.00

  '========================================

  MOVE P,P102,Z=0.00    '2拍照位置

  WAIT ARM

  '======================================

  *PAIZHAO2:

  SEND "AB" TO GP1

  SEND GP1 TO DATA$

  PPS$(2)=MID$(DATA$,1,2)

  PRINT "DATA$=",DATA$

  IF PPS$(2)="OK" THEN

  GOTO *PAIZHAOOK2

  ENDIF

  IF PPS$(2)="NG" THEN

  DELAY 100

  GOTO *PAIZHAO2

  ENDIF

  '=====================================

  *PAIZHAOOK2:

  PPX$(2)=MID$(DATA$,3,8)

  PPY$(2)=MID$(DATA$,11,8)

  PPR$(2)=MID$(DATA$,19,8)

  PPX!(2)=VAL(PPX$(2))

  PPY!(2)=VAL(PPX$(2))

  PPR!(2)=VAL(PPX$(2))

  LOC1(P12)=PPX!(2)

  LOC2(P12)=PPY!(2)

  LOC4(P12)=PPR!(2)

  LOC3(P12)=20.00

  '=========================================

  '=============偏移公式计算偏移S1============

  DLTX1=LOC1(P2)-LOC1(P1)

  DLTY1=LOC2(P2)-LOC2(P1)

  ANG1=ATN(DLTY1/DLTX1)

  DLTX11=LOC1(P12)-LOC1(P11)

  DLTY11=LOC2(P12)-LOC2(P11)

  ANG11=ATN(DLTY11/DLTX11)

  THETA=ANG11-ANG1

  LOC1(P1001)=LOC1(P1)*COS(THETA)-LOC2(P1)*SIN(THETA)

  LOC2(P1001)=LOC1(P1)*SIN(THETA)+LOC2(P1)*COS(THETA)

  DSTX1=LOC1(P11)-LOC1(P1001)

  DSTY1=LOC2(P11)-LOC2(P1001)

  LOC1(P1002)=LOC1(P2)*COS(THETA)-LOC2(P2)*SIN(THETA)

  LOC2(P1002)=LOC1(P2)*SIN(THETA)+LOC2(P2)*COS(THETA)

  DSTX2=LOC1(P12)-LOC1(P1002)

  DSTY2=LOC2(P12)-LOC2(P1002)

  DSTX=(DSTX1+DSTX2)/2

  DSTY=(DSTY1+DSTY2)/2

  LOC1(S1)=LOC1(S0)+DSTX

  LOC2(S1)=LOC2(S0)+DSTY

  LOC4(S1)=LOC4(S0)+RADDEG(THETA)

  LOC3(S1)=20.00

  '================================================

  '================================================

  *MAIN:

  FOR B%=1 TO 32

  C%=B%+499

  P[C%]=P0

  NEXT

  '======================================

  FOR B%=1 TO 32

  C%=B%+499

  P[C%]=PPNT(0,B%)

  NEXT

  '=======================================

  MOVE P,P103,Z=0.00      '3拍照位置

  WAIT ARM

  '=======================================

  *PAIZHAO3:

  SEND "AC" TO GP1

  SEND GP1 TO DATA$

  PPS$(3)=MID$(DATA$,1,2)

  PRINT "DATA$=",DATA$

  IF PPS$(3)="OK" THEN

  GOTO *PAIZHAOOK3

  ENDIF

  IF PPS$(3)="NG" THEN

  DELAY 100

  GOTO *PAIZHAO3

  ENDIF

  '=======================================

  *PAIZHAOOK3:

  PPX$(3)=MID$(DATA$,3,8)

  PPY$(3)=MID$(DATA$,11,8)

  PPR$(3)=MID$(DATA$,19,8)

  PPX!(3)=VAL(PPX$(3))

  PPY!(3)=VAL(PPX$(3))

  PPR!(3)=VAL(PPX$(3))

  LOC1(P13)=PPX!(3)

  LOC2(P13)=PPY!(3)

  LOC4(P13)=PPR!(3)

  LOC3(P13)=20.00

  SHIFT S0

  MOVE P,P13,Z=0.00       '走到吸料位

  WAIT ARM

  DO(23)=1                '吸料

  DELAY 100

  '=========================================

  MOVE P,P104,Z=0.00      '4拍照位置,矫正

  WAIT ARM

  '=======================================

  *PAIZHAO4:

  SEND "AD" TO GP1

  SEND GP1 TO DATA$

  PPS$(4)=MID$(DATA$,1,2)

  PRINT "DATA$=",DATA$

  IF PPS$(4)="OK" THEN

  GOTO *PAIZHAOOK4

  ENDIF

  IF PPS$(4)="NG" THEN

  DELAY 100

  GOTO *PAIZHAO4

  ENDIF

  '=====================================

  *PAIZHAOOK4:            '二次矫正拍照,固定相机

  PPX$(4)=MID$(DATA$,3,8)

  PPY$(4)=MID$(DATA$,11,8)

  PPR$(4)=MID$(DATA$,19,8)

  PPX!(4)=VAL(PPX$(4))

  PPY!(4)=VAL(PPX$(4))

  PPR!(4)=VAL(PPX$(4))

  LOC1(P14)=PPX!(4)

  LOC2(P14)=PPY!(4)

  LOC4(P14)=PPR!(4)

  LOC3(P14)=20.00

  SHIFT S0

  MOVE P,P14,Z=0.00              '矫正角度

  WAIT ARM

  '=====================================

  SHIFT S1

  MOVE P,P[A%+499],Z=0.00

  WAIT ARM

  DO(23)=0

  '====================================

  SHIFT S0

  MOVE P,P105,Z=0.00      '5拍照位置

  WAIT ARM

  '===================================

  *PAIZHAOOK5:

  SEND "AE" TO GP1

  SEND GP1 TO DATA$

  PPS$(5)=MID$(DATA$,1,2)

  PRINT "DATA$=",DATA$

  IF PPS$(5)="OK" THEN

  GOTO *PAIZHAOOK5

  ENDIF

  IF PPS$(5)="NG" THEN

  DELAY 100

  GOTO *PAIZHAO6

  ENDIF

  '==================================

  *PAIZHAO6:

  PPX$(5)=MID$(DATA$,3,8)

  PPY$(5)=MID$(DATA$,11,8)

  PPR$(5)=MID$(DATA$,19,8)

  PPX!(5)=VAL(PPX$(5))

  PPY!(5)=VAL(PPX$(5))

  PPR!(5)=VAL(PPX$(5))

  LOC1(P15)=PPX!(5)

  LOC2(P15)=PPY!(5)

  LOC4(P15)=PPR!(5)

  LOC3(P15)=20.00

  SHIFT S0

  MOVE P,P15,Z=0.00       '走到吸料位

  WAIT ARM

  DO(23)=1                '吸料

  DELAY 100

  '======================================

  MOVE P,P104,Z=0.00      '4拍照位置,矫正,固定相机

  WAIT ARM

  '=======================================

  *PAIZHAO4:

  SEND "AD" TO GP1

  SEND GP1 TO DATA$

  PPS$(4)=MID$(DATA$,1,2)

  PRINT "DATA$=",DATA$

  IF PPS$(4)="OK" THEN

  GOTO *PAIZHAOOK4

  ENDIF

  IF PPS$(4)="NG" THEN

  DELAY 100

  GOTO *PAIZHAO4

  ENDIF

  '=====================================

  *PAIZHAOOK4:            '二次矫正拍照

  PPX$(4)=MID$(DATA$,3,8)

  PPY$(4)=MID$(DATA$,11,8)

  PPR$(4)=MID$(DATA$,19,8)

  PPX!(4)=VAL(PPX$(4))

  PPY!(4)=VAL(PPX$(4))

  PPR!(4)=VAL(PPX$(4))

  LOC1(P14)=PPX!(4)

  LOC2(P14)=PPY!(4)

  LOC4(P14)=PPR!(4)

  LOC3(P14)=20.00

  SHIFT S0

  MOVE P,P14,Z=0.00     '矫正角度

  WAIT ARM

  A%=A%+1

  SHIFT S1

  MOVE P,P[A%+499],Z=0.00

  WAIT ARM

  DO(23)=0

  A%=A%+1

  IF A%=33 THEN

  A%=1

  GOTO *A

  ENDIF

  GOTO *MAIN

  [GEP]

  GP1

  MODE=1

  IPADRS=192.168.0.5

  PORT=5

  EOL=0

  TYPE=0

  [END]

                  

更多相关内容
工业机器人具有特性——雅马哈机器人 工业机器人具有特性——雅马哈机器人

工业机器人是面向工业范畴的多关节机械手或多自由度的机器人。工业机器人是主动执行工作的机器设备,是靠自身动力和控制能力来实现各种功用的一种机器。   ...

工业机器人码垛系统的组成——雅马哈 工业机器人码垛系统的组成——雅马哈

工业机器人码垛体系并非在实际应用中由机器人独立运转,而是与主动化设备合作执行体系作业。工业机器人码垛体系一般由4个子体系组成,电气操控子体系操控整个码垛体系的作业流程和节拍。物料传 ...

雅马哈机器人模拟调试功能简述 雅马哈机器人模拟调试功能简述

首先,你得预备一下软件和网口调试帮手(该调试帮手能够自己网上下载,也能够后台回复“网口帮手”获取),软件名称为 RCX-Studio Pro 2020 CL 该软件能够后台回复“2020CL”获取。安装好软件今 ...

雅马哈机器人软件操作 雅马哈机器人软件操作

过程一:原点复归首次调试或许锂电池没电或许编码器拔出后,需要做一次原点复归,而原点复归之前要手动把,XY轴放到正中,履行后只要不往两头跑便是能够的,4个轴绿灯持续会亮就行。 ...

雅马哈-机器人故障判断小诀窍 雅马哈-机器人故障判断小诀窍

目前,工业机器人已广泛应用于汽车及汽车零部件制造业、机械加工职业、电子电气职业、橡胶及塑料工业、食品工业、木材与家具制造业等***域中。在工业生产中,焊接机器人、安装机器人、喷涂机器 ...

工业机器人零部件故障及解决方法——雅马哈机器人 工业机器人零部件故障及解决方法——雅马哈机器人

工业机器人首要零部件包括减速齿轮、制动设备、电机、编码器等,在零部件故障中又以减速齿轮为故障多发,制动设备、电机和编码器次之。   当减速齿轮损坏时会产生振动或宣布不正常的动静。这 ...

工业机器人结构原理——雅马哈 工业机器人结构原理——雅马哈

机器人可以分为硬件部分和软件部分,硬件部分主要包含本体和操控器,而软件部分主要指的是它的操控技能。   本体部分   先来说下机器人的本体部分。工业 ...

协作机器人缺点应用场景——雅马哈 协作机器人缺点应用场景——雅马哈

协作机器人的鼓起能够帮助人们享用更好的日子质量,削减作业时刻。关于雇主来说,协作机器人能够承担最危险的使命,以降低受伤危险和劳动力本钱。协作机器人的缺陷是它们不能承担人类完结的所有 ...

雅马哈机器人视觉问题分析 雅马哈机器人视觉问题分析

1.图画特征挑选问题。   视觉伺服的功能与所用图画的特性密切相关。特征的挑选不只应考虑识别指标,还应考虑操控指标。从操控的角度来看,冗余特性消除了噪声的影响,提高了视觉伺服电机的功 ...

工业机器人编码器的分类——雅马哈 工业机器人编码器的分类——雅马哈

依据检测原理,编码器可分为光学式.磁式.依据其刻度法和信号输出形式,感应式和电容式可分为增量式.三种肯定式和混合式。   1.增量编码器:   增量编码器能够生成方位.视点和转数等信息。 ...

YAMAHA工业机器人编程错误处理 YAMAHA工业机器人编程错误处理

01差错例程剖析   先看一段代码:   *AA:   MOVE P,P101,Z=0.0   WAIT ARM   FOR I=1 TO 1000   MOVE P,P102,Z=0.0   WAIT ARM   DO2(0)=1   GOTO *TSA //差 ...

雅马哈志在跟人飙车技的机器人 雅马哈志在跟人飙车技的机器人

雅马哈方案将在构建Motobot过程中学到的东西运用起来,改善其包括摩托车、雪地车、沙滩车、工业机器人在内的各种产品。雅马哈清晰说到,“先进的车手安全系统”或许便是Motobot能帮助推动的领域 ...

雅马哈机器人轴数上的优缺点 雅马哈机器人轴数上的优缺点

工业机器人已经被广泛应用于各行各业,但我们也发现,工业机器人不只形状各异,其轴数也各不相同。所谓工业机器人的轴,能够用专业的名词自由度来解释,如果机器人具有三个自由度,那么它能够沿 ...

YAMAHA雅马哈机器人丰富的产品线 YAMAHA雅马哈机器人丰富的产品线

单轴机器人:特点 行程**短50mm-3050mm,负载**大120KG的产品线 选用高刚性导轨,精密滚压的滚珠丝杆 伺服马达的位置检测器,选用高耐久性的旋转变压器 可交换马达、导轨、滚珠丝杆等部品 发生 ...

雅马哈机器人提升速度方法 雅马哈机器人提升速度方法

查看机器人发动机磨损、空气滤清器是否故障。   1、雅马哈机器人使用过程中发动机正常的磨损,会引起动力下降上不去速度,这时需求经常对发动机进行保养。   2、雅马哈机器人的空气滤清器 ...

雅马哈AGV机器人发展 雅马哈AGV机器人发展

近两年来,泊车场的自动化、智能化也得到了快速开展,而AGV正是其中的“主角”。不少泊车设施通过采用AGV机器人,不仅实现了泊车过程的高度自动化,同时还优化了有限的泊车空间,规划了更多的泊 ...

雅马哈机器人应用行业——雅马哈 雅马哈机器人应用行业——雅马哈

雅马哈机器人通常应用于多个工业领域,包括:   轿车制造:在轿车出产线上用于焊接、涂装、检测等进程。   医疗设备:用于出产医疗设备和器械,如手术器械和护理产品。   食物和饮料: ...

工业机器人分类介绍——雅马哈 工业机器人分类介绍——雅马哈

工业机器人是面向工业范畴的多关节机械手或多自由度的机器设备,能主动执行工作,靠自身动力和控制能力完结各种功用。它可以接受人类指挥,也可以按照预先编排的程序运转,现代工业机器人还可以 ...

雅马哈工业机器人传动机构 雅马哈工业机器人传动机构

工业机器人常见的传动机构形式可以分为直线传动和旋转传动机构两种,其中直线传动机构可以通过齿轮齿条、丝杠螺母等传动元件将旋转运动转换成直线运动,也可以由直线驱动电机驱动,或是直接由气 ...

机器视觉与运动控制的结合——雅马哈机器人 机器视觉与运动控制的结合——雅马哈机器人

机器视觉体系相当于智能工厂的“眼睛和大脑”。跟着生产设备的集成化开展,打破传统操控流程,越来越多的视觉体系将运动操控结合到其架构中,传统的计划选用视觉体系+PLC+运动操控的形式,但由 ...

栏目导航
客服中心

在线咨询:QQ


联系方式联系方式

联 系 人:黄经理

联系QQ:3271883383

联系电话:13522565663


扫码添加微信(手机端请先保存图片)

工作时间工作时间

工作日:9:00-17:00

节假日:仅处理紧急事件

Contact us

联系我们

联系电话 QQ咨询
QQ咨询

3271883383

公司地址
返回顶部