Rev 842 Rev 843
Line 325... Line 325...
325 r_motor_off(); 325 r_motor_off();
326 printf("KONEC TESTU MOTORU\r\n"); 326 printf("KONEC TESTU MOTORU\r\n");
327 delay_ms(1000); 327 delay_ms(1000);
328 } 328 }
329   329  
330 void diagnostika() // diagnostika - vypis senzoru s moznosti prepnuti na test motoru 330 void diag() // diagnostika - vypis senzoru s moznosti prepnuti na test motoru
331 { 331 {
332 read_blue_sensors(); 332 read_blue_sensors();
333 printf("LEVA: %u \t",line_l); 333 printf("LEVA: %u \t",line_l);
334 delay_ms(10); 334 delay_ms(10);
335 printf("PRAVA: %u \t",line_r); 335 printf("PRAVA: %u \t",line_r);
Line 338... Line 338...
338 delay_ms(10); 338 delay_ms(10);
339 printf("P_NARAZ: %u \r\n",BUMPR); 339 printf("P_NARAZ: %u \r\n",BUMPR);
340 delay_ms(10); 340 delay_ms(10);
341 if(BUMPL&&BUMPR) // po zmacknuti stran narazniku spusti test motoru 341 if(BUMPL&&BUMPR) // po zmacknuti stran narazniku spusti test motoru
342 { 342 {
-   343 beep(100,200);
-   344 printf("Levy naraznik - test OLSA\r\n");
-   345 printf("Pravy naraznik - test motoru\r\n");
-   346 while(true)
-   347 {
-   348 if(BUMPR)
-   349 {
343 motor_test(); 350 motor_test();
-   351 }
-   352 if(BUMPL)
-   353 {
-   354 beep(100,200);
-   355 printf("TEST OLSA\r\n");
-   356 while(true)
-   357 {
-   358 int8 tisk;
-   359 int8 *tiskp;
-   360 read_olsa();
-   361 printf("cteni\r\n"); // po precteni vsech pixelu odradkuje
-   362 for(tiskp=0;tiskp<52;tiskp++) // tisk leve casti radky
-   363 {
-   364 tisk=olsa_lseg[tiskp];
-   365 printf("%x ",tisk);
-   366 }
-   367 for(tiskp=0;tiskp<52;tiskp++) // tisk prave casti radky
-   368 {
-   369 tisk=olsa_rseg[tiskp];
-   370 printf("%x ",tisk);
-   371 }
-   372 }
-   373 }
-   374 }
344 } 375 }
345 } 376 }
346   377  
347 // HLAVNI SMYCKA 378 // HLAVNI SMYCKA
348 void main() 379 void main()
Line 369... Line 400...
369 printf("OK! \r\n"); 400 printf("OK! \r\n");
370 delay_ms(500); 401 delay_ms(500);
371 printf("VYBRAT MOD... \r\n"); 402 printf("VYBRAT MOD... \r\n");
372 while(true) 403 while(true)
373 { 404 {
374 int8 tisk; -  
375 int8 *tiskp; -  
376 read_olsa(); 405 read_olsa();
377 printf("cteni\r\n"); // po precteni vsech pixelu posle "enter" -  
378 for(tiskp=0;tiskp<52;tiskp++) // tisk leve casti radky -  
379 { -  
380 tisk=olsa_lseg[tiskp]; -  
381 printf("%x ",tisk); -  
382 } -  
383 for(tiskp=0;tiskp<52;tiskp++) // tisk prave casti radky -  
384 { -  
385 tisk=olsa_rseg[tiskp]; -  
386 printf("%x ",tisk); -  
387 } -  
388 -  
389 } 406 }
390 } 407 }