Ortung in einem Raum mit Hindernissen
Hallo
Wir haben einen Roboter mit 2 Rädern, die so angebaut sind, dass der Roboter mit ihnen seitlich fahren kann. Links und rechts sind 2 Ultraschallsensoren. Der Roboter soll in einem Raum von den Maßen 120x60cm immer in der Mitte der 120 cm sein. Auf einer der beiden Seiten kann jedoch ein Hindernis sein, wir müssten also im Programm irgendwie herasufinden welcher Ultraschallsensor blockiert ist und welcher korrekte Werte ausgibt. Das soll zu allem Überfluss auch noch die ganze Zeit und möglichst schnell passieren.
Hat jemand eine Idee wie man das machen könnte?
P.S: Ich will keine fertigen Programmcodes sondern nur Ansätze wie man es machen könnte.
Gruß Checker
Liste der Anhänge anzeigen (Anzahl: 1)
Hier ist eine Skizze:
Das Hindernis kann aber auch auf der rechten Seite stehen und daher muss der Robo i-wie rausfinden welcher Ultraschall die Wand sieht und welcher das Hindernis.
@Richard: Momentan muss er nicht vorwärtsfahren, später kriegt er evtl. Omniwheels.
Edit: Die Hindernisse kommen daher, dass die Hindernisse auch robos sind und sich mit Omniwheel bewegen können. Unser Robo soll das später auch machen aber immer wieder die ausgangsposition finden, trotz hindernissen im US. Bild hier
Re: Ortung in einem Raum mit Hindernissen
Zitat:
Zitat von Checker108
Hallo
Wir haben einen Roboter mit 2 Rädern, die so angebaut sind, dass der Roboter mit ihnen seitlich fahren kann. Links und rechts sind 2 Ultraschallsensoren. Der Roboter soll in einem Raum von den Maßen 120x60cm immer in der Mitte der 120 cm sein. Auf einer der beiden Seiten kann jedoch ein Hindernis sein, wir müssten also im Programm irgendwie herasufinden welcher Ultraschallsensor blockiert ist und welcher korrekte Werte ausgibt.
Da der Bereich klar ist, sollten beide Sensoren einen Abstand von
60 cm - 1/2 Botbreite ausgeben, zeigt eine Seite weniger an ist ein
Hindernis vorhanden. Zeigt eine Seite mehr als 60cm - 1/2 Botbreite an,
befindet sich der Bot nicht mehr in der Mitte.
Mit einem Timer IRQ kann man die Abfrage der Sensoren z.B. alle
100 ms in einer ISR machen und die ermittelten Werte dann in der
Hauptroutine auswerten.
Das dürfte nicht allzu schwer sein, ob jetzt US oder IR Sensoren
besser geeignet sind? Ich habe beide nicht im Einsatz schaut doch
mal ins RN Wissen, da sind sicher Beispiele zu finden. :-) Ich würde
aber eher zu IR greifen, wenn US Reflektiert (Echo) und vom "falschen"
Empfänger aufgefangen wird.....ansonsten halt etwas zwischen den
Abfrage Links/Rechts warten.
Gruß Richard
Liste der Anhänge anzeigen (Anzahl: 1)
Hi
Skizze:
Bild hier
Wenn ich jetzt den linken (größeren) abfrage steht er ja zu weit rechts.