'readadc 12,b1
'readadc 10,b2
'sertxd(#b1," ",#b2,cr,lf)
#Picaxe 28X2
#Terminal 9600
#No_Data
symbol potX = b0
symbol potY = b1
symbol servo1pos = b2
symbol servo2pos = b3
symbol lastPos1 = b4
symbol lastPos2 = b5
symbol VrX = 12 ' ADC channel number for B.0
symbol VrY = 10 ' ADC channel number for B.1
symbol SERV01 = B.4
symbol SERV02 = B.5
Init:
Servo SERV01,75 ' check servo range of travel
Servo SERV02,75
Pause 1000
Servo SERV01,225
Servo SERV02,225
Pause 1000
Servo SERV01,150 ' center servos
Servo SERV02,150
Pause 1000
Main:
Do
ReadAdc VrX, potX
ReadAdc VrY, potY
servo1pos = 150 * potX / 255 + 75
servo2pos = 150 * potY / 255 + 75
if lastPos1 <> servo1pos then
lastPos1 = servo1pos
ServoPos SERV01, servo1pos
SerTxd("PotX=",#potX," servo1pos =",#servo1pos,CR,LF)
endif
if lastPos2 <> servo2pos then
lastPos2 = servo2pos
ServoPos SERV02, servo2pos
SerTxd("PotY=",#potY," servo2pos =",#servo2pos,CR,LF)
endif
Loop