étape d'innovation localisation ekf?


8

Disons que nous avons un tas d'observations zi du capteur et nous avons une carte dans laquelle nous pouvons obtenir les mesures prévues z^ipour les repères. En localisation EKF en étape de correction, faut-il comparer chaque observationzi avec toute la mesure prévue z^i?, donc dans ce cas, nous avons deux boucles? Ou nous comparons simplement chaque observation avec chaque mesure prévue?, Donc dans ce cas, nous avons une boucle. Je suppose que le capteur peut donner toutes les observations pour tous les points de repère à chaque balayage. L'image suivante illustre le scénario. Maintenant, chaque fois que j'exécute la localisation EKF, je reçoiszi={z1,z2,z3,z4} et j'ai m, donc je peux obtenir z^i={z^1,z^2,z^3,z^4}. Pour passer à l'étape de l'innovation, c'est ce que j'ai fait

Z1=z1z^1Z2=z2z^2Z3=z3z^3Z4=z4z^4
Zest l'innovation. Pour chaque itération, je reçois quatre innovations. Est-ce correct? J'utilise EKF-Localization dans ce livre Probabilistic Robotics page 204.


En fait, j'avais raison sur mon hypothèse. J'ai obtenu de bons résultats.
CroCo

Réponses:


3

Oui, c'est correct, compte tenu de deux hypothèses:

  1. Chaque mesure est indépendante (c'est-à-dire la distribution (gaussienne) d'observation zi est sans corrélation avec zj). Habituellement, cette hypothèse est juste (par exemple, mesurer la position des points de repère avec un scanner laser).

  2. L'association des données est connue. En d'autres termes, vous "saviez juste" que votre première observation était en fait une observation du point de repère 1. Par conséquent, vous pouvez simplement calculer l'innovation avec l'observation prédite générée par le point de repère 1. Ne pas savoir à quel point de repère appartient l'observation est l'endroit où le double Dans ce cas, vous devez comparer l'observation avec les observations prévues de tous * les autres points de repère, et choisir celle qui est la plus probable **, en utilisant une métrique telle que la distance de Mahalanobis.

* Vous pouvez probablement accélérer cela en le comparant uniquement à des points de repère estimés être dans le champ de vision du capteur.

** Ceci n'est qu'une méthode d'association de données. D'autres (par exemple, la compatibilité conjointe) existent.


Comment pourriez-vous calculer une valeur unique pour chaque point de repère?
En utilisant notre site, vous reconnaissez avoir lu et compris notre politique liée aux cookies et notre politique de confidentialité.
Licensed under cc by-sa 3.0 with attribution required.