Motorsteuerung über Sensorik

[zerebrator]

Super danke damit kann ich was anfangen. vor allem die Anweisungen.

Falls das nicht allzu viel ist hätte ich noch eine zusätzliche Frage

Kann ich das ganze auf einen Kompasssensor übertragen.?
Und zwar dieser gibt mir ebenso ständig die Position aus:

  /////////////////////////////////////////////////////////////
  //     Kompass Modul Abfrage und senden der Daten         ///
  ////////////////////////////////////////////////////////////
  
  byte byteHigh, byteLow; // byteHigh / byteLow für Bearing
  char pitch, roll;       // Pitch und Roll
  int bearing;            // Bearing

  Wire.beginTransmission(CMPS10Addr); // Kommunikation mit CMPS10
  Wire.write(2);                      // Start Register (2)
  Wire.endTransmission();
  Wire.requestFrom(CMPS10Addr , 4); // Abfrage von 4 Bytes vom CMPS10
  while (Wire.available() < 4); // Warten, bis 4 Bytes verfügbar
  byteHigh = Wire.read();       // High-Byte für Bearing speichern
  byteLow = Wire.read();        // Low-Byte für Bearing speichern
  pitch = Wire.read();          // Byte für Pitch speichern
  roll = Wire.read();           // Byte für Roll speichern
  bearing = ((byteHigh << 8) + byteLow) / 10; // Bearing berechnen
  
  sendData(bearing, pitch, roll);             // Daten versenden

void sendData(int bearing, int pitch, int roll) {
  String data = String(bearing) + ";" + String(pitch) + ";" + String(roll);
  
  lcd.setCursor(0,0);
    lcd.print("bear-pitch-roll");
    lcd.setCursor(0,1);
    lcd.print(data);
   
  
 // Serial.println(data);
delay (100);
}

Bearing ist für mich interessant.

Hier möchte ich unabhängig von Wert ( es kann ja im raum der Wert zwischen 0 und 360° vorliegen) bei finden eines Gegenstandes mit den vorher beschriebenen Sonar Sensor um 90° gedreht werden .

Wie wäre hier dein Ansatz ?

1000 dank nochmal

[i_make_it]

Ein Kompaßsensor kann keine Position mitteilen sondern nur einen Winkel zwichen seiner Ausrichtung und der Nordweisung.
Von dem was ich sehe vermute ich mal Das du keinen Kompass sondern ein 3DOF Mems oder Magnetometer Gyroskop hast.
Da mußt Du Dich dann auch noch um Drift etc. kümmern, sonst wird es über die Laufzeit immer lustiger.

Erst mal mußt Du unterscheiden können ob Hinderniss oder Gegenstand (wenn du nur beim Finden eines Gegenstandes so reagieren willst und nicht bei jedem Hinderniss).

vom Rechnen her ist das einfach. Wenn du schon Winkelgrad hast, dann mußt Du ja nur 90° addieren oder subtrahieren (je nach dem ob du links oder rechts Drehen willst).
Ist das Ergebniss gößer 360° ziehst du 360° ab.
Ist das Ergebniss kleiner 0° addierst du 360°.
Dann ist das Ergebniss immer im gültigen Wertebereich.

Du nimmst also vor der Drehung dein Sensorwert, führts die Berechnung aus und übergibst das Ergebniss einer Variablen.
Dann kannst Du den aktuellen Sensorwert mit der Variablen vergleichen und beim Drehen z.B. bei einer Differenz kleiner 10° und kleiner 3° jeweils die Geschwindigkeit senken, damit daraus kein endloses Hinundherdrehen wird, weil er nie das Ergebniss trifft.
Geht dann auch wieder mit IF oder CASE.

[zerebrator]

Sorry habe mich natürlich falsch ausgedrückt . Du hast vollkommen Recht es geht hier um den Winkel der ausgegeben wird. Und der Sensor ist ein CPMS10 mit Magnetometer Tilt Compensated und Gyro modul usw.
Es ist auch absolut richtig was du weiterhin beschreibst das hin und herdrehen nervt und hier liegt mein Problem ...
Wie kann ich das Codetechnisch lösen ?

Habe absolut keine Idee wie ich das in einer if Anweisung lösen soll
Sprich uS1 sieht etwas bei 15 cm dann Lese bearing ein, drehe solange bis du + 90° ( + Toleranz) erreicht hast, dann weiter gerade aus ?

ich krieg das nicht hin
Wie würdest du das Code technisch lösen ?

[i_make_it]

