init_engine_A();
init_engine_B();
-
+ engine_A_en(ENGINE_EN_OFF);
+ engine_B_en(ENGINE_EN_OFF);
init_adc(ADC_ISR);
}
+ int time_delay =0;
+
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);