git.piffa.net Git - rover/blob - prototypes/motor/drive/drive.ino

   1 /* L298n motor
   2 Aggiunta
   3
   4 Guida 2WD composta da 2 motori
   5
   6 - 2 motori DC
   7 - L298n module
   8 - Batteria > 6v
   9
  10 */
  11
  12 #include <rover.h>
  13
  14 void setup() {
  15     abilita();
  16 }
  17
  18
  19 void loop() {
  20 // Avanti
  21     avanti();
  22     delay(2000);
  23 // Stop
  24     stop();
  25     delay(1000);
  26
  27 // TurnSX
  28     turnSX();
  29     delay(1000);
  30
  31 // Avanti
  32     avanti();
  33     delay(2000);
  34 // Stop
  35     stop();
  36     delay(1000);
  37
  38
  39 // TurnDX
  40     turnDX();
  41     delay(1000);
  42
  43 // Stop
  44     stop();
  45     delay(1000);
  46 }
  47
  48 // Functions
  49 void avanti() {
  50     // Drive ahead: funzione composita
  51     forwardA() ;
  52     forwardB() ;
  53 }
  54
  55 void indietro() {
  56     // Drive backward: funzione composita
  57     backwardA();
  58     backwardB();
  59 }
  60
  61 void turnDX() {
  62     // Gira a DX
  63     forwardB() ;
  64     backwardA();
  65 }
  66
  67 void turnSX() {
  68     // Gira a DX
  69     forwardA() ;
  70     backwardB();
  71 }
  72
  73 void stop() {
  74     stopA();
  75     stopB();
  76 }