Sensorgesteuertes Auto mit Arduino Uno

[vangola]

Danke für deine Antwort/ Hilfe Peter(TOO)

so habe ich es auch mal ausprobiert, jedoch fuhr/fährt es die ganze Zeit gegen die Wand ohne etwas dagegen zu unternehmen.
Ich habe auch jetzt deinen beispielcode eingefügt und es fährt immer noch gegen die wand.

EDIT:

So ich hab da etwas angepasst und es geht doch einigermaßen, jedoch glaube ich dass die Geschwindigkeit der Motoren etwas zu hoch ist, wäre es vll über PWM zu lösen?
MfG Vangola

[Peter(TOO)]

Hallo Vangola,

Du postest hier halt auch nur halbe Wahrheiten und nicht deinen Ganzen Code!

Ich habe gerade gesehen, dass da mal cm und cm3 als Variable zu sehen ist ......

MfG Peter(TOO)

[vangola]

Ich habe für jeden Sensor eigene Abstandsvariable angelegt. (Ist es etwa falsch?)

// Sensor Links
long laengelinks;
long cm2;
// Sensor Vorne
long laengevorne;
long cm;
// Sensor Rechts
long laengerechts;
long cm3;
// Motor Rechts
const int Motor1Pin1 = 1;
const int Motor1Pin2 = 0;
//Motor Links
const int Motor2Pin1 = 2;
const int Motor2Pin2 = 3;

//int Abstand = 10;

void setup()

{
  // Sensor PINS
//  Serial.begin (9600);
  pinMode(11,OUTPUT);
  pinMode(10,INPUT);
  pinMode(12,OUTPUT);
  
  pinMode(8,OUTPUT);
  pinMode(9,INPUT);
  pinMode(7,OUTPUT);
  
  pinMode(5,OUTPUT);
  pinMode(6,INPUT);
  pinMode(4,OUTPUT);

  // Motor PINS
  pinMode(Motor1Pin1, OUTPUT);   
  pinMode(Motor1Pin2, OUTPUT);   
  pinMode(Motor2Pin1, OUTPUT);   
  pinMode(Motor2Pin2, OUTPUT); 

//  pinMode(13,OUTPUT);
}

void loop()
{

  
   scanvorne();
  if (cm >= 20)
    {
      GoForward();
      delay(300);
    }
  else
    {
      Stop(); 

      scanlinks();
      if (cm >= 20)
        {
          GoLeft();
          delay(250);
        }
      else
        {
          Stop();

          scanrechts();
          if (cm3 >= 20)
            {
               GoRight();
               delay(250);
             }
          else
            {
               Stop();
            }
        }
    }

}




// Sensor Steuerung
void scanvorne()

{
  digitalWrite(12,HIGH);
  
 
  digitalWrite(11,HIGH);
  delayMicroseconds(1000);
  digitalWrite(11,LOW);
  
  laengevorne = pulseIn(10,HIGH);
  
  cm = (laengevorne/2)/29.1;
  
  Serial.print(cm);
  Serial.println("cm1");
  
  
  
}
void scanlinks()

{
  digitalWrite(7,HIGH);
  

  digitalWrite(8,HIGH);
  delayMicroseconds(1000);
  digitalWrite(8,LOW);
  
  laengelinks = pulseIn(9,HIGH);
  
  cm2 = (laengelinks/2)/29.1;
  
  Serial.print(cm2);
  Serial.println("cm2");
  
 
  
}

void scanrechts()

{
  digitalWrite(4,HIGH);
  
  
  digitalWrite(5,HIGH);
  delayMicroseconds(1000);
  digitalWrite(5,LOW);
  
  laengerechts = pulseIn(6,HIGH);
  
  cm3 = (laengerechts/2)/29.1;
  
  Serial.print(cm3);
  Serial.println("cm3");
  
  
  
}

//Motoren Steuerung

void GoForward(){
   
  digitalWrite(Motor1Pin1, HIGH);
  digitalWrite(Motor2Pin1, HIGH);
  digitalWrite(Motor2Pin2, LOW);
  digitalWrite(Motor1Pin2, LOW);
}

void GoBackward(){
  
  digitalWrite(Motor1Pin1, LOW);
  digitalWrite(Motor1Pin2, HIGH);
  digitalWrite(Motor2Pin1, LOW);
  digitalWrite(Motor2Pin2, HIGH);

}

void GoLeft(){
  
  digitalWrite(Motor1Pin1, HIGH);
  digitalWrite(Motor1Pin2, LOW);
  digitalWrite(Motor2Pin1, LOW);
  digitalWrite(Motor2Pin2, LOW);
}

void GoRight(){
  digitalWrite(Motor2Pin2, LOW);
  digitalWrite(Motor2Pin1, HIGH);
  digitalWrite(Motor1Pin1, LOW);
  digitalWrite(Motor1Pin2, LOW);
}

void Stop(){
  digitalWrite(Motor1Pin2, LOW);
  digitalWrite(Motor1Pin1, LOW);
  digitalWrite(Motor2Pin1, LOW);
  digitalWrite(Motor2Pin2, LOW);
}

[Peter(TOO)]

Hallo,

Ich habe für jeden Sensor eigene Abstandsvariable angelegt. (Ist es etwa falsch?)

Nach Scanlinks() fragst du aber cm ab, also den Wert von Vorn !!

MfG Peter(TOO)

[vangola]

Hallo,

ja das hab ich auch eben gesehen und korrigiert, danke dir.
Das fährt jetzt einwandfrei, aber wie du es auch gemeint hast, hat es einen Linksdrall.
Ich überlege gerade wie man es macht damit es den Weg mit dem größten Abstand nimmt.

MfG Vangola

[Peter(TOO)]

if ( (cm2 >= 10) && (cm2 >= 10) )  // links und rechts min. 10cm frei
  {
    If (cm2 > cm3)
      Links();
    else
       Rechts();
  }

[Rabenauge]

So richtig wird das mit deinem Aufbau nicht funktionieren, denn die Sensoren haben nicht genug Öffnungswinkel (grob zwischen 15 und 25 Grad).
Das heisst, du hast Bereiche (schräg nach vorn) die gar nicht erfasst werden.
Besser wärs, zwei Sensoren schräg nach vorn zu richten, und zwar so, dass sich beide in der Mitte "überlappen", dann kannst du feststellen ob genau vor dem Roboter alles frei ist (sogar ziemlich genau, da du beide Sensoren auswerten kannst) und auch, in welche Richtung mehr Platz ist.
Der Haken dabei ist dann: das braucht Zeit, da du die Sensoren nacheinander permanent abfragen musst. Da kann man noch bisschen tricksen: bei Gradeausfahrt nur einen benutzen, und _wenn_ der nen Ping bekommt, den anderen fragen, ob er auch was sieht.

Wenn man das gut justiert (so dass sich die Erfassungsbereiche grad um die Breite des Roboters überlappen) dürfte man ziemlich gut auch schmale Lücken noch "vermessen" können. Man muss ja nicht die komplette Reichweite benutzen (die Dinger reagieren auf bis zu 5m).