git.piffa.net Git - rover/blob - prototypes/servo/rotation_lib/rotation_lib.ino

   1 /* Rotazione
   2
   3    Rotazione di un servomotore tramite la librerio Servo.h .
   4
   5 L'utilizzo della libreria Servo rende inutilizzabile analogWrite()
   6 sui pin 9 e 10 dato che utilizza i timer associati a questi PIN.
   7
   8 Power: un servo da 9g puo' arrivare ad impegnare 750mA sotto carico
   9 (se viene opposta resistenza al movimento del servo), un  SG90 prende
  10 ~52mA se il movimento e' libero. Quindi in fase di test il servo puo'
  11 essere alimentato direttamente da una scheda Arduino (200ma dal PIN 5v)
  12 ma per l'uso finale dovra' essere alimentato autonomamente.
  13
  14
  15 Rotazione a SX di 90'
  16 Rotazione a DC di 90'
  17
  18 Schema: https://www.arduino.cc/en/uploads/Tutorial/sweep_bb.png
  19         http://microbotlabs.com/images/mearm-uno-servo-1.jpg
  20    */
  21
  22 #include <Servo.h>
  23
  24 Servo myservo;  // create servo object to control a servo
  25                 // a maximum of eight servo objects can be created
  26
  27 // Servo vars
  28 int pos = 0;    // variable to store the servo position
  29 const byte servo =9 ;
  30 const byte middle = 90; // Centratura servo
  31 const int spausa = 30; // Pausa movimenti servo
  32
  33 void setup()
  34 {
  35   myservo.attach(servo);  // attaches the servo on pin 9 to the servo object
  36     myservo.write(middle);              // tell servo to go to position in variable 'pos'
  37     delay(2000);
  38 }
  39
  40
  41 void loop()
  42 {
  43 // Turn DX
  44     turnDX();
  45     delay(1000);
  46
  47     turnMiddle();
  48     delay(1000);
  49
  50 // Turn SX
  51     turnSX();
  52     delay(1000);
  53
  54     turnMiddle();
  55     delay(1000);
  56 }
  57
  58 // Functions
  59
  60 void turnDX() {
  61     // TurnDX
  62     myservo.write(170);
  63     delay(spausa);
  64 }
  65
  66 void turnSX() {
  67     // TurnSX
  68     myservo.write(10);
  69     delay(spausa);
  70 }
  71
  72 void turnMiddle() {
  73     // TurnDX
  74     myservo.write(middle);
  75     delay(spausa);
  76 }
  77