Robo România

Robot Kit 2WD Urmărire linie Modul cu 5 senzori TCRT - Line Following

Robot Kit 2WD Urmărire linie Modul cu 5 senzori TCRT – Line Following

Conţinut:
Placă de dezvoltare UNO R3 cu cablu USB.
Șasiu robot 2WD(mașina).
Modul senzor urmărire linie cu 5 TCRT5000 – Line Following.
Modul driver motoare L298N.
Suport baterii 4AA.
Suport baterii 6AA.
Cabluri Dupont 20 bucăţi mama-tata.
Pilon Metal M3 30mm 3 bucăţi.
Pilon Metal M3 15..20mm 8 bucăţi.
Piuliță M3 11 bucăţi.
Șurub M3x10 11 bucăţi.

Atenție mare la montare la legăturile electrice, în special la „+” adică Vcc și „-” adică GND

 

YouTube : (Atenție: Aceste tutoriale sunt exemple, pentru concurs trebuie să vă puneți imaginația și priceperea la lucru)

Cum asamblam șasiul 2WD Robot Smart Car Chassis

Un cod exemplu :

// Robot Line Follower – folosim 4 Sensori din modulul de 5 //
// roboromania.ro

// motor1 și motor2 = motor dreapta
// motor3 și motor4 = motor stânga
const int motor1 = 7;
const int motor2 = 6;
const int motor3 = 5;
const int motor4 = 4;

// roboromania.ro
// inițializare ppi a senzorilor de linie 1 la 4
// sensor1 și snsor2 = sensor dreapta
// sensor3 și sensor4 = sensor stânga
const int sensor1 = A5;
const int sensor2 = A4;
const int sensor3 = A3;
const int sensor4 = A2;

// iniţializarea pin speed motor
// obligatoriu pin PWM
const int pinSpeed = 9;

// iniţializarea variabile data 1 până la 4
int data1, data2, data3, data4;

// inițializează valoarea vitezei motor
// valoare 0 până la 255
int speedMotor = 255;
void setup()
{
pinMode(motor1, OUTPUT);
pinMode(motor2, OUTPUT);
pinMode(motor3, OUTPUT);
pinMode(motor4, OUTPUT);

pinMode(sensor1, INPUT);
pinMode(sensor2, INPUT);
pinMode(sensor3, INPUT);
pinMode(sensor4, INPUT);

pinMode(pinSpeed, OUTPUT);
}

void loop ()
{
// citirea senzorilor
// logic LOW/HIGH
data1 = digitalRead(sensor1);
data2 = digitalRead(sensor2);
data3 = digitalRead(sensor3);
data4 = digitalRead(sensor4);

// reglarea vitezei motorului
analogWrite(pinSpeed, speedMotor);
if (data1 == LOW && data2 == LOW && data3 == LOW && data4 == LOW)
{
//inainte
digitalWrite(motor1, HIGH);
digitalWrite(motor2, LOW);
digitalWrite(motor3, HIGH);
digitalWrite(motor4, LOW);
}

else if (data1 == HIGH && data2 == HIGH && data3 == HIGH && data4 == LOW)
{
//dreapta
digitalWrite(motor1, LOW);
digitalWrite(motor2, HIGH);
digitalWrite(motor3, HIGH);
digitalWrite(motor4, LOW);
}

else if (data1 == LOW && data2 == HIGH && data3 == HIGH && data4 == HIGH)
{
//stânga
digitalWrite(motor1, HIGH);
digitalWrite(motor2, LOW);
digitalWrite(motor3, LOW);
digitalWrite(motor4, HIGH);
}

else if (data1 == HIGH && data2 == HIGH && data3 == LOW && data4 == LOW)
{
//dreapta
digitalWrite(motor1, LOW);
digitalWrite(motor2, HIGH);
digitalWrite(motor3, HIGH);
digitalWrite(motor4, LOW);
}

else if (data1 == LOW && data2 == LOW && data3 == HIGH && data4 == HIGH)
{
//stânga
digitalWrite(motor1, HIGH);
digitalWrite(motor2, LOW);
digitalWrite(motor3, LOW);
digitalWrite(motor4, HIGH);
}

else if (data1 == HIGH && data2 == LOW && data3 == LOW && data4 == LOW)
{
//dreapta
digitalWrite(motor1, LOW);
digitalWrite(motor2, HIGH);
digitalWrite(motor3, HIGH);
digitalWrite(motor4, LOW);
}

else if (data1 == LOW && data2 == LOW && data3 == LOW && data4 == HIGH)
{
//stânga
digitalWrite(motor1, HIGH);
digitalWrite(motor2, LOW);
digitalWrite(motor3, LOW);
digitalWrite(motor4, HIGH);
}

else if (data1 == HIGH && data2 == LOW && data3 == HIGH && data4 == LOW)
{
//dreapta
digitalWrite(motor1, LOW);
digitalWrite(motor2, HIGH);
digitalWrite(motor3, HIGH);
digitalWrite(motor4, LOW);
}

else if (data1 == LOW && data2 == HIGH && data3 == LOW && data4 == HIGH)
{
//stânga
digitalWrite(motor1, HIGH);
digitalWrite(motor2, LOW);
digitalWrite(motor3, LOW);
digitalWrite(motor4, HIGH);
}

else if (data1 == LOW && data2 == HIGH && data3 == LOW && data4 == LOW)
{
//dreapta
digitalWrite(motor1, LOW);
digitalWrite(motor2, HIGH);
digitalWrite(motor3, HIGH);
digitalWrite(motor4, LOW);
}

else if (data1 == LOW && data2 == LOW && data3 == HIGH && data4 == LOW)
{
//stânga
digitalWrite(motor1, HIGH);
digitalWrite(motor2, LOW);
digitalWrite(motor3, LOW);
digitalWrite(motor4, HIGH);
}

else if (data1 == LOW && data2 == HIGH && data3 == HIGH && data4 == LOW)
{
//inainte
digitalWrite(motor1, HIGH);
digitalWrite(motor2, LOW);
digitalWrite(motor3, HIGH);
digitalWrite(motor4, LOW);
}

else if (data1 == HIGH && data2 == HIGH && data3 == HIGH && data4 == HIGH)
{
//inainte
digitalWrite(motor1, HIGH);
digitalWrite(motor2, LOW);
digitalWrite(motor3, HIGH);
digitalWrite(motor4, LOW);
}
// roboromania.ro
}

 

sau click alt exemplu