CODEEasyArmDS2 1
CODEEasyArmDS2 1
/*
Controle do Braço Robótico EasyArmDS2 através de
cinco potenciometros by MauricioDuarte
#include <Servo.h>
Servo myservo_pulso;
Servo myservo_garra;
Servo myservo_antebraco;
Servo myservo_base;
Servo myservo_braco;
int potpin = 0;
int potpin1 = 1;
int potpin2 = 2;
int potpin3 = 3;
int potpin4 = 4;
void setup()
{
myservo_pulso.attach(9);
myservo_garra.attach(10);
myservo_antebraco.attach(6);
myservo_base.attach(5);
myservo_braco.attach(11);
// attaches dos servos aos pinos correspondentes
}
void loop()
{
val = analogRead(potpin);
val = map(val, 0, 1023, 0, 180);
myservo_pulso.write(val);
delay(15);
val = analogRead(potpin1);
val = map(val, 0, 1023, 40, 120);
myservo_garra.write(val);
delay(15);
val = analogRead(potpin2);
val = map(val, 0, 1023, 0, 180);
myservo_antebraco.write(val);
delay(15);
val = analogRead(potpin4);
val = map(val, 0, 1023, 0, 180);
myservo_braco.write(val);
delay(15);
val = analogRead(potpin3);
val = map(val, 0, 1023, 0, 180);
myservo_base.write(val);
delay(15);
}