[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]
|
更多相关内容
|
雅马哈机器人减速齿轮损坏诊断及维修
雅马哈机器人具有支撑出产设备的灵活应对能力与值得夸耀的极大牢靠性。
当雅马哈机器人减速齿轮损坏时会产生振荡或发出不正常的动静。
这种情况下，它会引起过载和不正常的偏离打乱正 ...
|
|
机器人驱动器种类——雅马哈
1、直流伺服电动机驱动器，直流伺服电动机驱动器多选用脉宽调制(PWM)伺服驱动器，经过改变脉冲宽度来改变加在电动机电枢两端的均匀电压，从而改变电动机的转速。PWM伺服驱动器具有调速规模宽、 ...
|
|
造成机器人精度不足原因——雅马哈
许多工业运用需要准确的机器人来完成要害任务，例如航空制作和计量查看。但是，工业机器人一般不供给高精度。机器人的不准确性归因于几种过错源。这些过错源分为三大类：自动关节过错、运动学过 ...
|
|
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 //差 ...
|
|
码垛机器人运转时注意事项——雅马哈机器人
1.当运用起重机或叉车搬运机器人码垛机时,肯定不能人工支持机器人码垛机控制箱;
2.搬运中永久不要趴在机器人码垛机上或站在提起的机器人码垛机下方;
...
|
|
工业机器人关节减速器作用——雅马哈
工业机器人要害减速器的作用
工业机器人的操作主要靠伺服电机、减速器和操控器三个部件进行操控，其中减速器用于精准操控机器人关节的运动，传递更大的扭矩。目前，常见的减速器主要分为两 ...
|
|
雅马哈机器人零点的找回
机器人零点是机器人操作模型的初始方位，每一台机器人在出厂时就已经设置好了零点。当零点不正确时，机器人就不能正确的运动，此时就需要从头校准零点。
...
|
|
雅马哈弧焊机器人系统组成
一般的弧焊机器人是由示教盒、操控盘、机器人本体及自动送丝设备、焊接电源等部分组成。能够在计算机的操控下完成接连轨迹操控和点位操控。还能够使用直线插补和圆弧插补功能焊接由直线及圆弧所 ...
|
|
机器人工作原理解析——雅马哈机器人
一、机器人的组成部分
从最基本的层面来看，人体包含五个主要组成部分：
当然，人类还有一些无形的特征，如智能和品德，但在纯粹的物理层面上，此 ...
|
|
工业机器人预防性保养——雅马哈机器人
每台机器人都需求预防性保养，这样能够确保它们在出产线上保持最佳性能和完成一致性。当机器人没有进行定期的预防性保养查看，可能会导致零部件损坏或故障，然后致使出产怠慢乃至停机。对机器人 ...
|
|
雅马哈机器人软件操作
过程一：原点复归首次调试或许锂电池没电或许编码器拔出后，需要做一次原点复归，而原点复归之前要手动把，XY轴放到正中，履行后只要不往两头跑便是能够的，4个轴绿灯持续会亮就行。
...
|
|
影响工业机器人性能和使用寿命因素——雅马哈
近年来，各行各业将更多工业机器人纳入生产线的需求不断添加，从现代轿车制作到3C（计算机，通信和消费电子）产品制作。与传统生产线上的自动化专用设备相比，机器人操作灵活而且才能拔尖，因而 ...
|
|
雅马哈无人驾驶船轻松测量水库淤泥
雅马哈Breeze10无人驾驶船结合了卫星定位系统和用于自主导航的方位角数据，可以为下一个测量任务保存路线。Breeze10船长3.2米。宽1.2米，足以容纳R2Sonic公司Sonic2024多波束系统等声纳设备。
...
|
|
立柱机器人码垛机的应用优势
1．作业效率高
立柱机器人码垛机每小时抓取300——400次，您能够挑选单爪手和双爪手，速度和质量远高于手人工。
2．操作精度高，作业范围大。
立柱机器人码垛机占地面积小，动作 ...
|
|
工业机器人具有特性——雅马哈机器人
工业机器人是面向工业范畴的多关节机械手或多自由度的机器人。工业机器人是主动执行工作的机器设备，是靠自身动力和控制能力来实现各种功用的一种机器。
...
|
|
雅马哈机器人位置检测
BLOB查找与边际查找的速度相比，可使用2倍——10倍的速度进行检测。
适用于重视速度的位置检测。
仅检出甜甜圈形状
优势与劣势
优势：
...
|
|
雅马哈机器人维修经验
依据雅马哈工业机器人工程师多年的雅马哈机器人维修经验，做好雅马哈工业机器人的维修工作，将有用延伸机器人的运用寿命，降低问题概率。
1、一般保护 ...
|
|
分拣机器人构成及优点——雅马哈
目前，智能分拣机器人主要用于电子商务、邮政、快递等行业的包裹快速分拣，具有大规模的调度才能和智能途径规划才能，但处理对象的类型、重量和尺度在一定程度上受到限制。为了适应更多的业务场 ...
|
|
雅马哈机器人的故障判断介绍
当机器人在工作过程中产生毛病不要慌张，假如毛病不是由于控制器引起的，那么毛病的原因肯定是机器部件产生损坏。为了尽快以***简便的方法处理毛病、应当对毛病进行分析。而且需求找出是哪个零 ...
|
|
雅马哈工业机器人感知系统运行
在工业机器人中装备传感器，工业机器人内部传感器中，方位传感器和速度传感器，是当今机器人反馈控制中不行短少的元件。对于工业机器人来说，传感器便是工业机器人最主要的设备之一，能懂的应用 ...
|
|
联系方式
工作时间
