RoboDoupě.cz

Kód: Vybrat vše

 
 #define outputA 6
 #define outputB 7
 int counter = 0; 
 int aState;
 int aLastState;  
 void setup() { 
   pinMode (outputA,INPUT);
   pinMode (outputB,INPUT);
   
   Serial.begin (9600);
   aLastState = digitalRead(outputA);   }     //ulozi si aktualni pozici  
 
 void loop() { 
   aState = digitalRead(outputA);         	//precte "current" stav vstupu A
   if (aState != aLastState){                	//pokud se vstup A zmenil, je to pulz     
     if (digitalRead(outputB) != aState) {   	//pokud se vstup A lisi od vstupu B,
       counter ++;                           		//tocime se vpravo
     } else {  counter --;    }             		//jinak vlevo
     Serial.print("Position: ");
     Serial.println(counter); } 
   aLastState = aState;                      		//Update noveho stavu vstupu A 
 }

Kód: Vybrat vše

#Picaxe 08M2
#no_data
setfreq M8

symbol LCD	=0
symbol BAUD	=N9600_8
             
symbol outA	= pinc.3
symbol outB	= pinc.4


symbol aState  = b10
symbol aLast   = b11
symbol counter = b12




INIT:		aLast = outA
		counter = 0


START:	aState = outA
		 if aState <> aLast  then 
			if outB <> aState  then inc counter
		 	else dec counter
		   	endif
		   		
	  	   serout LCD,BAUD,($FE,$80,"Counter : ", #counter,"   ")
		 endif
		
		aLast = aState	  
		
		goto START