Servomoteur: Exemple de programme

/*
********************************************************
*                                                      *
*                                                      *
* RedOhm                                               *
* Herve Mazelin                                        *
******************************************************** 
*/
 
// Pour inclure la librairie Servo dans un programme
// on ajoutera au début du programme la ligne suivante :
#include <Servo.h>
 
 
Servo servo2;  // déclaration d'une variable de type Servo2
Servo servo3;  // déclaration d'une variable de type Servo3

int v1;
int v2;

// variable pour les compteurs enfin de jouer sur la vitesse du servomoteur
int i;

void setup()
{

 
  // ouvre le port série et fixe le debit de communication à 9600 bauds
   Serial.begin(9600);     
 
  // Attache un objet de type Servo à une broche
  servo2.attach(2);  // attache la variable Servo à la broche 2 
  servo3.attach(3);  // attache la variable Servo à la broche 3
 
 delay(10000);
 
 // -------------------- INITIALISATION PHASE 1 -----------------------------
 // parametre du servomoteur v2
 // fourchette comprise entre 30 et 150
 
 Serial.println ("----------- PHASE 1 -----------");
 Serial.println ("");
 Serial.println ("Initialisation du servomoteur 2 en position 30");
 delay (1000);
 
 // Forçage de la valeur v1 a 30 utilisation de l'opérateurs arithmétiques =
 // syntaxe v1 = 30
 
 
 v1=30;
 servo2.write(v1);
 
 // tempo pour attendre le positionnement du servo
 delay(5);
 
 
 Serial.print("position du servomoteur 2 -> ");
 Serial.println(v1);
 
 
 Serial.println("Position acquise");
 Serial.println ("");
 delay (10000);
 
   
 // -------------------- PHASE 2 -----------------------------
 // parametre du servomoteur v2
 // fourchette comprise entre 30 et 150
 
 Serial.println ("----------- PHASE 2 -----------");
 Serial.println ("");
 Serial.println ("Initialisation du servomoteur 2 en position 150");
 delay (1000);
 
 // Forçage de la valeur v1 a 30 utilisation de l'opérateurs arithmétiques =
 // syntaxe v1 = 150
 
 
 // Cette boucle est exécutée i fois .Dans la boucle ci-dessous
 // 120 passages   
 for (int i=0; i <= 120; i++)
 {
 servo2.write(v1+i);
 
 // tempo pour attendre le positionnement du servo
 delay(1);
  
 Serial.print("position du servomoteur 2 -> ");
 Serial.println(v1+i);
 }
 
 Serial.println("Position acquise");
 Serial.println ("");
 delay (10000);

 // -------------------- PHASE 3 -----------------------------
 // parametre du servomoteur v2
 // fourchette comprise entre 30 et 150
 
 Serial.println ("----------- PHASE 3 -----------");
 Serial.println ("");
 Serial.println ("Retour a la position 30 du servomoteur 2 ");
 delay (5000);
 
 v1=150;
 
 // Cette boucle est exécutée i fois .Dans la boucle ci-dessous
 // 120 passages   
 for (int i=0; i <= 120; i++)
 {
 servo2.write(v1-i);
 
 // tempo pour attendre le positionnement du servo
 delay(1);
  
 Serial.print("position du servomoteur 2 -> ");
 Serial.println(v1-i);
 }
 
 Serial.println("Position acquise");
 Serial.println ("");
 delay (10000);



 
 // -------------------- PHASE 4 -----------------------------
 // parametre du servomoteur v3
 // fourchette comprise entre 120 et 179
 
  
 Serial.println ("----------- PHASE 4 -----------");
 Serial.println ("");
 Serial.println ("Initialisation a 120 du servomoteur 3");
 delay (5000);
 
 
 // Forçage de la valeur v1 a 30 utilisation de l'opérateurs arithmétiques =
 // syntaxe v2 = 120
 
 
 v2=120;
 servo3.write(v2);
 
 
 // tempo pour attendre le positionnement du servo
 delay(5);
 
 
 Serial.print("position du servomoteur 3 -> ");
 Serial.println(v2);
 
 
 
 }
 







