das war mein erster Versuch:
Code:
#include "asuro.h"

int main(void)
{
    unsigned char taste;
	int i;
	
	Init();
	StatusLED(GREEN);
	MotorDir(FWD,FWD);
	
	while(1){
				taste=PollSwitch;
				taste=PollSwitch;
				taste=PollSwitch;
				taste=PollSwitch;
				taste=PollSwitch;
				taste=PollSwitch;
				taste=PollSwitch;
				taste=PollSwitch;
				taste=PollSwitch;
				taste=PollSwitch;
				taste=PollSwitch;
				taste=PollSwitch;
				taste=PollSwitch;
				
				if(taste==12){
								BackLED(OFF,ON);
								MotorDir(BREAK,BREAK);
								MotorSpeed(0,0);
								for(i=1;i>200;i++){
													Sleep(2);}
								
								BackLED(OFF,OFF);
								MotorDir(FWD,RWD);
								MotorSpeed(100,100);
								for(i=1;i>2000;i++);{
														Sleep(2);}
																	
								BackLED(OFF,OFF);
							    MotorDir(FWD,FWD);
								MotorSpeed(180,180);
								for(i=1;i>200;i++);{
														Sleep(2);}
								
								BackLED(OFF,ON);
							    MotorDir(RWD,RWD);
								MotorSpeed(180,180);
								for(i=1;i>2000;i++);{
														Sleep(2);}
								
				                BackLED(OFF,OFF);
								MotorDir(RWD,FWD);
								MotorSpeed(100,100);
								for(i=1;i>200;i++);{
														Sleep(2);}
								
								BackLED(OFF,OFF);
								MotorDir(FWD,FWD);
								MotorSpeed(200,200);
								for(i=1;i>300;i++);{
														Sleep(2);}
														
								}

				else if(taste==33){
									MotorDir(RWD,RWD);
									MotorSpeed(100,100);
									for(i=0;i<9999;i++){
															Sleep(10);} 
									MotorDir(BREAK,RWD);  
									MotorSpeed(0,125); 
									for(i=0;i<9999;i++){ 
															Sleep(10);}
									MotorDir(FWD,FWD);
									MotorSpeed(150,150);
									for(i=0;i<9999;i++){ 
															Sleep(10);}
									}
				else{
									MotorDir(FWD,FWD);
									MotorSpeed(200,200);
									}
				}					
	return 0;
}
da das icht funktoinierte hat habe ich einfach erstmal probiert den Servo auszulesen
Code:
#include "asuro.h"

int main(void)
{
    int i;
	Init();
	BackLED(ON,ON);
	for(i=1;1>1;i++){Sleep(1);}
	BackLED(OFF,OFF);
	while(1);
	return 0;
}