机器人>> Building-Arduino-Robots-and-Devices>> 返回
项目作者： lastralab

项目描述 ：
MIPT Arduino Devices and Ideas
高级语言： C++
项目地址: git://github.com/lastralab/Building-Arduino-Robots-and-Devices.git


Traffic Light

(Week 1):

Wiring:

screenshot 2017-02-13 09 12 14

Schematics:

screenshot 2017-02-13 10 34 45

Code:

  1. // Author: Niam Moltta
  2. // the setup routine runs once when you press reset:
  3. void setup() {
  4.   // initialize the digital pin as an output.
  5.   pinMode(8, OUTPUT);
  6.   pinMode(10, OUTPUT);
  7.   pinMode(12, OUTPUT);
  9. }
  11. void loop() {
  12.   digitalWrite(8, HIGH);   //red on
  13.   delay(5000);        //eight seconds       
  14.   digitalWrite(8, LOW);    //red off
  15.   digitalWrite(12, HIGH);    //green on           
  16.   delay(5000); //three seconds
  17.   digitalWrite(12, LOW); //green off
  18.   delay(500);
  19.   digitalWrite(12, HIGH); //green on
  20.   delay(500); //one second
  21.   digitalWrite(12, LOW); //green off
  22.   delay(500);
  23.   digitalWrite(12, HIGH); //green on
  24.   delay(500); //one second
  25.   digitalWrite(12, LOW); //green off
  26.   delay(500);
  27.   digitalWrite(12, HIGH); //green on
  28.   delay(500); // one sec
  29.   digitalWrite(12, LOW); //green off
  30.   digitalWrite(10, HIGH); //yellow on
  31.   delay(3000); //three sec
  32.   digitalWrite(10, LOW); //yellow off
  33.   //repeat from the beginning
  37. }

Demo:

Radar

(Week 3)

Build a sonar using arduino, a servo, and a ping and visualize it as a radar with Processing.

it deserved its own repository:
https://github.com/TaniaMol/ArduinoRadar

Ava’s Traffic Intersection

(Week 4):

screenshot 2017-02-10 10 54 37

Instructions:

Vehicle circulation can be blocked by the barrier if the train appears or the pedestrian presses the button for the green light.

The green light button is activated if there is no train approaching, and enough time (9 sec) has passed since the button was last activated.

The green light is activated for 5 seconds, which is followed by an intermittent beep. Then, the green light blinks for 3 seconds and the intermittent beep becomes more frequent. After that, the red light is activated again, and the timer counts the time from 0 to 9 seconds.

If the train appears when the green light is on for pedestrians, the red signal is activated urgently and a continuous beep of a different height can be heard.

You can imagine the intersection happening like this:

screenshot 2017-02-10 13 37 41

Black path is for cars, white & gray path is for the train and brown path is for people to cross.

While the train is passing, the switch cannot request a green light.

When the train comes again, the green light turns off and the red light turns on.

When the photoresistor is bright, that means the train is not passing but when you turn it dark, it means the train is passing.

Wiring:

screenshot 2017-02-12 22 09 27

Schematics:

screenshot 2017-02-13 09 48 36

Code that didn’t work and you are welcome to suggest any improvements:

  1. //Ava's TRAFFIC INTERSECTION
  2. //Author: Niam Moltta
  4. #include <Servo.h>
  5. #define SENSOR A0
  6. #define BUZZER 10
  7. #define BUTTON 9
  8. #define BARRIER 11
  9. #define GREEN 13
  10. #define RED 12
  11. int a = 2;
  12. int b = 3;
  13. int c = 4;
  14. int d = 5;
  15. int e = 6;
  16. int f = 7;
  17. int g = 8;
  18. int count;
  20. Servo myservo;
  22. void setup() {
  24.   pinMode(SENSOR, INPUT); //photoresistor
  25.   pinMode(BUZZER, OUTPUT);
  26.   pinMode(BUTTON, INPUT);
  27.   pinMode(BARRIER, OUTPUT); //servo
  28.   pinMode(GREEN, OUTPUT);
  29.   pinMode(RED, OUTPUT);
  31.   pinMode(a, OUTPUT); //DISPLAY FROM 2 TO 9
  32.   pinMode(b, OUTPUT);
  33.   pinMode(c, OUTPUT);
  34.   pinMode(d, OUTPUT);
  35.   pinMode(e, OUTPUT);
  36.   pinMode(f, OUTPUT);
  37.   pinMode(g, OUTPUT);
  39.   digitalWrite(BUTTON, HIGH);
  41.   myservo.attach(BARRIER);
  43.   Serial.begin(9600);
  44. }
  45. void loop() {
  47.   int Train = analogRead(A0); // Value of photoresistor.
  48.   int Button = digitalRead(BUTTON); // Request for crossing
  50.   Serial.println(Train); 
  51.   delay(5);  //print value to serial 
  53.   switch (count) {
  55.     case 0:
  56.   digitalWrite(a, LOW);
  57.   digitalWrite(b, LOW);
  58.   digitalWrite(c, LOW);
  59.   digitalWrite(d, LOW);
  60.   digitalWrite(e, LOW);
  61.   digitalWrite(f, LOW);
  62.   digitalWrite(g, HIGH);
  63.   delay(1000);
  64.     break;
  66.   case 1:
  67.   digitalWrite(a, HIGH);
  68.   digitalWrite(b, LOW);
  69.   digitalWrite(c, LOW);
  70.   digitalWrite(d, HIGH);
  71.   digitalWrite(e, HIGH);
  72.   digitalWrite(f, HIGH);
  73.   digitalWrite(g, HIGH);
  74.     delay(1000);
  75.     break;
  77.   case 2:
  78.   digitalWrite(a, LOW);
  79.   digitalWrite(b, LOW);
  80.   digitalWrite(c, HIGH);
  81.   digitalWrite(d, LOW);
  82.   digitalWrite(e, LOW);
  83.   digitalWrite(f, HIGH);
  84.   digitalWrite(g, LOW);
  85.     delay(1000);
  86.   break;
  88.   case 3:
  89.   digitalWrite(a, LOW);
  90.   digitalWrite(b, LOW);
  91.   digitalWrite(c, LOW);
  92.   digitalWrite(d, LOW);
  93.   digitalWrite(e, HIGH);
  94.   digitalWrite(f, HIGH);
  95.   digitalWrite(g, LOW);
  96.     delay(1000);
  97.   break;
  99.     case 4:
  100.   digitalWrite(a, HIGH);
  101.   digitalWrite(b, LOW);
  102.   digitalWrite(c, LOW);
  103.   digitalWrite(d, HIGH);
  104.   digitalWrite(e, HIGH);
  105.   digitalWrite(f, LOW);
  106.   digitalWrite(g, LOW);
  107.     delay(1000);
  108.   break;
  110.   case 5:
  111.   digitalWrite(a, LOW);
  112.   digitalWrite(b, HIGH);
  113.   digitalWrite(c, LOW);
  114.   digitalWrite(d, LOW);
  115.   digitalWrite(e, HIGH);
  116.   digitalWrite(f, LOW);
  117.   digitalWrite(g, LOW);
  118.     delay(1000);
  119.   break;
  121.   case 6:
  122.   digitalWrite(a, LOW);
  123.   digitalWrite(b, HIGH);
  124.   digitalWrite(c, LOW);
  125.   digitalWrite(d, LOW);
  126.   digitalWrite(e, LOW);
  127.   digitalWrite(f, LOW);
  128.   digitalWrite(g, LOW);
  129.     delay(1000);
  130.   break;
  132.   case 7:
  133.   digitalWrite(a, LOW);
  134.   digitalWrite(b, LOW);
  135.   digitalWrite(c, LOW);
  136.   digitalWrite(d, HIGH);
  137.   digitalWrite(e, HIGH);
  138.   digitalWrite(f, LOW);
  139.   digitalWrite(g, HIGH);
  140.     delay(1000);
  141.   break;
  143.   case 8:
  144.   digitalWrite(a, LOW);
  145.   digitalWrite(b, LOW);
  146.   digitalWrite(c, LOW);
  147.   digitalWrite(d, LOW);
  148.   digitalWrite(e, LOW);
  149.   digitalWrite(f, LOW);
  150.   digitalWrite(g, LOW);
  151.     delay(1000);
  152.   break;
  154.   case 9:
  155.   digitalWrite(a, LOW);
  156.   digitalWrite(b, LOW);
  157.   digitalWrite(c, LOW);
  158.   digitalWrite(d, LOW);
  159.   digitalWrite(e, HIGH);
  160.   digitalWrite(f, LOW);
  161.   digitalWrite(g, LOW);
  162.     delay(1000);
  163.     break;
  165.    break;
  167.   }
  169.   if (Train > 628) { //Train passing by.
  171.     digitalWrite(GREEN, LOW);
  172.     digitalWrite(RED, HIGH);
  173.     tone(BUZZER, 1000, 500); 
  174.     myservo.write(0); //barrier down
  176.   }
  177.   else {
  179.     digitalWrite(GREEN, LOW);
  180.     digitalWrite(RED, HIGH);
  181.     myservo.write(90); //barrier up
  183.   }
  185.   if (Train < 628 && Button == LOW) { //Button pressed.
  187.     Walker();
  189.   }
  190. }
  192. int Walker() {
  194.     myservo.write(0); //barrier down
  195.     delay(1000);
  196.     digitalWrite(RED, LOW);
  197.     delay(50);
  198.     digitalWrite(GREEN, HIGH);
  199.     count = 1;
  200.     delay(5000);
  201.       tone(BUZZER, 380, 500); //starts blinking and beeping
  202.     digitalWrite(GREEN, LOW); 
  203.     delay(500);
  204.     digitalWrite(GREEN, HIGH);
  205.     delay(500);
  206.       tone(BUZZER, 380, 500);
  207.     digitalWrite(GREEN, LOW);
  208.     delay(500);
  209.     digitalWrite(GREEN, HIGH);
  210.     delay(500);
  211.       tone(BUZZER, 380, 500);
  212.     digitalWrite(GREEN, LOW);
  213.     delay(500);
  214.     digitalWrite(GREEN, HIGH);
  215.     delay(500);
  216.       tone(BUZZER, 380, 500);
  217.     digitalWrite(GREEN, LOW); //blinking becomes more frequent
  218.     delay(150);
  219.     digitalWrite(GREEN, HIGH);
  220.     delay(150);
  221.       tone(BUZZER, 580, 150); //tone goes higher
  222.     digitalWrite(GREEN, LOW);
  223.     delay(150);
  224.     digitalWrite(GREEN, HIGH);
  225.     delay(150); 
  226.       tone(BUZZER, 580, 150);
  227.     digitalWrite(GREEN, LOW);
  228.     delay(150);
  229.     digitalWrite(GREEN, HIGH);
  230.     delay(150);
  231.       tone(BUZZER, 580, 150);
  232.     digitalWrite(GREEN, LOW);
  233.     delay(50);
  234.     digitalWrite(GREEN, HIGH);
  235.     delay(50);
  236.     count = 9;
  237.       tone(BUZZER, 580, 50);
  238.     digitalWrite(GREEN, LOW);
  239.     digitalWrite(RED, HIGH);
  240.     myservo.write(90); //barrier up 
  242. }

Demo:

Coward Robot example

(Week 5)

A robot who runs from the enemy as soon as he finds it in front of him.

Wiring:

screenshot 2017-02-13 15 42 31

Schematics:

screenshot 2017-02-13 21 23 30

Code:

  1. //Coward Robot
  2. //Author: Niam Moltta
  3. //this coward Starts reversing when it founds something close.
  5. #define E1 10  // Enable Pin for motor 1
  6. #define I2 8  // Control pin 1 for motor 1
  7. #define I1 9  // Control pin 2 for motor 1
  8. const int Ping = A0; //Ultrasonic sensor
  10. void setup() {
  12.     Serial.begin(9600);
  13.     pinMode(E1, OUTPUT);
  14.     pinMode(I1, OUTPUT);
  15.     pinMode(I2, OUTPUT);
  16. }
  18. void loop() {
  20. //analogWrite(E1, 255); // Run in half speed
  22.  long duration, inches, cm;
  24.   pinMode(Ping, OUTPUT);
  25.   digitalWrite(Ping, LOW);
  26.   delayMicroseconds(2);
  27.   digitalWrite(Ping, HIGH);
  28.   delayMicroseconds(5);
  29.   digitalWrite(Ping, LOW);
  31.   pinMode(Ping, INPUT);
  32.   duration = pulseIn(Ping, HIGH);
  34.   inches = microsecondsToInches(duration);
  35.   cm = microsecondsToCentimeters(duration);
  38.   // Serial monitor
  39.   Serial.print(inches);
  40.   Serial.print("in, ");
  41.   Serial.print(cm);
  42.   Serial.print("cm");
  43.   Serial.println();
  45.   delay(15);
  47.   if (cm <= 30) {
  49.   delay(1000);
  50.   digitalWrite(E1, HIGH);
  51.   digitalWrite(I1, LOW); //ccw
  52.   digitalWrite(I2, HIGH);
  54.   }
  56.   else {
  58.   digitalWrite(E1, HIGH); //cw
  59.   digitalWrite(I1, HIGH);
  60.   digitalWrite(I2, LOW);
  62.   }  
  64. } 
  66. long microsecondsToInches(long microseconds) {
  68.   return microseconds / 74 / 2;
  69. }
  71. long microsecondsToCentimeters(long microseconds) {
  73.   return microseconds / 29 / 2;
  74. }

Demo: