void PS2X::enableRumble() {
sendCommandString(enter_config, sizeof(enter_config));
sendCommandString(enable_rumble, sizeof(enable_rumble));
sendCommandString(exit_config, sizeof(exit_config));
en_Rumble = true;
}
void PS2X::reconfig_gamepad(){
sendCommandString(enter_config, sizeof(enter_config));
sendCommandString(set_mode, sizeof(set_mode));
if (en_Rumble)
sendCommandString(enable_rumble, sizeof(enable_rumble));
if (en_Pressures)
sendCommandString(set_bytes_large, sizeof(set_bytes_large));
sendCommandString(exit_config, sizeof(exit_config));
}
bool PS2X::enablePressures() {
sendCommandString(enter_config, sizeof(enter_config));
sendCommandString(set_bytes_large, sizeof(set_bytes_large));
sendCommandString(exit_config, sizeof(exit_config));
read_gamepad();
read_gamepad();
if(PS2data[1] != 0x79)
return false;
en_Pressures = true;
return true;
}
byte PS2X::config_gamepad(uint8_t clk, uint8_t cmd, uint8_t att, uint8_t dat, bool pressures, bool rumble) {
SaveInterruptState; // *** KJE *** save away the current state of interrupts
byte temp[sizeof(type_read)];
#ifdef __AVR__
_clk_mask = maskToBitNum(digitalPinToBitMask(clk));
_clk_oreg = portOutputRegister(digitalPinToPort(clk));
_cmd_mask = Num(digitalPinToBitMask(cmd));
_cmd_oreg = portOutputRegister(digitalPinToPort(cmd));
_att_mask = maskToBitNum(digitalPinToBitMask(att));
_att_oreg = portOutputRegister(digitalPinToPort(att));
_dat_mask = maskToBitNum(digitalPinToBitMask(dat));
_dat_ireg = portInputRegister(digitalPinToPort(dat));
#else
_clk_mask = digitalPinToBitMask(clk);
_clk_lport = portOutputRegister(digitalPinToPort(clk));
_cmd_mask = digitalPinToBitMask(cmd);
_cmd_lport = portOutputRegister(digitalPinToPort(cmd));
_att_mask = digitalPinToBitMask(att);
_att_lport = portOutputRegister(digitalPinToPort(att));
_dat_mask = digitalPinToBitMask(dat);
_dat_lport = portInputRegister(digitalPinToPort(dat));
#endif
pinMode(clk, OUTPUT); //configure ports
pinMode(att, OUTPUT);
pinMode(cmd, OUTPUT);
pinMode(dat, INPUT);
#if defined(__AVR__)
digitalWrite(dat, HIGH); //enable pull-up
#endif
DisableInterrupts; // *** KJE *** disable for now
CMD_SET(); // SET(*_cmd_oreg,_cmd_mask);
CLK_SET();
RestoreInterrupts; // *** *** KJE *** *** Interrupts may be enabled again
//new error checking. First, read gamepad a few times to see if it's talking
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
Serial.println("Controller mode not matched or no controller found");
Serial.print("Expected 0x41 or 0x73, got ");
Serial.println(PS2data[1], HEX);
#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++)
{
sendCommandString(enter_config, sizeof(enter_config)); //start config run
//read type
delayMicroseconds(CTRL_BYTE_DELAY);
DisableInterrupts; // *** KJE *** disable for now
CMD_SET();
CLK_SET();
ATT_CLR(); // low enable joystick
RestoreInterrupts; // *** *** KJE *** *** Interrupts may be enabled again
delayMicroseconds(CTRL_BYTE_DELAY);
for (int i = 0; i<9; i++) {
temp[i] = _gamepad_shiftinout(type_read[i]);
}
DisableInterrupts; // *** KJE *** disable for now
ATT_SET(); // HI disable joystick
RestoreInterrupts; // *** *** KJE *** *** Interrupts may be enabled again
controller_type = temp[3];
sendCommandString(set_mode, sizeof(set_mode));
if(rumble){ sendCommandString(enable_rumble, sizeof(enable_rumble)); en_Rumble = true; }
if(pressures){ sendCommandString(set_bytes_large, sizeof(set_bytes_large)); en_Pressures = true; }
sendCommandString(exit_config, sizeof(exit_config));
read_gamepad();
if(pressures){
if(PS2data[1] == 0x79)
break;
if(PS2data[1] == 0x73)
return 3;
}
if(PS2data[1] == 0x73)
break;
if(y == 10){
#ifdef PS2X_DEBUG
Serial.println("Controller not accepting commands");
Serial.print("mode stil set at");
Serial.println(PS2data[1], HEX);
#endif
return 2; //exit function with error
}
read_delay += 1; //add 1ms to read_delay
}
return 0; //no error if here
}
void PS2X::reconfig_gamepad()
{
sendCommandString(enter_config, sizeof(enter_config));
sendCommandString(set_mode, sizeof(set_mode));
sendCommandString(exit_config, sizeof(exit_config));
}
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)];
_clk_mask = digitalPinToBitMask(clk);
_clk_oreg = portOutputRegister(digitalPinToPort(clk));
_cmd_mask = digitalPinToBitMask(cmd);
_cmd_oreg = portOutputRegister(digitalPinToPort(cmd));
_att_mask = digitalPinToBitMask(att);
_att_oreg = portOutputRegister(digitalPinToPort(att));
_dat_mask = digitalPinToBitMask(dat);
_dat_ireg = portInputRegister(digitalPinToPort(dat));
MC_SET_PIN_OUTPUT(PS2_PIN_CLK);
MC_SET_PIN_OUTPUT(PS2_PIN_CMD);
MC_SET_PIN_OUTPUT(PS2_PIN_SEL);
MC_SET_PIN_INPUT(PS2_PIN_DAT);
CMD_SET(); // SET(*_cmd_oreg,_cmd_mask);
CLK_SET();
//new error checking. First, read gamepad a few times to see if it's talking
read_gamepad();
read_gamepad();
//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)
{
return 1; //return error code 1
}
//try setting mode, increasing delays if need be.
read_delay = 1;
for(int y = 0; y <= 10; y++)
{
sendCommandString(enter_config, sizeof(enter_config)); //start config run
//read type
_delay_us(CTRL_BYTE_DELAY);
CMD_SET();
CLK_SET();
ATT_CLR(); // low enable joystick
_delay_us(CTRL_BYTE_DELAY);
for (int i = 0; i<9; i++)
{
temp[i] = _gamepad_shiftinout(type_read[i]);
}
ATT_SET(); // HI disable joystick
controller_type = temp[3];
sendCommandString(set_mode, sizeof(set_mode));
sendCommandString(exit_config, sizeof(exit_config));
read_gamepad();
if(pressures)
{
if(PS2data[1] == 0x79)
{
break;
}
if(PS2data[1] == 0x73)
{
return 3;
}
}
if(PS2data[1] == 0x73)
{
break;
}
if(y == 10)
{
return 2; //exit function with error
}
read_delay += 1; //add 1ms to read_delay
}
return 0; //no error if here
}