2 Servos mit PWM ansteuern

[privatestatic]

Hallo Leute,

ich möchte 2 Servos mittels PWM im "Phase and Frequency Correct"-Modus ansteuern. Mit dem untenstehenden Programm funktioniert allerdings immer nur jeweils ein Servo. Wenn ich beide gleichzeitig aktiviere dann zuckeln sie nur sinnlos herum. Wie kann ich beide Servos gleichzeitig zum Laufen bringen?

MfG
Nico

#ifndef F_CPU
	#define F_CPU 16000000
#endif 

#include <avr/io.h>
#include <util/delay.h>

// Servoansteuerung
#define U_LIMIT 2000
#define L_LIMIT  1000
#define TOP      20000

#define SPEED(x) (L_LIMIT + ((( U_LIMIT - L_LIMIT ) / 255.0 )*x))
#define SETBIT(x,n) ((x)|=1L<<(n))
#define WAITMS(x)	_delay_loop_2(((F_CPU * 0.001) / 4)*x)	/**< 1 ms delay */

void init(void)
{

    ICR1 = TOP;			// ICR1 as TOP
	
    SETBIT(DDRD,PIND4); // Port PD4 (OC1B) als Ausgang
    SETBIT(DDRD,PIND5); // Port PD5 (OC1A) als Ausgang
	
    SETBIT(TCCR1A,COM1A1);	// OCR1A on
    SETBIT(TCCR1A,COM1B1);	// OCR1B on
    SETBIT(TCCR1B,CS11);	        // Prescaler 8
    SETBIT(TCCR1B,WGM13);	// Phase and Frequency Correct PWM
    
    //OCR1A = L_LIMIT + ((U_LIMIT-L_LIMIT)/2); // <-- Problem
    OCR1B = L_LIMIT + ((U_LIMIT-L_LIMIT)/2);
}

int main(void)
{
  unsigned char c;
  
  init();
	
  while(1)
  {
    for(c=0;c<=255;c++)
    {
      //OCR1A = SPEED(c);  // <-- Problem
      OCR1B = SPEED(c);
      WAITMS(10);
    }
  }
}

[Hubert.G]

Ich kann deinen Code so auf die Schnelle nicht nachvollziehen aber mich stören in zeitkritischen Anwendungen Warteschleifen unheimlich. Ich habe mir mit diesen Schleifen schon die unmöglichsten Fehler eingehandelt die nur sehr schwer nachzuvollziehen sind. Vieleicht überdenkst du mal das.

[privatestatic]

Hallo,

danke für die Antwort. An dem WAITMS(10) liegt es leider nicht. Auch wenn ich das WAITMS weglasse und einmalig beide Servos in feste Positionen bringen möchte funktioniert dies nicht.

Ich habe das Programm nochmals etwas modifiziert und diesmal FastPWM genutzt. An dem Problem hat sich jedoch nichts verändert. Es läuft immer nur ein Servo. Der andere muss kommentiert bleiben.

#ifndef F_CPU
	#define F_CPU 16000000
#endif

#include <avr/io.h>
#include <util/delay.h> 

// Werte für OCR1A/OCR1B
#define U_LIMIT	4000	// oberes Limit
#define L_LIMIT	2000	// unteres Limit

// Obergrenze Zähler
#define TOP		40000

// Makro für Normierung auf Werte zwischen 0 und 255
#define SPEED(x)	(L_LIMIT + ((( U_LIMIT - L_LIMIT ) / 255.0 )*x))
#define WAITMS(x)   _delay_loop_2(((F_CPU * 0.001) / 4)*x)

void init(void)
{
	ICR1 = TOP;				// ICR1 as TOP

	DDRD |= (1 << PIND4); // Port PD4 (OC1B) als Ausgang
	DDRD |= (1 << PIND5); // Port PD5 (OC1A) als Ausgang
	
	// Aktiviere OCR1A und OCR1B und setze Waveform Generation Mode 14
	TCCR1A = 0x00 | (1 << COM1A1) | (1 << COM1B1) | (1 << WGM11);	// OCR1A und OCR1B an
	TCCR1B = 0x00 | (1 << CS11)   | (1 << WGM12)  | (1 << WGM13);	// Prescaler 8, 16 Bit Fast PWM, TOP ist ICR1
	
	// Servos in Mittelstellung
	OCR1A = SPEED(127);
	//OCR1B = SPEED(127);			// <- Problem
}

int main(void)
{
	unsigned char c;
	init();
	while(1)	// Hauptschleife
	{
		for(c=0;c<=255;c++) // Servos von Minimalstellung zu Maximalstellung fahren
		{
			// setze Servopositionen
			OCR1A = SPEED(c);
			//OCR1B = SPEED(c);		// <- Problem
      
			// Zeit schinden
			WAITMS(10);
		}
	}
}

MfG
Nico

[SprinterSB]

Bist du sicher, daß deine Schaltung ok ist? Wenn zB zwei Servos zusammen zu viel Strom saugen und der µC resettet oder spinnt, dann kannst du so nen Effekt bekommen. Geht es, wenn zu die 2 Servos simultan an einem PWM-Kanal betreibst? Also die Soaftware genauso lässt wie sie mit einem Servo geht, aber nur die 2 Dinger an einen Pin anklemmen.

[privatestatic]

Arghh,

stimmt, das Problem lag in der Schaltung. Die beiden Programme funktionieren wunderbar! Mein fehler war, dass ich Servos und Atmel mit verschiedenen Stromquellen verbunden hatte und vergessen habe die Massen untereinander zu verbinden.

Grüße,
Nico