X-Git-Url: https://codewiz.org/gitweb?a=blobdiff_plain;f=examples%2Fat91sam7s%2Fat91sam7s.c;h=f0c14a29fdcf17ba23dbec2c5d59a9fb98481198;hb=ca408eeff468a18d16fc1c8f4b29df6d44ae0293;hp=89aedcb52324f120a87c11e83b54d2acc33c1672;hpb=d53e47551d9ba397baf1d708f25e9568dfd79595;p=bertos.git

diff --git a/examples/at91sam7s/at91sam7s.c b/examples/at91sam7s/at91sam7s.c
index 89aedcb5..f0c14a29 100644
--- a/examples/at91sam7s/at91sam7s.c
+++ b/examples/at91sam7s/at91sam7s.c
@@ -50,21 +50,35 @@
 
 Timer leds_timer;
 Serial ser_fd;
+int roll = 0;
 
 static void leds_toggle(void)
 {
 	uint8_t a = (~PIOA_ODSR & 0x0f);
 
-	if (a)
+	if (roll == 1)
 	{
+		if(a == 4)
+			roll = 2;
+
 		PIOA_SODR = a;
 		PIOA_CODR = a << 1;
+
+	}
+	else if (roll == 2)
+	{
+		if(a == 2)
+			roll = 1;
+
+		PIOA_SODR = a;
+		PIOA_CODR = a >> 1;	
 	}
 	else
 	{
 		PIOA_SODR  =  0x0f;
 		/* turn first led on */
 		PIOA_CODR  = 0x00000001;
+		roll = 1;
 	}
 
 	/* Wait for interval time */