Scribd
Upload
15 views2 pages

Code Final1

Uploaded by

Saurabh Kumar
Copyright
© © All Rights Reserved
We take content rights seriously. If you suspect this is your content, claim it here.
Available Formats
Download as TXT, PDF, TXT or read online on Scribd
15 views2 pages

Code Final1

Uploaded by

Saurabh Kumar
Copyright
© © All Rights Reserved
We take content rights seriously. If you suspect this is your content, claim it here.
Available Formats
Download as TXT, PDF, TXT or read online on Scribd
You are on page 1/ 2

#include <Servo.

h>

Servo servo1;
Servo servo2;
Servo servo3;
Servo servo4;
Servo servo5;

int i = 0;

void setup() {
servo1.attach(3); //base
servo2.attach(5); //shoulder
servo3.attach(6); //elbow
servo4.attach(9); //wrist
servo5.attach(10); //Gripper
}
void loop()
{
servo1.write(0);
servo2.write(0);
servo3.write(0);
servo4.write(0);
servo5.write(0);
for (i=0; i<=60; i++)
{
servo1.write(i);
delay(20);
}
for (i=0; i<=60; i++)
{
servo3.write(i);
delay(20);
}
for (i=0; i<=90; i++)
{
servo4.write(i);
delay(20);
}
for (i=0; i<=180; i++)
{
servo5.write(i);
delay(20);
}
for (i=90; i>=0; i--)
{
servo4.write(i);
delay(20);
}
for (i=180; i>=0; i--)
{
servo5.write(i);
delay(20);
}
for (i=60; i>=0; i--)
{
servo3.write(i);
delay(20);
}
for (i=0; i<=20; i++)
{
servo2.write(i);
delay(20);
}
for (i=60; i>=0; i--)
{
servo1.write(i);
delay(20);
}
for (i=20; i>=0; i--)
{
servo2.write(i);
delay(20);
}
for (i=0; i<=60; i++)
{
servo3.write(i);
delay(20);
}
for (i=0; i<=90; i++)
{
servo4.write(i);
delay(20);
}
for (i=0; i<=180; i++)
{
servo5.write(i);
delay(20);
}
for (i=90; i>=0; i--)
{
servo4.write(i);
delay(20);
}
for (i=180; i>=0; i--)
{
servo5.write(i);
delay(20);
}
for (i=60; i>=0; i--)
{
servo3.write(i);
delay(20);
}
}

You might also like