Advertisement
Guest User

Untitled

a guest
Aug 17th, 2019
161
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 1.67 KB | None | 0 0
  1. for(int i=0; i<N_BTN; i++) {
  2. int sensorValue = digitalRead(btn[i]);
  3. if(sensorValue==HIGH)
  4. Joystick.releaseButton(i);
  5. else
  6. Joystick.pressButton(i);
  7. }
  8.  
  9. for(int i=0; i<N_MAN; i++){
  10. uint8_t up = N_BTN + (2*i);
  11. uint8_t down = N_BTN + (2*i) +1;
  12.  
  13. if((millis()-lastTime[i])>MAN_TIME){
  14.  
  15. Joystick.setButton(up, false);
  16. Joystick.setButton(down, false);
  17.  
  18. int anVal = analogRead(man[i]);
  19. int currPos = 0;
  20. for(; currPos<manMaxPos[i]; currPos++){
  21. if(abs(anVal-manVal[i][currPos])<MAN_TOL){
  22. break;
  23. }
  24. }
  25.  
  26. //Valore non trovato
  27. if(currPos==manMaxPos[i])
  28. continue;
  29. else
  30. manCurr[i] = currPos;
  31.  
  32. //Valore non cambiato
  33. if(manCurr[i]==manPrev[i])
  34. continue;
  35.  
  36. if(manPrev[i]==manMaxPos[i]-1 && manCurr[i]==0){
  37. //Incremento
  38. Joystick.setButton(up, true);
  39. Joystick.setButton(down, false);
  40. lastTime[i] = millis();
  41. manPrev[i] = manCurr[i];
  42. Serial.println("Up");
  43. } else if(manPrev[i]==0 && manCurr[i]==manMaxPos[i]-1){
  44. //Decremento
  45. Joystick.setButton(up, false);
  46. Joystick.setButton(down, true);
  47. lastTime[i] = millis();
  48. manPrev[i] = manCurr[i];
  49. Serial.println("Dw");
  50. } else if(manCurr[i]==manPrev[i]+1){
  51. //Incremento
  52. Joystick.setButton(up, true);
  53. Joystick.setButton(down, false);
  54. lastTime[i] = millis();
  55. manPrev[i] = manCurr[i];
  56. Serial.println("Up");
  57. } else if(manCurr[i]==manPrev[i]-1){
  58. //Decremento
  59. Joystick.setButton(up, false);
  60. Joystick.setButton(down, true);
  61. lastTime[i] = millis();
  62. manPrev[i] = manCurr[i];
  63. Serial.println("Dw");
  64. }
  65.  
  66. }
  67.  
  68. }
  69.  
  70. Joystick.setThrottle(analogRead(A3));
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement