Robô Bípede - Programa de Pré-Montagem

/*
Programa de pré-montagem do bípede
Data: 15/11/2012 às 10:34:57
Programa de controle do robô bípede com 6 servos

*/

#include <Servo.h>

//Servos
//Quadris
Servo quadrilDireito;
Servo quadrilEsquerdo;
//joelhos
Servo joelhoDireito;
Servo joelhoEsquerdo;
//pés
Servo peDireito;
Servo peEsquerdo;

void setup() {
  //Definindo as portas de controle dos servos
  peDireito.attach(6);
  peEsquerdo.attach(11);
  joelhoDireito.attach(5);
  joelhoEsquerdo.attach(10);
  quadrilDireito.attach(3);
  quadrilEsquerdo.attach(9);
}

void loop() {
  //Movendo servos para posição inicial
  posicaoInicial();
  delay (3000);

}

//Função Posição Inicial (Move o eixo de todos os servos para 90º)
void posicaoInicial() {
  peDireito.write(90);
  peEsquerdo.write(90);
  quadrilDireito.write(90);
  quadrilEsquerdo.write(90);
  joelhoDireito.write(90);
  joelhoEsquerdo.write(90);
  delay(2000);
}
//Fim