Sprich uS1 sieht etwas bei 15 cm dann Lese bearing ein, drehe solange bis du + 90° ( + Toleranz) erreicht hast, dann weiter gerade aus ?

Das wird gerinfügig komlizierter.

In dem von mir Skizzierten Konstrukt dreht er ja bis die Bedingung des us-Sensors nicht mehr erfüllt ist.
Jetzt hast Du ja us-Sensor Bedingung erfüllt, Entscheidung der Drehrichtung, Bedingung 90° Drehen setzen
Drehen bis 90° Bedingung erfüllt ist unabhängig davon ob us-Sensor Bedingung weiterhin erfüllt ist.

Der Case Abschnitt, darf also nicht mehr selbst das Dehen ausführen sondern muß variablen setzen, die den Systemzustand speichern und über die dann im nächsten Schritt verhindert wird das der us-Case Teil erneut angesprungen wird dafür aber ein 90° Case Teil.
dort wird dann gedreht bis der Winkel entsprechend klein wird und dann mit geringerer Geschwindigkeit weitergedreht bis der Winkel 0 ist.
Wenn die Bedingugn erfüllt dit, werden die Merker wieder gelöscht und der Teil verlassen.
Dann kann wider normal weitergearbeitet werden.
Das Ziel ist dabei halt so Geschickt die Logik aufzubauen, das man sich nicht in endlosen hin und her Springen verzettelt.

Deshalb macht es Sinn sich vor dem Programmierne zu überlegen wass will man denn alles machen und welche Bedingunge nmüssen erfüllt werden.
Asl zweites mauß man sich darüber im klaren sein, daß, damit Sensoren immer wieder eingelesen werdne können das Programm ständig weiterlaufen muß.
Also Endlosschleife.
Damit wird auch der Code wärend einer Aktion tausende male durchlaufen.
Also wo halte ich wie, welchen Systemzustand fest, und verhindere damit das Entscheidungsbäume während einer Aktion immer wieder durchlaufen werden und sich so Werte verschieben oder Aktionen vorzeitig Terminiert werden, weil Eingangsbedingungen mittleriweile nicht mehr erfüllt sind.

delay sollte im Code nirgendswo vorkommen, sondern durch Timer ersetzt werden. so kann der Code durchlaufen werden und während einer Aktion auch andere Eingaben und Ausgaben verarbeitet werden.
Wenn etwas wirklich genau sein soll, muß man über Interrupts nachdenken.

Unter Umständen kann es notwendig sein den gesammten bisher erstellten Code auf den Prüfstand zu stellen und mit dme auge des neu erworbenen wissens zu überlegen ob ein kompletter Neubau nicht sinnvoller ist um schwächen und ausuferndes Volumen auszubügeln.

Wenn das ganze erst mal zu komplex ist, kannst Du Dir auch Anleien bei UML holen und z.B. auf einem Sück Hartschaum mit kleinen Papierkarten die einzelnen Funkionsblöcke mit Stecknadeln feststecken sowie mit bunten Fäden die Abhängigkeiten (alternativ auch ein UML Programm am Computer) aufzeigen.
Nach und nach eränzt man auf den Karten dan ndie Variabeln und erkennt so ob ein vorrausgehendes Modul die auch liefert oder ob eine Variabel nach dem Setzen auch irgendwo wieder gelöscht wird. Oder als Zombie das System blockiert.

Das dann in Code zu bringen ist dann meist der einfachere Teil, da man da schon den meisten Denksport hinter sich hat und (fast) nur noch auf Syntax achten muß.

[zerebrator]

Hi

Also ich habe das versucht so zu lösen :

else if (taskTrigger==3) { //nach rechts 
   switch (taskStep) {
     case 0:
       digitalWrite(leftMtrDirPin1, LOW);
      digitalWrite(leftMtrDirPin2, LOW);  
      digitalWrite(rightMtrDirPin1, HIGH);
      digitalWrite(rightMtrDirPin2, LOW); 
      analogWrite(leftMtrSpdPin, 255);   //drive the motor
      analogWrite(rightMtrSpdPin, 255);
       
       currentPosition=bearing;
       taskStep++;
       break;
     case 1:
       if (currentPosition= newPosition+90) { 
         taskTrigger=0;
         taskStep=0;  
   
    analogWrite(leftMtrSpdPin, 0);   //stopp the motors
    analogWrite(rightMtrSpdPin, 0);      
       }
   }
 }

vorher kommt die Anweisung :

if (!taskTrigger && (uS2 < 15 & uS3 > 30 )) //abstand kleiner als 15cm und abstand links grösser als 30  
    taskTrigger=1;
    
