Stap 8: Robotarm verkeer
Arduino broncode voor het verkeer van de robotarm / Servo Motor
#include<Servo.h> Servo servo_1; Servo servo_2; Servo servo_3; Servo servo_4; Servo servo_5; int servo1_pos = 0; int servo2_pos = 0; int servo3_pos = 0; int servo4_pos = 0;servo_4.attach(9);for(servo4_pos =175; servo4_pos >= 30; servo4_pos--) { servo_4.write(servo4_pos); delay(20); //Serial.println("inside servo 4 "); } servo_4.detach(); delay(1000); servo_1.attach(3); for(servo1_pos =5; servo1_pos <= 100; servo1_pos++) { servo_1.write(servo1_pos); delay(20); } servo_1.detach(); delay(1000); delay(1000); servo_1.attach(3); for(servo1_pos =100; servo1_pos >= 5; servo1_pos--) { servo_1.write(servo1_pos); delay(20); } delay(1000); servo_4.attach(9);for(servo4_pos =30; servo4_pos <= 175; servo4_pos++) { servo_4.write(servo4_pos); delay(20); Serial.println("inside servo 4 "); } servo_4.detach(); //break; delay(1000); servo_1.attach(3); for(servo1_pos =5; servo1_pos <= 100; servo1_pos++) { servo_1.write(servo1_pos); delay(20); } for(servo1_pos =100; servo1_pos >= 5; servo1_pos--) { servo_1.write(servo1_pos); delay(20); } servo_1.detach(); delay(1000);