YAMAHA机器人编程指令集Word格式文档下载.docx

1、END SELECT 结束条件选择语句GOTO *START_RUN 跳转语句（GOTO）,跳转到*START_RUNBO标签语句6.PMOVE（1,SGI1）,Z=0.00PMOVE语句是托盘移动语句指令，本指令默认为1号机器人，编号为1号托盘，SGI1托盘点位，第三轴（Z轴）抬升到0.00mm。7.DO（21,20）=&B01DO:是输出至并行端口，本语句使并行端口DO21置OFF,DO20置ON。8.DRIVE（3,0.00）DRIVE:以轴位单位的绝对移动指令。本指令是默认为一号机器人，第三轴（Z轴）绝对移动量为0.00mm。9.MOVE P,P1,Z=0.00MOVE:移动指令。本指

2、令是以PTP移动到P1点并且Z轴抬升到0.00mm。10.WART_ARMWART_ARM:等待机器人动作结束指令。11.LEN（BB$）LEN:是获取字符串BB$的长度。12.MID$（BB$,L_NO%,1）MID$:从指定位置获取字符串。本指令是将BB$的第L_NO%字符开始的1个字符赋给MID$。13.VAL（B2$）VAL:将字符串转换为数值。将字符串表达式B2$里的字符转换为数值。14.% ，！,$%:整数 ！：实数 $:字符，字符串15.DELAY1000DELAY:延时指令语句。本指令是延时1000ms。16.MOVE P,P50,Z=0.00,S=25本语句表示以PTP移动倒

3、是P50点位，并且Z轴抬升到0.00mm的位置，移动速度为25个脉冲单位。普通命令1.DIMDIM:声明数组变量。 注意：最多只能声明三维数组格式：DIM （角标）例：DIM A% （10）定义整型一维数组变量A%（0）A%（10）的11个元素。 DIM C% （2,2），D!（10）.定义整型数组C%（0,0）C%（2,2）与实数型数组D!（0）D!（10）DIM B! （2,3,4）.定义实数型三维数组变量B!（0,0,0）B!（2,3,4）的60个元素。2.LET（1）.LET:赋值语句。LET =LET 算术变量 = 表达式并行输出变量内部输出变量机械臂锁定输出变量定时输出变量串行输出

4、变量A!=B!+1B% （1, 2, 3） =INT （10.88）DO2 （ ） =&B00101 101MO （21, 20） =2LO （00） =1TO （01） =0SO12 （ ） =255（2）.LET:字符串赋值语句字符串变量 = A$=”YAMAHA”B$=”ROBOT”C$=A$+”- +“B$Resulrt: YAMAHA-ROBOT（3）.LET:坐标点赋值语句LET坐标点表达式P1 =P10 . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 将坐标点10 赋值给坐标点1P20=P20+P5

5、. . . . . . . . . . . . . . . . . . . . . . . . . 将坐标点20 与坐标点5 分别加上各个元素，并赋值给P20P30=P30P3 . . . . . . . . . . . . . . . . . . . . . . . . . . 将坐标点30 至坐标点3 分别减去各个元素，并赋值给P30P80=P70*4 . . . . . . . . . . . . . . . . . . . . . . . . . . . 将坐标点70 的各元素乘以4，并赋值给P80P60=P5/3 . . . . . . . . . . . . . . . . . .

6、 . . . . . . . . . . . . 将坐标点5 的各元素乘以1/3，并赋值给P60（4）.移位赋值语句移位变量移位表达式S1=S0 . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 将位移0 赋值给位移1S2=S1+S0 . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 将位移1 与位移0 分别加上每个元素，并赋值给位移23.REMREM:插入标注。REM 或 以后的字符被视作注释。不执行注释语句。 也可写入行的中间。例:REM * MA

7、IN PROGRAM *字符串操作1.CHR$CHR$:计算带有指定字符编码的字符。A$ = CHR$（65）.将A赋值给A$ 即：65在ASCCII表中对应的是A,CHR$意为将数值对应的ASCCII表中的字符赋给字符串A$的作用。2.LEFT$LEFT$:从一个字符串左端抽出n个字符赋给另一个字符串。B$ = LEFT$（A$,4）.将A$中的最左端的4个字符抽出赋給B$。3.RIGHT$RIGHT$:从一个字符串右端抽出n个字符赋給另一个字符串。B$ =RIGHT$（A$,4）.将A$中的最右端的4个字符抽出赋給B$。4.LEN获取字符串的长度。LEN（）即：返回字符串表达式中表示的字符

