You are on page 1of 4

Dos flexòmetres dos servos:

#include <Servo.h>

Servo servo_Polze;

Servo servo_Index;

int FlexpinPolze= 1;

int ledPinPolze= 10;

int Valorflexio_anteriorPolze=0;

int ValorflexioPolze= 0;

int FlexpinIndex= 0;

int ledPinIndex= 9;

int Valorflexio_anteriorIndex=0;

int ValorflexioIndex= 0;

void setup()

servo_Polze.attach(9);

servo_Index.attach(10);
Serial.begin(9600);

pinMode(ledPinIndex, OUTPUT);

pinMode(ledPinPolze, OUTPUT);//sets the led pin to output

void loop()

Polze();

Index();

//Cor();

//Anular();

//Petit();

void Polze(){

Valorflexio_anteriorPolze=ValorflexioPolze;

ValorflexioPolze= analogRead(FlexpinPolze);

//Serial.println(ValorflexioPolze);

ValorflexioPolze = map(ValorflexioPolze,550,750, 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,880, 0, 180);

ValorflexioIndex = constrain(ValorflexioIndex, 0, 180);

Serial.println(ValorflexioIndex);

ValorflexioIndex=(Valorflexio_anteriorIndex*5+ValorflexioIndex)/6;

delay(10);

servo_Index.write(ValorflexioIndex);

//void Cor(){
//void Anular(){

//void Petit

You might also like