Differences
This shows you the differences between two versions of the page.
|
pm:prj2022:avaduva:robot4wd [2022/05/27 23:23] mihai.cojocaru2510 [Bibliografie/Resurse] |
pm:prj2022:avaduva:robot4wd [2022/06/02 10:19] (current) mihai.cojocaru2510 [Descriere generală] |
||
|---|---|---|---|
| Line 12: | Line 12: | ||
| **Schema bloc** | **Schema bloc** | ||
| - | {{:pm:prj2022:avaduva:diagramarobot.png?700|}} | + | {{:pm:prj2022:avaduva:diagrama_electrica_robot.png?700|}} |
| ===== Hardware Design ===== | ===== Hardware Design ===== | ||
| Line 40: | Line 40: | ||
| ===== Download ===== | ===== Download ===== | ||
| - | + | <note important> | |
| - | <note> | + | {{:pm:prj2022:avaduva:obstacle_robot.rar|}} |
| </note> | </note> | ||
| Line 60: | Line 60: | ||
| ===== Cod ===== | ===== Cod ===== | ||
| - | #include <NewPing.h> | + | #include <NewPing.h> |
| - | const int LF = 6; | + | const int RF = 6; |
| - | const int LB = 7; | + | const int RB = 7; |
| - | const int RF = 5; | + | const int LF = 5; |
| - | const int RB = 4; | + | const int LB = 4; |
| #define trig 12 | #define trig 12 | ||
| Line 78: | Line 78: | ||
| void setup(){ | void setup(){ | ||
| + | pinMode(LF, OUTPUT); | ||
| pinMode(RF, OUTPUT); | pinMode(RF, OUTPUT); | ||
| - | pinMode(LF, OUTPUT); | + | pinMode(RB, OUTPUT); |
| pinMode(LB, OUTPUT); | pinMode(LB, OUTPUT); | ||
| - | pinMode(RB, OUTPUT); | ||
| | | ||
| dist = readPing(); | dist = readPing(); | ||
| Line 131: | Line 131: | ||
| void moveStop(){ | void moveStop(){ | ||
| | | ||
| - | digitalWrite(RF, LOW); | ||
| digitalWrite(LF, LOW); | digitalWrite(LF, LOW); | ||
| - | digitalWrite(RB, LOW); | + | digitalWrite(RF, LOW); |
| digitalWrite(LB, LOW); | digitalWrite(LB, LOW); | ||
| + | digitalWrite(RB, LOW); | ||
| } | } | ||
| Line 143: | Line 143: | ||
| check=true; | check=true; | ||
| | | ||
| - | digitalWrite(LF, HIGH); | ||
| digitalWrite(RF, HIGH); | digitalWrite(RF, HIGH); | ||
| - | digitalWrite(RB, LOW); | + | digitalWrite(LF, HIGH); |
| - | digitalWrite(LB, LOW); | + | digitalWrite(LB, LOW); |
| + | digitalWrite(RB, LOW); | ||
| } | } | ||
| } | } | ||
| Line 154: | Line 154: | ||
| check=false; | check=false; | ||
| - | digitalWrite(LF, LOW); | ||
| digitalWrite(RF, LOW); | digitalWrite(RF, LOW); | ||
| - | digitalWrite(RB, HIGH); | + | digitalWrite(LF, LOW); |
| - | digitalWrite(LB, HIGH); | + | digitalWrite(LB, HIGH); |
| + | digitalWrite(RB, HIGH); | ||
| | | ||
| } | } | ||
| Line 163: | Line 163: | ||
| void turnRight(){ | void turnRight(){ | ||
| - | digitalWrite(LF, HIGH); | + | digitalWrite(RF, HIGH); |
| - | digitalWrite(RB, HIGH); | + | digitalWrite(LB, HIGH); |
| | | ||
| - | digitalWrite(LB, LOW); | + | digitalWrite(RB, LOW); |
| - | digitalWrite(RF, LOW); | + | digitalWrite(LF, LOW); |
| | | ||
| delay(500); | delay(500); | ||
| Line 179: | Line 179: | ||
| | | ||
| | | ||
| - | } | ||
| - | |||
| - | void turnLeft(){ | ||
| - | |||
| - | digitalWrite(LB, HIGH); | ||
| - | digitalWrite(RF, HIGH); | ||
| - | | ||
| - | digitalWrite(LF, LOW); | ||
| - | digitalWrite(RB, LOW); | ||
| - | |||
| - | delay(500); | ||
| - | | ||
| - | digitalWrite(LF, HIGH); | ||
| - | digitalWrite(RF, HIGH); | ||
| - | | ||
| - | digitalWrite(LB, LOW); | ||
| - | digitalWrite(RB, LOW); | ||
| } | } | ||
| ===== Concluzii ===== | ===== Concluzii ===== | ||
