ACS an NIBObee

**pacman** · 15.06.2011, 12:58

Hallo, ich habe folgenden

Code:

// Die Anoden der rechten IR-LEDs hängen mit Vorwiderstand an PA0 (X1-AN0)
// Die Anoden der linken IR-LEDs hängen mit Vorwiderstand an PA1 (X1-AN1)
// Die Kathoden beider IR-LEDs sind mit PA3 (X3-AN3) verbunden
// Der IR-Empfänger ist mit PA2 (X2-AN2) verbunden

#define ddr_acs_led_l  	DDRA 	// Anoden der IR-LEDs links
#define port_acs_led_l 	PORTA
#define pin_acs_led_l	(1<<PA1)

#define ddr_acs_led_r  	DDRA    // rechts
#define port_acs_led_r 	PORTA
#define pin_acs_led_r 	(1<<PA0)

#define ddr_acs_36kHz  	DDRA 	// Kathoden der IR-LEDS mit 36kHz getaktet
#define port_acs_36kHz 	PORTA
#define pin_acs_36kHz 	(1<<PA3)

#define ddr_acs_tsop  	DDRA 	// Eingang IR-Empfänger
#define port_acs_tsop 	PINA  // Achtung, das ist ein Eingang!
#define pin_acs_tsop  	(1<<PA2)

#include <nibobee/iodefs.h>
#include <nibobee/led.h>
#include <nibobee/motpwm.h>
#include <nibobee/sens.h>

volatile uint8_t count36kHz;
volatile uint8_t acs=0;

void Sleep(uint8_t pause);
void Msleep(uint16_t pause);
void ACSData(uint16_t *data);

int main(void)
{
    uint16_t data[2]; // Speicher für ACS-Werte
	
    led_init();
	motpwm_init();
	sens_init();
	while(1==1) {
	
    // Setup Timer2
    TCCR2 = (1 << WGM20)|(1 << CS20); // PhaseCorrect-PWM, no prescaling, no OC2-Pin!
    TCNT2  = 96; // (512-416) 36kHz @15MHz
    OCR2 = 151; // (255-(208/2)) 151 ist 50:50 Compare Match für symetrische Halbwellen
    TIMSK |= (1 << OCIE2)|(1 << TOIE2); // Comp und OVF-ISR enable, Overflow bei Bottum!
    enable_interrupts();

    ddr_acs_led_l |= pin_acs_led_l;        // die Anoden der IR-LEDs
    port_acs_led_l &= ~pin_acs_led_l;

    ddr_acs_led_r |= pin_acs_led_r;
    port_acs_led_r &= ~pin_acs_led_r;

    ddr_acs_36kHz |= pin_acs_36kHz;        // die Kathoden der IR-LEDs

      led_set(0,1);
    Msleep(2000); // wait4programmer
      led_set(0,0);

    while(1)
   {enable_interrupts();
	int16_t speed_l=0;
	int16_t speed_r=0;
	motpwm_setLeft(speed_l);
	motpwm_setRight(speed_r);
     
	  ACSData(data);
      PORTB &= ~15; // alle Leds aus
      if(data[0] > 251) speed_l = 500;
         else if(data[0] > 230) speed_l = 800;
      if(data[1] > 251) speed_r = 500;
         else if(data[1] > 230) speed_r = 800;
      Msleep(100);
   }
   return(0);
}
 ISR (TIMER2_COMP_vect)
{
    port_acs_36kHz ^= pin_acs_36kHz; // IR-LEDs togglen
}
// Frequenzkorrektur für 36kHz (512-416 plus 3 Takte fürs Laden von TCNT2?)
 ISR (TIMER2_OVF_vect)
{
    TCNT2  += 99; // += bewirkt, dass schon erfolgte Zähltakte nicht ignoriert werden!
    port_acs_36kHz &= ~pin_acs_36kHz; // bei Nulldurchgang soll die IR-LED aus sein!
    //port_acs_36kHz |= pin_acs_36kHz; // seltamerweise funktioniert das auch?
    if(count36kHz) count36kHz--;
   if(acs) acs--;
}

void Sleep(uint8_t pause) // 1/36000 Pause blockierend
{
    count36kHz=pause;
    while(count36kHz);
}
void Msleep(uint16_t pause) // 1/1000 Pause blockierend
{
    while(pause--) Sleep(36);
}
void ACSData(uint16_t *data)
{
   OCR2=253;
   port_acs_led_l |= pin_acs_led_l; // ACS LED left on
   while((port_acs_tsop & pin_acs_tsop) && (OCR2 > 151))
   {
      acs=10; // Impulse senden, acs wird in OVF-ISR runtergezählt
      while(acs);
      OCR2--;
   }
   port_acs_led_l &= ~pin_acs_led_l; // ACS LED left off
   data[0]=OCR2;
   while(!(port_acs_tsop & pin_acs_tsop)); // warten bis keine Echo mehr

   OCR2=253;
   port_acs_led_r |= pin_acs_led_r; // ACS LED right on
   while((port_acs_tsop & pin_acs_tsop) && (OCR2 > 151))
   {
      acs=10;
      while(acs);
      OCR2--;
   }
   port_acs_led_r &= ~pin_acs_led_r; // ACS LED right off
   data[1]=OCR2;
   while(!(port_acs_tsop & pin_acs_tsop));
}

Beim Compilieren gibt er mir folgende Errors:
-static declaration of '__vector_3' follows non-static declaration
-previous declaration of '__vector_3' was here
-static declaration of '__vector_4' follows non-static declaration
-previous declaration of '__vector_4' was here
-expected declaration or statement at end of input

das ganze bezieht sich auf diesen Teil:

Code:

ISR (TIMER2_COMP_vect)
{
    port_acs_36kHz ^= pin_acs_36kHz; // IR-LEDs togglen
}
// Frequenzkorrektur für 36kHz (512-416 plus 3 Takte fürs Laden von TCNT2?)
 ISR (TIMER2_OVF_vect)
{TCNT2  += 99; // += bewirkt, dass schon erfolgte Zähltakte nicht ignoriert werden!
    port_acs_36kHz &= ~pin_acs_36kHz; // bei Nulldurchgang soll die IR-LED aus sein!
    //port_acs_36kHz |= pin_acs_36kHz; // seltamerweise funktioniert das auch?
    if(count36kHz) count36kHz--;
   if(acs) acs--;}

**radbruch** · 15.06.2011, 13:44

Hallo

Vor return fehlt eine }

