Codage du capteur de distance V5 à l'aide des inégalités mathématiques

L'utilisation du capteur de distance V5 sur votre robot lors d'un match VEX Robotics Competition (VRC) peut permettre à votre robot de marquer plus de points en utilisant des mouvements autonomes.

Le jeu utilisé comme exemple pour cet article est le jeu VRC 2021-2022, Tipping Point. Consultez cette page pour plus d’informations sur le jeu et comment il se joue. Pour les définitions de jeu utilisées tout au long de cet article, un aperçu des règles du jeu et la notation, le Manuel du jeu pour Tipping Point.


Le capteur de distance V5

Vue en angle du capteur de distance V5.

Le capteur de distance V5 est l'un des puissants capteurs V5 conçus pour une intégration complète avec la plate-forme robotique V5.

  • Ce capteur utilise une impulsion de lumière laser adaptée à la salle de classe pour mesurer la distance entre l'avant du capteur et un objet.
  • Le capteur de distance V5 peut être utilisé pour détecter un objet et déterminer la taille relative de l'objet. La taille approximative d'un objet est indiquée comme étant petite, moyenne ou grande.
  • Le capteur peut également être utilisé pour calculer la vitesse d'approche d'un robot. La vitesse d'approche mesure la vitesse du robot/capteur lorsqu'il se déplace vers l'objet.

Pour plus d'informations sur le capteur de distance V5, son fonctionnement et son utilisation avec VEXcode V5, vconsultez cet article de la bibliothèque VEX.


Exemple de capteur de distance V5

Le but de ce projet est de permettre au robot de ramasser et de déplacer un objectif mobile à l'aide du capteur de distance V5 pour détecter à quelle distance se trouve l'objectif.

Projet VEXcode V5 Blocks qui avance jusqu'à détecter un objectif mobile, le récupérer, puis le déplacer. Le projet indique : Au démarrage, avancer, attendre que la distance de l'objet DistanceCenter en mm soit inférieure à 139, puis arrêter de conduire. Ensuite, faites tourner ForkMotors vers le haut de 600 degrés, puis tournez à gauche de 90 degrés. Ensuite, avancez de 600 mm, faites pivoter les moteurs de fourche vers le bas de 600 degrés, puis reculez de 300 mm.

Il s'agit de l'exemple de code qui sera abordé dans cet article.

Une description des comportements dans l'exemple et la manière d'obtenir les paramètres utilisés pour coder le capteur de distance V5 seront abordées.

Vous pouvez créer le projet dans VEXcode V5 au fur et à mesure que vous suivez l'article, ou vous pouvez simplement lire l'article pour vous inspirer comme exemple de la façon d'inclure le capteur de distance V5 lorsque vous codez votre propre robot personnalisé.

Cette vidéo montre le code ci-dessus en cours d'exécution et le robot récupérant et déplaçant un objectif mobile.

Le menu « Périphériques » de VEXcode V5 s'ouvre pour afficher la configuration du périphérique dans cet exemple. Le menu affiche d'abord un capteur de distance intitulé DistanceCenter sur le port 19. Ensuite, il y a un système de transmission avec des moteurs sur les ports 1 et 10 et un capteur inertiel sur le port 3. Enfin, il y a un groupe de moteurs nommé ForkMotors sur les ports 2 et 9.

Voici la configuration du robot utilisée dans VEXcode V5 pour ajouter le robot et le capteur de distance à la configuration de cet exemple, si vous souhaitez essayer l'exemple vous-même.

Robot utilisé pour cet exemple

Vue de dessus du robot Moby Hero, avec un capteur de distance V5 ajouté et mis en évidence. Le capteur de distance est situé derrière et sous la fourche du robot, orienté vers l'avant.

Le robot utilisé dans cet exemple est le VRC Hero Bot 2021-2022, Moby. La conception de Moby ne comporte aucun capteur, le capteur de distance V5 a été ajouté à Moby pour cet exemple.

Pour cet exemple, le capteur de distance V5 est monté près du centre de Moby's Forks.

