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); |