Mitt åttonde projekt: Robotarm med smarta Tank chassi och Bluetooth (4 / 8 steg)
Steg 4: 1: a Test
För att säkerställa att alla kablar är rätt gör jag ett test med nedanstående koder:
Smarta tank chassi:
int motorPin = 8; höger sida till IB - framåt
int motorPin2 = 9; vänster sida till IA - framåt
int motorPin3 = 10; höger sida till IA - bakåt
int motorPin4 = 11; vänster sida till IB - bakåt
void setup() {
Serial.BEGIN (9600);
pinMode (motorPin, produktionen);
pinMode (motorPin2, produktionen);
pinMode (motorPin3, produktionen);
pinMode (motorPin4, produktionen);
}
void forward() {
digitalWrite (motorPin, hög);
digitalWrite (motorPin2, hög);
digitalWrite (motorPin3, låg);
digitalWrite (motorPin4, låg);
}
void backward() {
digitalWrite (motorPin, låg);
digitalWrite (motorPin2, låg);
digitalWrite (motorPin3, hög);
digitalWrite (motorPin4, hög);
}
void turnLeft() {
digitalWrite (motorPin, hög);
digitalWrite (motorPin2, låg);
digitalWrite (motorPin3, låg);
digitalWrite (motorPin4, hög);
}
void turnRight() {
digitalWrite (motorPin, låg);
digitalWrite (motorPin2, hög);
digitalWrite (motorPin3, hög);
digitalWrite (motorPin4, låg);
}
Ogiltig loop () {
Forward();
Delay(10000);
Backward();
Delay(10000);
turnLeft();
Delay(10000);
turnRight();
Delay(10000);
}
För robotarm:
#include < Servo.h >
Servo servo1;
Servo servo2;
Servo servo3;
void setup()
{
servo1.attach(5);
servo2.attach(6);
servo3.attach(7);
}
void loop()
{
servo1.write(40); Flytta ned
servo2.write(0); vrid moturs
servo3.write(40); klo öppna
Delay(5000);
servo1.write(180); flytta upp
servo2.write(180); Vrid medurs
servo3.write(110); klo nära
Delay(5000);
}
Spänna av 3 servon justeras för att undvika ett avbrott sker.