Smart IOT vagn för intern logistik (Intel IoT) (8 / 10 steg)
Steg 8: Robotarm rörelse
Arduino källkoden för förflyttning av 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);
för (servo4_pos = 175; servo4_pos > = 30; servo4_pos--)
{
servo_4.write(servo4_pos);
Delay(20);
Serial.println ("inuti servo 4");
}
servo_4.detach();
Delay(1000);
servo_1.attach(3);
för (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);
för (servo1_pos = 100; servo1_pos > = 5; servo1_pos--)
{
servo_1.write(servo1_pos);
Delay(20);
}
Delay(1000);
servo_4.attach(9);
för (servo4_pos = 30; servo4_pos < = 175; servo4_pos ++)
{
servo_4.write(servo4_pos);
Delay(20);
Serial.println ("inuti servo 4");
}
servo_4.detach();
bryta;
Delay(1000);
servo_1.attach(3);
för (servo1_pos = 5; servo1_pos < = 100; servo1_pos ++)
{
servo_1.write(servo1_pos);
Delay(20);
}
för (servo1_pos = 100; servo1_pos > = 5; servo1_pos--)
{
servo_1.write(servo1_pos);
Delay(20);
}
servo_1.detach();
Delay(1000);