Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- for(int i=0; i<N_BTN; i++) {
- int sensorValue = digitalRead(btn[i]);
- if(sensorValue==HIGH)
- Joystick.releaseButton(i);
- else
- Joystick.pressButton(i);
- }
- for(int i=0; i<N_MAN; i++){
- uint8_t up = N_BTN + (2*i);
- uint8_t down = N_BTN + (2*i) +1;
- if((millis()-lastTime[i])>MAN_TIME){
- Joystick.setButton(up, false);
- Joystick.setButton(down, false);
- int anVal = analogRead(man[i]);
- int currPos = 0;
- for(; currPos<manMaxPos[i]; currPos++){
- if(abs(anVal-manVal[i][currPos])<MAN_TOL){
- break;
- }
- }
- //Valore non trovato
- if(currPos==manMaxPos[i])
- continue;
- else
- manCurr[i] = currPos;
- //Valore non cambiato
- if(manCurr[i]==manPrev[i])
- continue;
- if(manPrev[i]==manMaxPos[i]-1 && manCurr[i]==0){
- //Incremento
- Joystick.setButton(up, true);
- Joystick.setButton(down, false);
- lastTime[i] = millis();
- manPrev[i] = manCurr[i];
- Serial.println("Up");
- } else if(manPrev[i]==0 && manCurr[i]==manMaxPos[i]-1){
- //Decremento
- Joystick.setButton(up, false);
- Joystick.setButton(down, true);
- lastTime[i] = millis();
- manPrev[i] = manCurr[i];
- Serial.println("Dw");
- } else if(manCurr[i]==manPrev[i]+1){
- //Incremento
- Joystick.setButton(up, true);
- Joystick.setButton(down, false);
- lastTime[i] = millis();
- manPrev[i] = manCurr[i];
- Serial.println("Up");
- } else if(manCurr[i]==manPrev[i]-1){
- //Decremento
- Joystick.setButton(up, false);
- Joystick.setButton(down, true);
- lastTime[i] = millis();
- manPrev[i] = manCurr[i];
- Serial.println("Dw");
- }
- }
- }
- Joystick.setThrottle(analogRead(A3));
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement