Материал: 1697

Продолжение ПРИЛОЖЕНИЯ А

myservo.attach(3); // serv 1 myservo1.attach(5); // serv 2 myservo2.attach(6); // serv 3 myservo3.attach(9); // serv 4 myservo4.attach(10); // serv 5 myservo5.attach(11); // serv 6 (klesh) goservo(myservo5,0,1,15);

Serial.begin(9600); // connect to the serial port pinMode(pin_a, OUTPUT);

pinMode(pin_b, OUTPUT); pinMode(pin_a1, OUTPUT); pinMode(pin_b1, OUTPUT); delay(3000);

}

void goservo(Servo serv,int to_num,int step_num,int dy)

{

int fpos;

if (serv.read()<to_num){

for(fpos = serv.read(); fpos < to_num; fpos=fpos+step_num)

{

serv.write(fpos);

delay(dy);

}

}else{

for(fpos = serv.read(); fpos >= to_num; fpos=fpos-step_num)

{

serv.write(fpos); delay(dy); }}}

ВКР. 155510.09.04.04.ПЗ

Лист

76