ajout des sources arduino

thubert
1 parent 0a7a4359
Showing 1 changed file with 57 additions and 0 deletions Show diff stats
Arduino/serialServo.ino
@@ -0,0 +1,57 @@
+#define SERVO1 2
+#define SERVO2 3
+#define CYCLE 10
+
+void setp() {
+  Serial.begin(9600);
+  pinMode(SERVO1, OTPT);
+  pinMode(SERVO2, OTPT);
+}
+
+void loop() {
+  int posx=90;
+  int posy=90;
+  while(1){
+    if (Serial.available()!=0){
+      char data=Serial.read();
+      delay(2);
+      while(Serial.available()==0){
+        switch(data){
+          case('h') : posx-=2;
+          if(posx>180)posx=180;
+          break;
+          case('b') : posx+=2;
+          if(posx<0)posx=0;
+          break;
+          case('g') : posy--;
+          if(posy>180)posy=180;
+          break;
+          case('d') : posy++;
+          if(posy<0)posy=0;
+          break;
+        }
+        if(posx>180)posx=180;
+        if(posx<0)posx=0;
+        if(posy>180)posy=180;
+        if(posy<0)posy=0;
+        setPosition(posx,posy);
+
+      }
+    }
+  }
+}
+  
+void setPosition(int positx,int posity){
+  int tempx= map(positx,180,0,1550,900);
+  int tempy= map(posity,180,0,2400,700);
+          /*Serial.print(tempx);
+        Serial.print("<X  Y>");
+        Serial.println(tempy);*/
+  digitalWrite(SERVO1,1);
+  delayMicroseconds(tempx);
+  digitalWrite(SERVO1,0);
+  digitalWrite(SERVO2,1);
+  delayMicroseconds(tempy);
+  digitalWrite(SERVO2,0);
+  delay(CYCLE);
+}