So in etwa sollte es funktionieren(nicht getestet!)

Code:
int flag=0;

while(1)
{
   if(PollSwitch() != 0)
      flag=1;


   if (flag==0)
   {   
      MotorDir(FWD,FWD);
      MotorSpeed(120,120);
   }

   else
   {
      MotorDir(RWD,RWD);
      MotorSpeed(120,120);
   } 
}
Beim C Programmieren happerts noch ein bisschen bei dir, schau dir z.B. diesen Online C Kurs an:
http://www.fh-augsburg.de/informatik...utorial/cyris/