Modding the 4WD1TST3.BAS program, for the GP2D12 sensor

i finally got done modding this program for the
program Jim made
for the GP2D12 sensor

it goes on the sensor mount
and i haven’t tested it yet so im still not sure if it works yet
but it did download without errors
feel free to test it
i think you have to wave your hand in front of it if it dosn’t work


'variable definitions
mid var word
left var word
right var word
right_detect var word
left_detect var word
middle_detect var word


left = 900
right = 900
mid = 0


low p0
low p1

sound 9,[100\880, 100\988,100\1046,100\1175]         

pause 1000                          'wait one second

main:
 
 gosub a2d_check                          'get the IR information
 	
 	left_detect = left_detect/10        
  right_detect = right_detect/10
  middle_detect = middle_detect/10
 
 left=(left - 5) min 885
 right=(right - 5) min 885
 
 mid =(mid - 5) min 0
 
 left = (left + left_detect) max 925
 right = (right + right_detect) max 925
 mid = (mid + middle_detect) max 0 
 
 if mid <15 then skip
  left =  (left - middle_detect) max 915
  right = (right - middle_detect) max 915
skip:
pulsout 0,(left)          'turn sensor left
pulsout 0,(right)         'turn sensor right
pulsout 0,(mid)           'return to middle position
pause 20

a2d_check:
adin ax1,2,AD_RON, right_detect
adin ax1,2,AD_RON, left_detect
adin ax1,2,AD_RON, middle_detect
return


goto main

if you try the program, please tell me if it works,
k

:smiley:

did anyone test it yet!!???

hasnt your package come yet? :wink:

its comin today :laughing: