Bras Robot Piloté via Internet
Chapitre 1. Introduction
Chapitre 2. Présentation du Bras
Chapitre 3. Carte d'Interface
Chapitre 4. Gestion par API
4.1. Atelier de développement FST4.21
4.2. Le programme principal P0
4.3. Les tâches de gestion des moteurs
4.4. Les capteurs Interrupteurs et Forçage Moteur
Chapitre 5. Communication TCP/IP
Chapitre 6. Visualisation 3D
Chapitre 7. Modes de fonctionnement
Chapitre 8. WEB
Chapitre 9. Conclusion et Ressources
Page d'accueilTable des matièresNiveau supérieurPage précédenteBas de la pagePage suivanteWebographie du module

4.4. Les capteurs Interrupteurs et Forçage Moteur

Les capteurs  Interrupteurs

  Afin d'arrêter les moteurs lorsque leur axe arrive en butée, plusieurs tâches gèrent ces capteurs de butée.

        Exemple :  Tâche de gestion des 2 butées du Socle
:

Si ButeeDroite ou ButeeGauche alors
Arreter MoteurSocle
FSi

   De plus chacun des moteurs a une durée de fonctionnement limitée dans le temps.

Les capteurs Forçage moteur

    Le capteur ButéePince conçu à partir de la broche SENSE du driver L298 sert à stopper le moteur lorsque celui force. Or, ce dernier force à chaque démarrage. Notre algorithme doit donc prévoir deux cas de figure :

    1°) Cas normal: Le moteur démarre, pour fermer ou ouvrir la pince, qui finit par arriver en butée (ouverte ou fermée). Nous devons donc détecter deux impulsions sur la broche SENSE pour en déduire que le moteur force et le stopper

    2°) La pince est déjà en butée : La pince est ouverte et on demande de l'ouvrir, ou bien la pince est fermée, et on demande de la fermer. Dans ces deux cas on ne doit pas faire tourner le moteur de la pince

Page d'accueilTable des matièresNiveau supérieurPage précédenteHaut de la pagePage suivanteWebographie du module