Aus RN-Wissen.de
Wechseln zu: Navigation, Suche
Rasenmaehroboter Test

K (Quellcode srf08.c: Änderung in Funktion SRF08_task, fehlendes Break in der StateMachine ergänzt)
 
(7 dazwischenliegende Versionen von einem anderen Benutzer werden nicht angezeigt)
Zeile 1: Zeile 1:
 
 
Dieser Artikel beschreibt die Ansteuerung des Ultraschallsensors [[Sensorarten#SRF08|SRF08]] mit der Programmiersprache C (avr-gcc).  
 
Dieser Artikel beschreibt die Ansteuerung des Ultraschallsensors [[Sensorarten#SRF08|SRF08]] mit der Programmiersprache C (avr-gcc).  
 
Für die I2C-Kommunikation wird die I2C-Master-lib von Peter Fleury verwendet, die unter [http://homepage.hispeed.ch/peterfleury/avr-software.html] zu finden ist.  
 
Für die I2C-Kommunikation wird die I2C-Master-lib von Peter Fleury verwendet, die unter [http://homepage.hispeed.ch/peterfleury/avr-software.html] zu finden ist.  
 
{{Baustelle|uwegw}}
 
  
 
Der SRF08 hat gegenüber dem SRF05 den Vorteil, dass man die Entfernung direkt als digitalen Wert auslesen kann, und nicht die Länge eines Pulses messen muss. Daher kann man die Messung starten, und den Controller erst einmal andere Aufgaben erledigen lassen, bevor man den Messwert ausliest. Der Messvorgang dauert bis zu etwa 70ms, und in dieser Zeit kann der Controller sich anderen Aufgaben widmen. Im [[Sensorarten#SRF08_Programmbeispiel|Bascom-Beispielprogramm]] wird von dieser Möglichkeit nicht Gebrauch gemacht. Dies vereinfacht das Programm zwar enorm, verschwendet aber reichlich Rechenzeit. Daher wurde in diesem Artikel ein anderer Ansatz gewählt. Er ist zwar deutlich komplexer, man kann aber die Programmdateien einfach übernehmen und in sein eigenes Projekt einbinden, ohne sich mit den Details der Umsetzung beschäftigen zu müssen.
 
Der SRF08 hat gegenüber dem SRF05 den Vorteil, dass man die Entfernung direkt als digitalen Wert auslesen kann, und nicht die Länge eines Pulses messen muss. Daher kann man die Messung starten, und den Controller erst einmal andere Aufgaben erledigen lassen, bevor man den Messwert ausliest. Der Messvorgang dauert bis zu etwa 70ms, und in dieser Zeit kann der Controller sich anderen Aufgaben widmen. Im [[Sensorarten#SRF08_Programmbeispiel|Bascom-Beispielprogramm]] wird von dieser Möglichkeit nicht Gebrauch gemacht. Dies vereinfacht das Programm zwar enorm, verschwendet aber reichlich Rechenzeit. Daher wurde in diesem Artikel ein anderer Ansatz gewählt. Er ist zwar deutlich komplexer, man kann aber die Programmdateien einfach übernehmen und in sein eigenes Projekt einbinden, ohne sich mit den Details der Umsetzung beschäftigen zu müssen.
Zeile 21: Zeile 18:
 
Zwischen zwei Messungen kann optional eine kurze Pause eingelegt werden. Dies wird in SRF08_PAUSE erledigt. Danach wird in SRF08_NEUSTART geprüft, ob eine neue Messung gestartet werden soll, und der Vorgang beginnt von vorne.  
 
Zwischen zwei Messungen kann optional eine kurze Pause eingelegt werden. Dies wird in SRF08_PAUSE erledigt. Danach wird in SRF08_NEUSTART geprüft, ob eine neue Messung gestartet werden soll, und der Vorgang beginnt von vorne.  
  
===Header SRF08.h ===
+
===Header srf08.h ===
 
<pre>
 
<pre>
 
/*
 
/*
Zeile 27: Zeile 24:
 
Der Sensor wird fortlaufend ausgelesen und neu gestartet. Dazu muss SRF08_task() regelmäßig aufgerufen werden.
 
Der Sensor wird fortlaufend ausgelesen und neu gestartet. Dazu muss SRF08_task() regelmäßig aufgerufen werden.
 
Mit den Funktionen get_SRF08_distance() und get_SRF08_light() kann man den letzten Messwert abrufen
 
Mit den Funktionen get_SRF08_distance() und get_SRF08_light() kann man den letzten Messwert abrufen
uwegw, 22.9.08
+
uwegw, 23.9.08
 
*/
 
*/
 +
  
 
#ifndef SRF08_H
 
#ifndef SRF08_H
Zeile 40: Zeile 38:
 
#define SRF08_adress 0xE0
 
#define SRF08_adress 0xE0
  
//Pause zwischen zwei Messungen.
+
//Pause zwischen zwei Messungen. Kann auch Null sein.
 
// Task-Aufrufintervall * SRF08_DELAY = Pausenzeit
 
// Task-Aufrufintervall * SRF08_DELAY = Pausenzeit
#define SRF08_DELAY 10
+
#define SRF08_DELAY 5
  
 
//Task für die State Machine, alle 10ms aufrufen!
 
//Task für die State Machine, alle 10ms aufrufen!
 
extern void SRF08_task(void);
 
extern void SRF08_task(void);
 +
 +
//Automatische Messung aktivieren
 +
void start_SRF08_automessung(void);
  
 
//Automatische Messung aktivieren/deaktivieren
 
//Automatische Messung aktivieren/deaktivieren
Zeile 64: Zeile 65:
  
 
#endif
 
#endif
 +
//Ende von srf08.h
  
 
</pre>
 
</pre>
  
=== Quellcode SRF08.c===
+
=== Quellcode srf08.c===
 
<pre>
 
<pre>
 
/*
 
/*
Zeile 73: Zeile 75:
 
Der Sensor wird fortlaufend ausgelesen und neu gestartet. Dazu muss SRF08_task() regelmäßig aufgerufen werden.
 
Der Sensor wird fortlaufend ausgelesen und neu gestartet. Dazu muss SRF08_task() regelmäßig aufgerufen werden.
 
Mit den Funktionen get_SRF08_distance() und get_SRF08_light() kann man den letzten Messwert abrufen
 
Mit den Funktionen get_SRF08_distance() und get_SRF08_light() kann man den letzten Messwert abrufen
uwegw, 22.9.08
+
uwegw, 23.9.08
 +
 
 
Die Messung ist als state machine realisiert.
 
Die Messung ist als state machine realisiert.
 
SRF08_WARTEN_AUF_FREIGABE: abwarten, bis Automessung aktiviert wurde
 
SRF08_WARTEN_AUF_FREIGABE: abwarten, bis Automessung aktiviert wurde
Zeile 102: Zeile 105:
 
void srf08_auslesen(void);
 
void srf08_auslesen(void);
  
 +
//Variablen für die state machine
 
enum SRF08_STATES {SRF08_WARTEN_AUF_FREIGABE,SRF08_MESSUNG_STARTEN,SRF08_MESSEN,SRF08_AUSLESEN,SRF08_PAUSE,SRF08_NEUSTART};
 
enum SRF08_STATES {SRF08_WARTEN_AUF_FREIGABE,SRF08_MESSUNG_STARTEN,SRF08_MESSEN,SRF08_AUSLESEN,SRF08_PAUSE,SRF08_NEUSTART};
 
uint8_t srf08_state=0;
 
uint8_t srf08_state=0;
  
 +
uint16_t get_SRF08_distance(void)
 +
{
 +
return SRF08_messwert;
 +
}
 +
 +
uint8_t get_SRF08_light(void)
 +
{
 +
return SRF08_light;
 +
}
 +
 +
void start_SRF08_automessung(void)
 +
{
 +
i2c_init();
 +
srf08_auto_aktiv=1;
 +
}
 +
 +
void set_SRF08_automessung(uint8_t on)
 +
{
 +
if(on){srf08_auto_aktiv=1; i2c_init(); } else {srf08_auto_aktiv=0;}
 +
}
 +
 +
//Verstärkung setzen
 +
void set_SRF08_gain(uint8_t gainvalue)
 +
{
 +
SRF08_gainvalue=gainvalue;
 +
}
 +
 +
//max. Reichweite festlegen
 +
void set_SRF08_range(uint8_t rangevalue)
 +
{
 +
SRF08_rangevalue=rangevalue;
 +
}
 +
 +
//regelmäßig aufrufen!
 
void SRF08_task(void)
 
void SRF08_task(void)
 
{
 
{
static volatile uint8_t srf_delaycnt=0;
+
static volatile uint8_t srf_delaycnt=0; //Zähler für die Pause
  
 
switch(srf08_state)
 
switch(srf08_state)
Zeile 117: Zeile 155:
 
srf08_state=SRF08_MESSUNG_STARTEN; //im nächsten Zyklus neue Messung beginnen
 
srf08_state=SRF08_MESSUNG_STARTEN; //im nächsten Zyklus neue Messung beginnen
 
}
 
}
+
        break;
 
//messung starten SRF08_MESSUNG_STARTEN
 
//messung starten SRF08_MESSUNG_STARTEN
 
case SRF08_MESSUNG_STARTEN:  
 
case SRF08_MESSUNG_STARTEN:  
Zeile 171: Zeile 209:
 
}
 
}
  
 +
 +
// Interne Funktionen. Nicht im hauptprogramm aufrufen!
 +
 +
//messung auslösen
 
void SRF08_messung_starten(void)
 
void SRF08_messung_starten(void)
 
{
 
{
Zeile 189: Zeile 231:
 
}
 
}
  
 
+
//Prüfen, ob Sensor bereit zum Auslesen ist
uint16_t get_SRF08_distance(void)
+
{
+
return SRF08_messwert;
+
}
+
 
+
uint8_t get_SRF08_light(void)
+
{
+
return SRF08_light;
+
}
+
 
+
void set_SRF08_automessung(uint8_t on)
+
{
+
if(on){ srf08_auto_aktiv=1;} else {srf08_auto_aktiv=0;}
+
}
+
 
+
 
+
void set_SRF08_gain(uint8_t gainvalue)
+
{
+
SRF08_gainvalue=gainvalue;
+
}
+
 
+
void set_SRF08_range(uint8_t rangevalue)
+
{
+
SRF08_rangevalue=rangevalue;
+
}
+
 
+
 
uint8_t srf08_ready(void)
 
uint8_t srf08_ready(void)
 
{
 
{
Zeile 227: Zeile 243:
 
}
 
}
  
 +
//Daten vom Sensor lesen
 
void srf08_auslesen(void)
 
void srf08_auslesen(void)
 
{
 
{
Zeile 242: Zeile 259:
  
 
}
 
}
</pre>
 
  
 +
//ende von srf08.c
 +
</pre>
  
 
=== Beispiel für den Aufruf im Hauptprogramm ===
 
=== Beispiel für den Aufruf im Hauptprogramm ===
Die beiden Codeblöcke als SRF08.h und SRF08.c abspeichern, und i2cmaster.h sowie twimaster.c ins Programmverzeichnis kopieren.
+
Die beiden Codeblöcke als srf08.h und srf08.c abspeichern, und i2cmaster.h sowie twimaster.c ins Programmverzeichnis kopieren.
  
 
Im Makefile müssen die Quelldateien SRF08.c und twimaster.c hinzugefügt werden. Dazu unter der Überschrift
 
Im Makefile müssen die Quelldateien SRF08.c und twimaster.c hinzugefügt werden. Dazu unter der Überschrift
Zeile 262: Zeile 280:
 
  Ansonsten müsste der Code auf allen AVRs mit I2C-Schnittstelle funktionieren.
 
  Ansonsten müsste der Code auf allen AVRs mit I2C-Schnittstelle funktionieren.
 
  Getestet bis jetzt nur auf einem mega16.
 
  Getestet bis jetzt nur auf einem mega16.
  uwegw, 22.9.08
+
  uwegw, 23.9.08
 
*/
 
*/
 +
 
#include <avr/io.h>
 
#include <avr/io.h>
 
#include <avr/interrupt.h>
 
#include <avr/interrupt.h>
#include "i2cmaster.h" //I2C-master-lib von P. Fleury verwenden
+
#include "srf08.h"
#include "SRF08.h"
+
  
 
int main(void)
 
int main(void)
Zeile 279: Zeile 297:
  
 
     sei();
 
     sei();
     i2c_init();
+
     start_SRF08_automessung(); //Messung beginnen
    set_SRF08_automessung(1); //Messung beginnen
+
  
     uint16_t messwert;
+
     uint16_t messwert;  
 
     while(1)
 
     while(1)
 
     {
 
     {
 
 
     messwert=get_SRF08_distance();
 
     messwert=get_SRF08_distance();
  
 
   /*
 
   /*
 
     Messwert verarbeiten...
 
     Messwert verarbeiten...
   */
+
   */
 
     }
 
     }
 
}
 
}
Zeile 299: Zeile 315:
 
SRF08_task();  
 
SRF08_task();  
 
}
 
}
 +
 
</pre>
 
</pre>
 +
 +
[[Category:Quellcode C]]
 +
[[Category:Sensoren]]

Aktuelle Version vom 6. Dezember 2012, 11:30 Uhr

Dieser Artikel beschreibt die Ansteuerung des Ultraschallsensors SRF08 mit der Programmiersprache C (avr-gcc). Für die I2C-Kommunikation wird die I2C-Master-lib von Peter Fleury verwendet, die unter [1] zu finden ist.

Der SRF08 hat gegenüber dem SRF05 den Vorteil, dass man die Entfernung direkt als digitalen Wert auslesen kann, und nicht die Länge eines Pulses messen muss. Daher kann man die Messung starten, und den Controller erst einmal andere Aufgaben erledigen lassen, bevor man den Messwert ausliest. Der Messvorgang dauert bis zu etwa 70ms, und in dieser Zeit kann der Controller sich anderen Aufgaben widmen. Im Bascom-Beispielprogramm wird von dieser Möglichkeit nicht Gebrauch gemacht. Dies vereinfacht das Programm zwar enorm, verschwendet aber reichlich Rechenzeit. Daher wurde in diesem Artikel ein anderer Ansatz gewählt. Er ist zwar deutlich komplexer, man kann aber die Programmdateien einfach übernehmen und in sein eigenes Projekt einbinden, ohne sich mit den Details der Umsetzung beschäftigen zu müssen.

Prinzip des Programms

Es wird fortlaufend gemessen, der Messwert wird ständig aktualisiert. Dazu muss die Funktion SRF08_task()regelmäßig aufgerufen werden, die den Ablauf steuert. Dies sollte in einem Timer-Interrupt passieren. Es muss sichergestellt werden, dass währenddessen von keiner anderen Funktion auf den I2C-Bus zugegriffen wird!


Die Messung wird durch eine state machine gesteuert, die von SRF08_task() periodisch aufgerufen wird.

Zu Beginn ist die state machine im state SRF08_WARTEN_AUF_FREIGABE. Nur wenn die Messung aktiviert wurde (per set_SRF08_automessung(1);), wird auf SRF08_MESSUNG_STARTEN gewechselt. Hier wird das Kommando zum Start der Messung gesendet.

Der Sensor lässt sich abfragen, ob er fertig mit der Messung ist und ausgelesen werden kann. Diese Abfrage geschieht in SRF08_MESSEN.

Wenn die Messung beendet ist, wird in SRF08_AUSLESEN der Messwert einlesen und gespeichert.

Zwischen zwei Messungen kann optional eine kurze Pause eingelegt werden. Dies wird in SRF08_PAUSE erledigt. Danach wird in SRF08_NEUSTART geprüft, ob eine neue Messung gestartet werden soll, und der Vorgang beginnt von vorne.

Header srf08.h

/*
Auslesen des SRF08 Ultraschallsensors über I2C
Der Sensor wird fortlaufend ausgelesen und neu gestartet. Dazu muss SRF08_task() regelmäßig aufgerufen werden.
Mit den Funktionen get_SRF08_distance() und get_SRF08_light() kann man den letzten Messwert abrufen
uwegw, 23.9.08
*/


#ifndef SRF08_H
#define SRF08_H

#include "i2cmaster.h" //I2C-master-lib von P. Fleury verwenden
#include <inttypes.h>
#include <avr/io.h>

//I2C-Busadresse
#define SRF08_adress 0xE0

//Pause zwischen zwei Messungen. Kann auch Null sein.
// Task-Aufrufintervall * SRF08_DELAY = Pausenzeit
#define SRF08_DELAY 5

//Task für die State Machine, alle 10ms aufrufen!
extern void SRF08_task(void);

//Automatische Messung aktivieren
void start_SRF08_automessung(void);

//Automatische Messung aktivieren/deaktivieren
// on: 1 oder 0, Automessung an/aus
extern void set_SRF08_automessung(uint8_t on);

//Verstärkung setzen
extern void set_SRF08_gain(uint8_t gainvalue);

//max. Reichweite festlegen
extern void set_SRF08_range(uint8_t rangevalue);

//gemessene Entfernung in cm zurückgeben
extern uint16_t get_SRF08_distance(void);

//gemessene Lichtstärke (0..255) zurückgeben
extern uint8_t get_SRF08_light(void);

#endif
//Ende von srf08.h

Quellcode srf08.c

/*
Auslesen des SRF08 Ultraschallsensors über I2C
Der Sensor wird fortlaufend ausgelesen und neu gestartet. Dazu muss SRF08_task() regelmäßig aufgerufen werden.
Mit den Funktionen get_SRF08_distance() und get_SRF08_light() kann man den letzten Messwert abrufen
uwegw, 23.9.08

Die Messung ist als state machine realisiert.
SRF08_WARTEN_AUF_FREIGABE: abwarten, bis Automessung aktiviert wurde
SRF08_MESSUNG_STARTEN: messvorgang starten
SRF08_MESSEN: Messung läuft, warten auf Ende
SRF08_AUSLESEN: Messwert einlesen
SRF08_PAUSE: Pause zwischen zwei Messungen
SRF08_NEUSTART: prüfen, ob Messung erneut gestartet werden soll.
*/


#include "SRF08.h"

volatile unsigned char srf08_auto_aktiv=0;


volatile uint16_t SRF08_messwert=0;
volatile uint8_t SRF08_light=0;

volatile uint8_t SRF08_gainvalue=5;
volatile uint8_t SRF08_rangevalue= 140; //6m default



//Deklarationen für interne Funktione, nicht im Header enthalten
void SRF08_messung_starten(void);
uint8_t srf08_ready(void);
void srf08_auslesen(void);

//Variablen für die state machine
enum SRF08_STATES {SRF08_WARTEN_AUF_FREIGABE,SRF08_MESSUNG_STARTEN,SRF08_MESSEN,SRF08_AUSLESEN,SRF08_PAUSE,SRF08_NEUSTART};
uint8_t srf08_state=0;

uint16_t get_SRF08_distance(void)
{
return SRF08_messwert;
}

uint8_t get_SRF08_light(void)
{
return SRF08_light;
}

void start_SRF08_automessung(void)
{
	i2c_init();
	srf08_auto_aktiv=1;
}

void set_SRF08_automessung(uint8_t on)
{
	if(on){srf08_auto_aktiv=1; i2c_init(); } else {srf08_auto_aktiv=0;}
}

//Verstärkung setzen
void set_SRF08_gain(uint8_t gainvalue)
{
	SRF08_gainvalue=gainvalue;
}

//max. Reichweite festlegen
void set_SRF08_range(uint8_t rangevalue)
{
		SRF08_rangevalue=rangevalue;
}

//regelmäßig aufrufen!
void SRF08_task(void)
{
static volatile uint8_t srf_delaycnt=0; //Zähler für die Pause

	switch(srf08_state)
	{
	
		case SRF08_WARTEN_AUF_FREIGABE: //Messung war abgeschaltet, warten bis wieder aktiviert SRF08_WARTEN_AUF_FREIGABE
		if(srf08_auto_aktiv)
		{
			srf08_state=SRF08_MESSUNG_STARTEN; //im nächsten Zyklus neue Messung beginnen
		}
	        break;
		//messung starten SRF08_MESSUNG_STARTEN
		case SRF08_MESSUNG_STARTEN: 
		SRF08_messung_starten();
		srf08_state=SRF08_MESSEN;
		break;
		
		//messung läuft noch, warten bis Ende SRF08_MESSEN
		case 2: 
		if(srf08_ready())
			{	
			srf08_state=SRF08_AUSLESEN;
			}
		break;
	
		//messung fertig, Werte auslesen SRF08_AUSLESEN
		case 3: 
			srf08_auslesen();
			srf08_state=SRF08_PAUSE;
			srf_delaycnt=SRF08_DELAY;
		break;	
		
		//messung fertig, evtl Pause machen SRF08_PAUSE
		case SRF08_PAUSE:
			if(srf_delaycnt)
				{
				srf_delaycnt--;
				}
			else
				{
				srf08_state=SRF08_NEUSTART;
				}
				
		break;		
		
		//wenn weiterhin gemessen werden soll, im nächsten zyklus nächste Messung starten SRF08_NEUSTART
		case SRF08_NEUSTART: 
			if(srf08_auto_aktiv)
				{
					srf08_state=SRF08_MESSUNG_STARTEN; //im nächsten Zyklus neue Messung beginnen
				}
			else
				{
					srf08_state=SRF08_WARTEN_AUF_FREIGABE; //Automessung stoppen
				}
		break;	
		

	
		default:
		break;
	}
}


// Interne Funktionen. Nicht im hauptprogramm aufrufen!

//messung auslösen
void SRF08_messung_starten(void)
{
	if(srf08_ready())
	{
		i2c_start(SRF08_adress+I2C_WRITE);
		i2c_write(0x01);//Gainregister
		i2c_write(SRF08_gainvalue);//Gain setzen
		i2c_write(SRF08_rangevalue);
	
		i2c_rep_start(SRF08_adress+I2C_WRITE);
		i2c_write(0x00);//Befehlsregister wählen		
		i2c_write(0x51);//Messung starten, Ergebnis in cm
		
		i2c_stop();
		
	}
}

//Prüfen, ob Sensor bereit zum Auslesen ist
uint8_t srf08_ready(void)
{

if(!(i2c_start(SRF08_adress+I2C_WRITE)))
	{	i2c_stop();
		return 1;
	}	
i2c_stop();
return 0;
}

//Daten vom Sensor lesen
void srf08_auslesen(void)
{
	if(srf08_ready())
	{
		i2c_start(SRF08_adress+I2C_WRITE);
		i2c_write(0x01);//Ergebnisregister Lichtsensor wählen
		i2c_rep_start(SRF08_adress+I2C_READ);
				
		SRF08_light= i2c_readAck();
		SRF08_messwert = ((i2c_readAck())<<8); //highbyte
		SRF08_messwert += (i2c_readNak()); //lowbyte
		i2c_stop();
	}

}

//ende von srf08.c

Beispiel für den Aufruf im Hauptprogramm

Die beiden Codeblöcke als srf08.h und srf08.c abspeichern, und i2cmaster.h sowie twimaster.c ins Programmverzeichnis kopieren.

Im Makefile müssen die Quelldateien SRF08.c und twimaster.c hinzugefügt werden. Dazu unter der Überschrift

# List C source files here. (C dependencies are automatically generated.)

die Zeilen

SRC += srf08.c
SRC += twimaster.c

einfügen.

Anwendungsbeispiel

/*
Beispiel für den Aufruf der SRF08-Routinen
 Die Timer-konfiguration ist angepasst für einen Mega16/32.
 Ansonsten müsste der Code auf allen AVRs mit I2C-Schnittstelle funktionieren.
 Getestet bis jetzt nur auf einem mega16.
 uwegw, 23.9.08
*/

#include <avr/io.h>
#include <avr/interrupt.h>
#include "srf08.h"

int main(void)
{

    //timer1 für 10ms-Interrupt starten
	TIMSK |=(1<<OCIE1A); //ctc interrupt
	TCCR1B |=(1<<CS12) | (1<<CS10); //Prescaler 1024
	TCCR1B |=(1<<WGM12);	//Clear Timer on Compare Match Modus
	OCR1A = 0x009C; 	//Compare auf 10ms bei 8MHz setzen

    sei();
    start_SRF08_automessung(); //Messung beginnen

    uint16_t messwert; 
    while(1)
    {
    messwert=get_SRF08_distance();

   /*
    Messwert verarbeiten...
   */	
    }
}


ISR(TIMER1_COMPA_vect) //wird alle 10ms aufgerufen
{
	SRF08_task(); 
}


LiFePO4 Speicher Test