Aber das löst noch nicht alle Probleme. In allen Funktionsaufrufen der Library fehlt das void wenn kein Parameter übergeben wird, atomic kann mein Kompiler auch nicht und base.h muss eingebunden werden wegen nibobee_initialization:

In motpwm.c:

Code:

void motpwm_init(void) {
  nibobee_initialization |= NIBOBEE_MOTPWM_INITIALIZED;
  set_output_group(IO_MOTOR);
  activate_output_group(IO_MOTOR);
  PWM_TIMER_CCRA = PWM_TIMER_CCRA_INIT;
  PWM_TIMER_CCRB = PWM_TIMER_CCRB_INIT;
  PWM_TIMER_IMSK |= PWM_TIMER_IMSK_INIT;
}


void motpwm_stop(void) {
  //ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
  cli();
    motpwm_motor_l = 0;
    motpwm_motor_r = 0;
    PWM_TIMER_OCRA = 0;
    PWM_TIMER_OCRB = 0;
  sei();
  //}
}

sens.c:

Code:

void sens_init(void) {
  set_output_group(IO_SENS);
}

leds.c:

Code:

void led_init(void) {
  activate_output_group(IO_LEDS);  // LED bits als Output
}

base.h einbinden:

Code:

...
#define pin_acs_tsop  	(1<<PA2)

#include <nibobee/base.h>
#include <nibobee/iodefs.h>
...

Ich habe den Beitrag mal hier eingeordend, das passt hier besser.

Gruß

mic

**pacman** · 15.06.2011, 16:44

Also, wenn ich das dazuschreibe, kommen noch mehr Fehlermeldungen: zB 'PWM_TIMER_CCRB' undeclared (first use in this function) ?

**pacman** · 19.06.2011, 16:21

Hallo, da bin ich wieder. Ich bin kurz vor dem Ziel. Mein letztes Problem ist noch, dass ich, wenn ich die sens.c Datei und die anderen ändern will, den Zugriff verweigert bekomme. Weiß einer wie ich das umgehen kann, oder muss ich die gesamte Datei in mein Programm kopieren?

**radbruch** · 19.06.2011, 17:15

Wie lautet denn der genaue Wortlaut der Meldung? Screenshot?

**pacman** · 19.06.2011, 18:19

"Zugriff auf C:/Program Files (x86)/NIBObeeLib/src/nibobee/motpwm.c wurde verweigert." zum Beispiel

**radbruch** · 19.06.2011, 18:26

Sollten sich die Dateien der Library nicht im AVR-Pfad befinden?

C:\WinAVR\avr\include\nibobee

**pacman** · 19.06.2011, 20:13

So, es klappt jetzt, nachdem ich den include-Ordner rüberkopiert habe. Allerdings funktioniert mein Programm immer noch nicht, wie es funktionieren sollte, könntest du noch einmal drübersehen?:

Code:

#define ddr_acs_led_l  	DDRA 	// Anoden der IR-LEDs links
#define port_acs_led_l 	PORTA
#define pin_acs_led_l	(1<<PA1)

#define ddr_acs_led_r  	DDRA    // rechts
#define port_acs_led_r 	PORTA
#define pin_acs_led_r 	(1<<PA0)

#define ddr_acs_36kHz  	DDRA 	// Kathoden der IR-LEDS mit 36kHz getaktet
#define port_acs_36kHz 	PORTA
#define pin_acs_36kHz 	(1<<PA3)

