| /Designs/duckweed_collector/SW/duckweed_tx/duckweed_tx.pde |
|---|
| 43,12 → 43,19 |
| Motor = analogRead(A0); |
| Rudder = analogRead(A1); |
| //!!! |
| Serial.print(Motor, DEC); |
| Serial.print(" * "); |
| Serial.println(Rudder, DEC); |
| Motor = MotorOffset - Motor; |
| Rudder=1023-Rudder; |
| Rudder = 512 - ((RudderOffset - Rudder)<<2); |
| Motor>>=2; |
| Rudder>>=2; |
| if (Motor>200) Motor=0; |
| if (Motor>200) Motor=0; // Odstranit pro programovani regulatoru |
| if (Rudder>250) Rudder=0; |
| //if (Rudder<71) Rudder=71; |
| Check=Motor+Rudder; |