| |
Exemple 1: Tester le fonctionnement du servomoteur
Le servomoteur place d'abord le Loader dans sa position initiale (en bas). Ensuite, la pelle est relevée, puis elle revient à sa position initiale après 2000 millisecondes.La commande setServo("S1", 160) fait tourner le servomoteur jusqu'à la position correspondant à un angle de 160°. S1 désigne le port de connexion.
Exécute le programme ci-dessous avec différents angles compris entre 0° et 180° afin de déterminer pour quelle valeur la pelle se trouve dans sa position initiale (en bas). |
|

|
|
from mbrobot_plus import *
#from mbrobot import*
setServo("S1", 160)
delay(2000)
setServo("S1", 100)
delay(2000)
setServo("S1", 160)
► Copy to clipboard
Exemple 2: Positionner le Loader à l'aide du capteur à ultrasons
Le robot doit charger un objet situé près d'un mur vertical, puis le transporter ailleurs (comme dans la vidéo ci-dessus). Pour mesurer la distance jusqu'au mur, tu utilises le capteur à ultrasons.
|
from mbrobot_plus import *
#from mbrobot import *
setServo("S1", 160)
setSpeed(20)
forward()
repeat:
d = getDistance()
print(d)
if d < 12:
stop()
delay(1000)
setServo("S1", 100)
setSpeed(20)
backward()
delay(4000)
stop()
setServo("S1", 160)
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 à 12 cm, le robot charge l'objet.
|