Advertisement
Guest User

Untitled

a guest
Mar 5th, 2015
219
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 4.45 KB | None | 0 0
  1. int rba;
  2. int M1 = 0;
  3. int M2 = 1;
  4. int M3 = 2;
  5. int M4 = 3;
  6.  
  7. int spd1 = 4;
  8. int spd2 = 5;
  9.  
  10. int ik1 = 6;
  11. int ik2 = 7;
  12. int ik3 = 8;
  13. int ik4 = 9;
  14.  
  15. int pol1 = 10;
  16. int pol2 = 11;
  17. int pol3 = 12;
  18. int pol4 = 13;
  19.  
  20. void setup()
  21. {
  22. pinMode(M1,OUTPUT);
  23. pinMode(M2,OUTPUT);
  24. pinMode(M3,OUTPUT);
  25. pinMode(M4,OUTPUT);
  26.  
  27. pinMode(spd1,OUTPUT);
  28. pinMode(spd2,OUTPUT);
  29.  
  30. pinMode(ik1,INPUT);
  31. pinMode(ik2,INPUT);
  32. pinMode(ik3,INPUT);
  33. pinMode(ik4,INPUT);
  34.  
  35. pinMode(pol1,INPUT);
  36. pinMode(pol2,INPUT);
  37. pinMode(pol3,INPUT);
  38. pinMode(pol4,INPUT);
  39. }
  40.  
  41. void loop()
  42. {
  43. if (Serial.available())
  44. {
  45. rba = Serial.read();
  46.  
  47.  
  48. if (rba == 'W') // bluetooth
  49. {
  50. digitalWrite(M1,HIGH);
  51. digitalWrite(M2,LOW);
  52. analogWrite(spd1,255);
  53. digitalWrite(M3,HIGH);
  54. digitalWrite(M4,LOW);
  55. analogWrite(spd2,255);
  56. }
  57. if (rba == 'S')
  58. {
  59. digitalWrite(M1,LOW);
  60. digitalWrite(M2,HIGH);
  61. analogWrite(spd1,255);
  62. digitalWrite(M3,LOW);
  63. digitalWrite(M4,HIGH);
  64. analogWrite(spd2,255);
  65. }
  66. if (rba == 'A')
  67. {
  68. digitalWrite(M1,LOW);
  69. digitalWrite(M2,HIGH);
  70. analogWrite(spd1,255);
  71. digitalWrite(M3,HIGH);
  72. digitalWrite(M4,LOW);
  73. analogWrite(spd2,255);
  74. }
  75. if (rba == 'D')
  76. {
  77. digitalWrite(M1,HIGH);
  78. digitalWrite(M2,LOW);
  79. analogWrite(spd1,255);
  80. digitalWrite(M3,LOW;
  81. digitalWrite(M4,HIGH);
  82. analogWrite(spd2,255);
  83. }
  84. if (rba == 'X')
  85. {
  86. digitalWrite(M1,LOW);
  87. digitalWrite(M2,LOW);
  88. analogWrite(spd1,255);
  89. digitalWrite(M3,LOW;
  90. digitalWrite(M4,LOW);
  91. analogWrite(spd2,255);
  92. }
  93.  
  94. if (rba == 'E')
  95. {
  96. if (digitalRead(ik1) == LOW) // ik
  97. {
  98. digitalWrite(M1,LOW);
  99. digitalWrite(M2,LOW);
  100. analogWrite(spd1,255);
  101. delay(1000);
  102. digitalWrite(M3,LOW;
  103. digitalWrite(M4,LOW);
  104. analogWrite(spd2,255);
  105. delay(1000);
  106. }
  107.  
  108. if (digitalRead(ik2) == LOW)
  109. {
  110. digitalWrite(M1,LOW);
  111. digitalWrite(M2,LOW);
  112. analogWrite(spd1,255);
  113. delay(1000);
  114. digitalWrite(M3,LOW;
  115. digitalWrite(M4,LOW);
  116. analogWrite(spd2,255);
  117. delay(1000);
  118. }
  119. if (digitalRead(ik3) == LOW)
  120. {
  121. digitalWrite(M1,LOW);
  122. digitalWrite(M2,LOW);
  123. analogWrite(spd1,255);
  124. delay(1000);
  125. digitalWrite(M3,LOW;
  126. digitalWrite(M4,LOW);
  127. analogWrite(spd2,255);
  128. delay(1000);
  129. }
  130. if (digitalRead(ik4) == LOW)
  131. {
  132. digitalWrite(M1,LOW);
  133. digitalWrite(M2,LOW);
  134. analogWrite(spd1,255);
  135. delay(1000);
  136. digitalWrite(M3,LOW);
  137. digitalWrite(M4,LOW);
  138. analogWrite(spd2,255);
  139. delay(1000);
  140. }
  141. if (digitalRead(pol1) == LOW) // pol
  142. {
  143. digitalWrite(M1,LOW);
  144. digitalWrite(M2,LOW);
  145. analogWrite(spd1,255);
  146. delay(1000);
  147. digitalWrite(M3,LOW);
  148. digitalWrite(M4,LOW);
  149. analogWrite(spd2,255);
  150. delay(1000);
  151. }
  152. if (digitalRead(pol2) == LOW)
  153. {
  154. digitalWrite(M1,LOW);
  155. digitalWrite(M2,LOW);
  156. analogWrite(spd1,255);
  157. delay(1000);
  158. digitalWrite(M3,LOW;
  159. digitalWrite(M4,LOW);
  160. analogWrite(spd2,255);
  161. delay(1000);
  162. }
  163. if (digitalRead(pol3) == LOW)
  164. {
  165. digitalWrite(M1,LOW);
  166. digitalWrite(M2,LOW);
  167. analogWrite(spd1,255);
  168. delay(1000);
  169. digitalWrite(M3,LOW);
  170. digitalWrite(M4,LOW);
  171. analogWrite(spd2,255);
  172. delay(1000);
  173. }
  174. if (digitalRead(pol4) == LOW)
  175. {
  176. digitalWrite(M1,LOW);
  177. digitalWrite(M2,LOW);
  178. analogWrite(spd1,255);
  179. delay(1000);
  180. digitalWrite(M3,LOW);
  181. digitalWrite(M4,LOW);
  182. analogWrite(spd2,255);
  183. delay(1000);
  184. }
  185.  
  186.  
  187. }
  188.  
  189.  
  190.  
  191.  
  192.  
  193.  
  194. }
  195.  
  196. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement