Projet

Général

Profil

Télécharger (1,71 ko)

Robot InMoov » code_test_InMoov.txt

code Arduiuno à copier-coller pour tester les servomoteurs - Jean-Baptiste Bonnemaison, 25/03/2020 15:01

 
#include <Servo.h>
Servo servo1;//pouce
Servo servo2;//index
Servo servo3;//majeur
Servo servo4;//anulaire
Servo servo5;//auriculaire
Servo servo6;//poignet

int positionservo1=0;
int positionservo2=0;
int positionservo3=0;
int positionservo4=0;
int positionservo5=0;
int positionservo6=0;

void setup() {
pinMode(13,OUTPUT);
pinMode(12,OUTPUT);
pinMode(11,OUTPUT);
pinMode(10,OUTPUT);
pinMode(9,OUTPUT);
pinMode(8,OUTPUT);
servo1.attach(13);//Servomoteur numéro 1 attaché à la broche 13.
servo2.attach(12);//Servomoteur numéro 2 attaché à la broche 12.
servo3.attach(11);//Servomoteur numéro 3 attaché à la broche 11.
servo1.attach(10);//Servomoteur numéro 4 attaché à la broche 10.
servo2.attach(9);//Servomoteur numéro 5 attaché à la broche 9.
servo3.attach(8);//Servomoteur numéro 6 attaché à la broche 8.
servo1.write(positionservo1);
servo2.write(positionservo2);
servo3.write(positionservo3);
servo4.write(positionservo4);
servo5.write(positionservo5);
servo6.write(positionservo6);
}

void loop() {
positionservo1=180;
positionservo2=180;
positionservo3=180;
positionservo4=180;
positionservo5=180;
positionservo6=0;
servo2.write(positionservo2);
delay(1000);
servo3.write(positionservo3);
delay(1000);
servo4.write(positionservo4);
delay(1000);
servo5.write(positionservo5);
delay(1000);
servo1.write(positionservo1);
delay(1000);
positionservo1=0;
positionservo2=0;
positionservo3=0;
positionservo4=0;
positionservo5=0;
positionservo6=0;
servo1.write(positionservo1);
delay(1000);
servo2.write(positionservo2);
delay(1000);
servo3.write(positionservo3);
delay(1000);
servo4.write(positionservo4);
delay(1000);
servo5.write(positionservo5);
delay(1000);
}
    (1-1/1)