www.vorhilfe.de
- Förderverein -
Der Förderverein.

Gemeinnütziger Verein zur Finanzierung des Projekts Vorhilfe.de.
Hallo Gast!einloggen | registrieren ]
Startseite · Mitglieder · Impressum
Forenbaum
^ Forenbaum
Status VH e.V.
  Status Vereinsforum

Gezeigt werden alle Foren bis zur Tiefe 2

Navigation
 Startseite...
 Suchen
 Impressum
Das Projekt
Server und Internetanbindung werden durch Spenden finanziert.
Organisiert wird das Projekt von unserem Koordinatorenteam.
Hunderte Mitglieder helfen ehrenamtlich in unseren moderierten Foren.
Anbieter der Seite ist der gemeinnützige Verein "Vorhilfe.de e.V.".
Partnerseiten
Weitere Fächer:

Open Source FunktionenplotterFunkyPlot: Kostenloser und quelloffener Funktionenplotter für Linux und andere Betriebssysteme
Forum "Uni-Sonstiges" - Triangulation - anderer Ansatz
Triangulation - anderer Ansatz < Sonstiges < Hochschule < Mathe < Vorhilfe
Ansicht: [ geschachtelt ] | ^ Forum "Uni-Sonstiges"  | ^^ Alle Foren  | ^ Forenbaum  | Materialien

Triangulation - anderer Ansatz: Verständnis
Status: (Frage) beantwortet Status 
Datum: 12:06 So 12.01.2020
Autor: marthasmith

Aufgabe
Hallo, ich habe mich entschlossen ein anderer Verfahren auszuprobieren, da der letzte Ansatz nicht erfolgreich war (siehe Triangulation). 

Gegeben sind n Landmarken, deren Koordinaten [mm] $P_i \in \IR^2$. [/mm] Die Position $P$ eines Roboters und seine Orientierung [mm] $\theta$ [/mm] sind nicht bekannt. Es gibt Messdaten der Winkel [mm] $\beta_i$ [/mm] zu den bekannten Landmarken. Das Ziel ist sowohl die Position $P$ als auch die Orientierung [mm] $\theta$ [/mm] zu bestimmen.

Die nachfolgende Vorgehensweise stammt aus dem Artikel "On Mobile Robot Localization From Landmark Bearings" von Ilan Shimshoni und kann hier auch eingesehen werden:[url]https://www.researchgate.net/profile/Ilan_Shimshoni/publication/3299298_On_mobile_robot_localization_from_landmark_bearings/links/0a85e53c65a8d95a71000000/On-mobile-robot-localization-from-landmark-bearings.pdf [url]

Ich stelle kurz die Vorgehensweise allgemein vor. Ich habe mir anschließend ein eigenes Beispiel konstruiert, aber leider kommt etwas falsches heraus und außerdem habe ich dazu auch eine Verständnisfrage.

Die Vorgehensweise ist eine Koordinatentransformation von den globalen Koordinaten [mm] $P_i$ [/mm] zu den Roboterkoordinaten [mm] $M_i$. [/mm] Diese Transformation ergibt sich aus der Position $P$ des Roboters und der Orientierung [mm] $\theta$. [/mm]

[mm] $M_i [/mm] = [mm] l_i(cos\beta_i, sin\beta_i) [/mm] = [mm] R(P_i-P) [/mm] = [mm] RP_i [/mm] + T$

wobei [mm] $R=\pmat{ cos\theta & sin\theta \\ -sin\theta & cos\theta}$ [/mm] die planare Rotationsmatrix um den Winkel [mm] $\theta$ [/mm] ist und [mm] $l_i$ [/mm] die unbekannte Distanz von $P$ zu [mm] $P_i$. [/mm] Das kann auch in zwei Gleichungen geschrieben werden:
[mm] $l_i \cdot cos(\beta_i) [/mm] = [mm] (cos(\theta), sin(\theta))\cdot P_i [/mm] + [mm] T_x$ [/mm] und
[mm] $l_i \cdot sin(\beta_i) [/mm] = [mm] (-sin(\theta), cos(\theta))\cdot P_i [/mm] + [mm] T_y$. [/mm]
Hieraus kann [mm] $l_i$ [/mm] eliminert werden:
[mm] $\left( (cos(\theta), sin(\theta))\cdot P_i + T_x \right)=((-sin(\theta), cos(\theta))\cdot P_i [/mm] + [mm] T_y)\cdot cot(\beta_i)$ [/mm]
Es ergibt sich ein Gleichungssystem:
[mm] $P_{ix}-P_{iy}\cdot(\beta_i),P_{iy}+P_{ix}\cdot cot(\beta_i),1,-cot(\beta_i)\cdot \vektor{cos(\theta) \\ sin(\theta) \\ T_x \\ T_y} [/mm] = 0$
Für alle n gegebenen Landmarken kann das durchgeführt werden. Weitere Bedingung ist, dass [mm] $\cos(\theta)^2 [/mm] + [mm] sin(\theta)^2=1$ [/mm] gilt.

