Advertisement
Guest User

asdf

a guest
Dec 11th, 2019
81
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 3.15 KB | None | 0 0
  1. #include <Servo.h>
  2.  
  3. int val1 = 90; //rotation
  4. int val2 = 40; //shoulder
  5. int val3 = 60; //arm
  6. int val4 = 90;
  7. int val5 = 0; //claw
  8. int val6 = 70; //claw
  9.  
  10. int Delay = 2;
  11.  
  12. Servo myServo1;
  13. Servo myServo2;
  14. Servo myServo3;
  15. Servo myServo4;
  16. Servo myServo5;
  17. Servo myServo6;
  18. int data = 0;
  19.  
  20. int mode = 119;
  21. //w=119
  22. //W=87
  23. void setup() {
  24. myServo1.attach(10);
  25. myServo2.attach(11);
  26. myServo3.attach(9);
  27.  
  28. myServo4.attach(3);
  29. myServo5.attach(5);
  30. myServo6.attach(6);
  31.  
  32. Serial.begin(9600); // Default communication rate of the Bluetooth module
  33.  
  34. myServo1.write(90); //rotation
  35. myServo2.write(40); //shoulder
  36. myServo3.write(60);
  37. myServo4.write(90);
  38. myServo5.write(val5); //arm
  39. myServo6.write(val6); //arm
  40. }
  41.  
  42. void loop() {
  43.  
  44. if(Serial.available() != 0){ // Checks whether data is comming from the serial port
  45. data = Serial.read(); // Reads the data from the serial port
  46. }
  47. Serial.println(data);
  48. // if(data == 'w') mode = 'w';
  49. // if(data == 'W') mode = 'W';
  50. // if(data == 'w') mode = 'u';
  51. // if(data == 'U') mode = 'U';
  52. //
  53. //
  54. // if((mode == 'w' && mode == 'u') || (mode == 'W' && mode == 'U')){ // base control
  55. // if(data == 'F'){
  56. // val1++;
  57. // val1 = constrain(val1, 38, 117);
  58. // myServo1.write(val1);
  59. // delay(Delay);
  60. // }
  61. // else if(data == 'B'){
  62. // val1--;
  63. // val1 = constrain(val1, 38, 117);
  64. // myServo1.write(val1);
  65. // delay(Delay);
  66. // delay(2);
  67. // }
  68. // else if(data == 'L'){
  69. // val2++;
  70. // val2 = constrain(val2, 0, 104);
  71. // myServo2.write(val2);
  72. // delay(Delay);
  73. // }
  74. // else if(data == 'R'){
  75. // val2--;
  76. // val2 = constrain(val2, 0, 104);
  77. // myServo2.write(val2);
  78. // delay(Delay);
  79. // }
  80. // }
  81. //
  82. // else if(mode == 'W' && mode == 'u'){ //arm elbow control
  83. // if(data == 'F'){
  84. // val3++;
  85. // val3 = constrain(val3, 25, 130);
  86. // myServo3.write(val3);
  87. // delay(Delay);
  88. // }
  89. // else if(data == 'B')
  90. // {
  91. // val3--;
  92. // val3 = constrain(val3, 25, 130);
  93. // myServo3.write(val3);
  94. // delay(Delay);
  95. // }
  96. // else if(data == 'L')
  97. // {
  98. // val4++;
  99. // val4 = constrain(val4, 0, 180);
  100. // myServo4.write(val4);
  101. // delay(Delay);
  102. // }
  103. // else if(data == 'R')
  104. // {
  105. // val4--;
  106. // val4 = constrain(val4, 0, 180);
  107. // myServo4.write(val4);
  108. // delay(Delay);
  109. // }
  110. // }
  111. // else if(mode == 'w' && mode == 'U'){ // claw control
  112. // if(data == 'F'){
  113. // val5++;
  114. // val6++;
  115. // val5 = constrain(val5, 0, 110);
  116. // val6 = constrain(val6, 70, 180);
  117. // myServo5.write(val5);
  118. // delay(Delay);
  119. // myServo6.write(val6);
  120. // delay(Delay);
  121. // }
  122. // else if(data == 'B')
  123. // {
  124. // val5--;
  125. // val6--;
  126. // val5 = constrain(val5, 0, 110);
  127. // val6 = constrain(val6, 70, 180);
  128. // myServo5.write(val5);
  129. // delay(Delay);
  130. // myServo6.write(val6);
  131. // delay(Delay);
  132. // }
  133. // }
  134. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement