arduino_básico_Michael_McRoberts

Capítulo 9 ■ Servomecanismos
225
Escrevemos para ambos os servos um valor de 90, que corresponde ao ponto central,
de modo que iniciem na posição central:
servo1.write(90);
servo2.write(90);
// Coloca o servo1 na posição inicial
// Coloca o servo2 na posição inicial
Então a palavra “STARTING...” é exibida na janela do monitor serial, para que você saiba
que o dispositivo está pronto para receber comandos:
Serial.println("STARTING...");
No loop principal, verifique se dados foram enviados pela linha de comunicação serial:
if (Serial.available() > 0) { // Verifica se dados foram digitados
Se afirmativo, deixe que o buffer encha e obtenha o comprimento da string, garantindo
que ele não ultrapasse o máximo de dez caracteres. Assim que o buffer estiver cheio,
chame a rotina splitString, enviando o array de buffer à função:
int index=0;
delay(100); // Deixa o buffer encher
int numChar = Serial.available(); // Encontra o comprimento da string
if (numChar>10) {
numChar=10;
}
while (numChar--) {
// Preenche o buffer com a string
buffer[index++] = Serial.read();
}
splitString(buffer); // Executa a função splitString
A função splitString recebe o array de buffer, faz sua divisão em comandos separados,
caso tenha sido digitado mais de um, e chama a rotina setServo, com o parâmetro
retirado da string de comando recebida pela linha serial:
void splitString(char* data) {
Serial.print("Data entered: ");
Serial.println(data);
char* parameter;
parameter = strtok (data, " ,"); // De string para tokens
while (parameter != NULL) { // Se ainda não atingimos o fim da string...
setServo(parameter); // ...execute a função setServo
parameter = strtok (NULL, " ,");
}
// Limpa o texto e os buffers seriais
for (int x=0; x