[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]
|
更多相关内容
|
工业机器人传动机构——雅马哈机器人
工业机器人常见的传动机构形式可以分为直线传动和旋转传动机构两种，其中直线传动机构可以通过齿轮齿条、丝杠螺母等传动元件将旋转运动转换成直线运动，也可以由直线驱动电机驱动，或是直接由气 ...
|
|
雅马哈诊断系统部分讲解
一、FAULTCODE（故障码）
二、DAIGCODE（确诊码）
三、CO形式维修
先介绍故障码（FAULT CODE）：当电喷体系发觉信号反常时，直接在LCD上显示俩位数字代码。而且表头上问题灯一起 ...
|
|
工业喷涂机器人特点
1.高精度，工业喷涂机器人选用高精度的定位体系，可以轻松精准地控制涂料的喷涂方位和角度，确保了与手艺喷涂比较更高的涂布均匀度和精度。尤其是针对光泽和色彩要求更高的产品，如轿车、电器等 ...
|
|
雅马哈机器人线性马达选型
跟着直线电机、线性马达、直线驱动技术的不断改进和进步，越来越多的国内企业，进入到直线电机的研发与出产，职业需求和国产直线电机市场规模也越来越大。但很多新型设备在初次运用线性马达或许 ...
|
|
焊接机器人外轴介绍——雅马哈机器人
1.焊接变位器。焊接变位器有多种规格，常见的焊接变位器有单轴焊接变位器.双轴焊接变位器.三轴焊接变位器等。，可根据不同的型号应用于不同的范畴。焊接机器人和焊接变位器协调运动。焊接机器人 ...
|
|
雅马哈机器人减速齿轮损坏诊断及维修
雅马哈机器人具有支撑出产设备的灵活应对能力与值得夸耀的极大牢靠性。
当雅马哈机器人减速齿轮损坏时会产生振荡或发出不正常的动静。
这种情况下，它会引起过载和不正常的偏离打乱正 ...
|
|
雅马哈机器人控制器340报BYE联不起机器
雅马哈机器人控制器340报BYE联不起机器该怎样修理呢？
过程：
①任何单元上面没有LED指示亮起。
②接地问题保护跳闸。
③无法装入体系软件 ...
|
|
工业机器人具有特性——雅马哈机器人
工业机器人是面向工业范畴的多关节机械手或多自由度的机器人。工业机器人是主动执行工作的机器设备，是靠自身动力和控制能力来实现各种功用的一种机器。
...
|
|
常见机械臂及其作用
机械臂是指高精度，多输入多输出、高度非线性、强耦合的复杂系统。因其共同的操作灵活性，已在工业装配、安全防爆等领域得到广泛应用。
那么我们常见的机械臂有哪些呢？按不同的职业分类为 ...
|
|
雅马哈机器人故障判断方法
目前，工业机器人已广泛应用于汽车及汽车零部件制造业、机械加工职业、电子电气职业、橡胶及塑料工业、食品工业、木材与家具制造业等***域中。在工业生产中，焊接机器人、安装机器人、喷涂机器 ...
|
|
雅马哈机器人伺服器设置步骤
1、测验一下电机，任何电路也不必衔接，把电机的三根线恣意两根短路在一起，用手滚动电机轴，感觉起来有阻力，那就OK。
2、把伺服驱动器按图纸接上电源(例如用了调压器，从100V调到220V， ...
|
|
雅马哈汽油发电机的日常护理
雅马哈汽油发电机是将化学能转化为机械能的机器，它的转化进程实际上便是工作循环的进程，简单来说便是是通过焚烧气缸内的燃料，发生动能，驱动发动机气缸内的活塞往复的运动，由此带动连在活塞 ...
|
|
雅马哈机器人SGF8驱控一体型模组
SGF8 驱控一体型模组，在包含导轨内嵌型模组的优势基础上，集导轨内嵌式模组、伺服电机、驱动操控器于一体。
体积小、集成度高、配线简略，简化了客户的电气设计，适配客户更多空间需求。
...
|
|
医用机器人基本种类——雅马哈
医用机器人品种很多，依照其用途不同，有临床医疗用机器人、护理机器人、医用教育机器人和为残疾人服务机器人等。
1、医院配送机器人：智能配送机器人在院区内主要承当送药、送餐进阻隔区 ...
|
|
码垛机器人运转时注意事项——雅马哈机器人
1.当运用起重机或叉车搬运机器人码垛机时,肯定不能人工支持机器人码垛机控制箱;
2.搬运中永久不要趴在机器人码垛机上或站在提起的机器人码垛机下方;
...
|
|
RGV、AGV、IGV搬运机器人区别
跟着人工智能的兴起，科技迅速发展，越来越多的搬运机器人替代了人工作业，在移动机器人市场上，除了咱们熟知的AGV之外，还有RGV和IGV也在自动化物流体系中发挥着各自的效果。那么RGV、AGV、IGV ...
|
|
深企与雅马哈机器人举行全球战略合作签约
3月8日，深圳橙子自动化与雅马哈机器人在深圳举办全球战略协作签约典礼，两边挥各自优势，完成互利共赢，一起为3C（即：计算机（Computer）、通讯（Communication）和消费类电子产品（ConsumerE ...
|
|
机器人日常的预防性维护检查——雅马哈
（1）备份控制器内存
（2）定期监督机器人，查看机器人、导线和电缆
（3）查看刹车设备
（4）查看机器人的结构紧凑程度
（5）听声音震 ...
|
|
工业机器人处理错误编程方法
过错例程剖析1
先看一段代码：
*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 //过错 ...
|
|
SCARA机器人构成及工作原理
SCARA机器人的构成
SCARA机器人是一种弧形多关节机器人，一般由四个关节构成。这种机器人的结构类似于人的手臂，但它的末端能够带有东西，如夹具、吸盘或激光头。SCARA机器人的关节都由电 ...
|
|
联系方式
工作时间
