if-else + while

[upaucc]

Hi,
habe mal was ganz einfaches geschrieben, aber es funktioniert nicht wie es sollte. Asuro soll zuerst checken ob er irgendwo dagegen steht, ist dies der Fall soll er stehen bleiben und eben eine Nachricht ausspucken, das macht er auch wunderbar.
Sollte keiner der Taster gedrückt sein, soll er solange geradeausfgahren bis er irgendwo dagegen stößt, dann soll er ca. 1 s still stehen und dann rückwärts fahren.
In wirklichkeit macht er jedoch das: Wird er eingeschaltet steht er ca 1s und fährt dann rückwärts.

#include "asuro.h"

int main(void)
{
   Init();
   if(PollSwitch()==0){
		while(PollSwitch()==0){
		MotorDir(FWD,FWD);
		MotorSpeed(150,150);
		StatusLED(GREEN);
		}
	MotorDir(BREAK,BREAK);
	MotorSpeed(0,0);
	Msleep(666);
	MotorDir(RWD,RWD);
	MotorSpeed(100,100);
    }
   else{
	MotorDir(BREAK,BREAK);
	MotorSpeed(0,0);
	StatusLED(RED);
	SerWrite("Hinderniss!\n",11);
   }
   
   
   
}