Ich habe mit drei Landmarken gearbeitet und mir einfach drei Punkte in ein Koordinatensystem gezeichnet und eine Roboter mit einer Ausrichtung, um das für mich mal durchzurechnen.
[mm] $P_1=(2;5,5), P_2=(2,5;3), P_3=(2,5;1)$. [/mm] Von dem Roboter aus gemessen sind die Winkel [mm] $\beta_1=45°, \beta_2=90°, \beta_3=135°$. [/mm]
Es müsste herauskommen: Roboter hat die Position (5,3) und [mm] $\theta=90°$. [/mm]
Ich habe das zugehörige Gleichungssystem aufgestellt:
[mm] \pmat{-3,5 & 7,5 & 1 & -1\\ 2,5 & 3 & 1 & 0 \\3,5 & 1,5 & 1 & 1}\cdot \vektor{cos(\theta) \\ sin(\theta) \\ T_x \\ T_y} [/mm] = 0$ und es mit dem Löser für Gleichungssysteme mathecalc.org gelöst. Es kam die Lösung:
[mm] $T_y\cdot\vektor{\frac{2}{3}\\\frac{10}{9}\\-5\\1}$. [/mm] Mit der Bedingung [mm] $\cos(\theta)^2 [/mm] + [mm] sin(\theta)^2=1$ [/mm] folgt dann [mm] $\left(\frac{2}{3}T_y\right)^2+\left(\frac{10}{9}T_y\right)^2=1$ [/mm] mit der Lösung [mm] $T_y=+ [/mm] - [mm] \frac{9}{11,7}$. [/mm] Und das stimmt nicht.

 







a. Wo mache ich den Fehler?
b. [mm] $cot(\alpha)=\frac{cos(\alpha)}{sin(\alpha)} [/mm] und wenn [mm] sin(\alpha)=0 [/mm] dann gibt es einen Fehler. Das finde ich auch komisch.

Im Anhang ein Bild dazu.
Mögliche Antworten sind mir übrigens auch in zwei Wochen noch wichtig. Habe ich aber offensichtlich vergessen zu ändern.
<br>



Dateianhänge:
Anhang Nr. 1 (Typ: JPG) [nicht öffentlich]
        
Bezug
Triangulation - anderer Ansatz: Mitteilung
Status: (Mitteilung) Reaktion unnötig Status 
Datum: 22:28 Di 14.01.2020
Autor: Eisfisch

Lösung:  ?   [Dateianhang nicht öffentlich]  

der Robater könnte auch rechts stehen- beide lösungen sind möglich
Q: http://www.arndt-bruenner.de/mathe/scripts/rueckwaertsschnitt.htm

Dateianhänge:
Anhang Nr. 1 (Typ: GIF) [nicht öffentlich]
Bezug
        
Bezug
Triangulation - anderer Ansatz: Antwort
Status: (Antwort) fertig Status 
Datum: 11:38 Mi 15.01.2020
Autor: HJKweseleit


> Ich stelle kurz die Vorgehensweise allgemein vor. Ich habe mir anschließend ein eigenes Beispiel konstruiert, aber leider kommt etwas falsches heraus und außerdem habe ich dazu auch eine Verständnisfrage.
>  

> wobei [mm]R=\pmat{ cos\theta & sin\theta \\ -sin\theta & cos\theta}[/mm] die planare Rotationsmatrix um den Winkel [mm]\theta[/mm] ist und [mm]l_i[/mm] die unbekannte Distanz von [mm]P[/mm] zu [mm]P_i[/mm].


Habe leider momentan keine Zeit, das Ganze durchzurechnen. Aber: Falls die Rotation wie üblich GEGEN den Uhrzeigersinn ablaufen soll, muss die Rotationsmatrix
[mm]R=\pmat{ cos\theta & -sin\theta \\ sin\theta & cos\theta}[/mm]
heißen. Vielleicht liegt da der Fehler.

Bezug
                
Bezug
Triangulation - anderer Ansatz: danke
Status: (Mitteilung) Reaktion unnötig Status 
Datum: 21:58 Mi 15.01.2020
Autor: marthasmith

Vielen Dank, werde ich morgen ausprobieren und dann vom Ergebnis berichten :) marthasmith

Bezug
Ansicht: [ geschachtelt ] | ^ Forum "Uni-Sonstiges"  | ^^ Alle Foren  | ^ Forenbaum  | Materialien


^ Seitenanfang ^
ev.vorhilfe.de
[ Startseite | Mitglieder | Impressum ]