HomeTortueGPanelRobotiqueGameGrid WebTigerPython
 Python - Online
lidar
Deutsch   English   Français   

10. LIDAR, PID, Capteur de LUMIÈRE

 

 

YOU LEARN HERE...

 

les fonctionnalités avancées du mbRobot Plus V3:

  • LIDAR: télémètre laser matriciel
  • PID Control: encodeurs de moteurs et régulation PID
  • Capteurs de luminosité : mesure de l'intensité lumineuse
  • Détection des intersections


 

COMMENT FONCTIONNE LE LIDAR ?

 

Le LIDAR est une technologie qui utilise la lumière laser pour mesurer les distances. Son fonctionnement est similaire à celui d'un capteur à ultrasons. Au lieu d'émettre des ondes ultrasonores, il envoie des impulsions laser qui sont réfléchies par les objets. Le capteur mesure le temps nécessaire à la lumière pour effectuer l'aller-retour. La distance est ensuite calculée à partir de cette durée et de la vitesse de la lumière.

 

Le Maqueen Plus V3 est équipé d'un capteur LIDAR matriciel. Dans un champ de détection de 60°, il fournit une matrice de 64 valeurs mesurées.

 

Pour mesurer les distances, tu peux utiliser les fonctions suivantes :

getDistance() Renvoie la distance « directe » jusqu'à l'objet
getDistanceList() Renvoie une liste de 64 distances.
getDistanceGrid() Renvoie 8 listes contenant chacune 8 distances.
getDistanceRow(i) Renvoie les distances de la ligne i de la matrice.
getDistanceColumn(j) Renvoie les distances de la colonne j de la matrice.
getDistanceAt(x, y) Renvoie la distance au point (x, y) de la matrice.


 

EXEMPLES

 

Exemple 1: Détecter des objets
Branche le capteur LIDAR sur la première ou la deuxième interface I2C. Le robot avance et mesure à l'aide du LIDAR la distance jusqu'aux objets qui se trouvent devant lui. Tu utilises la commande getDistance(). Si un objet se trouve à moins de 20 cm, le robot s'arrête. Lorsque la distance augmente à nouveau, il repart. Les valeurs mesurées sont affichées avec print(). La commande . delay(100) définit la période de mesure.

 

Programme:

from mbrobot_plusV3 import *

setSpeed(30)
repeat:
    d = getDistance()
    print(d)
    if d < 20:
        stop()
    else:
        forward()    
    delay(100)
► Copy to clipboard

 

Exemple 2: Comparer les distances mesurées à gauche et à droite par le LIDAR

La commande getDistanceRow(4)renvoie une liste de 8 valeurs mesurées (la quatrième ligne de la matrice). Tu compares les distances mesurées à gauche et à droite. Si la distance à gauche est plus petite, la LED gauche s'allume en rouge. Si la distance à droite est plus petite, la LED droite s'allume en vert. La commande print(row) affiche les 8 valeurs mesurées.

Place l'objet à différentes positions et observe les valeurs obtenues.

 

Programme:

from mbrobot_plusV3 import *

repeat:
    row = getDistanceRow(4) #8 Values left to right
    print(row)

    if row[0] < row[7]:
        setLEDLeft(1)
        setLEDRight(0)    
    else:
        setLEDLeft(0)
        setLEDRight(2)      
    delay(100)
► Copy to clipboard

 

Exemple 3: Que « voit » le capteur LIDAR ?

Le capteur LIDAR fournit généralement 8 × 8 = 64 points de mesure. Tu peux lire ces valeurs avec la commande getDistanceList() et les représenter sous forme de 8 lignes de 8 caractères. Plus un point est proche, plus le caractère choisi pour le représenter est grand.

Pour avoir suffisamment de temps pour observer la matrice, tu choisis une période de mesure plus longue (delay(3000)).

 

 

Programme:

from mbrobot_plusV3 import *

def readData():
    data = getDistanceList()
    matrix = []
    for row in range(8):
        rowData = [data[row * 8 + col] for col in range(8)]
        matrix.append(rowData)
    return matrix

def showMap(matrix):
    for row in matrix:
        line = ""
        for val in row:
            if val < 30:
                line += " X "
            elif val < 60:
                line += " x "
            elif val < 100:
                line += " - "
            elif val < 150:
                line += " . "
            else:
                line += " "
        print(line)
    print("")    
    print("------------------------------")
    print("")
	
while True:
    matrix = readData()
    showMap(matrix)
    delay(3000)	
► Copy to clipboard


 

RÉGULATION PID

 

Le Maqueen Plus V3 dispose d'encodeurs de moteurs qui permettent de contrôler avec précision les déplacements vers l'avant et les angles de rotation du robot.
La commande pidControlDistance(dir, dist, 1)permet au robot de parcourir une distance dist, exprimée en centimètres, vers l'avant (dir = 1) ou vers l'arrière (dir = 2).
La commande pidControlAngle(angle, 1), permet au robot de tourner d'un angle donné vers la gauche (angle < 0) ou vers la droite (angle > 0).



 

EXEMPLE

 

