programacion arduino 4

 // Incluímos la librería para poder controlar el servo

#include <Servo.h>

#include<SoftwareSerial.h>

 

Servo servocabeza;

Servo servobraiz;

Servo servobrade;

Servo servocadera;

int bttx=9;    //tx of bluetooth module is connected to pin 9 of arduino

int btrx=10;    //rx of bluetooth module is connected to pin 10 of arduino

int servoposition;

int servopos;

int new1;

SoftwareSerial bluetooth(bttx,btrx);

 

void setup() {

  Serial.begin(9600);

  int pos=0; 

  servocabeza.attach(9);  

  servobrade.attach(6);  

  servobraiz.attach(5);  

  servocadera.attach(3);

  bluetooth.begin(9600);

  servocabeza.write(0);

}

 

void loop() {

 if (bluetooth.available()){

    String value = bluetooth.readString();

    servoposition = value.toInt();

    if (value.toInt() == 0){

      Serial.println(servoposition);

    servocabeza.write(0);

      }

      if (value.toInt() == 45){

      Serial.println(servoposition);

    servocabeza.write(45);

      }

      if (value.toInt() == 90){

      Serial.println(servoposition);

    servocabeza.write(90);

      }

      if (value.toInt() == 135){

      Serial.println(servoposition);

    servocabeza.write(135);

      }

      if (value.toInt() == 180){

      Serial.println(servoposition);

    servocabeza.write(180);

      }

 }

}