Robofun 機器人論壇

標題: +Easy Bluetooth 藍芽模組的問題 [打印本頁]

作者: a50292 時間: 2012-11-23 20:34
標題: +Easy Bluetooth 藍芽模組的問題
本帖最後由 a50292 於 2012-11-24 12:09 編輯

' {$STAMP BS2}
' {$PBASIC 2.5}

Ping          PIN    15
PingServo    PIN    14
LeftServo    PIN    13
RightServo    PIN    12
xx    PIN    11

BT_RX PIN 2
BT_TX PIN 0

BT_SPEED CON 84

tLeft VAR Word
tRight VAR Word
temp VAR Word

rawDist       VAR    Word
sweepcount    VAR    Word

x             VAR    Byte
pulseCount    VAR    Byte

counter VAR Word
inDistance VAR Word

Main:
FOR sweepcount = 350 TO 1150 STEP 100
  FOR x = 0 TO 5
PULSOUT 15, sweepcount
PAUSE 10
  NEXT
  GOSUB GetSonar
NEXT

FOR sweepcount = 950 TO 550 STEP 100
  FOR x = 0 TO 5
PULSOUT 15, sweepcount
PAUSE 10
  NEXT
  GOSUB GetSonar
NEXT
GOTO Main

GetSonar:

LOW 15
PULSOUT 15, 5
PULSIN 15, 1, rawDist

  IF (rawDist < 600) THEN
IF (sweepcount < 750) THEN
   GOSUB Turn_Left
ELSEIF (sweepcount > 750) THEN
   GOSUB Turn_Right
ELSE
   GOSUB Back_Up
ENDIF
  ELSE
GOSUB Forward_Pulse
  ENDIF

RETURN

Forward_Pulse:
FOR pulsecount = 0 TO 5

HIGH 14
LOW 13
LOW 11
HIGH 12

PAUSE 20
NEXT
RETURN

Turn_Left:
FOR pulseCount = 0 TO 10

LOW 13
HIGH 14

PAUSE 20
NEXT
RETURN

Turn_Right:

FOR pulseCount = 0 TO 10

LOW 12
HIGH 11

PAUSE 20
NEXT
RETURN

Back_Up:
FOR pulseCount = 0 TO 3

HIGH 13
LOW 14
LOW 11
HIGH 12

PAUSE 10
NEXT

FOR pulseCount = 0 TO 7

HIGH 13
LOW 14
LOW 11
HIGH 12

PAUSE 10
NEXT
RETURN

--------------

這是我還沒加上之前的因為是要控制直流馬達跟感測器所以用這樣寫 (1是往前 2是往後不用左右)
不過加上藍芽的程式我摸不出來希望能幫忙一下

作者: playrobot 時間: 2013-1-14 17:01
抱歉, 您已經解決了嗎 ?

Easy Bluetooth Documentation v1.3 (.pdf)
RBT-001 Module - User Manual (.pdf)
Easy Bluetooth Software (.zip)
Easy Bluetooth Education Sample Code (.zip)
Easy Bluetooth Cell Phone Applet (.zip)
Easy Bluetooth Code For GUI (.bs2)
Easy Bluetooth AppNote (Bluetooth to Bluetooth Connection) (.pdf)
Easy Bluetoothx2demo (.zip)

歡迎光臨 Robofun 機器人論壇 (https://robofun.net/forum/)