Hallo zusammen,
ich habe nun meinen ASURO mit einem ATMEGA32-Prozessor ausgestattet.
Um die "Sichtweite" zu erweitern, habe ich versucht die IR-Einheit auf 2 LEDs zu erweitern:
- Die Kathode der rechten IR-LED hängt mit Vorwiderstand an PIN15 (PD1)
- Die Kathode der linken IR-LED hängt mit Vorwiderstand an PIN2 (PB1)
- Die Anoden beider IR-LEDs sind mit PIN21 (PD7) verbunden
Ich möchte nun ein Testprogramm machen, das zwischen der linken und rechten LED unterscheiden kann. Wenn die rechte LED ein Hindernis "sieht", soll die Status-LED grün leuchten, wenn die linke LED ein Hindernis "sieht", soll die Status-LED rot leuchten und wenn beide ein Hindernis erkennen soll die Status-LED orange leuchten.
Die Ausgänge auf LOW ziehen mache ich mit:
DDRD |= (1 << DDD1); // Port D1 als Ausgang
PORTD &= ~(1 << PD1); // PD1 auf LOW
und
DDRD |= (1 << DDB1); // Port B1 als Ausgang
PORTD &= ~(1 << PB1); // PB1 auf LOW
So weit, so gut - nur wie kann ich zwischen links und rechts unterscheiden?
Die Platine habe ich hier erworben: http://www.e-robotix.de
Noch ein Foto von meinem Umbau:
Hallo pinsel,
wie willst du denn IR LEDs als Sensor verwenden?
Eine IR LED kann Infrarot Licht senden, nicht empfangen.
Oder meinst du vielleicht Fototransistoren? Die müßtest du allerdings wie die Liniensensoren an Analog Eingänge hängen. Und die Ports müssen dementsprechend als Eingang initialisiert werden.
Hi m.a.r.v.i.n,
Sender sind 2 Infrarot-DIODEN vom Typ SFH415-U. Als Empfänger verwende ich einen IR-TRANSISTOR vom Typ SFH5110, der mit OUT am PIN14(PD0) verbunden ist.
Hei, pinsel120866,
hübsche Geschichte! Aber laufen jetzt die üblichen asuro-Programme ohne Änderung? Ausserdem: ich nehm mal an, dass Du nachgerechnet hast (oder nachgemessen), ob der µC ohne Probleme beide LED´s treiben kann. Weil ein Port ja eine Stromquelle/-senke mit etwas begrenzter Lieferfähigkeit ist.
Zum Unterscheiden: eben einen der Ports auf high setzen, dann ist nur der andere aktiv. Optisch "siehst" Du die LED leuchten, wenn Du sie mit einer digitalen Kamera betrachtest - also Optik auf die LED und auf dem Display gucken. Bei mir geht auch die Cam im Handy.
Na und dass Du mit den "Dioden" nicht sehen kannst, das hatten wir doch schon hier .
Viel Erfolg mit dem Gerät.
Ciao sagt der JoeamBerg
Hallo Pinsel,
der SFH5110 ist keine IR-LED , sondern ein Infrarot Empfänger IC für moduliertes IR Licht. Das wären dann ja 3 Empfänger und gar kein Sender.
Irgendwie verstehe ich nicht, was du eigentlich machen willst.
Ein Entfernungsdetektor wie der Liniensensor mit 2 Fototransistoren als Empfänger und einer LED als Sender. Dazu brauchst du 2 Analog Eingänge und einen Digital Ausgang. Ein Fototransistor empfängt das Licht von der linken Seite, der andere von der rechten.
Oder ein Entfernungsdetektektor wie die Modifikation der IR Schnittstelle von waste, mit einem IR Empfänger IC und 2 IR-LEDs als Sender. Dazu benötigst du einen digital Eingang und 3 Ausgänge für die IR LEDs (einer davon PWM fähig wg. moduliertem IR Licht). Ob das mit einem Empfänger funktioniert, kann ich so nicht sagen. Theoretisch ja, indem man die IR LEDs abwechselnd einzeln anschaltet und dann mit dem Empfänger lauscht, ob ein Signal aus dieser Richtung kommt.
In deiner Initialisierung für PB1 war noch ein Fehler. So geht es.
Zudem müßte PD7 als Timer Ausgang die 36kHz liefern, sonst empfängt der SFH5110 kein Signal. Code für den Mega32 hab ich gerade nicht griffbereit.Code:DDRB |= (1 << DDB1); // Port B1 als Ausgang PORTB &= ~(1 << PB1); // PB1 auf LOW
Hallo,
ich habe folgenden Code angepasst und getestet:
Wenn ich mit der Digitalkamera daraufblicke, leuchten beide LEDs. Irgendwie habe ich das Gefühl, als ob beide Dioden Synchron leuchten und nicht getrennt voneinander die Abstandsmessung durchführen.Code:/************************************************************************ Test Programm fuer den ASURO IR-Adapter Der ASURO ermittelt ueber den nach vorne gerichteten Infrarot Empfänger und Sender über die Reflektion des Lichtes an einem Objekt ungefaehr dessen Abstand. Es wird je nach Abstand die Status-LED in verschiedenen Farben eingeschaltet. Bei der größten Reflexion werden zusätzlich die Rueckfahr-LEDs eingeschalten. Zur Compilierung dieses Programmes wird asuro.c und asuro.h aus der ASURO Lib 2.6.1 benötigt. Die ASURO Lib ist auf sourceforge zu finden. ************************************************************************ Hardware: ASURO Roboter prozessor: ATMEGA32 clock: 16MHz Crystal **************************************************************************** date authors version comment ====== ====================== ======= ============================== Jan.08 (ch) robo.fr V1.0 First implemetation Mai 08 (aut) pinsel120866 V1.1 Erweitert auf 2 IR-Dioden Versions: V1.0 - first version ***************************************************************************/ /*************************************************************************** * * (c) 2007 robo.fr , christoph(at)roboterclub-freiburg.de * *************************************************************************** * This program is free software; you can redistribute it and/or modify * * it under the terms of the GNU General Public License as published by * * the Free Software Foundation version 2 of the License, * * If you extend the program please maintain the list of authors. * * If you want to use this software for commercial purposes and you * * don't want to make it open source, please contact the authors for * * licensing. * ***************************************************************************/ #include "asuro.h" #include <stdlib.h> /************************************************************************* uint8_t objekt_sichtbar(uint8_t abstand) Ist ein Objekt in der Entfernung kleiner oder gleich dem Eingangsparameter "abstand" erkennbar? objekt_sichtbar(7) liefert TRUE zurück, falls überhaupt ein Object detektierbar. abstand: 0: 5cm 1: 7cm 2: 13cm 3: 15cm 4: 16cm 5: 17cm 6: 18cm 7: 22cm ( Testobjekt: Joghurtecher, Umgebungsbeleuchtung: Zimmer ) return: TRUE falls Objekt gefunden FALSE wenn nicht Zeitbedarf: 5ms *************************************************************************/ uint8_t objekt_sichtbar_rechts(uint8_t distance) { uint16_t j,z; DDRD |= (1 << DDD1); // Port D1 als Ausgang PORTD &= ~(1 << PD1); // PD1 auf LOW OCR2 = 254-distance; // wenn OCR2=0xFE dann Objekt sehr nahe z=0; for(j=0;j<30;j++) // loop time: 5ms { if (PIND & (1 << PD0))z++; Sleep(6); // 6*Sleep(6)=1ms } if (z>=29) return FALSE; // Objekt nicht gefunden else return TRUE; } uint8_t objekt_sichtbar_links(uint8_t distance) { uint16_t j,z; DDRB|= (1 << DDB1); // Port B1 als Ausgang PORTB &= ~(1 << PB1); // PB1 auf LOW OCR2 = 254-distance; // wenn OCR2=0xFE dann Objekt sehr nahe z=0; for(j=0;j<30;j++) // loop time: 5ms { if (PIND & (1 << PD0))z++; Sleep(6); // 6*Sleep(6)=1ms } if (z>=29) return FALSE; // Objekt nicht gefunden else return TRUE; } /************************************************************************* uint8_t abstand() Abstandsermittelung über IR-Sendiode / IR-Empfänger. 0:kleinster Abstand 7:größter Abstand 255: kein Objekt Zeitbedarf: 5ms*9=45ms *************************************************************************/ uint8_t abstand_rechts() { uint8_t k,n; k=255; for(n=0;n<8;n++) { if (!objekt_sichtbar_rechts(n)) k=n; // solange kein Objekt, Distanz erhoehen } return k; } uint8_t abstand_links() { uint8_t l,m; l=255; for(m=0;m<8;m++) { if (!objekt_sichtbar_links(m)) l=m; // solange kein Objekt, Distanz erhoehen } return l; } /************************************************************************* Hauptprogramm *************************************************************************/ int main(void) { uint8_t n,m; Init(); FrontLED(ON); while(1) { n=abstand_rechts(); m=abstand_links(); StatusLED(OFF); BackLED(OFF,OFF); if ((n!=255) || (m!=255)) { if (n<2) StatusLED(GREEN); if (m<2) StatusLED(RED); Msleep(10); } else StatusLED(YELLOW); } }
Nochmal hallo,
es ist ein Entfernungsdetektektor wie die Modifikation der IR Schnittstelle von waste, mit einem IR Empfänger IC und 2 IR-LEDs als Sender.
Hallo pinsel,
sieht soweit gut aus, du mußt nur noch die nicht benötigte LED auschalten:
und beachte den Unterschied zwischen PORTD und PORTB, bzw. DDRD und DDRB.Code:uint8_t objekt_sichtbar_links(uint8_t distance) { uint16_t j,z; PORTD |= (1 << PD1); // PD1 auf HIGH (LED ausschalten) DDRB |= (1 << DDB1); // Port B1 als Ausgang PORTB &= ~(1 << PB1); // PB1 auf LOW ... uint8_t objekt_sichtbar_rechts(uint8_t distance) { uint16_t j,z; PORTB |= (1 << PB1); // PB1 auf HIGH (LED ausschalten) DDRD |= (1 << DDD1); // Port D1 als Ausgang PORTD &= ~(1 << PD1); // PD1 auf LOW ...
Danke m.a.r.v.i.n,
hat geklappt, jetzt hat mein Asuro 2 "Augen" und kann sogar zwischen links und rechts unterscheiden. Als nächstes versuche ich mich an einem Programm zur Hinderniserkennung und -umfahrung in die Richtung, wo mehr Platz ist.
Super, dann mal weiter so.
Berechtigungen
Zitieren
Lesezeichen