My Robot
-1 x ARDUINO UNO
-1 x TAMIYA UNIVERSAL PLATTAN uppsättning
-1 x TAMIYA TRACK & rullar UPPSÄTTNINGEN
-1 x TAMIYA MOTOR växellåda
-1 x L298 Dual H-Bridge Motor Driver
-1 x 9g Servo
-1 x IR-Sharp Sensor
-Plexiglas
-1 x SPDT Switch
-Några kablar
-Limpistol
-3 x 9 v batteri
-1 x Test PCB
-1 x L0875
-1 x 1uf kondensator
-1 x 10uf kondensatorn
Arduino kod:
#include
Servo MS;
int en = 4;
int b = 5;
int c = 6;
int d = 7.
int x;
int pos = 0;
void setup()
{
Serial.BEGIN(9600);
pinMode(a,OUTPUT);
pinMode(b,OUTPUT);
pinMode(c,OUTPUT);
pinMode(d,OUTPUT);
MS.attach(3);
}
void loop()
{
int S;
int F;
int D;
int sensorValue = analogRead(A2);
flyta vol = sensorValue * (5.0 / 1023.0);
Serial.println(Vol);
om (vol > = 0,7)
{
MS.write(0);
POS = 0;
Delay(500);
Serial.println(POS);
MS.write(90);
POS = 90.
Delay(500);
Serial.println(POS);
MS.write(180);
POS = 180;
Delay(500);
Serial.println(POS);
MS.write(90);
POS = 90.
Delay(500);
Serial.println(POS);
om (pos == 0 & & vol > = 0,7)
{
S = 1;
}
om (pos == 0 & & vol < = 0,7)
{
S = 0;
}
om (pos == 90 & & vol > = 0,7)
{
F = 1;
}
om (pos == 90 & & vol < = 0,7)
{
F = 0;
}
om (pos == 180 & & vol > = 0,7)
{
D = 1.
}
om (pos == 180 & & vol < = 0,7)
{
D = 0;
}
om (S == 0 & & F == 1 & & D == 1)
{
digitalWrite (en, hög);
digitalWrite b, låga.
digitalWrite (c, låg).
digitalWrite d, hög.
}
om (S == 1 & & F == 0 & & D == 1)
{
digitalWrite (en, låg);
digitalWrite b, låga.
digitalWrite (c, låg).
digitalWrite d, låg.
}
om (S == 1 & & F == 1 & & D == 0)
{
digitalWrite (en, låg);
digitalWrite b, hög.
digitalWrite (c, hög).
digitalWrite d, låg.
}
om (S == 1 & & F == 1 & & D == 1)
{
digitalWrite (en, hög);
digitalWrite b, låga.
digitalWrite (c, hög).
digitalWrite d, låg.
}
Serial.println (S);
Serial.println(F);
Serial.println(D);
}
om (vol < = 0,7)
{
MS.write(90);
digitalWrite (en, låg);
digitalWrite b, hög.
digitalWrite (c, låg).
digitalWrite d, hög.
}
}
PIN conecttion:
L298N:
-pin-1, 8, 15 till gnd arduino och 9v batteri anod;
-stift 2, 3 till motor 1;
-stift 13, 14 till motor 2.
-pin 4, 6, 9, 11 till batteriets katod
-pin 5, 7, 10, 12 till arduino digital stift (digital pin 4, 5, 6, 7);
Servo:
-gnd till arduino gnd;
-röd tråd till 5v arduino;
-vit tråd (signal) till digitala stift 3 arduino;
IR-Sharp Sensor:
-gnd till arduino gnd;
-röd tråd till 5v arduino;
-vit tråd (signal) till analoga pin A2 arduino