Bouw de Simpelste Arduino Volg-robot met SparkFun L298

Onderdelen en Benodigdheden

Benodigde Tools en Machines

• Lijmpistool (generisch)
• Schroevendraaier
• Lijn-volgend Robot Kit

Apps en Online Diensten

• Arduino IDE

Over dit Project

Een lijn-volgend robot is de "Hello World" van de robotica. Deze lijnvolger is heel simpel en makkelijk te bouwen.

Code

Arduino Gebaseerde Lijnvolger Robot (C/C++)

/*------- Definiëren Inputs -------*/
#define LS 2  // Linker sensor
#define RS 5  // Rechter sensor

/*------- Definiëren Outputs -------*/
#define LM1 11 // Linker motor
#define LM2 10 // Linker motor
#define RM1 9  // Rechter motor
#define RM2 6  // Rechter motor

void setup() {
  pinMode(LS, INPUT);
  pinMode(RS, INPUT);
  pinMode(LM1, OUTPUT);
  pinMode(LM2, OUTPUT);
  pinMode(RM1, OUTPUT);
  pinMode(RM2, OUTPUT);
}

void loop() {
  if ((digitalRead(LS) == LOW) && (digitalRead(RS) == LOW)) // Conditie 1: Stop
    MoveForward();
  
  if ((digitalRead(LS) == HIGH) && (digitalRead(RS) == HIGH)) // Conditie 2: Vooruit
    Stop();
  
  if ((digitalRead(LS) == LOW) && (digitalRead(RS) == HIGH)) // Rechts
    TurnLeft();
  
  if ((digitalRead(LS) == HIGH) && (digitalRead(RS) == LOW)) // Links
    TurnRight();
}

void MoveForward() {
  analogWrite(LM1, 50); analogWrite(LM2, 0);
  analogWrite(RM1, 50); analogWrite(RM2, 0);
  delay(20);
}

void TurnRight() {
  analogWrite(LM1, 0); analogWrite(LM2, 60);
  analogWrite(RM1, 60); analogWrite(RM2, 0);
  delay(30);
}

void TurnLeft() {
  analogWrite(LM1, 60); analogWrite(LM2, 0);
  analogWrite(RM1, 0); analogWrite(RM2, 60);
  delay(30);
}

void Stop() {
  analogWrite(LM1, 0); analogWrite(LM2, 0);
  analogWrite(RM1, 0); analogWrite(RM2, 0);
  delay(20);
}

Schema's