Ok Basically this is my pseudocode. It's very rough though I did it in around a minute.
main:
start both wheel servos full speed
if object too close in sight move back and move ir sensors left and right to choose direction
if object is blocking left side and not right.. right servo spins backwards and then both servos at full speed
if object is blocking right side and not left... left servo spins backwards then both servos at full speed
if object is blocking both sides... move back and make right servo moves backwards and goto main
Right now what I have is this... and it works, but not the way I want it. I want the servo to always be moving.
Main:
if IN12 = 0 then
servo P8, 1500
Endif
goto Main
Since that last code didn't work to well I tried this code below which didn't do anything.
Main:
if IN12 = 0 then
high P8
Endif
goto Main
PS if anyone is wondering what if IN12 = 0 is... it's a button on my bot board. :P
Can anyone help me find a code to always keep 2 servos continously moving until it detects something?