Advertisement
Guest User

Untitled

a guest
May 19th, 2017
73
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 2.24 KB | None | 0 0
  1. import lejos.nxt.*;
  2. public class minesweep {
  3.  
  4. public static void main(String[] args) throws Exception{
  5. LightSensor light = new LightSensor(SensorPort.S3);
  6. minesweep Neo = new minesweep();
  7. Motor.A.setSpeed(400); //right
  8. Motor.B.setSpeed(500); //left
  9. Motor.C.setSpeed(400); //arm
  10. int count = 0;
  11. int see = 50;
  12. int ident = 0;
  13.  
  14. while(count == 0){
  15. Motor.A.setSpeed(400); //right
  16. Motor.B.setSpeed(490); //left
  17. Motor.A.forward();
  18. Motor.B.forward();
  19.  
  20. see = light.readValue();
  21.  
  22. if (see < 30) {
  23. ident = ident + 1;
  24. }
  25.  
  26. if (ident == 1) {
  27. Motor.A.setSpeed(200);
  28. Motor.B.setSpeed(200);
  29. Thread.sleep(500);
  30.  
  31. Sound.buzz();
  32.  
  33. Motor.A.forward();
  34. Motor.B.backward();
  35. Thread.sleep(640);
  36.  
  37. Motor.A.forward();
  38. Motor.B.forward();
  39. Thread.sleep(500);
  40.  
  41. ident = ident + 1;
  42. }
  43.  
  44. if (ident == 3){
  45. Motor.A.setSpeed(0);
  46. Motor.B.setSpeed(0);
  47. Thread.sleep(100);
  48.  
  49. Motor.A.setSpeed(200);
  50. Motor.B.setSpeed(400);
  51.  
  52. Sound.buzz();
  53.  
  54. Motor.A.forward();
  55. Motor.B.forward();
  56. Thread.sleep(1000);
  57.  
  58. Motor.A.setSpeed(200);
  59. Motor.B.setSpeed(200);
  60.  
  61. Motor.A.forward();
  62. Motor.B.forward();
  63. Thread.sleep(500);
  64.  
  65. ident = ident + 1;
  66. }
  67.  
  68. if (ident == 5){
  69. Motor.A.setSpeed(200);
  70. Motor.B.setSpeed(200);
  71. Thread.sleep(500);
  72.  
  73. Sound.buzz();
  74.  
  75. Motor.A.forward();
  76. Motor.B.backward();
  77. Thread.sleep(500);
  78.  
  79. Motor.A.forward();
  80. Motor.B.forward();
  81. Thread.sleep(500);
  82.  
  83. ident = ident + 1;
  84. }
  85.  
  86. if (ident == 7){
  87. Motor.A.setSpeed(200);
  88. Motor.B.setSpeed(200);
  89. Thread.sleep(500);
  90.  
  91. Sound.buzz();
  92.  
  93. Motor.A.forward();
  94. Motor.B.backward();
  95. Thread.sleep(1850);
  96.  
  97. Motor.A.backward();
  98. Motor.B.backward();
  99. Thread.sleep(910);
  100.  
  101. Motor.A.setSpeed(0);
  102. Motor.B.setSpeed(0);
  103.  
  104. Motor.C.forward();
  105. Thread.sleep(600);
  106.  
  107. Motor.A.setSpeed(400);
  108. Motor.B.setSpeed(400);
  109. Motor.C.setSpeed(0);
  110.  
  111. Motor.A.forward();
  112. Motor.B.forward();
  113. Thread.sleep(11000);
  114.  
  115. count = 11;
  116. }
  117.  
  118. }
  119.  
  120. }
  121.  
  122. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement