Skip to content

Instantly share code, notes, and snippets.

@jairoFernandez
Created May 31, 2017 03:15
Show Gist options
  • Star 0 You must be signed in to star a gist
  • Fork 0 You must be signed in to fork a gist
  • Save jairoFernandez/1f0dae3de2ca4497761e9c951d6bbc75 to your computer and use it in GitHub Desktop.
Save jairoFernandez/1f0dae3de2ca4497761e9c951d6bbc75 to your computer and use it in GitHub Desktop.
Mano robotica
#include <Servo.h>
Servo servo_1;
Servo servo_2;
Servo servo_3;
Servo servo_4;
Servo servo_5;
int flex_1 = 0;
int flex_2 = 1;
int flex_3 = 2;
int flex_4 = 3;
int flex_5 = 4;
void setup()
{
servo_1.attach(5);
servo_2.attach(3);
servo_3.attach(9);
servo_4.attach(10);
servo_5.attach(6);
}
void loop()
{
int flex_1_pos;
int servo_1_pos;
flex_1_pos = analogRead(flex_1);
servo_1_pos = map(flex_1_pos, 1020, 1023, 180, 0);
servo_1_pos = constrain(servo_1_pos, 0, 180);
servo_1.write(servo_1_pos);
int flex_2_pos;
int servo_2_pos;
flex_2_pos = analogRead(flex_2);
servo_2_pos = map(flex_2_pos, 1020, 1023, 180, 0);
servo_2_pos = constrain(servo_2_pos, 0, 180);
servo_2.write(servo_2_pos);
int flex_3_pos;
int servo_3_pos;
flex_3_pos = analogRead(flex_3);
servo_3_pos = map(flex_3_pos, 1020, 1023, 0, 180);
servo_3_pos = constrain(servo_3_pos, 0, 180);
servo_3.write(servo_3_pos);
int flex_4_pos;
int servo_4_pos;
flex_4_pos = analogRead(flex_4);
servo_4_pos = map(flex_4_pos, 1020, 1023, 180, 0);
servo_4_pos = constrain(servo_4_pos, 0, 180);
servo_4.write(servo_4_pos);
int flex_5_pos;
int servo_5_pos;
flex_5_pos = analogRead(flex_5);
servo_5_pos = map(flex_5_pos, 1020, 1023, 180, 0);
servo_5_pos = constrain(servo_5_pos, 0, 180);
servo_5.write(servo_5_pos);
}
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment