first commit

sketch_jan18a.ino

@@ -0,0 +1,49 @@
+#include <Servo.h>
+
+Servo ServoBase;
+Servo ServoArmOne;
+const int SW_pin = 10;
+const int X_pin = A1;
+const int Y_pin = A0;
+
+void setup () {
+  ServoBase.attach(13);
+  ServoArmOne.attach(12);
+  Serial.begin(9600);
+  pinMode(SW_pin, INPUT);
+  digitalWrite(SW_pin, HIGH);
+}
+
+void loop() {
+  bool SW = digitalRead(SW_pin);
+  if (!SW) {
+    ServoBase.write(90);
+  }
+
+  int Y_State = analogRead(Y_pin);
+  moveBase(Y_State);
+
+/*
+  Serial.print("Switch:  ");
+  Serial.print(digitalRead(SW_pin));
+  Serial.print("\n");
+  Serial.print("X-axis: ");
+  Serial.print(analogRead(X_pin));
+  Serial.print("\n");
+  Serial.print("Y-axis: ");
+  Serial.println(analogRead(Y_pin));
+  Serial.print("\n\n");
+  delay(500);
+  */
+
+}
+
+void moveBase(int pos) {
+  int newServoPos = pos * 0.1761;
+  ServoBase.write(newServoPos);
+  Serial.print(newServoPos);
+  Serial.print("\n");
+  Serial.print(pos);
+  Serial.print("\n");
+}
+