Simple PING Code
Embed Size (px)
Citation preview
-
8/18/2019 Simple PING Code
1/2
' {$STAMP BS2}
' {$PBASIC 2.5}
Ping PIN 15
PingServo PIN 14
LeftServo PIN 13
RigtServo PIN 12
r!"#it %AR &or
"ee()o*nt %AR &or
+ %AR B,te
(*-eCo*nt %AR B,te
M!in
/0R "ee()o*nt 35 T0 115 STP 2
/0R + T0 5
PLS0T 14 "ee()o*nt
PAS 2
N6T
70SB 7etSon!r
N6T
/0R "ee()o*nt 85 T0 55 STP 2
/0R + T0 5
PLS0T 14 "ee()o*nt
PAS 2
N6T
70SB 7etSon!r
N6T
70T0 M!in
7etSon!r
L0& Ping
PLS0T Ping 5
PLSIN Ping 1 r!"#it
I/ 9r!"#it : ;< T=N
I/ 9"ee()o*nt : >5< T=N
70SB T*rn?Left
LSI/ 9"ee()o*nt @ >5< T=N
70SB T*rn?Rigt
LS
70SB B!)?(
N#I/
LS
70SB /or"!r?P*-e
N#I/
RTRN
/or"!r?P*-e
/0R (*-e)o*nt T0 5
PLS0T LeftServo 5
PLS0T RigtServo ;5
PAS 2
N6T
RTRN
T*rn?Left
/0R (*-eCo*nt T0 1
PLS0T LeftServo ;5
PLS0T RigtServo ;5
PAS 2
-
8/18/2019 Simple PING Code
2/2
N6T
RTRN
T*rn?Rigt
/0R (*-eCo*nt T0 1
PLS0T LeftServo 5
PLS0T RigtServo 5
PAS 2
N6T
RTRN
B!)?(
/0R (*-eCo*nt T0 3
PLS0T LeftServo >5
PLS0T RigtServo >5
PAS 2
N6T
/0R (*-eCo*nt T0 >
PLS0T LeftServo ;5
PLS0T RigtServo 5
PAS 2
N6T
RTRN
