[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、有气喷涂机器人
有气喷涂机器人也称低压有气喷涂,喷涂机依托低压空气使油漆在喷出枪口后构成雾化气流作用于物体外表(墙面或木器面),有气喷涂相对于手刷而言无刷痕,并且平面相对均 ...
|
|
工业机器人关节减速器作用——雅马哈
工业机器人要害减速器的作用
工业机器人的操作主要靠伺服电机、减速器和操控器三个部件进行操控,其中减速器用于精准操控机器人关节的运动,传递更大的扭矩。目前,常见的减速器主要分为两 ...
|
|
AGV与AMR的区别——雅马哈机器人
两种自动化体系是客户进行货品/托盘移动的首选:自动导向车(AGV)和自主移动机器人(AMR)。AGV现已存在了很长一段时间,随着时间的推移,其功能和技能都在大幅度进步,而AMR在逐步受到关注。
...
|
|
工业机器人应用误区——雅马哈机器人
机器人出资一般从几万到百万美元,在第一时间作出正确的挑选并且防止常见的过错是十分重要的,因为过错将导致不必要的开支或许任务的延期。
误区一:轻视了有用负荷和惯性
机器人用户 ...
|
|
工业机器人预防性保养——雅马哈机器人
每台机器人都需求预防性保养,这样能够确保它们在出产线上保持最佳性能和完成一致性。当机器人没有进行定期的预防性保养查看,可能会导致零部件损坏或故障,然后致使出产怠慢乃至停机。对机器人 ...
|
|
雅马哈能花式开摩托的机器人
不是放了个机器人上去,是真的在开车!
据科技网站Engadget报道,雅马哈近来发布了一款名为MotoBot的机器人,它可以像人类一样驾驭超级摩托车。也许不必 ...
|
|
雅马哈机器人伺服器设置步骤
1、测验一下电机,任何电路也不必衔接,把电机的三根线恣意两根短路在一起,用手滚动电机轴,感觉起来有阻力,那就OK。
2、把伺服驱动器按图纸接上电源(例如用了调压器,从100V调到220V, ...
|
|
雅马哈机器人14.501报警处理方式
14.501 数据接收过错 14.502 成帧过错 14.503 奇偶过错 的处理方式,为什么要把这三个报警放到一起讲呢,由于这三个报警基本上原因都区别不大。
1. 首 ...
|
|
雅马哈示教器维修故障
YAMAHA 雅马哈示教器修理常见故障:按键损坏、电源板问题、高压板问题、液晶问题、主板坏,上电黑屏、 花屏、蓝屏、白屏,上电无反响、上电烧baoxian,不能正常开机、进入不了体系、接触问题、按 ...
|
|
RGV、AGV、IGV搬运机器人区别
跟着人工智能的兴起,科技迅速发展,越来越多的搬运机器人替代了人工作业,在移动机器人市场上,除了咱们熟知的AGV之外,还有RGV和IGV也在自动化物流体系中发挥着各自的效果。那么RGV、AGV、IGV ...
|
|
焊接机器人外轴介绍——雅马哈机器人
1.焊接变位器。焊接变位器有多种规格,常见的焊接变位器有单轴焊接变位器.双轴焊接变位器.三轴焊接变位器等。,可根据不同的型号应用于不同的范畴。焊接机器人和焊接变位器协调运动。焊接机器人 ...
|
|
码垛机器人维修的注意事项——雅马哈
码垛机器人是输送机输送来的料袋、纸箱或是其它包装材料依照客户工艺要求的工作方式主动堆叠成垛,并将成垛的物料进行输送的设备。码垛机器人在码垛行业有着适当广泛的运用,大大节约了劳动力, ...
|
|
雅马哈志在跟人飙车技的机器人
雅马哈方案将在构建Motobot过程中学到的东西运用起来,改善其包括摩托车、雪地车、沙滩车、工业机器人在内的各种产品。雅马哈清晰说到,“先进的车手安全系统”或许便是Motobot能帮助推动的领域 ...
|
|
工业机器人处理错误编程方法
过错例程剖析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 robot)的新机型,可用于电子产品拼装等。与此前比较提高了功能,例如作业时间可缩短约1成等。在*大的工业机器人商场我国,本土企业兴起 , ...
|
|
工业机器人码垛系统的组成——雅马哈
工业机器人码垛体系并非在实际应用中由机器人独立运转,而是与主动化设备合作执行体系作业。工业机器人码垛体系一般由4个子体系组成,电气操控子体系操控整个码垛体系的作业流程和节拍。物料传 ...
|
|
工业机器人三大核心部件
能够替代人类去做一些深重重复性的作业,做到运动和指令的精确传输,各部位紧密配合完结复杂的作业,那么这些灵动的5轴6轴机器人是怎么精准灵敏的完结这些指令的呢?
...
|
|
雅马哈发动机选择西门子软件解决方案建设数字化企业
来自日本的多元化发动机制作商雅马哈发动机株式会社近来宣布,选择了Siemens PLM Software的产品生命周期办理(PLM)软件来支撑其数字化。雅马哈发动机将在其支柱业务摩托车的全部研发部门中布 ...
|
|
立柱机器人码垛机的应用优势
1.作业效率高
立柱机器人码垛机每小时抓取300——400次,您能够挑选单爪手和双爪手,速度和质量远高于手人工。
2.操作精度高,作业范围大。
立柱机器人码垛机占地面积小,动作 ...
|
|