void loop() 
{ 
   
  

  
 

}

100

101

102

103

104

105

106

107

108

109

110

111

112

113

114

115

116

117

118

119

120

121

122

123

124

125

126

127

128

129

130

131

132

133

134

135

136

137

138

139

140

141

142

143

144

145

146

147

148

149

150

151

152

153

154

155

156

157

158

159

160

161

162

163

164

165

166

167

168

169

170

171

172

********************************************************

* *

* RedOhm *

* Herve Mazelin *

********************************************************

// Pour inclure la librairie Servo dans un programme

// on ajoutera au début du programme la ligne suivante :

#include <Servo.h>

Servo servo2; // déclaration d'une variable de type Servo2

Servo servo3; // déclaration d'une variable de type Servo3

int v1;

int v2;

// variable pour les compteurs enfin de jouer sur la vitesse du servomoteur

int i;

void setup()

{

// ouvre le port série et fixe le debit de communication à 9600 bauds

Serial.begin(9600);

// Attache un objet de type Servo à une broche

servo2.attach(2); // attache la variable Servo à la broche 2

servo3.attach(3); // attache la variable Servo à la broche 3

delay(10000);

// -------------------- INITIALISATION PHASE 1 -----------------------------

// parametre du servomoteur v2

// fourchette comprise entre 30 et 150

Serial.println ("----------- PHASE 1 -----------");

Serial.println ("");

Serial.println ("Initialisation du servomoteur 2 en position 30");

delay (1000);

// Forçage de la valeur v1 a 30 utilisation de l'opérateurs arithmétiques =

// syntaxe v1 = 30

v1=30;

servo2.write(v1);

// tempo pour attendre le positionnement du servo

delay(5);

Serial.print("position du servomoteur 2 -> ");

Serial.println(v1);

Serial.println("Position acquise");

Serial.println ("");

delay (10000);

// -------------------- PHASE 2 -----------------------------

// parametre du servomoteur v2

// fourchette comprise entre 30 et 150

Serial.println ("----------- PHASE 2 -----------");

Serial.println ("");

Serial.println ("Initialisation du servomoteur 2 en position 150");

delay (1000);

// Forçage de la valeur v1 a 30 utilisation de l'opérateurs arithmétiques =

// syntaxe v1 = 150

// Cette boucle est exécutée i fois .Dans la boucle ci-dessous

// 120 passages

for (int i=0; i <= 120; i++)

{

servo2.write(v1+i);

// tempo pour attendre le positionnement du servo

delay(1);

Serial.print("position du servomoteur 2 -> ");

Serial.println(v1+i);

}

Serial.println("Position acquise");

Serial.println ("");

delay (10000);

// -------------------- PHASE 3 -----------------------------

// parametre du servomoteur v2

// fourchette comprise entre 30 et 150

Serial.println ("----------- PHASE 3 -----------");

Serial.println ("");

Serial.println ("Retour a la position 30 du servomoteur 2 ");

delay (5000);

v1=150;

// Cette boucle est exécutée i fois .Dans la boucle ci-dessous

// 120 passages

for (int i=0; i <= 120; i++)

{

servo2.write(v1-i);

// tempo pour attendre le positionnement du servo

delay(1);

Serial.print("position du servomoteur 2 -> ");

Serial.println(v1-i);

}

Serial.println("Position acquise");

Serial.println ("");

delay (10000);

// -------------------- PHASE 4 -----------------------------

// parametre du servomoteur v3

// fourchette comprise entre 120 et 179

Serial.println ("----------- PHASE 4 -----------");

Serial.println ("");

Serial.println ("Initialisation a 120 du servomoteur 3");

delay (5000);

// Forçage de la valeur v1 a 30 utilisation de l'opérateurs arithmétiques =

// syntaxe v2 = 120

v2=120;

servo3.write(v2);

// tempo pour attendre le positionnement du servo

delay(5);

Serial.print("position du servomoteur 3 -> ");

Serial.println(v2);

}

void loop()

{

}