Pour plus d'informations sur Moby, cet article de la bibliothèque VEX.

Vous n'êtes pas obligé d'utiliser Moby pour coder le capteur de distance V5 ou pour participer au concours de cette année. Vous pouvez monter le capteur sur votre robot personnalisé où bon vous semble.

Remarque : assurez-vous qu'aucune structure du robot ne se trouve devant la petite fenêtre laser sur la face du capteur. Il doit y avoir un chemin dégagé devant le capteur entre l'objectif et le capteur.

Répartition des comportements à noter

Pour ramasser et déplacer un objectif mobile à l'aide des commentaires du capteur de distance V5, décomposez d'abord la manière dont le robot doit se déplacer.

Le robot Moby est placé sur un terrain avec un objectif mobile placé à quelques mètres devant lui.

Tout d’abord, le robot doit être placé face au Mobile Goal.

Le robot Moby est présenté après avoir avancé pour détecter l'objectif mobile. L'objectif mobile se trouve désormais à l'intérieur des bras fourchus du robot.

Ensuite, le robot doit avancer jusqu'à ce que le capteur de distance détecte que le but mobile se trouve à l'intérieur des fourches et à proximité du capteur.

Le robot Moby est présenté après avoir détecté le Mobile Goal et levé ses bras pour le ramasser.

Une fois que le capteur détecte que le but mobile se trouve à l'intérieur des fourches ou à proximité du capteur, le robot arrête de rouler et lève les fourches pour ramasser le but mobile.

Le robot Moby, qui transporte l'objectif mobile, a tourné de 90 degrés vers la gauche.

Une fois le Mobile Goal récupéré, le robot tournera à gauche de 90 degrés et avancera de 600 millimètres (mm).

Le robot Moby a abaissé sa fourche pour déposer le Mobile Goal, puis a reculé.

Le robot abaissera ensuite les fourches pour placer le but mobile vers le bas et s'éloignera du but mobile en marche arrière afin de ne pas le renverser accidentellement lors du prochain mouvement.


Comprendre les paramètres

Afin d'exécuter les comportements ci-dessus, il est important de comprendre à quelle distance se trouve l'objectif mobile du capteur de distance V5.

Paramètre pour capter le but mobile à l'aide du capteur de distance V5

Un robot Moby sur un terrain avec un objectif mobile placé entre ses fourches afin de déterminer la distance idéale.

Pour que le robot avance jusqu'à ce que le capteur de distance détecte que le but mobile se trouve à l'intérieur des fourches et à proximité du capteur, les valeurs du capteur doivent être enregistrées à partir du cerveau V5.

Placez le but mobile entre les fourches du robot.

L'écran V5 Brain s'affiche dans le menu Accueil avec l'option Appareils mise en surbrillance.L'écran du cerveau est affiché dans le menu Informations sur l'appareil, qui contient la liste de tous les ports intelligents du cerveau et des appareils connectés. L'icône du capteur de distance dans le menu Informations sur l'appareil est mise en surbrillance pour indiquer que les éléments peuvent être sélectionnés pour ouvrir leurs menus d'informations.

Ensuite, depuis l'écran du cerveau, sélectionnez « Appareils », puis l'icône du capteur de distance.

L'écran du cerveau s'affiche dans le menu Capteur de distance qui répertorie les données du capteur. Le menu affiche les données relatives à la taille, la vitesse et la distance d'un objet. Le menu comporte également un diagramme qui visualise la distance et son évolution au fil du temps. Sur cette capture d'écran, l'objet est de petite taille, sa vitesse est de 0 mètre par seconde et sa distance est de 139 mm.

La distance en millimètres (mm) à laquelle le but mobile se trouve du capteur est indiquée sur l'écran du cerveau.

Le même projet VEXcode V5 Blocks qu'auparavant qui avance jusqu'à détecter un objectif mobile, le récupère, puis le déplace. La valeur à laquelle la distance de l'objet mesurée par le capteur de distance est comparée dans le projet est de 139 et elle est mise en évidence.

