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);


            }
   195   196   197   198   199   200   201   202   203   204   205