Monte-Carlo-Lokalisierung

8

Ich implementiere eine Monte-Carlo-Lokalisierung für meinen Roboter, die eine Karte der Umgebung sowie ihres Startorts und ihrer Ausrichtung erhält. Mein Ansatz ist wie folgt:

  1. Erstellen Sie gleichmäßig 500 Partikel um die angegebene Position
  2. Dann bei jedem Schritt:
    • Bewegungsaktualisierung aller Partikel mit Kilometerzähler (mein aktueller Ansatz ist newX = oldX + odometryX (1 + standardGaussianRandom) usw.)
    • Weisen Sie jedem Partikel mithilfe von Sonardaten ein Gewicht zu (die Formel gilt für jede Sensorwahrscheinlichkeit * = gaussianPDF (realReading), wobei gaussian den Mittelwert für das vorhergesagte Lesen hat).
    • Geben Sie das Partikel mit der größten Wahrscheinlichkeit als Position in diesem Schritt zurück
    • dann werden 9/10 der neuen Partikel gemäß den Gewichten von den alten neu abgetastet und 1/10 wird gleichmäßig um die vorhergesagte Position abgetastet

Jetzt habe ich einen Simulator für die Umgebung des Roboters geschrieben. So verhält sich diese Lokalisierung: http://www.youtube.com/watch?v=q7q3cqktwZI

Ich habe große Angst, dass der Roboter für einen längeren Zeitraum verloren gehen könnte. Wenn Sie Partikel in einem größeren Bereich hinzufügen, geht der Roboter noch leichter verloren.

Ich erwarte eine bessere Leistung. Irgendein Rat?

Andrei Ivanov
quelle
Die im Video gezeigte Leistung ist gut, wenn man einen einzelnen Sonarsensor berücksichtigt. Haben Sie ein Beispielvideo, in dem der Roboter verloren geht?
Demetris
Es gibt tatsächlich 5 Sonare, würde man immer noch sagen, dass es gut ist? Ich habe kein Video, in dem der Roboter verloren geht, aber ich werde es heute an einem echten Roboter versuchen.
Andrei Ivanov
Mir ist nicht klar, worum es Ihnen geht. Der von Ihnen implementierte PF scheint gut zu funktionieren. Vielleicht können Sie detaillierter beschreiben, was Ihrer Meinung nach das Problem ist.
Demetris
Bitte stellen Sie nicht dieselbe Frage auf mehreren Stack-Exchange-Sites . Wenn Sie versehentlich auf der falschen Site nachfragen, kann diese auf die richtige migriert werden.
Mark Booth
1
Willkommen bei Robotics Andrei Ivanov. Derzeit ist nicht klar, was Ihre eigentliche Frage hier ist. Wir bevorzugen praktische, beantwortbare Fragen, die auf tatsächlichen Problemen basieren, mit denen Sie konfrontiert sind . Schauen Sie sich auf Wie fragen und Tour für weitere Informationen darüber , wie Stapelaustauscharbeiten, und darüber nachdenken , wie Sie Ihre Frage bearbeiten können, um es zu vertreten hat .
Mark Booth

Antworten: