Problem z programem obsługującym pada od PS2

[silver2001]

cześć, mam problem z moim programem do robota - po wciśnięciu przycisku na padzie od PS2, silnik w robocie się kręci dopóki nie odepnę źródła zasilania, a powinien kręcić się tak długo jak przytrzymam przycisk. To jest mój program :

#include <Mouse.h>
#include <Servo.h>
#include <LiquidCrystal.h>
#include <PS2X_lib.h>  //for v1.6
Servo myservo;
int val = 0;





/******************************************************************
* set pins connected to PS2 controller:
*   - 1e c olumn: original 
*   - 2e colmun: Stef?
* replace pin numbers by the ones you use
******************************************************************/
#define PS2_DAT        13  //14    
#define PS2_CMD        11  //15
#define PS2_SEL        10  //16
#define PS2_CLK        12  //17

/******************************************************************
* select modes of PS2 controller:
*   - pressures = analog reading of push-butttons 
*   - rumble    = motor rumbling
* uncomment 1 of the lines for each mode selection
******************************************************************/
//#define pressures   true
#define pressures   false
//#define rumble      true
#define rumble      false

PS2X ps2x; // create PS2 Controller Class

//right now, the library does NOT support hot pluggable controllers, meaning 
//you must always either restart your Arduino after you connect the controller, 
//or call config_gamepad(pins) again after connecting the controller.

int error = 0;
byte type = 0;
byte vibrate = 0;



int PP = 9;
int PT = 8;
int LP = 7;
int LT = 6;

int gora = 5;
int dol = 4;



void setup(){

 myservo.attach(3);
 Serial.begin(57600);

 myservo.write(val= 40);
 delay(300);
 myservo.write(val = 0);
 delay(50);


 delay(300);  //added delay to give wireless ps2 module some time to startup, before configuring it

 //CHANGES for v1.6 HERE!!! **************PAY ATTENTION*************

 //setup pins and settings: GamePad(clock, command, attention, data, Pressures?, Rumble?) check for error
 error = ps2x.config_gamepad(PS2_CLK, PS2_CMD, PS2_SEL, PS2_DAT, pressures, rumble);

 if(error == 0){
   Serial.print("Found Controller, configured successful ");
   Serial.print("pressures = ");
 if (pressures)
   Serial.println("true ");
 else
   Serial.println("false");
 Serial.print("rumble = ");
 if (rumble)
   Serial.println("true)");
 else
   Serial.println("false");
   Serial.println("Try out all the buttons, X will vibrate the controller, faster as you press harder;");
   Serial.println("holding L1 or R1 will print out the analog stick values.");
   Serial.println("Note: Go to www.billporter.info for updates and to report bugs.");
 }  
 else if(error == 1)
   Serial.println("No controller found, check wiring, see readme.txt to enable debug. visit www.billporter.info for troubleshooting tips");

 else if(error == 2)
   Serial.println("Controller found but not accepting commands. see readme.txt to enable debug. Visit www.billporter.info for troubleshooting tips");

 else if(error == 3)
   Serial.println("Controller refusing to enter Pressures mode, may not support it. ");

//  Serial.print(ps2x.Analog(1), HEX);

 type = ps2x.readType(); 
 switch(type) {
   case 0:
     Serial.print("Unknown Controller type found ");
     break;
   case 1:
     Serial.print("DualShock Controller found ");
     break;
   case 2:
     Serial.print("GuitarHero Controller found ");
     break;
 case 3:
     Serial.print("Wireless Sony DualShock Controller found ");
     break;
  }
  pinMode(PP,OUTPUT);
  pinMode(PT,OUTPUT);
  pinMode(LP,OUTPUT);
  pinMode(LT,OUTPUT);
  pinMode(gora,OUTPUT);
  pinMode(dol,OUTPUT); 
}