else if (!taskTrigger && ( uS2 < 15 & uS1 > 30 )) //wenn abstand kleiner als 15 und links groesser als 30 dann rechts
    taskTrigger=2;

else if (!taskTrigger && (uS3 < 16)) //wenn abstand kleiner als 16 dann rechts drehen
    taskTrigger=3;

leider "pulsiert" der Antrieb nur
Es schert ihm nicht was die Werte des kompasmoduls machen.

Ich krieg das nicht hin ....
Warum wartet er nicht bis er um 90° gedreht hat ???

Hat jemand einen Vorschlag ?

Gruß
Chr.

[i_make_it]

if (currentPosition= newPosition+90) {

Syntaxfehler?
http://www.arduino-tutorial.de/category/programmieren/

Arithmetische Operatoren
= Zuweisung a=2*b Weist der linken Seite den Wert auf der Rechten Seite zu.

Vergleichsoperatoren
== Gleichheit a==b Prüft auf Gleichheit.


currentPosition=bearing;
wird bei jedem Durchlauf aktualisiert

und mit dem Inhalt von "newPosition+90" wieder überschrieben.
if (currentPosition= newPosition+90) {

Wo "newPosition" herkommt, wann es mit was gesetzt wird und was sicherstellt das es nur einmal am Anfang einer Drehung gesetzt wird kann ich nicht erkennen.

[zerebrator]

hmm sobald ich es vergleiche läuft er endlos weiter egal wie oft ich ihm um seine eigene Achse drehe ...

Vielleicht zu Erklärung bzw. So wie ich es gemacht habe.
currentPosition bekommt die Werte direkt vom baering aus diesem Code :

  /////////////////////////////////////////////////////////////
  //     Kompass Modul Abfrage und senden der Daten         ///
  ////////////////////////////////////////////////////////////
  
  byte byteHigh, byteLow; // byteHigh / byteLow für Bearing
  char pitch, roll;       // Pitch und Roll
  int bearing;            // Bearing

  Wire.beginTransmission(CMPS10Addr); // Kommunikation mit CMPS10
  Wire.write(2);                      // Start Register (2)
  Wire.endTransmission();
  Wire.requestFrom(CMPS10Addr , 4); // Abfrage von 4 Bytes vom CMPS10
  while (Wire.available() < 4); // Warten, bis 4 Bytes verfügbar
  byteHigh = Wire.read();       // High-Byte für Bearing speichern
  byteLow = Wire.read();        // Low-Byte für Bearing speichern
  pitch = Wire.read();          // Byte für Pitch speichern
  roll = Wire.read();           // Byte für Roll speichern
  bearing = ((byteHigh << 8) + byteLow) / 10; // Bearing berechnen
  
  sendData(bearing, pitch, roll);             // Daten versenden

void sendData(int bearing, int pitch, int roll) {
  String data = String(bearing) + ";" + String(pitch) + ";" + String(roll);
  
  lcd.setCursor(0,0);
    lcd.print("bear-pitch-roll");
    lcd.setCursor(0,1);
    lcd.print(data);
   
  
 // Serial.println(data);
delay (100);
}

currentPosition und newPosition habe ich deklariert mit

int currentPosition;
int newPosition;

in dem Fall ist newPosition = 0 ? oder
wie übergebe ich nur für diese Anweisung die Werte von currentPosition an newPosition ?
denn wenn ich das nach der Initialisierung mache mit newposition=currentposition dann ist doch new Position gleich wie current ,wenn ich dann vergleiche dann wird dieser Zustand, weil er ja dauernd übergeben wird nie erfüllt sein oder ?????

???

[zerebrator]

if (currentPosition= newPosition+90) {

Syntaxfehler?
http://www.arduino-tutorial.de/category/programmieren/

Arithmetische Operatoren
= Zuweisung a=2*b Weist der linken Seite den Wert auf der Rechten Seite zu.

Vergleichsoperatoren
== Gleichheit a==b Prüft auf Gleichheit.


currentPosition=bearing;
wird bei jedem Durchlauf aktualisiert

und mit dem Inhalt von "newPosition+90" wieder überschrieben.
if (currentPosition= newPosition+90) {

Wo "newPosition" herkommt, wann es mit was gesetzt wird und was sicherstellt das es nur einmal am Anfang einer Drehung gesetzt wird kann ich nicht erkennen.

Ja das ist auch mein Schmerz ... keine Ahnung wie ich newPosition initialieseren , übergeben , deklarieren soll....