ich habe 4 servo(5 euro von conrad) am küchenbot und steuere die frei ,siehe beispiel (180 grad), frage den srf04ultra ab und sende die daten zum pc mit dem easy-radio-funkmodul , ich scanne den raum damit ab,
1 waitus braucht gemäss ausrechnung der asmlaufroutine 10us , darum sind die servowertzahlen um den teiler 10 kleiner :
Code:
Sub scan_vorn()
For servo_wert = 1 To 180
servo_wert1=servo_wert+50
servo_wert2=2000-servo_wert1
PORTB.0=1
WaitUs (servo_wert1)
PORTB.0=0
WaitUs (servo_wert2)
srf04_vorn()
Print #1,Str(srf04_w_vorn)
Next wert
For servo_wert = 180 To 1 Step -1
servo_wert1=servo_wert+50
servo_wert2=2000-servo_wert1
PORTB.0=1
WaitUs (servo_wert1)
PORTB.0=0
WaitUs (servo_wert2)
srf04_vorn()
Print #1,Str(srf04_w_vorn)
Next wert
End Sub
Lesezeichen