| 20,7 → 20,7 |
|---|
| rr=RR_CIHLA; //!!! Rozumna rychlost pro objizdeni cihly (bylo by lepsi rychlost zvysovat) a pri detekci pohybu zase snizit |
| disp(0x99); |
| set_pwm1_duty(0); // zabrzdi levym kolem, prave vpred |
| set_pwm2_duty(255); |
| set_pwm2_duty(220); |
| output_high(MOT_L); |
| output_low(MOT_R); |
| odocounter=get_timer1(); |
| 38,7 → 38,7 |
|---|
| }; |
| |
| set_pwm1_duty(0); |
| set_pwm2_duty(255); // !!! mozna prilis maly vykon pro rozjezd pro zatuhlou prevodovku |
| set_pwm2_duty(220); // !!! mozna prilis maly vykon pro rozjezd pro zatuhlou prevodovku |
| output_high(MOT_L); // leve kolo reverz |
| output_low(MOT_R); // prave kolo vpred |
| if(get_timer1()>(odocounter+5)) // konec zatacky? |
| 96,8 → 96,8 |
|---|
| if (r2>(CASAVR-CASMIN-rr)) r2=(r2<<1)+rr-(CASAVR-CASMIN); |
| |
| //!!! pro zatuhle prevodovky |
| r1<<=1; // Rychlost je dvojnasobna |
| r2<<=1; // Rozsah 2 az 184 pro rr=0 |
| // r1<<=1; // Rychlost je dvojnasobna |
| // r2<<=1; // Rozsah 2 az 184 pro rr=0 |
| |
| set_pwm1_duty(r1); // Nastav rychlost motoru |
| set_pwm2_duty(r2); |
| 147,8 → 147,8 |
|---|
| }; |
| disp(0xC3); |
| |
| set_pwm1_duty(0); //!!! pred zatuhlejma prevodovkama tam bylo 20 a 200 |
| set_pwm2_duty(255); |
| set_pwm1_duty(20); //!!! pred zatuhlejma prevodovkama tam bylo 20 a 200 |
| set_pwm2_duty(250); |
| output_high(MOT_L); |
| output_low(MOT_R); |
| delay_us(40); |