Arduino robot arm marmor kör (3 / 3 steg)
Steg 3: Finidhing av och kodning
Nu är det dags att vara kreativ.
Här har jag använt enkla shutes för att få marmor från gripdon till kebab spett.
När du har skapat marmor kör, ansluta arduino Nano till:
Axeln servo digital stift 4
Armbågen servo till digital stift 5
Hand servo till digital stift 6.
Lycka till!
Nedan är koden:
#include
Servo handservo;
Servo elbowservo;
Servo baseservo;
void setup() {
handservo.attach(6);
handservo.write(130);
Delay(1000);
elbowservo.attach(5);
elbowservo.write(125);
Delay(1000);
baseservo.attach(4);
baseservo.write(75);
Delay(1000);
}
void loop() {
elbowDown();
baseDown();
handClose();
baseUp();
elbowUp();
handOpen();
}
void handOpen() {
för (int h = 97; h < = 130; h + = 1) {
handservo.write(h);
Delay(15);
}
Delay(1000);
}
void handClose() {
för (int en = 130; en > = 97; en-=1) {
handservo.write(a);
Delay(15);
}
Delay(1000);
}
void elbowDown() {
för (int d = 125; d > = 5; d-=1) {
elbowservo.write(d);
Delay(20);
}
Delay(1000);
}
void elbowUp() {
för (int e = 5; e < = 125; e += 1) {
elbowservo.write(e);
Delay(20);
}
Delay(1000);
}
void baseUp() {
för (int b = 147; b > = 75; b-=1) {
baseservo.write(b);
Delay(20);
}
Delay(1000);
}
void baseDown() {
för (int c = 75; c < = 147; c + = 1) {
baseservo.write(c);
Delay(20);
}
Delay(1000);
}