Hallo Bernd,
danke für den Tipp aus der Praxis! Du hast recht: Mit einem Sensor pendelt das Fahrzeug im Zickzack an der Linienkante entlang. Das ist gewollt, weil es den Einstieg so einfach wie möglich macht. Wer mehr will, ist mit dem IR Liniensensor 3-fach gut bedient. Deine Gewichtung mit Zweierpotenzen ist dafür ein schöner Kniff: Jedes Sensormuster ergibt genau eine Zahl, und das Programm kann für jede Zahl eine passende Lenkbewegung wählen.
Funduino Team
Chassis with line tracking for Arduino
FunduinoLast updated on
Ein Roboterfahrzeug einer schwarzen Linie folgen lassen
You need this
Funduino UNO R3 Mikrocontroller - ATmega328P, 16 MHz, für Arduino
13,90 € *Item no. F23107480About the product — Funduino UNO R3 Mikrocontroller - ATmega328P, 16 MHz, für Arduino
Chassis Komplettset - 2 Getriebemotoren, Räder, Batteriefach
34,90 € *Item no. F23105900About the product — Chassis Komplettset - 2 Getriebemotoren, Räder, Batteriefach
L298N Motortreiber - H-Brücke für 2 DC-Motoren, 5-35 V
3,22 € *Item no. F23107161About the product — L298N Motortreiber - H-Brücke für 2 DC-Motoren, 5-35 V
TCRT5000 Reflexsensor 90° - Infrarot, 1-50 mm, 3,3-5 V
1,69 € *Item no. F23107303About the product — TCRT5000 Reflexsensor 90° - Infrarot, 1-50 mm, 3,3-5 V
Batteriefach 6x AA - 9 V Ausgang, Clip-Anschluss
1,59 € *Item no. F23108808About the product — Batteriefach 6x AA - 9 V Ausgang, Clip-Anschluss
Breadboard 830 Kontakte - Steckbrett für Arduino, lötfrei
2,90 € *Item no. FUN-1010553About the product — Breadboard 830 Kontakte - Steckbrett für Arduino, lötfrei
Breadboardkabel männlich-männlich - 40 Stück, 20 cm
1,74 € *Item no. FUN-1010558About the product — Breadboardkabel männlich-männlich - 40 Stück, 20 cm
All 7 parts together 59,94 € *Ready to ship immediately · Delivery time: 1-3 business days
* All prices include statutory VAT, plus shipping costs.
Material
Prerequisite: the chassis is assembled.
Structure
How line following works
The sketch
Sketch: Follow the line
int GS = 200; // Geschwindigkeit der Motoren. Moeglich sind Werte von 0 bis 255.
int DWert; // Variable fuer den ausgelesenen digitalen Wert
// Gleichstrommotor 1 = LINKS
int GSM1 = 10; // Enable-Pin: steuert die Drehgeschwindigkeit des linken Motors
int in1 = 9; // Ueber in1 und in2 wird die Drehrichtung des linken Motors gesteuert
int in2 = 8;
// Gleichstrommotor 2 = RECHTS
int GSM2 = 5; // Enable-Pin: steuert die Drehgeschwindigkeit des rechten Motors
int in3 = 7; // Ueber in3 und in4 wird die Drehrichtung des rechten Motors gesteuert
int in4 = 6;
int Sensor = 2; // Pin, an dem der Liniensensor ausgelesen wird
void setup()
{
Serial.begin(9600);
pinMode(GSM1, OUTPUT);
pinMode(GSM2, OUTPUT);
pinMode(in1, OUTPUT);
pinMode(in2, OUTPUT);
pinMode(in3, OUTPUT);
pinMode(in4, OUTPUT);
pinMode(Sensor, INPUT);
}
void loop()
{
DWert = digitalRead(Sensor); // Digitalen Wert am Sensor auslesen
// Zur Kontrolle: der Wert wird an den Seriellen Monitor geschickt
Serial.print("Wert: ");
Serial.println(DWert);
if (DWert == 1) // Weisser Untergrund erkannt ...
{
// ... dann laeuft nur der linke Motor und das Fahrzeug dreht nach rechts,
// also zurueck in Richtung Linie.
analogWrite(GSM1, GS);
digitalWrite(in1, HIGH); // Vorwaerts. Rueckwaerts waere in1 LOW und in2 HIGH.
digitalWrite(in2, LOW);
// Der rechte Motor steht still: beide Richtungspins auf LOW.
digitalWrite(in3, LOW);
digitalWrite(in4, LOW);
}
if (DWert == 0) // Schwarzer Untergrund erkannt ...
{
// ... dann laeuft nur der rechte Motor und das Fahrzeug dreht nach links,
// also wieder an die Kante der Linie heran.
analogWrite(GSM2, GS);
digitalWrite(in3, HIGH);
digitalWrite(in4, LOW);
// Der linke Motor steht still.
digitalWrite(in1, LOW);
digitalWrite(in2, LOW);
}
}Rate the instructions
Comments
2 postsLieber gleich mehrere Sensoren einsetzen. Das Dreiermodul im Sortiment ist klasse. Fünf ist noch besser. Wenn man die Werte der Sensoren von links nach rechts mit den Zweierpotenzen gewichtet, kann man viel bessere Fahrbefehle vorgeben.