Advertisement
mechagical

code sgvr mini

Aug 12th, 2015
301
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 2.83 KB | None | 0 0
  1. //SGVR MINI version 1.0.0
  2.  
  3. // Features: Motor, LED
  4.  
  5. const int motorA1 = 2; //masuk pin2
  6. const int motorA2 = 3; //masuk pin3
  7. const int motorB1 = 4; //masuk pin4
  8. const int motorB2 = 5; //masuk pin5
  9. const int ledmerah = 10; //:LED indikator on/off masuk pin10
  10. const int ledhijau = 11; //LED indikator jalan masuk pin11
  11.  
  12. int incomingByte; // a variable to read incoming serial data into
  13.  
  14. void setup() {
  15. // initialize serial communication:
  16. Serial.begin(9600);
  17. // initialize the LED pin as an output:
  18. pinMode (motorA1, OUTPUT);
  19. pinMode (motorA2, OUTPUT);
  20. pinMode (motorB1, OUTPUT);
  21. pinMode (motorB2, OUTPUT);
  22. pinMode (ledmerah, OUTPUT);
  23. pinMode (ledhijau, OUTPUT);
  24. }
  25.  
  26. void loop() {
  27.  
  28. digitalWrite (ledmerah, HIGH);
  29. // see if there's incoming serial data:
  30. if (Serial.available() > 0) {
  31. // read the oldest byte in the serial buffer:
  32. incomingByte = Serial.read();
  33. // if it's a 1 (ASCII 72), go forward:
  34. if (incomingByte == '1') {
  35. digitalWrite (motorA1, HIGH);
  36. digitalWrite (motorB1, HIGH);
  37. digitalWrite (motorA2, LOW);
  38. digitalWrite (motorB2, LOW);
  39. digitalWrite (ledhijau, HIGH);
  40. delay (100) ;
  41. digitalWrite (motorA1, LOW);
  42. digitalWrite (motorB1, LOW);
  43. digitalWrite (motorA2, LOW);
  44. digitalWrite (motorB2, LOW);
  45. digitalWrite (ledhijau, LOW);
  46. }
  47.  
  48. if (incomingByte == '2') {
  49. digitalWrite (motorA1, LOW);
  50. digitalWrite (motorB1, LOW);
  51. digitalWrite (motorA2, HIGH);
  52. digitalWrite (motorB2, HIGH);
  53. digitalWrite (ledhijau, HIGH);
  54. delay (100) ;
  55. digitalWrite (motorA1, LOW);
  56. digitalWrite (motorB1, LOW);
  57. digitalWrite (motorA2, LOW);
  58. digitalWrite (motorB2, LOW);
  59. digitalWrite (ledhijau, LOW);
  60. }
  61.  
  62. if (incomingByte == '3') {
  63. //digitalWrite (motorA1, HIGH);
  64. digitalWrite (motorB1, HIGH);
  65. //digitalWrite (motorA2, LOW);
  66. digitalWrite (motorB2, LOW);
  67. digitalWrite (ledhijau, HIGH);
  68. delay (100) ;
  69. //digitalWrite (motorA1, LOW);
  70. digitalWrite (motorB1, LOW);
  71. //digitalWrite (motorA2, LOW);
  72. digitalWrite (motorB2, LOW);
  73. digitalWrite (ledhijau, LOW);
  74.  
  75. }
  76.  
  77. if (incomingByte == '4') {
  78. digitalWrite (motorA1, HIGH);
  79. // digitalWrite (motorB1, HIGH);
  80. digitalWrite (motorA2, LOW);
  81. // digitalWrite (motorB2, LOW);
  82. digitalWrite (ledhijau, HIGH);
  83. delay (100) ;
  84. digitalWrite (motorA1, LOW);
  85. // digitalWrite (motorB1, LOW);
  86. digitalWrite (motorA2, LOW);
  87. // digitalWrite (motorB2, LOW);
  88. digitalWrite (ledhijau, LOW);
  89. }
  90.  
  91.  
  92.  
  93. }
  94.  
  95. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement