Arduino Uno R3 |
Joystick Playstation 2 Wireless |
1.Pin Data
2.Pin Command
3.Pin Vibration Motor Power
4.Pin Ground
5.Pin Power 3.3V
6.Pin Attention
7.Pin Clock
8.Pin Unknown
9.Pin Acknowledge
Tetapi dari 9 pin tersebut, kita hanya akan memakai 6 buah saja, yaitu Pin 1, 2, 4, 5, 6 dan 7. Sesuai dengan library yang sudah dibuat oleh Bill Porter, koneksi pin-pin tersebut dengan board Arduino (dapat dilihat pada kode program, pada baris ke 17) adalah sebagai berikut:
Pin 1 (Data) –> Pin Digital 12 Arduino
Pin 2 (Command) –> Pin Digital 11 Arduino
Pin 4 (Ground) –> Pin Ground Arduino
Pin 5 (Power 3.3V) –> Pin 3.3V Arduino
Pin 6 (Attention) –> Pin Digital 10 Arduino
Pin 7 (Clock) –> Pin Digital 13 Arduino
Posisi Wire |
Recever to Arduino Uno R3 |
Ini Code nya Copas Aje...
#include <PS2X_lib.h>
#include <Servo.h>
PS2X ps2x;
int error = 0;
byte type = 0;
byte vibrate = 0;
Servo myservo;
int pos = 90;
int led1=9;
int le1=0;
int led2=8;
int le2=0;
int led3=7;
int le3=0;
int led4=6;
int le4=0;
int led5=5;
int le5=0;
int led6=4;
int le6=0;
int led7=3;
int le7=0;
int led8=2;
int le8=0;
void setup(){
Serial.begin(57600);
pinMode(led1,OUTPUT);
pinMode(led2,OUTPUT);
pinMode(led3,OUTPUT);
pinMode(led4,OUTPUT);
pinMode(led5,OUTPUT);
pinMode(led6,OUTPUT);
pinMode(led7,OUTPUT);
pinMode(led8,OUTPUT);
error = ps2x.config_gamepad(13,11,10,12, true, true); //setup pins and settings: GamePad(clock, command, attention, data, Pressures?, Rumble?) check for error
if(error == 0){
Serial.println("Found Controller, configured successful");
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("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.println("Unknown Controller type");
break;
case 1:
Serial.println("DualShock Controller Found");
break;
case 2:
Serial.println("GuitarHero Controller Found");
break;
}
myservo.attach(9);
myservo.write(pos);
}
void loop(){
/* You must Read Gamepad to get new values
Read GamePad 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");
le5=1;}
if(ps2x.Button(PSB_SELECT))
{Serial.println("Select is being held");
le6=1;}
if(ps2x.Button(PSB_PAD_UP)) { //will be TRUE as long as button is pressed
Serial.print("Up held this hard: ");
Serial.println(ps2x.Analog(PSAB_PAD_UP), DEC);
}
if(ps2x.Button(PSB_PAD_RIGHT)){
Serial.print("Right held this hard: ");
Serial.println(ps2x.Analog(PSAB_PAD_RIGHT), DEC);
}
if(ps2x.Button(PSB_PAD_LEFT)){
Serial.print("LEFT held this hard: ");
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_BLUE); //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");
le7=1;}
if(ps2x.Button(PSB_R2))
{Serial.println("R2 pressed");
le8=1;}
}
if(ps2x.Button(PSB_GREEN))
{ Serial.println("Triangle pressed");
le1=1;}
if(ps2x.Button(PSB_RED)) //will be TRUE if button was JUST pressed
{ Serial.println("Circle just pressed");
le2=1;}
if(ps2x.Button(PSB_PINK)) //will be TRUE if button was JUST released
{ Serial.println("Square just released");
le3=1;}
if(ps2x.Button(PSB_BLUE)) //will be TRUE if button was JUST pressed OR released
{ Serial.println("X just changed");
le4=1;}
if(ps2x.Button(PSB_L1) || ps2x.Button(PSB_R1)) // print stick values if either is TRUE
{
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);
}
if(le1==1){
digitalWrite(led1,HIGH);
le1=0;
}
else{
digitalWrite(led1,LOW);
}
if(le2==1){
digitalWrite(led2,HIGH);
le2=0;
}
else{
digitalWrite(led2,LOW);
}
if(le3==1){
digitalWrite(led3,HIGH);
le3=0;
}
else{
digitalWrite(led3,LOW);
}
if(le4==1){
digitalWrite(led4,HIGH);
le4=0;
}
else{
digitalWrite(led4,LOW);
}
if(le5==1){
digitalWrite(led5,HIGH);
le5=0;
}
else{
digitalWrite(led5,LOW);
}
if(le6==1){
digitalWrite(led6,HIGH);
le6=0;
}
else{
digitalWrite(led6,LOW);
}
if(le7==1){
digitalWrite(led7,HIGH);
le7=0;
}
else{
digitalWrite(led7,LOW);
}
if(le8==1){
digitalWrite(led8,HIGH);
le8=0;
}
else{
digitalWrite(led8,LOW);
}
if(ps2x.Analog(PSS_RX) != 128) //if right analog stick is moved on X axis right-left
{
Serial.println("Right Stick Moves!");
if(ps2x.Analog(PSS_RX) > 128)
{
myservo.write( map(ps2x.Analog(PSS_RX), 129,255,91,180));
delay(15);
}
if(ps2x.Analog(PSS_RX) < 128)
{
myservo.write( map(ps2x.Analog(PSS_RX), 0,127,0,89));
delay(15);
}
}
if(ps2x.Analog(PSS_RX) == 128) //if right analog stick is center
{
Serial.println("Servo Centered!");
myservo.write(90);
delay(15);
}
}
delay(50);
}
Sumber dari Famosa Studio
Post a Comment