Line 384... |
Line 384... |
384 |
read_blue_sensors(); |
384 |
read_blue_sensors(); |
385 |
read_olsa(); |
385 |
read_olsa(); |
386 |
olsa_position(); |
386 |
olsa_position(); |
387 |
printf("LEVA: %u \t",line_l); // tiskne z leveho senzoru |
387 |
printf("LEVA: %u \t",line_l); // tiskne z leveho senzoru |
388 |
printf("PRAVA: %u \t",line_r); // tiskne z praveho senzoru |
388 |
printf("PRAVA: %u \t",line_r); // tiskne z praveho senzoru |
389 |
printf("poloha: %u\t",position); // tiskne pozici OLSA |
389 |
printf("POLOHA: %u\t",position); // tiskne pozici OLSA |
390 |
printf("L_NARAZ: %u \t",BUMPL); // leve tlacitko narazniku |
390 |
printf("L_NARAZ: %u \t",BUMPL); // leve tlacitko narazniku |
391 |
printf("P_NARAZ: %u \r\n",BUMPR); // prave tlacitko narazniku |
391 |
printf("P_NARAZ: %u \r\n",BUMPR); // prave tlacitko narazniku |
392 |
if(BUMPL&&BUMPR) // po zmacknuti stran narazniku spusti test motoru |
392 |
if(BUMPL&&BUMPR) // po zmacknuti stran narazniku spusti test motoru |
393 |
{ |
393 |
{ |
394 |
beep(100,1000); |
394 |
beep(100,1000); |