' {$STAMP BS2}
' {$PBASIC 2.5}
RX CON 0 ' HomeWork Board PIN腳對應EasyBT藍芽RX腳位
TX CON 2 ' HomeWork Board PIN腳對應EasyBT藍芽RX腳位
a VAR Byte '變數函數
b VAR Word '變數函數
remote_handling: '----藍芽模式
DO
SERIN RX,84,[STR a\1] ' SERIN <= 接收指令 84為藍芽鮑率 STR為顯示一個字元
DEBUG "a=",DEC a,CR ' DEBUG顯示指令 "a="顯示a= DEC a <= 顯示十進位 a CR跳行
'向前
IF a=49 THEN '要是 a=8 時
FOR b = 0 TO 20 '迴圈
PULSOUT 15, 900 '產生一個850ms脈衝波形PIN15腳輸出,伺服馬達接PIN15腳
PULSOUT 14, 600 '產生一個650ms脈衝波形PIN14腳輸出,伺服馬達接PIN14腳
NEXT
GOTO remote_handling '跳回remote_handling
'向後
ELSEIF a=50 THEN '否則 a=2 時
FOR b = 0 TO 20 '迴圈
PULSOUT 15, 600 '產生一個650ms脈衝波形PIN15腳輸出,伺服馬達接PIN15腳
PULSOUT 14, 900 '產生一個850ms脈衝波形PIN14腳輸出,伺服馬達接PIN14腳
NEXT
GOTO remote_handling '跳回remote_handling
'向右
ELSEIF a=51 THEN '否則 a=3 時
FOR b = 0 TO 20 '迴圈
PULSOUT 15, 900 '產生一個850ms脈衝波形PIN15腳輸出,伺服馬達接PIN15腳
PULSOUT 14, 900 '產生一個850ms脈衝波形PIN14腳輸出,伺服馬達接PIN14腳
NEXT
GOTO remote_handling '跳回remote_handling
'向左
ELSEIF a=52 THEN '否則 a=4 時
FOR b = 0 TO 20 '迴圈
PULSOUT 15, 600 '產生一個650ms脈衝波形PIN15腳輸出,伺服馬達接PIN15腳
PULSOUT 14, 600 '產生一個650ms脈衝波形PIN14腳輸出,伺服馬達接PIN14腳
NEXT
ENDIF '結束
GOTO remote_handling '跳回remote_handling
LOOP
|