Description

//Ce qui suit est une procédure de contrôle de moteur pas à pas simple,

# Définir EN 8//moteur pas à pas activer, actif faible
# Définir le contrôle de direction du moteur pas à pas X_DIR 5//axe X
# Définir le contrôle de direction du moteur pas à pas Y_DIR 6//axe y
# Définir le contrôle de direction du moteur pas à pas Z_DIR 7/z axis
# Définir le contrôle pas à pas X_STP 2//axe x
# Définir le contrôle pas à pas Y_STP 3//axe y
# Définir le contrôle pas à pas Z_STP 4/z-axis
/*
//Fonction: étape. Fonction: pour contrôler la direction du moteur pas à pas, le nombre d’étapes.
//Paramètres: commande de direction dir, broche de moteur pas à pas correspondante dirPin, broche de moteur pas à pas correspondante stepperPin, numéro de pas de valeur de retour.

*/
Étape vide (dir booléen, dirPin d’octet, stepperPin d’octet, étapes int)
{
Écriture numérique (dirPin, dir);
Retard (50);
Pour (int i = 0; i <étapes; i +) {
Numérique (stepperPin, haut);
Delaymicrosecondes (800);
Numérique (stepperPin, bas);
Delaymicrosecondes (800);
}
}
Configuration du vide () {//le moteur pas à pas utilisé dans la broche IO est réglé sur la sortie
PinMode (X_DIR, sortie); pinMode (X_STP, sortie);
PinMode (Y_DIR, sortie); pinMode (Y_STP, sortie);
PinMode (Z_DIR, sortie); pinMode (Z_STP, sortie);
PinMode (EN, sortie);
Numérique (EN, bas);
}
Boucle vide () {
Étape (false, X_DIR, X_STP, 200);//axe X inverse 1 anneau, l’étape 200 est un cercle.
Étape (faux, Y_DIR, Y_STP, 200);//axe y moteur inverse 1 anneau, l’étape 200 est un cercle.
Étape (false, Z_DIR, Z_STP, 200);//z axe moteur inverse 1 anneau, l’étape 200 est un cercle.
Retard (1000);
Étape (true, X_DIR, X_STP, 200);//moteur à axe X avant 1 tours, l’étape 200 est un cercle.
Étape (true, Y_DIR, Y_STP, 200);//axe y moteur avant 1 tours, l’étape 200 est un cercle.
Étape (true, Z_DIR, Z_STP, 200);//z axe moteur avant 1 tours, l’étape 200 est un cercle.
Retard (1000);
}

Remarque: lors de l’insertion du module A4988, veillez à ne pas insérer le module opposé. Câblage du moteur pas à pas comme suit:
2A, 2B est un groupe (rouge, vert), 1A, 1B est un groupe (bleu, jaune), si vous voulez changer de direction, peut être changer la position d’un groupe, par exemple 2A, 2B échangés mutuellement.