#define ddr_acs_tsop  	DDRA 	// Eingang IR-Empfänger
#define port_acs_tsop 	PINA  // Achtung, das ist ein Eingang!
#define pin_acs_tsop  	(1<<PA2)

#include <nibobee/iodefs.h>
#include <nibobee/led.h>
#include <nibobee/motpwm.h>
#include <nibobee/sens.h>
#include <nibobee/base.h>

volatile uint8_t count36kHz;
volatile uint8_t acs=0;

void Sleep(uint8_t pause);
void Msleep(uint16_t pause);
void ACSData(uint16_t *data);

int main(void)
{
    uint16_t data[2]; // Speicher für ACS-Werte
	
    led_init();
	motpwm_init();
	sens_init();
	while(1==1) {
	
    // Setup Timer2
    TCCR2 = (1 << WGM20)|(1 << CS20); // PhaseCorrect-PWM, no prescaling, no OC2-Pin!
    TCNT2  = 96; // (512-416) 36kHz @15MHz
    OCR2 = 151; // (255-(208/2)) 151 ist 50:50 Compare Match für symetrische Halbwellen
    TIMSK |= (1 << OCIE2)|(1 << TOIE2); // Comp und OVF-ISR enable, Overflow bei Bottum!
    
	enable_interrupts();
	int16_t speed_l=0;
	int16_t speed_r=0;
	motpwm_setLeft(speed_l);
	motpwm_setRight(speed_r);

    ddr_acs_led_l |= pin_acs_led_l;        // die Anoden der IR-LEDs
    port_acs_led_l &= ~pin_acs_led_l;

    ddr_acs_led_r |= pin_acs_led_r;
    port_acs_led_r &= ~pin_acs_led_r;

    ddr_acs_36kHz |= pin_acs_36kHz;        // die Kathoden der IR-LEDs

      led_set(0,1);
    Msleep(2000); // wait4programmer
      led_set(0,0);

    while(1)
  	  ACSData(data);
      PORTB &= ~15; // alle Leds aus
      if(data[0] > 251) speed_l = 500;
         else if(data[0] > 230) speed_l = 800;
      if(data[1] > 251) speed_r = 500;
         else if(data[1] > 230) speed_r = 800;
      Msleep(100);

	 
   }
   return(0);
}
 ISR (TIMER2_COMP_vect)
{
    port_acs_36kHz ^= pin_acs_36kHz; // IR-LEDs togglen
}
// Frequenzkorrektur für 36kHz (512-416 plus 3 Takte fürs Laden von TCNT2?)
 ISR (TIMER2_OVF_vect)
{
    TCNT2  += 99; // += bewirkt, dass schon erfolgte Zähltakte nicht ignoriert werden!
    port_acs_36kHz &= ~pin_acs_36kHz; // bei Nulldurchgang soll die IR-LED aus sein!
    //port_acs_36kHz |= pin_acs_36kHz; // seltamerweise funktioniert das auch?
    if(count36kHz) count36kHz--;
   if(acs) acs--;
}

void Sleep(uint8_t pause) // 1/36000 Pause blockierend
{
    count36kHz=pause;
    while(count36kHz);
}
void Msleep(uint16_t pause) // 1/1000 Pause blockierend
{
    while(pause--) Sleep(36);
}
void ACSData(uint16_t *data)
{
   OCR2=253;
   port_acs_led_l |= pin_acs_led_l; // ACS LED left on
   while((port_acs_tsop & pin_acs_tsop) && (OCR2 > 151))
   {
      acs=10; // Impulse senden, acs wird in OVF-ISR runtergezählt
      while(acs);
      OCR2--;
   }
   port_acs_led_l &= ~pin_acs_led_l; // ACS LED left off
   data[0]=OCR2;
   while(!(port_acs_tsop & pin_acs_tsop)); // warten bis keine Echo mehr

   OCR2=253;
   port_acs_led_r |= pin_acs_led_r; // ACS LED right on
   while((port_acs_tsop & pin_acs_tsop) && (OCR2 > 151))
   {
      acs=10;
      while(acs);
      OCR2--;
   }
   port_acs_led_r &= ~pin_acs_led_r; // ACS LED right off
   data[1]=OCR2;
   while(!(port_acs_tsop & pin_acs_tsop));
}

**radbruch** · 19.06.2011, 20:47

Code:

    while(1)
  	  ACSData(data);
      PORTB &= ~15; // alle Leds aus
      if(data[0] > 251) speed_l = 500;
         else if(data[0] > 230) speed_l = 800;
      if(data[1] > 251) speed_r = 500;
         else if(data[1] > 230) speed_r = 800;
      Msleep(100);
   }

Wo werden die speed_x-Werte an die Antriebe übergeben?

Hier stimmt es auch noch nicht:

while(1==1) {

und

while(1)
ACSData(data);

Lese endlos die ACS-Daten ein...