void loop() {
 /* You must Read Gamepad to get new values and set vibration values
    ps2x.read_gamepad(small motor on/off, larger motor strenght from 0-255)
    if you don't enable the rumble, use ps2x.read_gamepad(); with no values
    You should call this at least once a second
  */  
 if(error == 1) //skip loop if no controller found
   return; 

 if(type == 2){ //Guitar Hero Controller
   ps2x.read_gamepad();          //read controller 

   if(ps2x.ButtonPressed(GREEN_FRET))
     Serial.println("Green Fret Pressed");
   if(ps2x.ButtonPressed(RED_FRET))
     Serial.println("Red Fret Pressed");
   if(ps2x.ButtonPressed(YELLOW_FRET))
     Serial.println("Yellow Fret Pressed");
   if(ps2x.ButtonPressed(BLUE_FRET))
     Serial.println("Blue Fret Pressed");
   if(ps2x.ButtonPressed(ORANGE_FRET))
     Serial.println("Orange Fret Pressed"); 

   if(ps2x.ButtonPressed(STAR_POWER))
     Serial.println("Star Power Command");

   if(ps2x.Button(UP_STRUM))          //will be TRUE as long as button is pressed
     Serial.println("Up Strum");
   if(ps2x.Button(DOWN_STRUM))
     Serial.println("DOWN Strum");

   if(ps2x.Button(PSB_START))         //will be TRUE as long as button is pressed
     Serial.println("Start is being held");
   if(ps2x.Button(PSB_SELECT))
     Serial.println("Select is being held");

   if(ps2x.Button(ORANGE_FRET)) {     // print stick value IF TRUE
     Serial.print("Wammy Bar Position:");
     Serial.println(ps2x.Analog(WHAMMY_BAR), DEC); 
   } 
 }
 else { //DualShock Controller
   ps2x.read_gamepad(false, vibrate); //read controller and set large motor to spin at 'vibrate' speed

   if(ps2x.Button(PSB_START))         //will be TRUE as long as button is pressed
     Serial.println("Start is being held");
   if(ps2x.Button(PSB_SELECT))
     Serial.println("Select is being held"); 


   if(ps2x.Button(PSB_PAD_UP)) 
     Serial.print("UP held this hard: ");
     Serial.println(ps2x.Analog(PSAB_PAD_UP));

   if(ps2x.Button(PSB_PAD_RIGHT)){
     digitalWrite(gora,HIGH);
     Serial.print("podnosze ramie ");
     Serial.println(ps2x.Analog(PSAB_PAD_RIGHT));

   if(ps2x.Button(PSB_PAD_LEFT)){
     digitalWrite(dol,HIGH);
     Serial.print("opuszczam ramie");
     Serial.println(ps2x.Analog(PSAB_PAD_LEFT), DEC);

   if(ps2x.Button(PSB_PAD_DOWN)){
     Serial.print("DOWN held this hard: "); 
     Serial.println(ps2x.Analog(PSAB_PAD_DOWN), DEC);

   vibrate = ps2x.Analog(PSAB_CROSS);  //this will set the large motor vibrate speed based on how hard you press the blue (X) button
   if (ps2x.NewButtonState())         //will be TRUE if any button changes state (on to off, or off to on)
     if(ps2x.Button(PSB_L3))
       Serial.println("L3 pressed");
     if(ps2x.Button(PSB_R3))
       Serial.println("R3 pressed");
     if(ps2x.Button(PSB_L2))
       Serial.println("L2 pressed");

     if(ps2x.Button(PSB_R2))
       Serial.println("R2 pressed");

    if(ps2x.Button(PSB_L1))
   Serial.println("serwo sie rozwiera");
   myservo.write(val = 180);

   if(ps2x.Button(PSB_R1)) 
   Serial.println("servo sie zwiera");
   myservo.write(val = 0);
   digitalWrite(vibrate,HIGH);


     if(ps2x.Button(PSB_TRIANGLE))
       Serial.println("Triangle pressed");        


   if(ps2x.ButtonPressed(PSB_CIRCLE))               //will be TRUE if button was JUST pressed
     Serial.println("Circle just pressed");
   if(ps2x.NewButtonState(PSB_CROSS))               //will be TRUE if button was JUST pressed OR released
     Serial.println("X just changed");
   if(ps2x.ButtonReleased(PSB_SQUARE))              //will be TRUE if button was JUST released
     Serial.println("Square just released");     

   if(ps2x.Button(PSB_L1))
   Serial.println("serwo sie rozwiera");
   myservo.write(val = 180);

   if(ps2x.Button(PSB_R1)) 
   Serial.println("servo sie zwiera");
   myservo.write(val = 0);
   digitalWrite(vibrate,HIGH);


     Serial.print("Stick Values:");
     Serial.print(ps2x.Analog(PSS_LY), DEC); //Left stick, Y axis. Other options: LX, RY, RX  
     Serial.print(",");

     Serial.print(ps2x.Analog(PSS_LX), DEC); 
     Serial.print(",")

     Serial.print(ps2x.Analog(PSS_RY), DEC); 
     Serial.print(",");

     Serial.println(ps2x.Analog(PSS_RX), DEC); 
     Serial.print(",");





 delay(500);  



   }
  }
 }
}
}