C'est la valeur qui sera utilisée dans le projet lors de la récupération du but mobile à l'aide du capteur de distance.

Paramètre pour monter et descendre les fourches

Robot Moby sur un terrain avec un objectif mobile placé entre ses fourches.

Placez à nouveau le but mobile à l’intérieur des fourches.

L'écran du cerveau est affiché dans le menu Informations sur l'appareil, qui contient la liste de tous les ports intelligents du cerveau et des appareils connectés. Une icône de moteur dans le menu Informations sur l'appareil est mise en surbrillance pour indiquer que les éléments peuvent être sélectionnés pour ouvrir leurs menus d'informations.

Ensuite, depuis l'écran du cerveau, sélectionnez « Appareils », puis l'icône du moteur 2. Le moteur 2 contrôle la fourche gauche.

Un robot Moby sur un terrain avec un Mobile Goal placé entre ses fourches levées pour le ramasser.

Soulevez manuellement les fourches jusqu'à ce que la partie inférieure du but mobile ne bloque pas la vue du capteur de distance.

Lorsque vous soulevez manuellement les fourches, assurez-vous de soulever simultanément chaque fourche des côtés gauche et droit du Moby, car chacune est contrôlée par son propre moteur.

Remarque : éviter points de pincement lors du levage manuel des fourches.

L'écran « Cerveau » apparaît dans le menu Smart Motor qui répertorie les données de l'appareil. Le menu affiche des relevés et des graphiques qui présentent les données de l'appareil. Sur cette capture d'écran, la valeur en degrés du moteur est mise en évidence et affiche 604.

Le nombre de degrés d'élévation des fourches est indiqué sur l'écran du cerveau.

Le même projet VEXcode V5 Blocks qu'auparavant qui avance jusqu'à détecter un objectif mobile, le récupère, puis le déplace. Le nombre de degrés de rotation du groupe moteur de fourche dans ce projet est de 600 et est mis en évidence.

C'est la valeur qui sera utilisée dans le projet lors de la montée et de la descente des fourches pour ramasser et placer le but mobile.

Utilisation des blocs Opérateur

Le bloc opérateur « Inférieur à » de VEXcode V5 est affiché. Ce bloc sert à comparer deux valeurs et à indiquer si la première est inférieure à la seconde.

Dans ce projet, le bloc opérateur <Less than> est utilisé pour coder le capteur de distance.

L'écran du cerveau s'affiche dans le menu Capteur de distance qui répertorie les données du capteur. Le menu affiche les données relatives à la taille, la vitesse et la distance d'un objet. Le menu comporte également un diagramme qui visualise la distance et son évolution au fil du temps. Sur cette capture d'écran, l'objet est de petite taille, sa vitesse est de 0 mètre par seconde et sa distance est de 139 mm.

En effet, à mesure que le capteur de distance se rapproche d'un objet, la distance en millimètres entre le capteur et cet objet diminue.

Le même projet VEXcode V5 Blocks qu'auparavant qui avance jusqu'à détecter un objectif mobile, le récupère, puis le déplace. La valeur à laquelle la distance de l'objet mesurée par le capteur de distance est comparée dans le projet est de 139 et elle est mise en évidence.

Des valeurs seuils peuvent être sélectionnées pour déclencher des comportements du robot une fois que la distance est inférieure à une valeur prédéterminée.

Par exemple, lorsque le robot se dirige vers l'objectif mobile, utilisez le bloc opérateur <Less than> pour déclencher le comportement du robot qui s'arrête une fois que soit environ 139 millimètres (mm).

Robot Moby sur un terrain avec un objectif mobile à l'intérieur de ses fourches. La distance entre le capteur de distance et l'objectif mobile est indiquée par une flèche rouge.

Si cette valeur passait à 10 millimètres (mm) par exemple, le robot heurterait le but mobile et pourrait s'endommager, car 10 millimètres (mm) du capteur ne sont pas assez loin pour empêcher les fourches du robot de se toucher. l'objectif mobile.

For more information, help, and tips, check out the many resources at VEX Professional Development Plus

Last Updated: