Etapes pour mesurer la distance de la balise 1 au robot :
Le robot envoie un pulse de synchronisation à la balise 1 et envoie son message ultrason..
La balise reçoit le pulse lance un compteur. Le message se propage dans l'air à la vitesse du son.
La balise de réception écoute en permanence, et détecte le temps écoulé entre le pulse zigbee et la réception de l'ultrason.Le décalage doppler peut aussi être mesuré.
La balise renvoie les informations sur le temps de propagation et le doppler au robot, qui les utilise pour calculer sa position.
$Distance = T_{propagation} * V_{son}$. La vitesse du son dépend la température.
La mesure de la distance à plus de trois balises permet d'améliorer la mesure et de compenser la température.
Le doppler peut aussi être utilisé pour améliorer le résultat, au moyen d'un filtre de Kalmann.
La suite de cet article présentera plus précisément les différentes sous-parties: