HomeTurtlegraficsGPanelRoboticsGameGrid WebTigerPython
 Python - Online
Beatle
Deutsch   English   Français   

8. PINCE ROBOTIQUE AVEC SERVOMOTEUR

 

 

YOU LEARN HERE...

 

comment installer une pince robotique (Maqueen Mechanic Beatle) sur ton mbRobot et la commander à l'aide d'un servomoteur. La pince robotique permet de saisir et de transporter des objets légers.


 

 

ASSEMBLER LA PINCE ROBOTIQUE

 

Tu peux acheter la pince robotique équipée d'un servomoteur séparément (Maqueen Mechanics Beatle) ou dans un kit de construction (Maqueen Mechanics Roboter-Kit). Le servomoteur se branche sur le port S1 ou S2 du Maqueen 4 ou du Maqueen Plus.

 

 

 

Sur le Maqueen Plus V2, le servomoteur se branche sur le port P1 ou P2. Ces ports se trouvent à l'arrière droit du châssis.

Dans ton programme, tu dois donc utiliser P1 ou P2 (au lieu de S1 ou S2) comme paramètre de la commande setServo().

 

 

 

 

EXEMPLES

 

Exemple 1: Tester la pince robotique

Le servomoteur actionne simultanément les deux bras de la pince. La commande
setServo("S1", 60)
place la pince en position ouverte, tandis que la commande
setServo("S1", 95)
tpermet au robot de saisir des objets. Tu devras éventuellement ajuster les angles.

 



from mbrobot import *
#from mbrobot_plus import *

setServo("S1", 95)
delay(1000)             
setServo("S1", 60)
delay(1000) 
setServo("S1", 95)
► Copy to clipboard

 

Exemple 2: Saisir un objet

Le robot se dirige vers un objet situé à une courte distance devant lui, le saisit avec sa pince, recule sur une courte distance, tourne à gauche et dépose l'objet à un nouvel emplacement (comme dans la vidéo ci-dessus).

 

from mbrobot import *
#from mbrobot_plus import *

setServo("S1", 95)
delay(1000)
setServo("S1", 60)
forward()
delay(1000)
stop()
setServo("S1", 95)
backward()
delay(500)
left()
delay(700)
stop()
setServo("S1", 60)
► Copy to clipboard

 

Exemple 3: Positionner la pince robotique à l'aide du capteur à ultrasons

Dans l'exemple 2, le robot démarre toujours à la même distance de l'objet et la durée de son déplacement vers l'avant est déterminée par une temporisation (delay(1000)). Grâce à un capteur à ultrasons, le robot peut déterminer lui-même la position correcte. Le robot avance jusqu'à ce que la distance qui le sépare de l'objet ou d'un mur situé derrière celui-ci soit inférieure à 20 cm. Il saisit alors l'objet avec sa pince robotique et le transporte ailleurs (comme dans la vidéo ci-dessous).

 

from mbrobot import *
#from mbrobot_plus import *

setServo("S1", 60)
forward()
repeat:
    d = getDistance()
    print(d)
    if d < 20: 
        stop()
        delay(500)
        setServo("S1", 95)
        delay(500)             
        backward()
        delay(2500)
        left()
        delay(700)      
        stop()
        setServo("S1", 60)
    delay(100) 
  
► Copy to clipboard

La distance jusqu'au mur est mesurée toutes les 100 millisecondes dans une boucle repeat « infinie ». Lorsque cette distance devient inférieure à 20 cm, le robot s'arrête et saisit l'objet avec sa pince robotique.

Exemple 4: Faire pivoter le capteur à ultrasons à l'aide d'un servomoteur

Conformément aux instructions de montage ci-dessus, le capteur à ultrasons est fixé sur un deuxième servomoteur. Celui-ci est branché sur le port S2. Tu peux utiliser ce capteur à ultrasons orientable pour rechercher des objets (exercice 3) ou pour permettre au robot de suivre un mur en maintenant une distance déterminée (exercice 4).


from mbrobot import *
#from mbrobot_plus import *

setServo("S2", 90)
delay(2000)
setServo("S2", 0)
delay(2000)
setServo("S2", 90)
delay(2000)

angle = 90
while angle >= 0:
    setServo("S2", angle)
    delay(500)
    angle = angle - 10
    
angle = 0
while angle <= 90:
    setServo("S2", angle)
    delay(500)
    angle = angle + 10 
► Copy to clipboard

Ce programme montre comment utiliser un deuxième servomoteur pour faire pivoter le capteur à ultrasons de sa position frontale vers une position parallèle à la direction de déplacement du robot. Le mouvement s'effectue d'abord en une seule étape, puis progressivement par petits angles.

 

 

À RETENIR...

 

La commande setServo(port, angle) permet de faire tourner le servomoteur jusqu'à l'angle souhaité. Le premier paramètre indique le port utilisé (S1 ou S2) et le deuxième paramètre définit un angle compris entre 0° et 180°. Le servomoteur actionne simultanément les deux bras de la pince. Tu peux brancher un deuxième servomoteur sur le port S2 pour faire pivoter le capteur à ultrasons.

 

 

EXERCICES

 

 


1.


Un robot équipé d'une pince robotique avance pendant 2000 millisecondes et saisit un objet. Il tourne ensuite de 180° vers la gauche, avance pendant 2000 millisecondes et dépose l'objet. Puis il tourne de 180° vers la droite et va chercher l'objet suivant.

 
 
2.

Complète la situation de l'exercice 1 en ajoutant deux murs. Le robot doit utiliser son capteur à ultrasons pour déterminer quand terminer chacun de ses déplacements vers l'avant. Il doit ensuite répéter plusieurs fois les opérations de saisie, de transport et de dépôt des objets.


 


3.

À l'aide du servomoteur, le capteur à ultrasons pivote progressivement par petits angles jusqu'à ce qu'il détecte un objet. Il déclenche alors une alarme. Tu peux limiter la recherche aux objets situés à une distance comprise entre 30 et 70 cm.

4.

À l'aide d'un servomoteur, le capteur à ultrasons pivote jusqu'à une position parallèle à la direction de déplacement du robot, afin de pouvoir mesurer la distance latérale. Le robot avance ensuite le long d'un mur rectiligne en maintenant une distance d'environ 15 cm.