X-Git-Url: http://git.droids-corp.org/?p=aversive.git;a=blobdiff_plain;f=projects%2Fmicrob2010%2Fballboard%2Fmain.c;h=ed8716bac27493480471eb8cacad4a07674d85b9;hp=963336865661db443eb9305d98778e0a6e72ef75;hb=6914527de2ecfef9d790740c71739e7418246b96;hpb=c8bae2eb9f3084d53436bc6c9fee9952dfcc1fda

diff --git a/projects/microb2010/ballboard/main.c b/projects/microb2010/ballboard/main.c
index 9633368..ed8716b 100755
--- a/projects/microb2010/ballboard/main.c
+++ b/projects/microb2010/ballboard/main.c
@@ -112,16 +112,21 @@ void bootloader(void)
 
 void do_led_blink(__attribute__((unused)) void *dummy)
 {
-#if 1 /* simple blink */
-	static uint8_t a=0;
+	static uint8_t a = 0;
 
-	if(a)
-		LED1_ON();
-	else
-		LED1_OFF();
-
-	a = !a;
-#endif
+	if (ballboard.flags & DO_ERRBLOCKING) {
+		if (a & 1)
+			LED1_ON();
+		else
+			LED1_OFF();
+	}
+	else {
+		if (a & 4)
+			LED1_ON();
+		else
+			LED1_OFF();
+	}
+	a++;
 }
 
 static void main_timer_interrupt(void)
@@ -149,7 +154,8 @@ int main(void)
 	LED1_OFF();
 	memset(&gen, 0, sizeof(gen));
 	memset(&ballboard, 0, sizeof(ballboard));
-	ballboard.flags = DO_ENCODERS | DO_CS | DO_POWER; // DO_BD
+	ballboard.flags = DO_ENCODERS | DO_CS | DO_POWER |
+		DO_ERRBLOCKING | DO_BD;
 
 	/* UART */
 	uart_init();
@@ -163,7 +169,7 @@ int main(void)
 #  error not supported
 #endif
 
-	eeprom_write_byte(EEPROM_MAGIC_ADDRESS, EEPROM_MAGIC_BALLBOARD);
+	//eeprom_write_byte(EEPROM_MAGIC_ADDRESS, EEPROM_MAGIC_BALLBOARD);
 	/* check eeprom to avoid to run the bad program */
 	if (eeprom_read_byte(EEPROM_MAGIC_ADDRESS) !=
 	    EEPROM_MAGIC_BALLBOARD) {
@@ -197,8 +203,7 @@ int main(void)
 	PWM_NG_TIMER_16BITS_INIT(4, TIMER_16_MODE_PWM_10,
 				 TIMER4_PRESCALER_DIV_1);
 
-	PWM_NG_INIT16(&gen.pwm1_4A, 4, A, 10, PWM_NG_MODE_SIGNED |
-		      PWM_NG_MODE_SIGN_INVERTED,
+	PWM_NG_INIT16(&gen.pwm1_4A, 4, A, 10, PWM_NG_MODE_SIGNED,
 		      &PORTD, 4);
 	PWM_NG_INIT16(&gen.pwm2_4B, 4, B, 10, PWM_NG_MODE_SIGNED,
 		      &PORTD, 5);
@@ -240,6 +245,9 @@ int main(void)
 	/* ax12 */
 	ax12_user_init();
 
+ 	gen.logs[0] = E_USER_ST_MACH;
+ 	gen.log_level = 5;
+
 	sei();
 
 	printf_P(PSTR("\r\n"));