Page 200 - MDP2022-3
P. 200
int servo_1_pos;
int servo_2_pos;
int servo_3_pos;
int servo_4_pos;
int servo_5_pos;
int servo_6_pos;
int servo_7_pos;
flex_1_pos = analogRead(flex_1); //중지
servo_1_pos = map(flex_1_pos,300 ,1000, 0, 180);
servo_1_pos = constrain(servo_1_pos, 0, 180);
servo_1.write(servo_1_pos);
flex_2_pos = analogRead(flex_2);//검지
servo_2_pos = map(flex_2_pos,300 ,1000, 0, 180);
servo_2_pos = constrain(servo_2_pos, 0, 180);
servo_2.write(servo_2_pos);
flex_3_pos = analogRead(flex_3);//약지
servo_3_pos = map(flex_3_pos,300 ,1000, 0, 180);
servo_3_pos = constrain(servo_3_pos, 0, 180);
servo_3.write(servo_3_pos);
flex_4_pos = analogRead(flex_4);//새끼
servo_4_pos = map(flex_4_pos,300,1000, 0, 180);
servo_4_pos = constrain(servo_4_pos, 0, 180);
servo_4.write(servo_4_pos);
flex_5_pos = analogRead(flex_5);//엄지
servo_5_pos = map(flex_5_pos,300,1000, 0, 180);
servo_5_pos = constrain(servo_5_pos, 0, 180);
servo_5.write(servo_5_pos);
flex_6_pos = analogRead(flex_6);//손목1
servo_6_pos = map(flex_6_pos,300,1000, 0, 180);
servo_6_pos = constrain(servo_6_pos, 0, 180);
wrist_1.write(servo_6_pos);
flex_7_pos = analogRead(flex_7);//손목2
servo_7_pos = map(flex_7_pos,300,1000, 0, 180);
servo_7_pos = constrain(servo_7_pos, 0, 180);
wrist_2.write(servo_7_pos);
}