romeo-soft.fr

Code : Tout sélectionner

Pour le code, je suis développeur de métier. Donc si tu veux qu'on y regarde y a aucun souci 

Code : Tout sélectionner

#include <Servo.h> // librairie pour servomoteur
 
///
/// Déclaration des constantes
///position des servomoteure  
const int POS_MIN_Z = 500; // Position min pour servo pour rotation sur axe des z
const int POS_MAX_Z = 2500; // Position max pour servo pour rotation sur axe des z
const int POS_MIN_X = 1200; // Position min pour servo pour rotation sur axe des x
const int POS_MAX_X = 2500; // Position max pour servo pour rotation sur axe des x
const int SERVO_Z = 5; //declaration constante de broche, servo pour rotation sur axe des z
const int SERVO_X = 6; //declaration constante de broche, servo pour rotation sur axe des x
 

/// Déclaration des variables

int rxByte = 0; // variable de stockage des octets reçus par port série
int rxNumber = 0; // variable de calcul du nombre reçu par port série
int posZ = 0; // Position axe z
int posX = 0; // Position axe X
 
///
/// Instancialtion des servos
///
Servo zServo;
Servo xServo;
 

/// \bref Initialisation des servomoteurs
/// la fonction setup() est exécutée en premier 1 seule fois au démarrage du programme

void setup()
{
pinMode(SERVO_Z, OUTPUT); //met la broche en sortie
pinMode(SERVO_X, OUTPUT); //met la broche en sortie
zServo.attach(SERVO_Z, POS_MIN_Z, POS_MAX_Z);
xServo.attach(SERVO_X, POS_MIN_X, POS_MAX_X);
Serial.begin(9600); // initialise connexion série à 115200 bauds
posZ = POS_MIN_Z;
posX = POS_MIN_X;
}
 

/// \bref Boucle principale
/// la fonction loop() s'exécute sans fin en boucle aussi longtemps que l'Arduino est sous tension

void loop()
{
if(posZ == POS_MIN_Z){
for(posZ = POS_MIN_Z; posZ <= POS_MAX_Z; posZ++){
zServo.writeMicroseconds(posZ); // génère l'impulsion de la durée voulue en µs pour le servomoteur
delay(5);
}
for(posX = POS_MIN_X; posX <= POS_MAX_X; posX++){
xServo.writeMicroseconds(posX); // génère l'impulsion de la durée voulue en µs pour le servomoteur
delay(5);
}
}else{
for(posZ = POS_MAX_Z; posZ >= POS_MIN_Z; posZ--){
zServo.writeMicroseconds(posZ); // génère l'impulsion de la durée voulue en µs pour le servomoteur
delay(5);
}
for(posX = POS_MAX_X; posX >= POS_MIN_X; posX--){
xServo.writeMicroseconds(posX); // génère l'impulsion de la durée voulue en µs pour le servomoteur
delay(5);
}
posZ = POS_MIN_Z;
}
}
//seb03000