50 lines
894 B
C++
50 lines
894 B
C++
#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");
|
|
}
|
|
|