Advertisement
roctbb

Arduino Line

Feb 28th, 2015
233
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 1.80 KB | None | 0 0
  1. #include <Servo.h>
  2.  
  3. //int simpleCount;
  4. //int headTimer;
  5. int distStep;
  6. Servo neck;
  7. const int ledPin = 2;
  8. int mode; // Режим работы 0 - автоматический, 1 - ручной, 2 - смешанный
  9.  
  10. const int Trig_pin = 2; // Подключаем сенсор расстояния к цифровому портам 2 и 3
  11. const int Echo_pin = 3;
  12.  
  13. const int bLSensor_1 = 12; // Подключаем датчики чёрной линии к портам 8,9,10;
  14. const int bLSensor_2 = 11;
  15. const int bLSensor_3 = 10;
  16.  
  17. const int IR_RECV_PIN = A3;
  18. const int OFF_BUTTON_CODE = 0xFD00FF;//FD00FF
  19.  
  20. Servo leftWheel;
  21. Servo rightWheel;
  22.  
  23.  
  24. //IRrecv irReceiver(IR_RECV_PIN);
  25.  
  26. //#include "Ultrasonic.h"
  27. // ------------------------- Legs -----------------------------
  28. const int loopRestart = 10;
  29.  
  30. void setup() {
  31. // Serial.begin(38400);
  32. // Serial.begin(57600);
  33. //pinMode(A0, OUTPUT);
  34. mode = 0;
  35.  
  36. leftWheel.attach(5);
  37. rightWheel.attach(4);
  38. leftWheel.write(180);
  39. rightWheel.write(0);
  40.  
  41. pinMode(bLSensor_1,INPUT);
  42. pinMode(bLSensor_2,INPUT);
  43. pinMode(bLSensor_3,INPUT);
  44.  
  45. neck.attach(4);
  46. neck.write(90);
  47.  
  48. pinMode(Trig_pin, OUTPUT);
  49. pinMode(Echo_pin, INPUT);
  50.  
  51. // analogWrite(ledPin,LOW);
  52. distStep = 0;
  53. }
  54.  
  55. void loop(){
  56.  
  57. if(digitalRead(bLSensor_2) == LOW && digitalRead(bLSensor_1) == HIGH &&digitalRead(bLSensor_3) == HIGH){
  58.  
  59. leftWheel.write(180);
  60. rightWheel.write(0);
  61. }
  62. if(digitalRead(bLSensor_2) == LOW && digitalRead(bLSensor_1) == LOW &&digitalRead(bLSensor_3) == LOW){
  63.  
  64. leftWheel.write(90);
  65. rightWheel.write(90);
  66. }
  67. else {
  68. if(digitalRead(bLSensor_1) == LOW){
  69.  
  70. leftWheel.write(90);
  71. rightWheel.write(0);
  72.  
  73. }
  74. if(digitalRead(bLSensor_3 ) == LOW){
  75.  
  76. leftWheel.write(180);
  77. rightWheel.write(90);
  78.  
  79. }}
  80.  
  81.  
  82.  
  83.  
  84.  
  85.  
  86. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement