Mi octavo proyecto: Brazo Robot con el chasis del tanque inteligente y Bluetooth (4 / 8 paso)

Paso 4: prueba 1

Para asegurar el cableado es correcto hacer una prueba con los siguientes códigos:

Para el chasis del tanque inteligente:

 int motorPin = 8; //right side to IB - forwardint motorPin2 = 9; //left side to IA - forwardint motorPin3 = 10; //right side to IA - backwardint motorPin4 = 11; //left side to IB - backwardvoid setup() { Serial.begin (9600); pinMode(motorPin, OUTPUT); pinMode(motorPin2, OUTPUT); pinMode(motorPin3, OUTPUT); pinMode(motorPin4, OUTPUT);}void forward(){ digitalWrite(motorPin, HIGH); digitalWrite(motorPin2, HIGH); digitalWrite(motorPin3, LOW); digitalWrite(motorPin4, LOW); } void backward() { digitalWrite(motorPin, LOW); digitalWrite(motorPin2, LOW); digitalWrite(motorPin3, HIGH); digitalWrite(motorPin4, HIGH); } void turnLeft() { digitalWrite(motorPin, HIGH); digitalWrite(motorPin2, LOW); digitalWrite(motorPin3, LOW); digitalWrite(motorPin4, HIGH); } void turnRight() { digitalWrite(motorPin, LOW); digitalWrite(motorPin2, HIGH); digitalWrite(motorPin3, HIGH); digitalWrite(motorPin4, LOW); }void loop () { forward(); delay(10000); backward(); delay(10000); turnLeft(); delay(10000); turnRight(); delay(10000);} 

Para el brazo del robot:

 #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); // move down servo2.write(0); //turn anticlockwise servo3.write(40); //claw open delay(5000); servo1.write(180); // move up servo2.write(180); //turn clockwise servo3.write(110); //claw close delay(5000);} 

La gama de 3 servos se ajustan para evitar cualquier interrupción.