Problem mit Arduino Programmierung

[fox67]

Hallo ich steuere mit meinem Arduino zwei Schritmotoren an. Mit einem in Delphi programmierten Programm empfange ich Daten aus einem Flugsimulator und schicke diesen an den Arduino(das funktioniert auch so weit). Die Daten die an den Arduino geschickt werden sehen folgender maßen aus:



1: AWert1,Wert2 Beispiel(A100,400)

2: PWert2 Beispiel(P100)

3: EWert3,Wert4 Beispiel(E-400,-1000)

Erklärung:

A bedeutet: Anfang dies wird beim Programmstart gesendet damit der Arduino weiß wo die Motoren stehen und wo sie eigentlich stehen solten

Wert1 = aktuelle Position
Wert2 = neue Position

P bedeutet: Alle Daten nach dem ersten Wert haben ein P vorne dran dahinter steht der neue Wert auf den die Motoren sich einstellen sollen

E bedeutet: Einstellen um die Motoren auf nul zu stellen

Wert3 = Schritte die Motor1 Machen muß um auf 0 zu kommen

Wert4 = Schritte die Motor2 machen muß um auf 0 zu kommen

Leider funktioniert das nur mit dem 1 Datensatz(mit A vornedran) also beim Programmstart.
Bei den anderen kommt keine Reaktion. Was mir völlig unerklärlich ist.

Hier der Arduino Code:

Code:

#include <AH_28BYJ48.h>

const int stepsPerRevolution = 64*64;

float x ;
float y ;
int Schritte1;
int Schritte2;
int neu;
int current;
int diff;

AH_28BYJ48 step100(stepsPerRevolution, 2,3,4,5);
AH_28BYJ48 step1000(stepsPerRevolution, 8,9,10,11);


void setup() {
 Serial.begin(9600);
 
 
}

void loop() {
  if (Serial.available()){
   
    
    if (Serial.find("A")){
     current = Serial.parseInt();
     neu = Serial.parseInt();
     
     diff = neu-current;
     x = diff * 4.096;
     y = x/10;
     Schritte1 = (int)x;
     Schritte2 = (int)y;
     step100.setSpeedHz(1000);
     step1000.setSpeedHz(1000);
     step100.step(Schritte1);
     step1000.step(Schritte2);
    }
    
    
    if (Serial.find("P")) {
      neu = Serial.parseInt();
     diff = neu-current;
     x = diff * 4.096;
     y = x/10;
     Schritte1 = (int)x;
     Schritte2 = (int)y;
     Serial.write(10);
     step100.setSpeedHz(1000);
     step1000.setSpeedHz(1000);
     step100.step(Schritte1);
     step1000.step(Schritte2);
     current = neu; 
   }
  
  if (Serial.find("E")){
    Schritte1 = Serial.parseInt();
    Schritte2 = Serial.parseInt();
    Serial.write(12);
     step100.setSpeedHz(1000);
     step1000.setSpeedHz(1000);
     step100.step(Schritte1);
     step1000.step(Schritte2);
   
   } 
  }  
  
}

[Union]

Lies Dir mal die Dokumentation durch. Serial.Find() liest die Daten bis der String gefunden wird. Das machst Du 3 Mal. Besser wäre ja wohl ein Zeichen zu lesen und dieses dann abzufragen und abhängig davon zu verzweigen. Denn wenn Du das 'A' nicht findest, steht der Zeiger ja am Ende des Puffers. Des weiteren wäre wohl eine Stream-Struktur à la char ID, byte Len, Data[Len] angebracht sonst hast Du irgendwann Probleme.

[fox67]

Ah ok da lag also der Fehler ich habe das ganze etwas umgeschrieben. Jetzt funktioniert es. Vielen Dank

Code:

#include <AH_28BYJ48.h>

const int stepsPerRevolution = 64*64;

float x ;
float y ;
int Schritte1;
int Schritte2;
int neu;
int current;
int diff;
int a;
int Zeiger1;
int Zeiger2;
int aktuell;

AH_28BYJ48 step100(stepsPerRevolution, 2,3,4,5);
AH_28BYJ48 step1000(stepsPerRevolution, 8,9,10,11);


void setup() {
 Serial.begin(9600);
 
 
}

void loop() {
  if (Serial.available()){
    
    
    if (Serial.find("P")){
     a = Serial.parseInt();
     aktuell = Serial.parseInt();
     neu = Serial.parseInt();
     Zeiger1 = Serial.parseInt();
     Zeiger2 = Serial.parseInt();
    
    switch(a){
     
     case 1:     
     current = aktuell;
     diff = neu-current;
     x = diff * 4.096;
     y = x/10;
     Schritte1 = (int)x;
     Schritte2 = (int)y;
     step100.setSpeedHz(1000);
     step1000.setSpeedHz(1000);
     step100.step(Schritte1);
     step1000.step(Schritte2);
     current = neu;
     break;
     case 2:
      diff = neu-current;
     x = diff * 4.096;
     y = x/10;
     Schritte1 = (int)x;
     Schritte2 = (int)y;
     Serial.write(10);
     step100.setSpeedHz(1000);
     step1000.setSpeedHz(1000);
     step100.step(Schritte1);
     step1000.step(Schritte2);
     current = neu; 
     break;
     case 3:
      
     step100.setSpeedHz(1000);
     step1000.setSpeedHz(1000);
     step100.step(Zeiger1);
     step1000.step(Zeiger2);
     break;
     
     default:
     break;
    }
    }
    
    
   
  }  
  
}

[Union]

Es wäre auch besserer Stil nicht alles direkt in loop zu schreiben, sondern das in eine procedure auszulagern. Falls Du in der Hauptschleife noch mehr machen möchtest, wird es ansonsten schnell unübersichtlich.