REM Servo Delay

option autorun on
option explicit
option default integer

const k_usOpen = 2000 'Servoposition open
const k_usClose = 1000 'Servoposition close
const k_msDelay = 50 'Delay per step (Step = 5uS, max. Resolution Servo-Command)

dim float sVal = k_usClose / 1000
dim sInt = k_usClose
dim oc_Flag = 0

servo 1, sVal

on key tasten()
settick k_msDelay, msInterrupt(),4

REM MM-Edit chat, press "o" and "return" for OPEN
REM In TeraTerm, press "o"
REM MM-Edit chat, press "c" and "return" for CLOSE
REM In TeraTerm, press "c"

DO
pause 1000
LOOP

sub tasten()
local a$
a$ = inkey$
if (left$(a$,1) = "o" and oc_Flag <> 1) then
oc_Flag = 1
timer = 0
print "Open . . . "
elseif (left$(a$,1) = "c" and oc_Flag <> 2) then
oc_Flag = 2
timer = 0
print "Close . . . "
endif
end sub


sub msInterrupt()
if (oc_Flag = 1) then
doorOpen()
elseif (oc_Flag = 2) then
doorClose()
endif
end sub

sub doorOpen()
if (sInt = k_usOpen) then
oc_Flag = 0
print "RUNTIME to open in SEC:"int(timer / 1000)
else
sInt = sInt + 5
sVal = sInt / 1000
servo 1, sVal
print sVal
endif
end sub

sub doorClose()
if (sInt = k_usClose) then
oc_Flag = 0
print "RUNTIME to close in SEC:"int(timer / 1000)
else
sInt = sInt - 5
sVal = sInt / 1000
servo 1, sVal
print sVal
endif
end sub