Merge pull request #5 from StefQM/master
Removed occasional incorrect reading of L2 button
Esse commit está contido em:
Bill Porter
+53
-64
@@ -4,14 +4,12 @@
|
||||
#include <stdint.h>
|
||||
#include <avr/io.h>
|
||||
#if ARDUINO > 22
|
||||
#include "Arduino.h"
|
||||
#include "Arduino.h"
|
||||
#else
|
||||
#include "WProgram.h"
|
||||
#include "pins_arduino.h"
|
||||
#include "WProgram.h"
|
||||
#include "pins_arduino.h"
|
||||
#endif
|
||||
|
||||
|
||||
|
||||
static byte enter_config[]={0x01,0x43,0x00,0x01,0x00};
|
||||
static byte set_mode[]={0x01,0x44,0x00,0x01,0x03,0x00,0x00,0x00,0x00};
|
||||
static byte set_bytes_large[]={0x01,0x4F,0x00,0xFF,0xFF,0x03,0x00,0x00,0x00};
|
||||
@@ -19,47 +17,54 @@ static byte exit_config[]={0x01,0x43,0x00,0x00,0x5A,0x5A,0x5A,0x5A,0x5A};
|
||||
static byte enable_rumble[]={0x01,0x4D,0x00,0x00,0x01};
|
||||
static byte type_read[]={0x01,0x45,0x00,0x5A,0x5A,0x5A,0x5A,0x5A,0x5A};
|
||||
|
||||
/****************************************************************************************/
|
||||
boolean PS2X::NewButtonState() {
|
||||
return ((last_buttons ^ buttons) > 0);
|
||||
|
||||
}
|
||||
|
||||
/****************************************************************************************/
|
||||
boolean PS2X::NewButtonState(unsigned int button) {
|
||||
return (((last_buttons ^ buttons) & button) > 0);
|
||||
}
|
||||
|
||||
/****************************************************************************************/
|
||||
boolean PS2X::ButtonPressed(unsigned int button) {
|
||||
return(NewButtonState(button) & Button(button));
|
||||
}
|
||||
|
||||
/****************************************************************************************/
|
||||
boolean PS2X::ButtonReleased(unsigned int button) {
|
||||
return((NewButtonState(button)) & ((~last_buttons & button) > 0));
|
||||
}
|
||||
|
||||
/****************************************************************************************/
|
||||
boolean PS2X::Button(uint16_t button) {
|
||||
return ((~buttons & button) > 0);
|
||||
}
|
||||
|
||||
/****************************************************************************************/
|
||||
unsigned int PS2X::ButtonDataByte() {
|
||||
return (~buttons);
|
||||
}
|
||||
|
||||
/****************************************************************************************/
|
||||
byte PS2X::Analog(byte button) {
|
||||
return PS2data[button];
|
||||
}
|
||||
|
||||
/****************************************************************************************/
|
||||
unsigned char PS2X::_gamepad_shiftinout (char byte) {
|
||||
|
||||
|
||||
unsigned char tmp = 0;
|
||||
for(i=0;i<8;i++) {
|
||||
|
||||
for(unsigned char i=0;i<8;i++) {
|
||||
if(CHK(byte,i)) CMD_SET();
|
||||
else CMD_CLR();
|
||||
CLK_CLR();
|
||||
|
||||
CLK_CLR();
|
||||
delayMicroseconds(CTRL_CLK);
|
||||
|
||||
if(DAT_CHK()) SET(tmp,i);
|
||||
//if(DAT_CHK()) SET(tmp,i);
|
||||
if(DAT_CHK()) bitSet(tmp,i);
|
||||
|
||||
CLK_SET();
|
||||
#if CTRL_CLK_HIGH
|
||||
delayMicroseconds(CTRL_CLK_HIGH);
|
||||
@@ -70,11 +75,12 @@ unsigned char PS2X::_gamepad_shiftinout (char byte) {
|
||||
return tmp;
|
||||
}
|
||||
|
||||
/****************************************************************************************/
|
||||
void PS2X::read_gamepad() {
|
||||
read_gamepad(false, 0x00);
|
||||
}
|
||||
|
||||
|
||||
/****************************************************************************************/
|
||||
boolean PS2X::read_gamepad(boolean motor1, byte motor2) {
|
||||
double temp = millis() - last_read;
|
||||
|
||||
@@ -84,8 +90,6 @@ boolean PS2X::read_gamepad(boolean motor1, byte motor2) {
|
||||
if(temp < read_delay) //waited too short
|
||||
delay(read_delay - temp);
|
||||
|
||||
|
||||
|
||||
if(motor2 != 0x00)
|
||||
motor2 = map(motor2,0,255,0x40,0xFF); //noting below 40 will make it spin
|
||||
|
||||
@@ -100,12 +104,10 @@ boolean PS2X::read_gamepad(boolean motor1, byte motor2) {
|
||||
|
||||
delayMicroseconds(CTRL_BYTE_DELAY);
|
||||
//Send the command to send button and joystick data;
|
||||
|
||||
for (int i = 0; i<9; i++) {
|
||||
PS2data[i] = _gamepad_shiftinout(dword[i]);
|
||||
}
|
||||
|
||||
|
||||
if(PS2data[1] == 0x79) { //if controller is in full data return mode, get the rest of data
|
||||
for (int i = 0; i<12; i++) {
|
||||
PS2data[i+9] = _gamepad_shiftinout(dword2[i]);
|
||||
@@ -113,8 +115,8 @@ boolean PS2X::read_gamepad(boolean motor1, byte motor2) {
|
||||
}
|
||||
|
||||
ATT_SET(); // HI disable joystick
|
||||
// Check to see if we received valid data or not. We should be in analog mode for our data
|
||||
// to be valie
|
||||
// Check to see if we received valid data or not.
|
||||
// We should be in analog mode for our data to be valid (analog == 0x7_)
|
||||
if ((PS2data[1] & 0xf0) == 0x70)
|
||||
break;
|
||||
|
||||
@@ -123,14 +125,13 @@ boolean PS2X::read_gamepad(boolean motor1, byte motor2) {
|
||||
delay(read_delay);
|
||||
}
|
||||
|
||||
// If we get here and still not in analog mode, try increasing the read_delay...
|
||||
// If we get here and still not in analog mode (=0x7_), try increasing the read_delay...
|
||||
if ((PS2data[1] & 0xf0) != 0x70) {
|
||||
if (read_delay < 10)
|
||||
read_delay++; // see if this helps out...
|
||||
}
|
||||
|
||||
|
||||
#ifdef PS2X_COM_DEBUG
|
||||
#ifdef PS2X_COM_DEBUG
|
||||
Serial.println("OUT:IN");
|
||||
for(int i=0; i<9; i++){
|
||||
Serial.print(dword[i], HEX);
|
||||
@@ -145,7 +146,7 @@ boolean PS2X::read_gamepad(boolean motor1, byte motor2) {
|
||||
Serial.print(" ");
|
||||
}
|
||||
Serial.println("");
|
||||
#endif
|
||||
#endif
|
||||
|
||||
last_buttons = buttons; //store the previous buttons states
|
||||
|
||||
@@ -155,14 +156,15 @@ boolean PS2X::read_gamepad(boolean motor1, byte motor2) {
|
||||
buttons = (uint16_t)(PS2data[4] << 8) + PS2data[3]; //store as one value for multiple functions
|
||||
#endif
|
||||
last_read = millis();
|
||||
return ((PS2data[1] & 0xf0) == 0x70);
|
||||
return ((PS2data[1] & 0xf0) == 0x70); // 1 = OK = analog mode - 0 = NOK
|
||||
}
|
||||
|
||||
/****************************************************************************************/
|
||||
byte PS2X::config_gamepad(uint8_t clk, uint8_t cmd, uint8_t att, uint8_t dat) {
|
||||
return config_gamepad(clk, cmd, att, dat, false, false);
|
||||
}
|
||||
|
||||
|
||||
/****************************************************************************************/
|
||||
byte PS2X::config_gamepad(uint8_t clk, uint8_t cmd, uint8_t att, uint8_t dat, bool pressures, bool rumble) {
|
||||
|
||||
byte temp[sizeof(type_read)];
|
||||
@@ -177,7 +179,6 @@ byte PS2X::config_gamepad(uint8_t clk, uint8_t cmd, uint8_t att, uint8_t dat, bo
|
||||
_dat_mask = digitalPinToBitMask(dat);
|
||||
_dat_ireg = portInputRegister(digitalPinToPort(dat));
|
||||
#else
|
||||
|
||||
uint32_t lport; // Port number for this pin
|
||||
_clk_mask = digitalPinToBitMask(clk);
|
||||
lport = digitalPinToPort(clk);
|
||||
@@ -196,7 +197,6 @@ byte PS2X::config_gamepad(uint8_t clk, uint8_t cmd, uint8_t att, uint8_t dat, bo
|
||||
|
||||
_dat_mask = digitalPinToBitMask(dat);
|
||||
_dat_lport = portInputRegister(digitalPinToPort(dat));
|
||||
|
||||
#endif
|
||||
|
||||
pinMode(clk, OUTPUT); //configure ports
|
||||
@@ -215,22 +215,21 @@ byte PS2X::config_gamepad(uint8_t clk, uint8_t cmd, uint8_t att, uint8_t dat, bo
|
||||
read_gamepad();
|
||||
read_gamepad();
|
||||
|
||||
//see if it talked
|
||||
if(PS2data[1] != 0x41 && PS2data[1] != 0x73 && PS2data[1] != 0x79){ //see if mode came back. If still anything but 41, 73 or 79, then it's not talking
|
||||
#ifdef PS2X_DEBUG
|
||||
//see if it talked - see if mode came back.
|
||||
//If still anything but 41, 73 or 79, then it's not talking
|
||||
if(PS2data[1] != 0x41 && PS2data[1] != 0x73 && PS2data[1] != 0x79){
|
||||
#ifdef PS2X_DEBUG
|
||||
Serial.println("Controller mode not matched or no controller found");
|
||||
Serial.print("Expected 0x41 or 0x73, got ");
|
||||
Serial.print("Expected 0x41, 0x73 or 0x79, but got ");
|
||||
Serial.println(PS2data[1], HEX);
|
||||
#endif
|
||||
|
||||
#endif
|
||||
return 1; //return error code 1
|
||||
}
|
||||
|
||||
//try setting mode, increasing delays if need be.
|
||||
read_delay = 1;
|
||||
|
||||
for(int y = 0; y <= 10; y++)
|
||||
{
|
||||
for(int y = 0; y <= 10; y++) {
|
||||
sendCommandString(enter_config, sizeof(enter_config)); //start config run
|
||||
|
||||
//read type
|
||||
@@ -268,26 +267,21 @@ byte PS2X::config_gamepad(uint8_t clk, uint8_t cmd, uint8_t att, uint8_t dat, bo
|
||||
break;
|
||||
|
||||
if(y == 10){
|
||||
#ifdef PS2X_DEBUG
|
||||
#ifdef PS2X_DEBUG
|
||||
Serial.println("Controller not accepting commands");
|
||||
Serial.print("mode stil set at");
|
||||
Serial.println(PS2data[1], HEX);
|
||||
#endif
|
||||
#endif
|
||||
return 2; //exit function with error
|
||||
}
|
||||
|
||||
read_delay += 1; //add 1ms to read_delay
|
||||
}
|
||||
|
||||
return 0; //no error if here
|
||||
}
|
||||
|
||||
|
||||
|
||||
/****************************************************************************************/
|
||||
void PS2X::sendCommandString(byte string[], byte len) {
|
||||
|
||||
|
||||
#ifdef PS2X_COM_DEBUG
|
||||
#ifdef PS2X_COM_DEBUG
|
||||
byte temp[len];
|
||||
ATT_CLR(); // low enable joystick
|
||||
delayMicroseconds(CTRL_BYTE_DELAY);
|
||||
@@ -299,26 +293,23 @@ void PS2X::sendCommandString(byte string[], byte len) {
|
||||
delay(read_delay); //wait a few
|
||||
|
||||
Serial.println("OUT:IN Configure");
|
||||
for(int i=0; i<len; i++){
|
||||
for(int i=0; i<len; i++) {
|
||||
Serial.print(string[i], HEX);
|
||||
Serial.print(":");
|
||||
Serial.print(temp[i], HEX);
|
||||
Serial.print(" ");
|
||||
}
|
||||
Serial.println("");
|
||||
|
||||
#else
|
||||
#else
|
||||
ATT_CLR(); // low enable joystick
|
||||
for (int y=0; y < len; y++)
|
||||
_gamepad_shiftinout(string[y]);
|
||||
|
||||
ATT_SET(); //high disable joystick
|
||||
delay(read_delay); //wait a few
|
||||
#endif
|
||||
#endif
|
||||
}
|
||||
|
||||
|
||||
|
||||
/****************************************************************************************/
|
||||
byte PS2X::readType() {
|
||||
/*
|
||||
byte temp[sizeof(type_read)];
|
||||
@@ -345,28 +336,28 @@ byte PS2X::readType() {
|
||||
return 2;
|
||||
|
||||
return 0;
|
||||
*/
|
||||
*/
|
||||
|
||||
if(controller_type == 0x03)
|
||||
return 1;
|
||||
else if(controller_type == 0x01)
|
||||
return 2;
|
||||
else if(controller_type == 0x0C)
|
||||
return 3; //2.4G Wireless Dual Shock PS2 Game Controller
|
||||
|
||||
return 0;
|
||||
|
||||
}
|
||||
|
||||
/****************************************************************************************/
|
||||
void PS2X::enableRumble() {
|
||||
|
||||
sendCommandString(enter_config, sizeof(enter_config));
|
||||
sendCommandString(enable_rumble, sizeof(enable_rumble));
|
||||
sendCommandString(exit_config, sizeof(exit_config));
|
||||
en_Rumble = true;
|
||||
|
||||
}
|
||||
|
||||
/****************************************************************************************/
|
||||
bool PS2X::enablePressures() {
|
||||
|
||||
sendCommandString(enter_config, sizeof(enter_config));
|
||||
sendCommandString(set_bytes_large, sizeof(set_bytes_large));
|
||||
sendCommandString(exit_config, sizeof(exit_config));
|
||||
@@ -381,8 +372,8 @@ bool PS2X::enablePressures() {
|
||||
return true;
|
||||
}
|
||||
|
||||
/****************************************************************************************/
|
||||
void PS2X::reconfig_gamepad(){
|
||||
|
||||
sendCommandString(enter_config, sizeof(enter_config));
|
||||
sendCommandString(set_mode, sizeof(set_mode));
|
||||
if (en_Rumble)
|
||||
@@ -390,13 +381,11 @@ void PS2X::reconfig_gamepad(){
|
||||
if (en_Pressures)
|
||||
sendCommandString(set_bytes_large, sizeof(set_bytes_large));
|
||||
sendCommandString(exit_config, sizeof(exit_config));
|
||||
|
||||
}
|
||||
|
||||
|
||||
/****************************************************************************************/
|
||||
#ifdef __AVR__
|
||||
inline void PS2X::CLK_SET(void) {
|
||||
|
||||
register uint8_t old_sreg = SREG;
|
||||
cli();
|
||||
*_clk_oreg |= _clk_mask;
|
||||
@@ -439,11 +428,12 @@ inline void PS2X::ATT_CLR(void) {
|
||||
}
|
||||
|
||||
inline bool PS2X::DAT_CHK(void) {
|
||||
return (*_dat_ireg & _dat_mask)? true : false;
|
||||
return (*_dat_ireg & _dat_mask) ? true : false;
|
||||
}
|
||||
|
||||
#else
|
||||
// On pic32, use the set/clr registers to make them atomic...inline void PS2X::CLK_SET(void) {
|
||||
// On pic32, use the set/clr registers to make them atomic...
|
||||
inline void PS2X::CLK_SET(void) {
|
||||
*_clk_lport_set |= _clk_mask;
|
||||
}
|
||||
|
||||
@@ -468,8 +458,7 @@ inline void PS2X::ATT_CLR(void) {
|
||||
}
|
||||
|
||||
inline bool PS2X::DAT_CHK(void) {
|
||||
return (*_dat_lport & _dat_mask)? true : false;
|
||||
|
||||
return (*_dat_lport & _dat_mask) ? true : false;
|
||||
}
|
||||
|
||||
#endif
|
||||
|
||||
+79
-83
@@ -72,36 +72,34 @@ GNU General Public License for more details.
|
||||
*
|
||||
******************************************************************/
|
||||
|
||||
|
||||
// $$$$$$$$$$$$ DEBUG ENABLE SECTION $$$$$$$$$$$$$$$$
|
||||
// to debug ps2 controller, uncomment these two lines to print out debug to uart
|
||||
|
||||
//#define PS2X_DEBUG
|
||||
//#define PS2X_COM_DEBUG
|
||||
|
||||
|
||||
#ifndef PS2X_lib_h
|
||||
#define PS2X_lib_h
|
||||
#define PS2X_lib_h
|
||||
|
||||
#if ARDUINO > 22
|
||||
#include "Arduino.h"
|
||||
#include "Arduino.h"
|
||||
#else
|
||||
#include "WProgram.h"
|
||||
#include "WProgram.h"
|
||||
#endif
|
||||
|
||||
#include <math.h>
|
||||
#include <stdio.h>
|
||||
#include <stdint.h>
|
||||
#ifdef __AVR__
|
||||
#include <avr/io.h>
|
||||
|
||||
#define CTRL_CLK 4
|
||||
#define CTRL_BYTE_DELAY 3
|
||||
// AVR
|
||||
#include <avr/io.h>
|
||||
#define CTRL_CLK 4
|
||||
#define CTRL_BYTE_DELAY 3
|
||||
#else
|
||||
// Pic32...
|
||||
#include <pins_arduino.h>
|
||||
#define CTRL_CLK 5
|
||||
#define CTRL_CLK_HIGH 5
|
||||
#define CTRL_BYTE_DELAY 4
|
||||
// Pic32...
|
||||
#include <pins_arduino.h>
|
||||
#define CTRL_CLK 5
|
||||
#define CTRL_CLK_HIGH 5
|
||||
#define CTRL_BYTE_DELAY 4
|
||||
#endif
|
||||
|
||||
//These are our button constants
|
||||
@@ -127,14 +125,14 @@ GNU General Public License for more details.
|
||||
#define PSB_SQUARE 0x8000
|
||||
|
||||
//Guitar button constants
|
||||
#define GREEN_FRET 0x0200
|
||||
#define RED_FRET 0x2000
|
||||
#define YELLOW_FRET 0x1000
|
||||
#define BLUE_FRET 0x4000
|
||||
#define ORANGE_FRET 0x8000
|
||||
#define STAR_POWER 0x0100
|
||||
#define UP_STRUM 0x0010
|
||||
#define DOWN_STRUM 0x0040
|
||||
#define STAR_POWER 0x0100
|
||||
#define GREEN_FRET 0x0200
|
||||
#define YELLOW_FRET 0x1000
|
||||
#define RED_FRET 0x2000
|
||||
#define BLUE_FRET 0x4000
|
||||
#define ORANGE_FRET 0x8000
|
||||
#define WHAMMY_BAR 8
|
||||
|
||||
//These are stick values
|
||||
@@ -161,77 +159,75 @@ GNU General Public License for more details.
|
||||
#define PSAB_CROSS 15
|
||||
#define PSAB_SQUARE 16
|
||||
|
||||
|
||||
#define SET(x,y) (x|=(1<<y))
|
||||
#define CLR(x,y) (x&=(~(1<<y)))
|
||||
#define CHK(x,y) (x & (1<<y))
|
||||
#define TOG(x,y) (x^=(1<<y))
|
||||
|
||||
|
||||
|
||||
class PS2X {
|
||||
public:
|
||||
boolean Button(uint16_t);
|
||||
unsigned int ButtonDataByte();
|
||||
boolean NewButtonState();
|
||||
boolean NewButtonState(unsigned int);
|
||||
boolean ButtonPressed(unsigned int);
|
||||
boolean ButtonReleased(unsigned int);
|
||||
void read_gamepad();
|
||||
boolean read_gamepad(boolean, byte);
|
||||
byte readType();
|
||||
byte config_gamepad(uint8_t, uint8_t, uint8_t, uint8_t);
|
||||
byte config_gamepad(uint8_t, uint8_t, uint8_t, uint8_t, bool, bool);
|
||||
void enableRumble();
|
||||
bool enablePressures();
|
||||
byte Analog(byte);
|
||||
void reconfig_gamepad();
|
||||
private:
|
||||
public:
|
||||
boolean Button(uint16_t); //will be TRUE if button is being pressed
|
||||
unsigned int ButtonDataByte();
|
||||
boolean NewButtonState();
|
||||
boolean NewButtonState(unsigned int); //will be TRUE if button was JUST pressed OR released
|
||||
boolean ButtonPressed(unsigned int); //will be TRUE if button was JUST pressed
|
||||
boolean ButtonReleased(unsigned int); //will be TRUE if button was JUST released
|
||||
void read_gamepad();
|
||||
boolean read_gamepad(boolean, byte);
|
||||
byte readType();
|
||||
byte config_gamepad(uint8_t, uint8_t, uint8_t, uint8_t);
|
||||
byte config_gamepad(uint8_t, uint8_t, uint8_t, uint8_t, bool, bool);
|
||||
void enableRumble();
|
||||
bool enablePressures();
|
||||
byte Analog(byte);
|
||||
void reconfig_gamepad();
|
||||
|
||||
inline void CLK_SET(void);
|
||||
inline void CLK_CLR(void);
|
||||
inline void CMD_SET(void);
|
||||
inline void CMD_CLR(void);
|
||||
inline void ATT_SET(void);
|
||||
inline void ATT_CLR(void);
|
||||
inline bool DAT_CHK(void);
|
||||
private:
|
||||
inline void CLK_SET(void);
|
||||
inline void CLK_CLR(void);
|
||||
inline void CMD_SET(void);
|
||||
inline void CMD_CLR(void);
|
||||
inline void ATT_SET(void);
|
||||
inline void ATT_CLR(void);
|
||||
inline bool DAT_CHK(void);
|
||||
|
||||
unsigned char _gamepad_shiftinout (char);
|
||||
unsigned char PS2data[21];
|
||||
void sendCommandString(byte*, byte);
|
||||
unsigned char i;
|
||||
unsigned int last_buttons;
|
||||
unsigned int buttons;
|
||||
#ifdef __AVR__
|
||||
uint8_t maskToBitNum(uint8_t);
|
||||
uint8_t _clk_mask;
|
||||
volatile uint8_t *_clk_oreg;
|
||||
uint8_t _cmd_mask;
|
||||
volatile uint8_t *_cmd_oreg;
|
||||
uint8_t _att_mask;
|
||||
volatile uint8_t *_att_oreg;
|
||||
uint8_t _dat_mask;
|
||||
volatile uint8_t *_dat_ireg;
|
||||
#else
|
||||
uint8_t maskToBitNum(uint8_t);
|
||||
uint16_t _clk_mask;
|
||||
volatile uint32_t * _clk_lport_set;
|
||||
volatile uint32_t * _clk_lport_clr;
|
||||
uint16_t _cmd_mask;
|
||||
volatile uint32_t * _cmd_lport_set;
|
||||
volatile uint32_t * _cmd_lport_clr;
|
||||
uint16_t _att_mask;
|
||||
volatile uint32_t * _att_lport_set;
|
||||
volatile uint32_t * _att_lport_clr;
|
||||
uint16_t _dat_mask;
|
||||
volatile uint32_t * _dat_lport;
|
||||
#endif
|
||||
unsigned long last_read;
|
||||
byte read_delay;
|
||||
byte controller_type;
|
||||
boolean en_Rumble;
|
||||
boolean en_Pressures;
|
||||
unsigned char _gamepad_shiftinout (char);
|
||||
unsigned char PS2data[21];
|
||||
void sendCommandString(byte*, byte);
|
||||
unsigned char i;
|
||||
unsigned int last_buttons;
|
||||
unsigned int buttons;
|
||||
|
||||
#ifdef __AVR__
|
||||
uint8_t maskToBitNum(uint8_t);
|
||||
uint8_t _clk_mask;
|
||||
volatile uint8_t *_clk_oreg;
|
||||
uint8_t _cmd_mask;
|
||||
volatile uint8_t *_cmd_oreg;
|
||||
uint8_t _att_mask;
|
||||
volatile uint8_t *_att_oreg;
|
||||
uint8_t _dat_mask;
|
||||
volatile uint8_t *_dat_ireg;
|
||||
#else
|
||||
uint8_t maskToBitNum(uint8_t);
|
||||
uint16_t _clk_mask;
|
||||
volatile uint32_t *_clk_lport_set;
|
||||
volatile uint32_t *_clk_lport_clr;
|
||||
uint16_t _cmd_mask;
|
||||
volatile uint32_t *_cmd_lport_set;
|
||||
volatile uint32_t *_cmd_lport_clr;
|
||||
uint16_t _att_mask;
|
||||
volatile uint32_t *_att_lport_set;
|
||||
volatile uint32_t *_att_lport_clr;
|
||||
uint16_t _dat_mask;
|
||||
volatile uint32_t *_dat_lport;
|
||||
#endif
|
||||
|
||||
unsigned long last_read;
|
||||
byte read_delay;
|
||||
byte controller_type;
|
||||
boolean en_Rumble;
|
||||
boolean en_Pressures;
|
||||
};
|
||||
|
||||
#endif
|
||||
|
||||
@@ -1,28 +1,64 @@
|
||||
#include <PS2X_lib.h> //for v1.6
|
||||
|
||||
/******************************************************************
|
||||
* set pins connected to PS2 controller:
|
||||
* - 1e column: 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 conect the controller,
|
||||
//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;
|
||||
|
||||
void setup(){
|
||||
|
||||
Serial.begin(57600);
|
||||
|
||||
delay(300); //added delay to give wireless ps2 module some time to startup, before configuring it
|
||||
|
||||
//CHANGES for v1.6 HERE!!! **************PAY ATTENTION*************
|
||||
|
||||
error = ps2x.config_gamepad(13,11,10,12, true, true); //setup pins and settings: GamePad(clock, command, attention, data, Pressures?, Rumble?) check for error
|
||||
//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.println("Found Controller, configured successful");
|
||||
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("Go to www.billporter.info for updates and to report bugs.");
|
||||
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");
|
||||
|
||||
@@ -32,39 +68,35 @@ void setup(){
|
||||
else if(error == 3)
|
||||
Serial.println("Controller refusing to enter Pressures mode, may not support it. ");
|
||||
|
||||
//Serial.print(ps2x.Analog(1), HEX);
|
||||
// Serial.print(ps2x.Analog(1), HEX);
|
||||
|
||||
type = ps2x.readType();
|
||||
switch(type) {
|
||||
case 0:
|
||||
Serial.println("Unknown Controller type");
|
||||
Serial.print("Unknown Controller type found ");
|
||||
break;
|
||||
case 1:
|
||||
Serial.println("DualShock Controller Found");
|
||||
Serial.print("DualShock Controller found ");
|
||||
break;
|
||||
case 2:
|
||||
Serial.println("GuitarHero Controller Found");
|
||||
Serial.print("GuitarHero Controller found ");
|
||||
break;
|
||||
case 3:
|
||||
Serial.print("Wireless Sony DualShock Controller found ");
|
||||
break;
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
void loop(){
|
||||
/* You must Read Gamepad to get new values
|
||||
Read GamePad and set vibration values
|
||||
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
|
||||
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))
|
||||
@@ -78,7 +110,6 @@ void loop(){
|
||||
if(ps2x.ButtonPressed(ORANGE_FRET))
|
||||
Serial.println("Orange Fret Pressed");
|
||||
|
||||
|
||||
if(ps2x.ButtonPressed(STAR_POWER))
|
||||
Serial.println("Star Power Command");
|
||||
|
||||
@@ -87,22 +118,17 @@ void loop(){
|
||||
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
|
||||
{
|
||||
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
|
||||
@@ -110,7 +136,6 @@ void loop(){
|
||||
if(ps2x.Button(PSB_SELECT))
|
||||
Serial.println("Select is being held");
|
||||
|
||||
|
||||
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);
|
||||
@@ -128,15 +153,8 @@ void loop(){
|
||||
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)
|
||||
{
|
||||
|
||||
|
||||
|
||||
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))
|
||||
@@ -145,24 +163,18 @@ void loop(){
|
||||
Serial.println("L2 pressed");
|
||||
if(ps2x.Button(PSB_R2))
|
||||
Serial.println("R2 pressed");
|
||||
if(ps2x.Button(PSB_GREEN))
|
||||
if(ps2x.Button(PSB_TRIANGLE))
|
||||
Serial.println("Triangle pressed");
|
||||
|
||||
}
|
||||
|
||||
|
||||
if(ps2x.ButtonPressed(PSB_RED)) //will be TRUE if button was JUST pressed
|
||||
if(ps2x.ButtonPressed(PSB_CIRCLE)) //will be TRUE if button was JUST pressed
|
||||
Serial.println("Circle just pressed");
|
||||
|
||||
if(ps2x.ButtonReleased(PSB_PINK)) //will be TRUE if button was JUST released
|
||||
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.NewButtonState(PSB_BLUE)) //will be TRUE if button was JUST pressed OR released
|
||||
Serial.println("X just changed");
|
||||
|
||||
|
||||
if(ps2x.Button(PSB_L1) || ps2x.Button(PSB_R1)) // print stick values if either is TRUE
|
||||
{
|
||||
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(",");
|
||||
@@ -172,11 +184,6 @@ void loop(){
|
||||
Serial.print(",");
|
||||
Serial.println(ps2x.Analog(PSS_RX), DEC);
|
||||
}
|
||||
|
||||
|
||||
}
|
||||
|
||||
|
||||
delay(50);
|
||||
|
||||
}
|
||||
|
||||
Referência em uma Nova Issue
Bloquear um usuário