机器人教程网

标题: 三菱st语言 fb块 [打印本页]

作者: zhou    时间: 2022-3-20 16:32
标题: 三菱st语言 fb块
//##########################初始化#########################//5 t# X- L7 N7 s, \8 ^" [5 s+ b3 j
IF ldp(TRUE,bool_[2] OR bool_[5]) OR bool_[3] OR bool_[6] OR SM402 THEN0 p% u# s( g. r. U( F4 \; Z0 v
        int_[0]:=0; int_[1]:=0;1 Q! |1 h0 J1 O
END_IF;. Y- F1 a1 ~' v# B; |" W, E: i- q
//##########################叫载具###########################//
- j0 _" r% j! M8 rIF bool_[2] AND int_[0]=0 AND int_[1]=0 AND NOT time_[0].s THEN6 L$ R' F/ `' |! L. }3 a
        int_[0]:=1;
- G# U1 s3 f" m4 c1 V3 H- U0 Y        ELSIF time_[0].s THEN
: n' `  K7 O. x4 W/ a1 u        int_[0]:=0;
+ M' c% k% A: [+ _! @( E        int_[1]:=0;
" @/ X4 p3 V# r8 xEND_IF;
5 L7 ]! v$ s5 }/ Xout_t((*bool_[2] AND*) int_[0]=1 AND int_[1]=0 OR time_[0].s AND andfi(TRUE,SM413),time_[0],200);//回应超时1 q! R+ S( c) S
out_t((*bool_[2] AND *)int_[1]=51 AND bool_[8] AND bool_[10],time_[1],30);//叫载具成功) V$ ~5 R' i. Q; o' v& C* Q# ]) i
out_t((*bool_[2] AND*) int_[1]=51 AND(NOT bool_[8] OR NOT bool_[10]),time_[2],30);//叫载具失败       
- O* {0 \6 Q& A( _* ~, t/ wbool_[3]:=time_[1].s;//叫载具正常结束7 D: X2 [* {7 r! _: K+ D
bool_[4]:=time_[2].s;//叫载具异常结束
$ j. L- R6 M; b- D  F2 o; u: t9 T1 q: ]. O6 I( s





欢迎光临 机器人教程网 (http://robotjc.com/) Powered by Discuz! X3.2