Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #include <Servo.h>
- String comandoBt, id, valorSerial;
- int valorServo = 0;
- Servo servo1;
- Servo servo2;
- Servo servo3;
- void setup(){
- Serial.begin(9600);
- servo1.attach(9);
- servo2.attach(10);
- servo3.attach(11);
- }
- void loop() {
- if (Serial.available()) {
- while (Serial.available()>0){
- char serial = Serial.read();
- comandoBt += serial;
- delay(10);
- }
- verificaComando();
- /**
- * // para depuração na Serial
- Serial.print("Geral: ");
- Serial.println(comandoBt);
- Serial.print("ID: ");
- Serial.println(id);
- Serial.print("Valor: ");
- Serial.println(valorSerial);
- */
- if(id == "s1") {
- //Serial.println("Servo1 sera acionado");
- servo1.write(valorServo);
- }
- if(id == "s2") {
- //Serial.println("Servo2 sera acionado");
- servo2.write(valorServo);
- }
- if(id == "s3") {
- //Serial.println("Servo3 sera acionado");
- servo3.write(valorServo);
- }
- // limpa as Strings para próxima leitura
- comandoBt = "";
- id = "";
- valorSerial = "";
- }
- }
- void verificaComando()
- {
- // Primeiro, vamos olhar para o separador que é ',' (vírgula)
- if(comandoBt.indexOf(",")>=0)
- {
- // Se for encontrado, temos a primeira sequencia até o separador
- // vamos salvar na String id para identificar qual servo acionar
- id = comandoBt.substring(0,(comandoBt.indexOf(",")));
- // Em seguida, temos os caracteres a partir do separador de espaço até
- // o fim da string e vamos salvar na string valorSerial
- valorSerial = comandoBt.substring(comandoBt.indexOf(",")+1);
- // transforma a String valorSerial em um inteiro para aplicar no servo
- valorServo = valorSerial.toInt();
- }
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement