You are on page 1of 3

#include <Servo.

h>

Servo servo_Polze;
Servo servo_Index;
Servo servo_Cor;
Servo servo_Anular;
Servo servo_Petit;

int FlexpinIndex= 0;
int ledPinIndex= 9;
int Valorflexio_anteriorIndex=0;
int ValorflexioIndex= 0;

int FlexpinPolze= 1;
int ledPinPolze= 10;
int Valorflexio_anteriorPolze=0;
int ValorflexioPolze= 0;

int FlexpinCor= 2;
int ledPinCor= 11;
int Valorflexio_anteriorCor=0;
int ValorflexioCor= 0;

int FlexpinAnular= 3;
int ledPinAnular= 12;
int Valorflexio_anteriorAnular=0;
int ValorflexioAnular= 0;

int FlexpinPetit= 4;
int ledPinPetit= 13;
int Valorflexio_anteriorPetit=0;
int ValorflexioPetit= 0;

void setup()
{
servo_Polze.attach(9);
servo_Index.attach(10);
servo_Cor.attach(11);
servo_Anular.attach(12);
servo_Petit.attach(13);
Serial.begin(9600);
pinMode(ledPinIndex, OUTPUT);
pinMode(ledPinPolze, OUTPUT);
pinMode(ledPinCor, OUTPUT);
pinMode(ledPinAnular, OUTPUT);
pinMode(ledPinPetit, OUTPUT);
}

void loop()
{
Polze();
Index();
Cor();
Anular();
Petit();
}

void Polze(){
Valorflexio_anteriorPolze=ValorflexioPolze;

ValorflexioPolze= analogRead(FlexpinPolze);

//Serial.println(ValorflexioPolze);
ValorflexioPolze = map(ValorflexioPolze,450,800, 0, 180);

ValorflexioPolze = constrain(ValorflexioPolze, 0, 180);

//Serial.println(ValorflexioPolze);
ValorflexioPolze=(Valorflexio_anteriorPolze*10+ValorflexioPolze)/11;
servo_Polze.write(ValorflexioPolze);
delay(5);
}

void Index(){

Valorflexio_anteriorIndex=ValorflexioIndex;

ValorflexioIndex= analogRead(FlexpinIndex);

//Serial.println(ValorflexioIndex);
ValorflexioIndex = map(ValorflexioIndex,600,900, 0, 180);

ValorflexioIndex = constrain(ValorflexioIndex, 0, 180);


//Serial.println(ValorflexioIndex);
ValorflexioIndex=(Valorflexio_anteriorIndex*5+ValorflexioIndex)/6;
delay(5);
servo_Index.write(ValorflexioIndex);
}

void Cor(){
Valorflexio_anteriorCor=ValorflexioCor;

ValorflexioCor= analogRead(FlexpinCor);

//Serial.println(ValorflexioCor);
ValorflexioCor = map(ValorflexioCor,400,800, 0, 180);

ValorflexioCor = constrain(ValorflexioCor, 0, 180);

//Serial.println(ValorflexioCor);
ValorflexioCor=(Valorflexio_anteriorCor*10+ValorflexioCor)/11;
servo_Cor.write(ValorflexioCor);
delay(5);
}

void Anular(){
Valorflexio_anteriorAnular=ValorflexioAnular;

ValorflexioAnular= analogRead(FlexpinAnular);

//Serial.println(ValorflexioAnular);
ValorflexioAnular = map(ValorflexioAnular,450,800, 0, 180);

ValorflexioAnular = constrain(ValorflexioAnular, 0, 180);

//Serial.println(ValorflexioAnular);
ValorflexioAnular=(Valorflexio_anteriorAnular*10+ValorflexioAnular)/11;
servo_Anular.write(ValorflexioAnular);
delay(5);
}

void Petit (){


Valorflexio_anteriorPetit=ValorflexioPetit;

ValorflexioPetit= analogRead(FlexpinPetit);

//Serial.println(ValorflexioPetit);
ValorflexioPetit = map(ValorflexioPetit,450,800, 0, 180);

ValorflexioPetit = constrain(ValorflexioPetit, 0, 180);

//Serial.println(ValorflexioPetit);
ValorflexioPetit=(Valorflexio_anteriorPetit*10+ValorflexioPetit)/11;
servo_Petit.write(ValorflexioPetit);
delay(5);
}

You might also like