adrian/RoboterArm
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

servo rewrite

Browse Source
This commit is contained in:
adrian
2026-01-25 21:10:34 +01:00
parent 0d07435ec1
commit fd09e270ec
2 changed files with 62 additions and 49 deletions
Download Patch File Download Diff File Expand all files Collapse all files

62
roboterarm/roboterarm.ino Normal file
View File

@ -0,0 +1,62 @@
#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);
}
//base movement
int Y_State = analogRead(Y_pin);
int currentYState = ServoBase.read();
if (Y_State > 524) {
int newYState = currentYState + 1;
ServoBase.write(newYState);
delay(15);
}else if (Y_State < 502) {
int newYState = currentYState - 1;
ServoBase.write(newYState);
delay(15);
}
//arm movement
int X_State = analogRead(X_pin);
int currentXState = ServoArmOne.read();
if (X_State > 524) {
int newXState = currentXState + 1;
ServoArmOne.write(newXState);
delay(15);
}else if (X_State < 502) {
int newXState = currentXState - 1;
ServoArmOne.write(newXState);
delay(15);
}
}

49
sketch_jan18a.ino
View File

@ -1,49 +0,0 @@
#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");
}