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







Zitieren

Lesezeichen