Wie ktoś dlaczego tak się dzieje ? co jest nie tak napisane w programie ?

z góry dzięki 🙂

[Lukaszm]

if(ps2x.Button(PSB_R1)) 
   Serial.println("servo sie zwiera"); 
   myservo.write(val = 0); 

Zdajesz sobie sprawę że trzecia linia będzie wykonywana za każdym razem, niezależnie od warunku w if-ie?

1. Polecam poprawić nawiasy (klamrowe). Wygląda na to że w kilku miejscach zgubiłeś nawiasy zamykające (tak mi się wydaje)

2. To Ty tak skopałeś formatowanie czy forum? Bo w tym co widzę na ekranie ciężko się połapać (indentacja)

Poza tym fajnie byłoby jakbyś wstawił minimalny przykład obrazujący problem, a nie ściągnięty skądś 260-liniowy kod ze zmienionymi kilkoma liniami (i zepsutą indentacją).

[silver2001]

Ok, poprawiłem nawiasy i juz wszystko działa tylko czemu czasem ma takie opóźnienia w działaniu ? Raz zareaguje odrazu a raz po 5 sekundach

[Treker (Damian Szymański)]

silver2001, polecam zapoznać się z tematyką przerwań zewnętrznych w Arduino 🙂

Dzięki nim najczęściej można rozwiązać problemy opóźnionych reakcji na czujniki itd.

Więcej o tym zagadnieniu znajdziesz w kursie: Kurs Arduino II – #4 – przerwania, kontaktron, czujnik PIR

[Polecacz 101]

Produkcja i montaż PCB - wybierz sprawdzone PCBWay!
   • Darmowe płytki dla studentów i projektów non-profit
   • Tylko 5$ za 10 prototypów PCB w 24 godziny
   • Usługa projektowania PCB na zlecenie
   • Montaż PCB od 30$ + bezpłatna dostawa i szablony
   • Darmowe narzędzie do podglądu plików Gerber
Zobacz również » Film z fabryki PCBWay

[silver2001]

Przeczytałem ten artykuł o przerwaniach, ale to działa tak że 1 przerwanie na cały program ? Z tego co tam czytałem można dodać max 2 przerwania dla arduino UNO. W przykładach w tym artykule jest pokazany program który obsługuje tylko alarm - jest krótki a moj program " troszkę " dłuższy i ma więcej niż 1 warunek. Gdzie wstawić to przerwanie ?

[Treker (Damian Szymański)]

silver2001, w przypadku Arduino UNO można wykorzystać dwa przerwania zewnętrzne. W funkcji przerwania nie należy robić nic długiego. Wystarczy, że zareagujesz np. na wciśnięcie klawisza i zapamiętasz w zmiennej, jakiej reakcji oczekuje użytkownik. Cała reszta powinna być już robiona w pętli głównej programu.

Niestety, ale wymaga to odpowiedniego pisania całego programu, szczególnie przy dość długim kodzie. W Twoim programie każde delay i pirintln wprowadza opóźnienia do działania całego urządzenia. Wskazanie przerwań, to tylko drogowskaz ode mnie, bo powinieneś iść w tym kierunku, jednak żadne "dwie linie kodu" tutaj niestety nie rozwiążą całego problemu.

[silver2001]

Więc, musze użyć pinu " command " w odbiorniku jako przerwanie do arduino ? Czy innego ?