8、串长度（字节数）。B=LEN（A$）5.MID$（BB$,L_NO%,1）6.VAL将字符串转化为数值。I4%=VAL（B5$）.将B5$里的值转化为实际的数值赋给I4%。7.STR$STR$:将数值转化为字符串。将表达式中指定的值转换为字符串。表达式中可指定整数型及实数型的数值。B$=STR$ （10.01）将数值10.01转化为字符串赋給B$。8.ORDORD:获得指定字符串的起始字符的字符编码。即计算字符编码。计算字符串表达式起始字符的字符编码。A=ORD （B） . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . .

9、将 66 （=&H42 ） 赋值给A。 字符“B”在ASCCII表中对应的数值为66。坐标点、坐标、位移坐标1.CHANGECHANGE:对指定的机器人的机械手进行切换。通过CHANGE 进行机器人编号指定机器人的机械手的切换。指定为OFF 时，表示无机械手设定。机器人编号可以省略。当进行省略时，机器人1 被指定。在切换机械手之前，请利用HAND 语句对机械手进行定义。CHANGE Hn/OFFHAND H1= 0 150.0 0.0HAND H2= 5000 20.00 0.0P1=150.00 300.00 0.00 0.00 0.00 0.00CHANGE H2 . . . . . .

10、. . . . . . . . . . . . . . . . . . . . . . . . . .更改为机械手2MOVE P, P1 . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 机械手2 的前端向P1 移动（1）CHANGE H1 . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 更改为机械手1MOVE P, P1 . . . . . . . . . . . . . . . . . . . . . . . . . . . .

11、. . . . . 机械手1 的前端向P1 移动（2）HALT2.HANDHAND:对指定机器人的机械手进行定义。定义语句：HAND机器人编号Hn= 第1 参数 第2 参数 第3 参数 R选择语句：CHANGE机器人编号Hn前提水平多关节机器人时（1）.未指定R时。机械手（工装治具）是固定在基准第二机械臂前端的。机械手n基准点与基准第二机械臂基准点之间的脉冲偏移量。逆时针方向为+脉冲。第二参数机械手n基准点与基准第二机械臂基准点之间的长度差（mm）。第三参数机械手n的Z轴的偏移量（mm）。（2）.指定0。机械手n的偏移量mm。3.LOCx、LOCy、LOCz、LOCr以轴位单位或者以位移数据为

12、要素单位来设定或者获取坐标点数据。LOCX/=LOCX（P10）=A（1）将P10的第一轴（x轴）数据变更为数组A（1）的值。LOCY（S1）=B.将S1的第二轴（Y轴）数据变更为B的值。（A1）=LOCX（P10）将P10的第一轴的数据赋給数组A（1）。B=LOCY（S1）.将位移数据的第二轴数据赋給B。4.JTOXY/XYJOTJTOXY:以轴单位制转换，将脉冲转换成毫米。将关节坐标数据转化为指定机器人的正交坐标数据。P10=JTOXY（WHERE）将当前位置数据转化成正交坐标数据。XYJOT:将正交坐标数据（mm）转化为轴坐标数据（脉冲）。将坐标点变量的正交数据转化为指定机器人的关节坐标

13、数据。P10=XYJOT（P10）5.LEFTY/RIGHTYLEFTY:将水平多关节机器人的手系系统设置为左手系。此命令对水平多关节机器人有效。RIGHTY:将水平多关节机器人的手系系统设置为手系。LEFTY（机器人编号） 注：机器人编号可以省略。RIGHTYMOVE P,P1LEFTY5.Pn/SnPn:在程序中定义点位坐标。Sn:在程序中定义位移坐标。6.SHIFTSHIFT:设置位移坐标。 （位移变量）SHIFT S1SHIFT SAMOVE P,P2分支命令1.FORNEXTFORNEXT:反复执行FOR的下一条语句至NEXT的上一条语句，直至变量超过指定值为止，将跳出循环，执行下一

14、条语句。FOR开始值TO STOP命令区NEXTFOR A=1 TO 10MOVE L,P2MOVE P,P3PRINT “YAMAHA”;ANEXT A2.GOSUBRETURNGOSUBRETURN:通过GOSUB跳转到标签子程序，并执行标签子程序，在通过RETURN返回到主程序继续执行。MAIN . GOSUB . HALT RETURN *ST:MOVE P, P0GOSUB *CLOSEHANDMOVE P, P1GOSUB *OPENHANDGOTO *STSUB ROUTINE*CLOSEHAND:DO （20） = 1RETURN*OPENHAND:DO （20） = 03.G

15、OTOGOTO:无条件跳转至标签所指定的语句。 GOTOMAIN ROUTINE*ST :MOVE P , P0, P1IF DI （20） = 1 THENGOT O *FINENDIFGOT O *ST*FIN: 4.IF（1）.IF:更据条件分支控制流程。IFTHENELSETHEN命令区1ELSEIFFHEN命令区2ELSE命令区3IF DI （21, 20） = 1 THENWAIT DI （20） =0ELSEIF DI （21, 20） =2 THENGOTO *FIN5.ONGOTOONGOTO:根据条件跳转至标签所指定的行。ON DI3 （ ） GOT O *L1,*L2,*

16、L3 . . . . . . 根据DI3 （ ） 的值跳转至*L1 *L3GOTO *ST . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 返回*STMOVE P, P10, Z=0*L2:DO （30） = 1*L3:DO （30） = 06.WHILEWENDWHILEWEND:在条件成立时，反复执行WHILE与WEND之间的语句；在条件不成立时，则跳出WHILEWEND的循环，执行WEND的下一跳语句；在条件一次都不成立的时候，则WHILEWEND语句则一次都不执行，直接执行WEND语句的下一条语句。

17、WHILE WENDA=0WHILE DI3（0）=1A=A+1PRINT “COUNTER=”；WENDNALT错误控制指令1.ON ERROR GOTOON ERROR GOTO:在发生错误时跳转到指定的标签。含义：在执行机器人语言程序时发生了错误，不停止程序，跳转至标签指定位置处理错误例程，然后将继续执行。1：ON ERROR GOTO 2：ON ERROR GOTO 0ON ERROR GOT O *ER1FOR A = 0 TO 9P A+10 = P A*L99:ERROR ROUTINE*ER1:IF ERR = &H0604 THEN *NEXT1 . . . . . . .

18、. . . . . . . . 确认是否发生了Point doesntexist的错误H0606 THEN *NEXT2 . . . . . . . . . . . . . . . 确认是否发生了Subscript out ofrange的错误ON ERROR GOT O 0 . . . . . . . . . . . . . . . . . . . . . . 显示错误并停止执行*NEXT1:RESUME NEXT . . . . . . . . . . . . . . . . . . . . . . 跳转至错误发生行的下一行继续执行*NEXT2:RESUME *L99 . . . . .

19、. . . . . . . . . . . . . . . . . . . 跳转至标签*L99 并继续执行2.RESUMERESUME:错误恢复处理后恢复执行程序从。进行错误恢复处理后，恢复执行程序。按照程序恢复启动的位置有3种方法：（1）：RESUME 从错误错误原因命令开始恢复启动程序。（2）：RESUME 从错误原因的下一个命令开始恢复启动程序。（3）：RESUME 从显示有标签行的命令开始恢复启动程序。1.RESUME NEXT2.RESUME 3.ERR/ERLERR:获取错误编码。ERL:获取错误发生行编码。ERR ERL 程序控制1.CALL调用子过程。调用SUBEND SUB语

20、句中定义的子过程。CALL标签中所指定的名称与SUB所定义的名称相同。（1）.在实参中指定的常量和表达式为值传递；（2）.在实参中指定的变量和数组元素时为传递，如果在实参前面加上ERF则变为引用传递。（3）. 在实参中指定了所有数组（数组名后面带有 （ ） ）时，将变为引用传递。CALL （ ,例1：X%=4Y%=5CALL *COMPARE （ REF X%,REF Y% ）SUB ROUTINE: COMP ARESUB *COMPARE （ A%, B% ）IF A% B% THENTEMP%=A%A%=B%B%=TEMP%END SUB例2;I = 1CALL *TEST （ I ） TESTSUB *TESTX = X + 1IF X 15 THENCALL *TEST （ X ）2.HALTHALT:停止程序并复位。直接停止程序并进行复位。HALT执行后重新启动程序时，程序将从一开始进行执行。HALT HALT PROGRAM FIN3.HALTALLHALTALL:停止并复位所有程序。直接停止并复位所有程序，当HALTALL停止复位后重新启动时，将从主程序或者任务一种最后执行的程序的最前端开始执行。HALTALL MAIN ROUTINEMOVE P ,P0,P1HAL TALL “PROGRAM FIN4.HOLDHOLD:暂停程序。直接暂停程序。重新启动程序时，