Asuro Steuerung für Dieselmotor

[erik1563]

Moin Moin!
Ich habe vor kurzem mal meinen Asuro wieder ausgegraben, weil ich gezwungen war mich wieder mit C zu beschäftigen. (Studium)<br>Ich habe vor mit Hilfe des Asuro und einem RC-Servo eine Drehzahlsteuerung für einen kleinen Dieselmotor zu bauen.<br>Ich hab heute den Tag über daran gearbeitet den Servo anzusteuern, funktioniert mittlerweile auch, aber ich scheitere daran den Servo über die IR Schnittstelle zu steuern

#include "asuro.h"

int main(void)
{
   Init();
	unsigned char l[3];
	while(1) {
	SerRead(l,3,0);
     while(l > 0)
		{
		
		BackLED(ON,OFF);
		Sleep(l);
		BackLED(OFF,OFF);
		Sleep(144);Sleep(144);Sleep(144);Sleep(144);Sleep(144);Sleep(144);Sleep(144);Sleep(144);Sleep(144);Sleep(144);
		}
	}
   return 0;
}

Das ist das Programm.
Ziel ist es über das Terminal eine 3 stellige Nummer einzugeben, welche die Stellung des Servos verändert. Bisher sind das noch die direkten unsigned char Werte für Sleep() (ca 60-200 Linker und Rechter Anschlag vom Servo), später bastel ich das so um, das man einen Winkel angibt.
Was ist an meinem Progrämmchen verkehrt?
gruss Erik

[radbruch]

Hallo

Wenn du mit SerRead() Zeichen über die serielle Schnittstelle liest, dann sind das ascii-Zeichen. Die Codes für die Ziffern liegen dabei zwischen 0x30 für '0' und 0x39 für '9'. Man muss also 0x30 oder '0' vom ascii-Code abziehen um den Wert der Stelle zu erhalten. Um von drei gesendeten Zeichen auf eine dreistellige Zahl zu kommen verwendet man deshalb Formeln wie diese:

(Zeichen1 - '0') * 100 + (Zeichen2 - '0') * 10 + (Zeichen3 - '0')

        BackLED(ON,OFF);
        Sleep((l[0] - '0') * 100 + (l[1] - '0') * 10 + (l[2] - '0'));
        BackLED(OFF,OFF);
        Sleep(72);Sleep(144);Sleep(144);Sleep(144);Sleep(144);Sleep(144);Sleep(144);Sleep(144);Sleep(144);Sleep(144);  // 19ms Pause 

l ist ein ungünstig gewählter Name für Variablen.

Gruß

mic

[erik1563]

Danke für die schnelle Antwort! Hat super funktioniert!
Ich hab den Tag weiter experimentiert und erst einmal versucht ein Bugrad mit dem Servo zu steuern:

http://www.youtube.com/watch?v=uFt6hllIRMU
klappt einigermaßen, aber ich habe Stromprobleme... wenn der Servo sich zu schnell bewegt bricht die Spannung zusammen und Asuro startet neu.
Naja zum spielen hats gereicht.
Nächster Schritt ist ein Drehzahlsensor für den Diesel zu baun.
Fals Interesse besteht halte ich euch gerne auf dem laufenden.

[radbruch]

Irgendwie erinnert mich das an meine eigenen Schandtaten:
http://www.youtube.com/watch?v=F45RU9yRXtI

Bei dir sieht das aber deutlich besser aus.

Interesse besteht immer ;)

[erik1563]

Hier noch einmal den Code zum Linienfolgenprogramm:

#include "asuro.h"

int main(void)
{
   Init();
	unsigned char l;
	int data[2];
	FrontLED(ON);
	l=108;
	Sleep(255);
	Sleep(255);
	MotorDir(FWD,FWD);
	MotorSpeed(130,130);
	int servo(unsigned char l) {
								
								BackLED(ON,OFF);
								Sleep(l);
								BackLED(OFF,OFF);
								Sleep(144);Sleep(72);Sleep(144);Sleep(144);Sleep(144);Sleep(144);Sleep(144);Sleep(144);Sleep(144);
                                return 0;}
	while(1) {
			LineData(data);
			if(data [0] < data[1])
				{l=l+4;
				MotorSpeed(100,140);}
			else if(data[0] == data[1])
				{l=l;}
			
			else
				{l=l-4;
				MotorSpeed(140,100);}
				servo(l);
				
				
			if(l > 120)
				{l=120;}
			else if(l < 80)
				{l=80;}
			else
				{l=l;}
	}
   return 0;
}

Nun möchte ich meine Servofunktion so gestalten, das sie den PWM wie bei der MotorSpeed) Funktion funktioniert. Mit anderen Worten: Ich möchte der servo()Funktion einen Wert übergeben, der so lange ausgeführt wird, bis er geändert wird, damit der Servo einen Hebel gegen einen Federdruck halten kann.
Bisher ist das ja so, das der Servo zwar in der richtigen Stellung bleibt, wenn servo() nicht mehr while schleife andauernd ausgeführt wird, aber inaktiv ist und damit verdrahbar.
Lässt sich das mit dem Atmel umsetzen oder braucht man dafür multitaskting?

[radbruch]

Hallo

Multitasking können die AVRs natürlich nicht. Für Aufgaben, die quasi im Hintergrund ablaufen sollen, verwendet man deshalb die Timerfunktionen der AVRs. Hier wird die "klassische" Servoansteuerung beschrieben:
http://www.rn-wissen.de/index.php/Servo

#define SERVOPIN 7
#define SERVOPORT PORTD
#define DDRSERVO DDRD

volatile unsigned char servopos;

void servo_init()
{
    TIMSK|=(1<<OCIE2);
    TCCR2 |= (1<<WGM21) | (1<<CS20);    //Prescale=1, CTC mode
    OCR2 = F_CPU/100000;            //alle 10µS ein IRQ
    DDRSERVO|=(1<<SERVOPIN);
};

ISR(TIMER2_COMP_vect)
{
    static int count;
    if(count>servopos)SERVOPORT&=~(1<<SERVOPIN);
      else SERVOPORT|=(1<<SERVOPIN);
    if(count<2000)count++;
      else count=0;
}; 

Wie funktioniert das? Der Timer wird so programmiert, dass er alle 10µs die Interruptserviceroutine (ISR) aufruft. Die Aufrufe werden in der ISR mitgezählt (count), der Zählerstand wird zwischen den Aufrufen gespeichert (static). Zusätzlich wird in der ISR der Zählerwert mit dem Wert für die Servoposition (servopos) verglichen und dem Ergebniss entsprechend der Servoausgang gesetzt oder gelöscht. Bei 10µs oder 0,01ms pro Aufruf ist nach 100 Aufrufen eine Millisekunde vergangen, nach 2000 sind es 20ms.

Alles klar soweit? Wie verwendet man das nun beim asuro? Man könnte Timer0 verwenden, denn der wird von der Library des asuro nicht verwendet. Oder man klinkt sich in den Timer1 ein der ja schon für die PWM-Ansteuerung der Antriebe genutzt wird:

#include "asuro.h"

volatile unsigned char servopos=40; // 40 ist ca. 1 ms

SIGNAL (SIG_OVERFLOW1)
{
    static int count = 1;
    if(count > servopos) BackLED(OFF,OFF); else BackLED(ON,OFF);
    if(count < 780) count++; else count=1;
}

int main(void)
{
   Init();
    TIMSK |= (1 << TOIE1); // Timer1 Overflow-ISR einklinken für Servo

    unsigned char l;
    int data[2];
    FrontLED(ON);
    l=108;
    Sleep(255);
    Sleep(255);
    MotorDir(FWD,FWD);
    MotorSpeed(130,130);

    while(1) {
            LineData(data);
            if(data [0] < data[1])
                {l=l+4;
                MotorSpeed(100,140);}
            else if(data[0] == data[1])
                {l=l;}

            else
                {l=l-4;
                MotorSpeed(140,100);}
                //servo(l);
                servopos = l; // Servoposition setzen

            if(l > 120)
                {l=120;}
            else if(l < 80)
                {l=80;}
            else
                {l=l;}
    }
   return 0;
} 

ungetestet

Gruß

mic