pos2=pos2-1;
myservo2.write(pos2);
delay(5);
if(pos2<0)
// limit the lifting angle
{
pos2=0;
}
}
// upper arm back
if(ps2x.Analog(PSS_RY)>200)
{
pos2=pos2+1;
myservo2.write(pos2);
delay(5);
if(pos2>180) // limit the declining angle
{
pos2=180;
}
}
}
//***************************************************************
void zhuazi()
{
// close the claw
if(ps2x.Analog(PSS_LX)>220)
{
// the upper arm will lift up
//if push the right joystick to downward
// the robot arm will go down
// if push the left joystick to the right
266
Need help?
Do you have a question about the 4DOF and is the answer not in the manual?
Questions and answers