[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工业机器人编程错误处理
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雅马哈机器人丰富的产品线
单轴机器人:特点 行程**短50mm-3050mm,负载**大120KG的产品线 选用高刚性导轨,精密滚压的滚珠丝杆 伺服马达的位置检测器,选用高耐久性的旋转变压器 可交换马达、导轨、滚珠丝杆等部品 发生 ...
|
|
雅马哈机器人提升速度方法
查看机器人发动机磨损、空气滤清器是否故障。
1、雅马哈机器人使用过程中发动机正常的磨损,会引起动力下降上不去速度,这时需求经常对发动机进行保养。
2、雅马哈机器人的空气滤清器 ...
|
|
雅马哈AGV机器人发展
近两年来,泊车场的自动化、智能化也得到了快速开展,而AGV正是其中的“主角”。不少泊车设施通过采用AGV机器人,不仅实现了泊车过程的高度自动化,同时还优化了有限的泊车空间,规划了更多的泊 ...
|
|
雅马哈机器人应用行业——雅马哈
雅马哈机器人通常应用于多个工业领域,包括:
轿车制造:在轿车出产线上用于焊接、涂装、检测等进程。
医疗设备:用于出产医疗设备和器械,如手术器械和护理产品。
食物和饮料: ...
|
|
工业机器人分类介绍——雅马哈
工业机器人是面向工业范畴的多关节机械手或多自由度的机器设备,能主动执行工作,靠自身动力和控制能力完结各种功用。它可以接受人类指挥,也可以按照预先编排的程序运转,现代工业机器人还可以 ...
|
|
雅马哈工业机器人传动机构
工业机器人常见的传动机构形式可以分为直线传动和旋转传动机构两种,其中直线传动机构可以通过齿轮齿条、丝杠螺母等传动元件将旋转运动转换成直线运动,也可以由直线驱动电机驱动,或是直接由气 ...
|
|
机器视觉与运动控制的结合——雅马哈机器人
机器视觉体系相当于智能工厂的“眼睛和大脑”。跟着生产设备的集成化开展,打破传统操控流程,越来越多的视觉体系将运动操控结合到其架构中,传统的计划选用视觉体系+PLC+运动操控的形式,但由 ...
|
|