Sistemati gli include della lib Servo.h

[rover] / libraries / rover / rover.cpp

diff --git a/libraries/rover/rover.cpp b/libraries/rover/rover.cpp
index 1b6c88e16c32d3c86a55c2ed2d9932205a55f2aa..d95fe065190912808ab355e57e2843965a97bd73 100644 (file)
--- a/libraries/rover/rover.cpp
+++ b/libraries/rover/rover.cpp
@@ -24,8 +24,17 @@ const int enB = 5;
 const int in3 = 4;
 const int in4 = 3;
 byte speedB = 255;
-// Funzioni
 
+// Servo vars
+int pos = 0;    // variable to store the servo position 
+const byte servoPIN =9 ;
+const byte middle = 90; // Centratura servo
+const int spausa = 30; // Pausa movimenti servo
+Servo myservo; // Non c'e' bisogno di extern se e' dichiarato in questo scope
+
+////////////////////////
+// Funzioni:
+//
 void abilita() {
 // Abilita i PINs come OUTPUTS
     pinMode(enA, OUTPUT);
@@ -34,6 +43,10 @@ void abilita() {
     pinMode(enB, OUTPUT);
     pinMode(in3, OUTPUT);
     pinMode(in4, OUTPUT);
+
+
+    pinMode(servoPIN, OUTPUT);
+    myservo.attach(servoPIN);
 }
 
 
@@ -104,3 +117,19 @@ void stopB() {
     // Stop
     digitalWrite(enB,LOW);
 }
+
+// Servo
+void turnDX() {
+    // TurnDX
+    myservo.write(170);
+}
+    
+void turnSX() {
+    // TurnSX
+    myservo.write(10);
+}
+
+void turnMiddle() { 
+    // TurnDX
+    myservo.write(middle);
+}