git.piffa.net Git - rover/blob - prototypes/macchina/raw/raw.ino

   1 /* Raw
   2
   3 Prototipo rozzo per il movimento utilizzando le funzioni
   4 di base della libreria Rover.
   5
   6
   7 Schema: https://lab.piffa.net/schemi/2wd_car_bb.png
   8 Codice: http://git.andreamanni.com/web?p=rove
   9
  10 */
  11
  12
  13 #include "rover.h"
  14 #include "Servo.h"
  15
  16 int rotPausa = 200; // Pausa per una minima rotazione
  17
  18 void setup()
  19 {
  20     abilita();
  21     servoMiddle();
  22 }
  23
  24
  25 void loop()
  26 {
  27 // Fintanto che non ci sono ostacoli: avanti
  28     while (distanceCheck() == 0) {
  29         avanti();
  30         delay(50); // Movimento minimo, per stabilizzare
  31         // l'input del sensore
  32     }
  33 // Se c'e' un ostacolo: gira
  34     giraDX();
  35     delay(rotPausa);
  36 }