Rev 816 Rev 818
Line 294... Line 294...
294 int8 i; 294 int8 i;
295 beep(100,200); 295 beep(100,200);
296 printf("TEST MOTORU\r\n"); 296 printf("TEST MOTORU\r\n");
297 delay_ms(1000); 297 delay_ms(1000);
298 printf("LEVY MOTOR DOPREDU\r\n"); 298 printf("LEVY MOTOR DOPREDU\r\n");
-   299 delay_ms(1000);
299 for(i=0;i<255;i++) 300 for(i=0;i<255;i++)
300 { 301 {
301 l_motor_fwd(i); 302 l_motor_fwd(i);
302 printf("RYCHLOST: %u\r\n",i); 303 printf("RYCHLOST: %u\r\n",i);
303 delay_ms(5); 304 delay_ms(5);
Line 307... Line 308...
307 l_motor_fwd(i); 308 l_motor_fwd(i);
308 printf("RYCHLOST: %u\r\n",i); 309 printf("RYCHLOST: %u\r\n",i);
309 delay_ms(5); 310 delay_ms(5);
310 } 311 }
311 printf("LEVY MOTOR DOZADU\r\n"); 312 printf("LEVY MOTOR DOZADU\r\n");
-   313 delay_ms(1000);
312 for(i=0;i<255;i++) 314 for(i=0;i<255;i++)
313 { 315 {
314 l_motor_bwd(i); 316 l_motor_bwd(i);
315 printf("RYCHLOST: %u\r\n",i); 317 printf("RYCHLOST: %u\r\n",i);
316 delay_ms(5); 318 delay_ms(5);
Line 320... Line 322...
320 l_motor_bwd(i); 322 l_motor_bwd(i);
321 printf("RYCHLOST: %u\r\n",i); 323 printf("RYCHLOST: %u\r\n",i);
322 delay_ms(5); 324 delay_ms(5);
323 } 325 }
324 printf("PRAVY MOTOR DOPREDU\r\n"); 326 printf("PRAVY MOTOR DOPREDU\r\n");
-   327 delay_ms(1000);
325 for(i=0;i<255;i++) 328 for(i=0;i<255;i++)
326 { 329 {
327 r_motor_fwd(i); 330 r_motor_fwd(i);
328 printf("RYCHLOST: %u\r\n",i); 331 printf("RYCHLOST: %u\r\n",i);
329 delay_ms(5); 332 delay_ms(5);
Line 333... Line 336...
333 r_motor_fwd(i); 336 r_motor_fwd(i);
334 printf("RYCHLOST: %u\r\n",i); 337 printf("RYCHLOST: %u\r\n",i);
335 delay_ms(5); 338 delay_ms(5);
336 } 339 }
337 printf("PRAVY MOTOR DOZADU\r\n"); 340 printf("PRAVY MOTOR DOZADU\r\n");
-   341 delay_ms(1000);
338 for(i=0;i<255;i++) 342 for(i=0;i<255;i++)
339 { 343 {
340 r_motor_bwd(i); 344 r_motor_bwd(i);
341 printf("RYCHLOST: %u\r\n",i); 345 printf("RYCHLOST: %u\r\n",i);
342 delay_ms(5); 346 delay_ms(5);
Line 345... Line 349...
345 { 349 {
346 r_motor_bwd(i); 350 r_motor_bwd(i);
347 printf("RYCHLOST: %u\r\n",i); 351 printf("RYCHLOST: %u\r\n",i);
348 delay_ms(5); 352 delay_ms(5);
349 } 353 }
-   354 l_motor_off();
-   355 r_motor_off();
350 printf("KONEC TESTU MOTORU\r\n"); 356 printf("KONEC TESTU MOTORU\r\n");
-   357 delay_ms(1000);
351 } 358 }
352   359  
353 void diagnostika() // diagnostika - vypis senzoru s moznosti prepnuti na test motoru 360 void diagnostika() // diagnostika - vypis senzoru s moznosti prepnuti na test motoru
354 { 361 {
355 read_blue_sensors(); 362 read_blue_sensors();
Line 394... Line 401...
394 delay_ms(500); 401 delay_ms(500);
395 printf("VYBRAT MOD... \r\n"); 402 printf("VYBRAT MOD... \r\n");
396 403
397 while(true) 404 while(true)
398 { 405 {
399 olsa_send(test); 406 olsa_send(main_reset);
400 } 407 }
401 } 408 }