Examplw 1: Avancer et tourner avec la régulation PID
Le robot avance d'abord de 20 cm, recule ensuite de 20 cm, tourne de 90° vers la droite, puis de 90° vers la gauche.

Programme:

from mbrobot_plusV3 import *

pidControlDistance(1, 20, 1)
pidControlDistance(2, 20, 1)
pidControlAngle(90, 1)
pidControlAngle(-90, 1)
► Copy to clipboard

pidControlDistance(1, 20, 1) : le robot avance de 20 cm.
pidControlDistance(2, 20, 1) : e robot recule de 20 cm.
pidControlDistance(90, 1) : le robot tourne de 90° vers la gauche.
pidControlDistance(-90, 1) : le robot tourne de 90° vers la droite.



 

CAPTEURS DE LUMINOSITÉ

 

Les deux capteurs de luminosité intégrés permettent de mesurer l'intensité de la lumière ambiante. Il s'agit de photorésistances (LDR), dont la résistance électrique varie en fonction de la lumière reçue.

 

Les variations de résistance sont détectées par le micro:bit et converties en valeurs numériques comprises entre 0 et 1023. La valeur 0 correspond à une très faible luminosité et la valeur 1023 à une luminosité très élevée. Les capteurs se trouvent à l'avant du châssis, à gauche et à droite.


 

EXAMPLE

  Commander le robot à l'aide d'une lampe de poche

À l'aide d'une lampe de poche, tu éclaires le côté droit ou gauche du robot. Si le capteur de luminosité droit mesure une valeur supérieure à 250, le robot décrit un arc de cercle vers la droite.

Si tu éclaires le capteur gauche, il décrit un arc de cercle vers la gauche. Sinon, il avance tout droit.

 
La commande readLightIntensity(0) renvoie la valeur lumineuse du capteur droit.
La commande readLightInternsity(1) renvoie la valeur lumineuse du capteur gauche.

Tu devras éventuellement adapter la valeur seuil de 250à la luminosité ambiante.

Programme:

from mbrobot_plusV3 import *

setSpeed(30)
repeat:
    vR = readLightIntensity(0) #right
    vL = readLightIntensity(1) #left
    print(vR, vL)
    if vR > 250:
        rightArc(0.2)
    elif vL > 250:
        leftArc(0.2)
    else:
        forward()        
    delay(100)
► Copy to clipboard


 

DÉTECTION DES INTERSECTIONS

 

Le mbRobot Plus V3 peut détecter différents types d'intersections : intersections en T, bifurcations vers la gauche ou vers la droite et croisements. La fonction intersectionDetecting() renvoie 1 lorsque le robot détecte une intersection, sinon elle renvoie 0.



 

EXEMPLE

 

Avec ce programme simple, tu peux tester comment le robot détecte les différents types d'intersections. Tu le fais avancer jusqu'à ce qu'il détecte une intersection. Il doit alors s'arrêter.Le robot détecte une intersection lorsque la condition

if intersectionDetecting() == 1:
ou, plus simplement,
if intersectionDetecting():

En informatique, 1 correspond à True et 0 à False. Tu peux donc omettre == 1.

 

Programme:

from mbrobot_plusV3 import *

forward()
repeat:
    if intersectionDetecting():
        stop()
    delay(100)
► Copy to clipboard

 

 

À RETENIR...

 

Le capteur LIDAR mesure la distance jusqu'aux objets situés devant le robot et fournit une matrice de 64 valeurs mesurées. Selon le problème à résoudre, tu peux utiliser une seule valeur, une liste de valeurs d'une ligne ou la liste complète des 64 mesures.

La régulation PID permet de faire avancer ou reculer le robot d'une distance précise (en centimètres) ou de le faire tourner d'un angle déterminé.

Les capteurs de luminosité permettent de mesurer l'intensité de la lumière ambiante. Les valeurs mesurées sont comprises entre 0 et 1023. Tu obtiens notamment des valeurs plus élevées lorsque tu éclaires les capteurs avec une lampe de poche.

La fonction intersectionDetecting() renvoie 1 lorsque le robot se trouve sur une intersection. Pour déterminer le type d'intersection, il est préférable d'utiliser les capteurs infrarouges irL2 et irR2, qui peuvent détecter la luminosité de la surface de part et d'autre de la voie suivie.

 

 

EXERCICES

 

 

1.

Construis un parcours et fais-le suivre par le robot à l'aide du capteur LIDAR, comme dans la vidéo suivante :: VideoLIDAR

   
 
2.

Dessine un parcours composé de plusieurs segments de 20 cm de longueur. Utilise la régulation PID pour que le robot suive ce parcours avec précision.


 
 
3.

Construis un tunnel à l'aide d'une boîte en carton et fais passer le robot à travers celui-ci. Le robot doit détecter automatiquement lorsqu'il se trouve dans le tunnel et allumer ses LED.

Lorsqu'il sort du tunnel, il doit éteindre les LED.

 

4.
Crée un parcours comportant des bandes et des intersections, puis programme le robot pour qu'il suive des itinéraires déterminés.