3.9 KiB
Code de déplacement du robot holonome 2023
Ce dépôt contient de code le déplacement du robot holonome de l'équipe Poivron Robotique. Ce robot a pour ambition de participer à la coupe de France de Robotique en 2023.
Le but est de présenter un code assurant toutes les fonctions de déplacement du robot, allant de la commande PWM des moteurs jusqu'au suivi d'une trajectoire (droite, portion de cercle, courbe de Bézier) en passant par le contrôle de l'accélération et de la décélération.
Ce code est conçu pour s'exécuter sur un Raspberry Pi Pico.
Nous en profitons pour proposer également les fonctions bas niveau développées pour le Raspberry Pi Pico.
Voici un bref paragraphe explicatif pour chaque bloc fonctionnel.
Moteurs
Initialise les modules PWM et propose les fonctions pour les piloter.
QEI
Décode les signaux renvoyés par les codeurs et les convertit en distance parcoure par les roues, en millimètres.
L'interprétation des signaux se fait grâce aux PIOs et à l'exemple fourni dans le SDK.
SPI
Tentative de créer des fonctions non bloquantes pour le SPI. Mais vu la vitesse du SPI, l'intérêt est limité. Une partie du code n'a pas été éprouvé.
Gyro ADXRS453
Initialise le Gyroscope ADXRS453. Décode les données fournies par le gyroscope et les convertit en radian/seconde. Les biais éventuels ne sont pas compensés.
Gyro
Compensation du biais du gyroscope et intégration de la vitesse pour obtenir l'orientation.
Localisation
Utilisation des équations définies dans cette l'étude pour obtenir la position du robot à partir du déplacement mesuré de ses roues.
Devrait à terme aussi utiliser les valeurs du gyroscope pour gagner en précision.
Asservissement des moteurs
À partir d'une consigne de vitesse pour chaque moteur, utilisation d'un correcteur proportionnel et intégrale (PI) pour déterminer la commande des moteurs.
Commande de vitesse
À partir de la rotation désirée et des vitesses X et Y dans le référentiel du robot, détermine la consigne de vitesse pour chaque moteur grâce aux lois de commande.
Asservissement en position
À partir d'une consigne de position, détermine la rotation désirée et les vitesses X et Y dans le référentiel du robot. Ceci en deux étapes :
- Asservissement avec un simple gain proportionnel
- Projection des vitesses X et Y dans le référentiel du robot.
Gestion des trajets
Cette fonction permet de parcourir une trajectoire en tenant compte des contraintes de vitesse.
- Calcul de la vitesse
- Prise en compte de l'accélération maximale
- Prise en compte de la décélération pour s'arrêter. Voir cet article.
- Calcul de l'avancement sur la trajectoire.
- Obtention de la nouvelle consigne de position.
Pour se déplacer sur une trajectoire, cette fonction utilise les outils de gestion des trajectoires définis dans les fichiers trajectoire*.
Fonctions bas niveau
I2C Maître, non bloquant
Le fichier i2c_maitre.c propose une implémentation non-bloquante de l'i2c. L'utilisation s'effectue ainsi :
- La fonction i2c_gestion doit être appelée régulièrement.
- La fonction i2c_transmission (ou une fonction englobant celle-ci, telle que i2c_lire_registre_nb) doit être appelée jusqu'à ce qu'elle renvoie I2C_SUCCES.
Pour un exemple concret lisant une valeur dans une mémoire i2c, voir test_i2c_lecture_pico_annex_nb2 de Test.c