|
I only did a quick read but I think I see two problems:
loop:
if p1_sw_top = 1 then j:
goto red:
j:
goto loop:
If p1_sw_top = 1 is true, then you have the program stuck in an infinite loop until you change p1_sw_top = 1 to false. That will probably shut down your robot since you exceed the time limit on the watchdog timer.. (delta T)
if count1 = 1 then yo:
count1=1
yo:
if count1 = 0 then yo2:
count1 = 0
yo2:
s:
if count1 = 0 you then change count1 to 1 go past the yo: label, test if count1 = 0 which it never will (since you just changed it to 1) and then change it with count1 = 0 so you're right back with count1 = 0 just like you started. I think you intended to have an unconditional "goto s:" between "count1 = 1" and "yo:"
Good luck... I'm off to N.O. for Mardi Gras!
Steve Alaniz
" What good is technology if you can't abuse it?" - Ted Forth
|