eb_smetak - reseni zahady

diff --git a/src/smetak/main.c b/src/smetak/main.c
index 48125fd58e21a69d515a5c07de51db20bb79c220..be5802adf1278db3ba74b2e41794b28333bdf4eb 100644 (file)
--- a/src/smetak/main.c
+++ b/src/smetak/main.c
@@ -123,7 +123,8 @@ void init_perip(void)          // inicializace periferii mikroprocesoru
 
        init_engine_A();
        init_engine_B();
-
+       engine_A_en(ENGINE_EN_OFF);
+       engine_B_en(ENGINE_EN_OFF);
 
        init_adc(ADC_ISR);
 
@@ -135,6 +136,8 @@ void init_perip(void)          // inicializace periferii mikroprocesoru
 }
 
 
+ int time_delay =0;
+
 
 int main (void)  {
 
@@ -145,14 +148,15 @@ int main (void)  {
        set_servo(1, 0x80);
        set_servo(2, 0x80);
        
-//     engine_A_en(ENGINE_EN_ON);
-//     engine_A_dir(ENGINE_DIR_FW);
-//     engine_A_pwm(40);
-//     engine_B_en(ENGINE_EN_ON);
-//     engine_B_dir(ENGINE_DIR_FW);
-//     engine_B_pwm(40);
+       time_delay = time_ms + 500;
 
+       deb_led_on(LEDR);
+       while(time_ms < time_delay) led_blik();
+       deb_led_on(LEDY);
 
+       while(1);
+       
+       
        engine_A_dir(ENGINE_DIR_FW);//FW);
        engine_B_dir(ENGINE_DIR_BW);
        engine_A_en(ENGINE_EN_ON);