Agrilab Wiki

Code Arduino

Code Arduino

Première itération

Le code a été rédigé sur un logiciel du nom d'Arduino IDE

Voici la première version testée à l'aide de TinkerCAD ( voir cette section )

#include <Servo.h>

// Déclaration des servo
Servo axe;
Servo crem;
Servo cut;

// Positions de départ
int AxeSetup=0;
int CremSetup=170;
int CutSetup=180;

// Autres positions
int AxeBas=0;
int AxeHaut=180;

int CremClose=40;
int CremOpen=180;

int CutClose=0;
int CutOpen=180;

int buttonState1 = 0; // lance l'action d'une séquence complète (pin5)
int buttonState2 = 0;

void setup() {
// put your setup code here, to run once:
pinMode(5,INPUT); // séquence complète
pinMode(6,INPUT);

Serial.begin(9600);
cut.attach(2);
cut.write(CutSetup);
axe.attach(7);
axe.write(AxeSetup);
crem.attach(4);
crem.write(CremSetup);

delay(3000);
}

void loop() {
// put your main code here, to run repeatedly:
buttonState1 = digitalRead(5);
buttonState2 = digitalRead(6);

if (buttonState1 == HIGH and buttonState2 == LOW)
else (buttonState1 == HIGH and buttonState2 == HIGH

}
}

void seq() {
// Ferme la cremaillère
for (int position = crem.read(); position >= CremClose; position--) {
crem.write(position);
delay(15);
}
delay(1000);

// Ferme la pince de coupe
for (int position = cut.read(); position >= CutClose; position--) {
cut.write(position);
delay(15);
}
delay(1000);

// Rotation de l'axe vers la haut

for (int position = axe.read(); position <= AxeHaut; position++) {
axe.write(position);
delay(15);
}
delay(1000);

// Ouvre la crémaillère au max

for (int position = crem.read(); position <= CremOpen; position++) {
crem.write(position);
delay(15);
}
delay(1000);

// Rotation de l'axe vers le bas
for (int position = axe.read(); position >= AxeBas; position--) {
axe.write(position);
delay(15);
}
delay(1000);

// Ouvre la pince de coupe

for (int position = cut.read(); position <= CutOpen; position++) {
cut.write(position);
delay(15);
}
delay(1000);

// Crémaillère en position initiale

for (int position = crem.read(); position >= CremSetup; position--) {
crem.write(position);
delay(15);
}
delay(1000);

Version finale

Le fichier de code animant la version finale du prototype de césar est disponible en bas de page. Le fichier est à ouvrir à l'aide du logiciel Arduino IDE .

Par rapport à la première version, les boucles "for" ont disparu. Cela permet d'alléger le code.

Aussi, ayant les vrais composants, les valeurs des variables déclarées en début de code sont différentes de la première version.
Ces dernières ont été trouvée manuellement, à l'aide de potentiomètre. Nous avons recréer les mouvements du robot étape par étape. Procéder ainsi permet d'augmenter la longévité des composants en leur épargnant une mort prématurée en cas d'erreur.

Un exemple pour illustrer: si la crémaillère se ferme alors qu'une grosse salade est prise entre les mains de César, elle va forcer et risque de se casser.
Les conséquences sont les suivantes: une augmentation des coûts de prototypage accompagnée d'une perte de temps.

#include <Servo.h>

// Déclaration des servo
Servo axe;
Servo crem;
Servo cut;

// Positions de départ
int AxeSetup=800;
int CremSetup=1800;
int CutSetup=1200;

// Autres positions
int AxeBas=900;
int AxeHaut=2200;

int CremClose=1300; //valeur min 1200
int CremOpen=1800; //valeur max 1850

int CutClose=870; //valeur min 800 !!!!!
int CutOpen=1200; //valeur max 1300 !!!!!

int buttonState1 = 0; // lance l'action d'une séquence complète (pin5)
int buttonState2 = 0; // lance l'action de préhension (pin6)
int buttonState3 = 0; // lance l'action de coupe (pin3)

void setup() {
// put your setup code here, to run once:
pinMode(5,INPUT); // lancement séquence complète
pinMode(6,INPUT); // lancement préhension
pinMode(3,INPUT); // lancement coupe

cut.attach(2);
cut.write(CutSetup);
axe.attach(7);
axe.write(AxeSetup);
crem.attach(4);
crem.write(CremSetup);

delay(3000);
}

void loop() {
// put your main code here, to run repeatedly:
buttonState1 = digitalRead(5);
buttonState2 = digitalRead(6);
buttonState3 = digitalRead(3);

if (buttonState1 == HIGH)
if (buttonState2 == HIGH)
if (buttonState3 == HIGH) {
cpe();
}
}

void pre()

//Ferme la crémaillère
crem.writeMicroseconds(CremClose);
delay(3000);

//Rotation de l'axe vers le haut
axe.writeMicroseconds(AxeHaut);
delay(3000);

//Ouvre la crémaillère
crem.writeMicroseconds(CremOpen);
delay(3000);

//Rotation de l'axe vers le bas
axe.writeMicroseconds(AxeBas);
delay(3000);

//Crémaillère en position initiale
crem.writeMicroseconds(CremSetup);
delay(3000);

//Axe en position Setup
axe.writeMicroseconds(AxeSetup);
delay(3000);
}

void seq() {
//Rotation de l'axe e position initiale
axe.writeMicroseconds(AxeBas);
delay(3000);

// Ferme la cremaillère
crem.writeMicroseconds(CremClose);
delay(3000);

// Ferme la pince de coupe
cut.writeMicroseconds(CutClose);
delay(3000);

// Rotation de l'axe vers la haut

axe.writeMicroseconds(AxeHaut);
delay(3000);

// Ouvre la pince de coupe
cut.writeMicroseconds(CutOpen);

// Ouvre la crémaillère au max

crem.writeMicroseconds(CremOpen);
delay(3000);

 // Axe en position setup

axe.writeMicroseconds(AxeSetup);
delay(3000);
}

void cpe () {
/*

// Rotation de l'axe en position initiale
axe.writeMicroseconds(AxeBas);
delay(3000);

// Ferme la cremaillère
crem.writeMicroseconds(CremClose);
delay(3000);

*/
// Ferme la pince de coupe
cut.writeMicroseconds(CutClose);
delay(4000);

// Ouvre la pince de coupe
cut.writeMicroseconds(CutOpen);
delay(1000);

/*

// Ouvre la crémaillère
crem.writeMicroseconds(CremSetup);
delay(3000);

// Axe en position setup
axe.writeMicroseconds(AxeSetup);
delay(3000);

*/
}