Code: Select all
Dim bad As Integer
Dim good As Integer
Dim center As Integer
Dim stroke As Integer
Dim position As Integer
dim t as integer
Dim servocom As Integer
Declare Sub servo(position As Integer)
stroke = 50 'servo stroke value
center = 700 'center position value of servo
bad = center - stroke 'bad position value of servo
good = center + stroke 'good position value of servo
servocom = 6 'change to your serial port
' setup servo controller com port
Open com "com" & servocom & ":,2400,n,8,2,cs0,ds0,cd0,rs" As #3
t = Err
If t <> 0 Then
Print "Check Servo Controller port selection"
Sleep
End
End If
sleep 100
while inkey$ = ""
position = bad
servo(position)
sleep 50
position = center
servo(position)
sleep 450
position = good
servo(position)
sleep 50
position = center
servo(position)
sleep 450
wend
end
' servo movement routine
Sub servo(position As Integer)
' send command
Print #3,"!SC" ; Chr$(0) ; Chr$(0) ; chr$(lobyte(position))_
; Chr$(hibyte(position)); Chr$(13);
End Sub