- for (i = 0; i < 16; i++) {
- // zapiname/vypiname portb4 v sudem/lichem kroku
- if (i & 1) {
- PORTB |= _BV(PORTB4);
- } else {
- PORTB &= ~_BV(PORTB4);
- }
-
- // hodnopta PWM pro PB1 (OC1A)
- // jdeme od 128 do 248, napriklad:
- OCR1A = 0x80 + (i << 3);
-
- // busy-wait, nebo se muzeme nechat casovat
- // pomoci watchdogu (WDT, datasheet sekce 7.4.5)
- // nebo pomoci Timer/Counter 0 (datasheet sekce 11)
- _delay_ms(1500);
+ // PB4 (motor 2) zapínáme podle sepnutí plováku PB0
+ if (PINB & _BV(PINB0)) { // rozepnuto (1)
+ PORTB &= ~_BV(PORTB4);
+ } else { // sepnuto (0)
+ PORTB |= _BV(PORTB4);