Actuating Servos on a Schedule/Time Delay

[wdmagic]

I need to have servos (up to say 8) move from position 0 to (X) on a time delay, but I need to set a seperate time delay between each servo also,
so say every 10 minutes I need to cycle all servos and I need each servo to wait say 20 seconds before returning to the 0 position and letting the next servo run, so on and so forth. only 1 servo can be out of the position 0 at a one time. right now I'm just working with 2 servos, but I want to use up to 8. Ive been working with the code below, i would like the display to show which servo is not in position 0, and how long before the servos are to run (in a countdown perhaps). My code is incorrect as it would fire up all servos at the same time. also if anyone sees other problems with code let me know.


DEFINE LCD_DREG PORTD ' LCD Data bits on PORTD
DEFINE LCD_DBIT 0 ' PORTD starting address
DEFINE LCD_RSREG PORTD ' LCD RS bit on PORTD
DEFINE LCD_RSBIT 5 ' LCD RS bit address
DEFINE LCD_EREG PORTD ' LCD E bit on PORTD
DEFINE LCD_EBIT 4 ' LCD E bit address
DEFINE LCD_BITS 4 ' LCD in 4-bit mode
DEFINE LCD_LINES 4 ' LCD has 4 rows
DEFINE ADC_BITS 10 ' A/D number of bits
DEFINE ADC_CLOCK 1 ' Use A/D internal RC clock
DEFINE ADC_SAMPLEUS 50 ' Set sampling time in us

TRISA = 1 'PORTA is all input
TRISD = 0 ' PORTD is output 'LCD
TRISB = 0 ' PORTB is output

LCDOUT $FE, 1 ' Clear LCD
PAUSE 500 ' Wait 0.5sec for LCD to initialize

Time Var Word : time = 0' Time Between Engaging
Servo VAR word : Servo = 200 ' Servo Position Set when Engaged
NumServos VAR byte : numservos = 2 ' # of Servos, Max 8
Counter VAr word : Counter = 0' Time Counter
X var word : x = 0 ' OnTime
Y VAR WORD : y = 0 ' Servo Select

AGAIN:
ADCIN 0, time ' Read Channel 0 data
time = (time / 121) + 60 ' 60-600 Seconds
for Y = 1 to NumServos
PULSOUT PORTB.0 [Y], 100 ' Send the Home position Pulse
Next y
PAUSE 20 ' Wait 20 ms
goto Display
Counter = counter + 1
if counter > time then counter = 0
GOTO AGAIN ' Repeat

RunServos:
for X = 1 to 500 ' 20ms X 500 = 10 Seconds
For Y = 1 to NumServos ' Select Servo
PULSOUT PORTB.0[Y], 200 ' Send the Not HOME Pulse
Next Y
PAUSE 20 ' Wait 20 ms
goto display
next X
Return

Display:
LCDOUT $FE, 2
LCDOUT $FE, $80
LCDOUT "Set Minutes = ", DEC3 time
LCDOUT $FE, $C0
LCDOUT "RunTime = " , DEC Counter , " "
return

[wdmagic]

OK i got it to work, timing is a bit off but it shouldnt work with servo positions used. I added a 3rd servo on a pot just to see what numbers i had to send to activate the servos... weird thing is it rotates from 15 - 50, a pic programming manual says to use 130 - 170, and Ive seen articles on here that use 100 - 200. on a older program i wrote just for testing servos with a 12f675 I used 100 - 200 and it worked fine. I am now using a 18f4550. not sure why its having issues. I would like to get it back to the 100-200 range for servo resolution. heres the code working right now. I did speed it up changing the adc math, 500 will go back to 121.


TRISA = 255 ' PORTA is all input
TRISD = 0 ' PORTD is output
TRISB = 0 ' PORTB is output

LCDOUT $FE, 1 ' Clear LCD
PAUSE 250 ' Wait 0.5sec for LCD to initialize

Time Var WORD : time = 0 ' Time Between Engaging
HomePos VAR byte : homepos = 20 ' Servo Starting Position 15
Servo VAR byte : Servo = 25 ' Servo Position Set when Engaged 50
NumServos VAR byte : numservos = 2 ' # of Servos, Max 8
Counter VAr WORD : Counter = 0 ' Time Counter
X var word : x = 0 ' OnTime
Y VAR WORD : y = 0 ' Servo Select

Initialize:
PORTB.2 = 1 ' Set All Servos to Home Position
For Y = 1 to NumServos ' Select Servo (Each in use for 5s)
for X = 1 to 25 ' 20ms X 250 = 5 Seconds
PULSOUT PORTB.0[y], homepos ' Send the Home Position Pulse
PAUSE 20 ' Wait 20 ms
next X
Next Y
PORTB.2 = 0

Mainloop:
ADCIN 0, time ' Read Channel 0 data
time = (time / 512) + 5 ' 60-600 Seconds
Counter = counter + 1
LCDOUT $FE, 2
LCDOUT $FE, $80
LCDOUT "Set Minutes = ", DEC3 time
LCDOUT $FE, $C0
LCDOUT "Servo OFF = " , DEC3 counter

if counter > time then
counter = 0
For Y = 1 to NumServos ' Select Servo (Each in use for 15s)
LCDOUT $FE, 2
LCDOUT $FE, $80
LCDOUT "Set Minutes = ", DEC3 time
LCDOUT $FE, $C0
LCDOUT "Servo On = " , DEC3 counter ' Update Display (Servo Selection)
PORTB.2 = 1 ' Set All Servos to Home Position
for X = 1 to 25 ' 20ms X 250 = 5 Seconds
PULSOUT PORTB.0[y], servo ' Send the Home Position Pulse
PAUSE 20 ' Wait 20 ms
next X
Next Y
PORTB.2 = 0
pause 100
PORTB.2 = 1 ' Set All Servos to Home Position

For Y = 1 to NumServos ' Select Servo (Each in use for 5s)
for X = 1 to 25 ' 20ms X 250 = 5 Seconds
PULSOUT PORTB.0[y], homepos ' Send the Home Position Pulse
PAUSE 20 ' Wait 20 ms
next X
Next Y
PORTB.2 = 0
ENDIF

'For X = 1 to 100
Pause Time
'next x
x = 0
GOTO mainloop ' Repeat
END