Robo Delta

Pessoal sou aluno do curso de mecatronica na UTFPR e preciso de uma ajuda para programar um robo delta com servo motores.

Minha duvida é como faço para fazer o incremento dos motores, por exemplo: Preciso incrementar o angulo de 3 servos motor um para cada angulo. , nao tenho muito conhecimento de programaçao.

Fiz um codigo bem basico e gostaria de saber como posso chamar funcoes em separado …

Muito obrigado desde ja .

#include <Servo.h>

Servo motor1;
Servo motor2;
Servo motor3;

void setup()
{
motor1.writeMicroseconds (2200);
motor2.writeMicroseconds (2200);
motor3.writeMicroseconds (2200);
motor1.attach(3);
motor2.attach(5);
motor3.attach(6);
}
void loop()
{
motor1.write(135);
motor2.write(135);
motor3.write(135);
delay(500);

motor1.write(100);
motor2.write(140);
motor3.write(150);
delay(500);

motor2.write(100);
motor3.write(170);
motor1.write(110);
delay(500);

motor1.write(148);
motor2.write(125);
motor3.write(148);
delay(500);

motor2.write(145);
motor1.write(145);
motor3.write(135);
delay(500);

/*motor2.write(160);
motor1.write(100);
motor3.write(150);
delay(500);
*/
motor1.write(180);
motor2.write(180);
motor3.write(180);
delay(500);

motor1.detach();
motor2.detach();
motor3.detach();
}