static int initializePad(int port, int slot)
{
int ret;
int modes;
int i;
waitPadReady(port, slot);
modes = padInfoMode(port, slot, PAD_MODETABLE, -1);
if (modes > 0) {
for (i = 0; i < modes; i++) {
}
}
if (modes == 0) {
return 1;
}
i = 0;
do {
if (padInfoMode(port, slot, PAD_MODETABLE, i) == PAD_TYPE_DUALSHOCK)
break;
i++;
} while (i < modes);
if (i >= modes) {
return 1;
}
ret = padInfoMode(port, slot, PAD_MODECUREXID, 0);
if (ret == 0) {
return 1;
}
padSetMainMode(port, slot, PAD_MMODE_DUALSHOCK, PAD_MMODE_LOCK);
waitPadReady(port, slot);
padInfoPressMode(port, slot);
waitPadReady(port, slot);
padEnterPressMode(port, slot);
waitPadReady(port, slot);
actuators = padInfoAct(port, slot, -1, 0);
if (actuators != 0) {
actAlign[0] = 0;
actAlign[1] = 1;
actAlign[2] = 0xff;
actAlign[3] = 0xff;
actAlign[4] = 0xff;
actAlign[5] = 0xff;
waitPadReady(port, slot);
padSetActAlign(port, slot, actAlign);
}
else {
//printf("Did not find any actuators.\n");
}
return 1;
}
static int initializePad(struct pad_data_t* pad) {
int tmp;
int modes;
int i;
// is there any device connected to that port?
if (waitPadReady(pad) == PAD_STATE_DISCONN) {
return 1; // nope, don't waste your time here!
}
// How many different modes can this device operate in?
// i.e. get # entrys in the modetable
modes = padInfoMode(pad->port, pad->slot, PAD_MODETABLE, -1);
LOG("PAD: The device has %d modes\n", modes);
if (modes > 0) {
LOG("( ");
for (i = 0; i < modes; i++) {
tmp = padInfoMode(pad->port, pad->slot, PAD_MODETABLE, i);
LOG("%d ", tmp);
}
LOG(")");
}
tmp = padInfoMode(pad->port, pad->slot, PAD_MODECURID, 0);
LOG("PAD: It is currently using mode %d\n", tmp);
// If modes == 0, this is not a Dual shock controller
// (it has no actuator engines)
if (modes == 0) {
LOG("PAD: This is a digital controller?\n");
return 1;
}
// Verify that the controller has a DUAL SHOCK mode
i = 0;
do {
if (padInfoMode(pad->port, pad->slot, PAD_MODETABLE, i) == PAD_TYPE_DUALSHOCK)
break;
i++;
} while (i < modes);
if (i >= modes) {
LOG("PAD: This is no Dual Shock controller\n");
return 1;
}
// If ExId != 0x0 => This controller has actuator engines
// This check should always pass if the Dual Shock test above passed
tmp = padInfoMode(pad->port, pad->slot, PAD_MODECUREXID, 0);
if (tmp == 0) {
LOG("PAD: This is no Dual Shock controller??\n");
return 1;
}
LOG("PAD: Enabling dual shock functions\n");
// When using MMODE_LOCK, user cant change mode with Select button
padSetMainMode(pad->port, pad->slot, PAD_MMODE_DUALSHOCK, PAD_MMODE_LOCK);
waitPadReady(pad);
tmp = padInfoPressMode(pad->port, pad->slot);
LOG("PAD: infoPressMode: %d\n", tmp);
waitPadReady(pad);
tmp = padEnterPressMode(pad->port, pad->slot);
LOG("PAD: enterPressMode: %d\n", tmp);
waitPadReady(pad);
pad->actuators = padInfoAct(pad->port, pad->slot, -1, 0);
LOG("PAD: # of actuators: %d\n", pad->actuators);
if (pad->actuators != 0) {
pad->actAlign[0] = 0; // Enable small engine
pad->actAlign[1] = 1; // Enable big engine
pad->actAlign[2] = 0xff;
pad->actAlign[3] = 0xff;
pad->actAlign[4] = 0xff;
pad->actAlign[5] = 0xff;
waitPadReady(pad);
tmp = padSetActAlign(pad->port, pad->slot, pad->actAlign);
LOG("PAD: padSetActAlign: %d\n", tmp);
} else {
LOG("PAD: Did not find any actuators.\n");
}
waitPadReady(pad);
return 1;
}
void Ps2Pad::initPad(void) {
int modes = 0;
if (_padStatus == STAT_NONE) {
if (padPortOpen(_port, _slot, _padBuf) == 1) {
_padStatus = STAT_OPEN;
_padInitTime = _system->getMillis();
} else {
padPortClose(_port, _slot);
printf("Unable to open port (%d/%d)!\n", _port, _slot);
}
} else {
if (checkPadReady(_port, _slot)) {
switch (_padStatus) {
case STAT_OPEN:
_padStatus = STAT_DETECT;
break;
case STAT_DETECT:
_isDualShock = false;
modes = padInfoMode(_port, _slot, PAD_MODETABLE, -1);
// Verify that the controller has a DUAL SHOCK mode
for (int cnt = 0; cnt < modes; cnt++)
if (padInfoMode(_port, _slot, PAD_MODETABLE, cnt) == PAD_TYPE_DUALSHOCK)
_isDualShock = true;
// If ExId != 0x0 => This controller has actuator engines
// This check should always pass if the Dual Shock test above passed
if (_isDualShock)
if (padInfoMode(_port, _slot, PAD_MODECUREXID, 0) == 0)
_isDualShock = false;
if (_isDualShock) {
// When using MMODE_LOCK, user cant change mode with Select button
padSetMainMode(_port, _slot, PAD_MMODE_DUALSHOCK, PAD_MMODE_LOCK);
_padStatus = STAT_INIT_DSHOCK;
} else
_padStatus = STAT_WAIT_READY;
break;
case STAT_INIT_DSHOCK:
padEnterPressMode(_port, _slot);
_padStatus = STAT_CHECK_ACT;
break;
case STAT_CHECK_ACT:
_actuators = padInfoAct(_port, _slot, -1, 0);
if (_actuators != 0)
_padStatus = STAT_INIT_ACT;
else {
_isDualShock = false;
_padStatus = STAT_WAIT_READY;
}
break;
case STAT_INIT_ACT:
char actAlign[6];
actAlign[0] = 0;
actAlign[1] = 1;
actAlign[2] = actAlign[3] = actAlign[4] = actAlign[5] = 0xff;
padSetActAlign(_port, _slot, actAlign);
_padStatus = STAT_WAIT_READY;
break;
case STAT_WAIT_READY:
_padStatus = STAT_OKAY;
break;
case STAT_OKAY:
case STAT_NONE:
// pad is already initialized (or not there)
break;
}
} else {
// check for timeout...
if (_system->getMillis() - _padInitTime > 5000) {
// still no pad, give up.
if (padPortClose(_port, _slot) != 1)
printf("WARNING: can't close port: %d/%d\n", _port, _slot);
printf("looking for pad, gave up and closed port\n");
_padStatus = STAT_NONE;
}
}
}
}
int main(int argc, char **argv)
{
u32 port;
struct padButtonStatus buttons;
int dualshock[2];
int acts[2];
SifInitRpc(0);
printf("libpadx sample");
if((argc == 2) && (strncmp(argv[1], "free", 4) == 0))
{
printf(" - Using PS2SDK freesio2.irx and freepad.irx modules.\n");
loadmodules(1);
}
else
{
printf(" - Using ROM XSIO2MAN and XPADMAN modules.\n");
printf("Start this sample with 'free' as an argument to load freesio2.irx and freepad.irx\n");
printf("Example: ps2client execee host:padx_sample.elf free\n");
loadmodules(0);
}
padInit(0);
padBuf[0] = memalign(64, 256);
padBuf[1] = memalign(64, 256);
old_pad[0] = 0;
old_pad[1] = 0;
portConnected[0] = 0;
portConnected[1] = 0;
dualshock[0] = 0;
dualshock[1] = 0;
acts[0] = 0;
acts[1] = 0;
padPortOpen(0, 0, padBuf[0]);
padPortOpen(1, 0, padBuf[1]);
while(1)
{
for(port=0; port < 2; port++)
{
s32 state = padGetState(port, 0);
if((state == PAD_STATE_STABLE) && (portConnected[port] == 0))
{
u32 i;
u8 mTable[8];
u32 ModeCurId;
u32 ModeCurOffs;
u32 ModeCurExId;
u32 ModeTableNum = padInfoMode(port, 0, PAD_MODETABLE, -1);
printf("Controller (%i) connected\n", port);
/* Check if dualshock and if so, activate analog mode */
for(i = 0; i < ModeTableNum; i++)
mTable[i] = padInfoMode(port, 0, PAD_MODETABLE, i);
/* Works for dualshock2 */
if((mTable[0] == 4) && (mTable[1] == 7) && (ModeTableNum == 2))
dualshock[port] = 1;
/* Active and lock analog mode */
if(dualshock[port] == 1)
{
padSetMainMode(port, 0, PAD_MMODE_DUALSHOCK, PAD_MMODE_LOCK);
padWait(port);
}
ModeCurId = padInfoMode(port, 0, PAD_MODECURID, 0);
ModeCurOffs = padInfoMode(port, 0, PAD_MODECUROFFS, 0);
ModeCurExId = padInfoMode(port, 0, PAD_MODECUREXID, 0);
ModeTableNum = padInfoMode(port, 0, PAD_MODETABLE, -1);
acts[port] = padInfoAct(port, 0, -1, 0);
printf(" ModeCurId : %i (%s)\n", (int)ModeCurId, padTypeStr[ModeCurId]);
printf(" ModeCurExId : %i\n", (int)ModeCurExId);
printf(" ModeTable : ");
for(i = 0; i < ModeTableNum; i++)
{
mTable[i] = padInfoMode(port, 0, PAD_MODETABLE, i);
printf("%i ", (int)mTable[i]);
}
printf("\n");
printf(" ModeTableNum : %i\n", (int)ModeTableNum);
printf(" ModeCurOffs : %i\n", (int)ModeCurOffs);
printf(" NumOfAct : %i\n", (int)acts[port]);
printf(" PressMode : %i\n", (int)padInfoPressMode(port, 0));
if(acts[port] > 0)
{
u8 actAlign[6] = { 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF};
u32 i;
/* Set offsets for motor parameters for SetActDirect. */
for(i=0; i < acts[port]; i++)
actAlign[i] = i;
padSetActAlign(port, 0, actAlign);
padWait(port);
}
printf(" EnterPressMode : %i\n", (int)padEnterPressMode(port, 0));
padWait(port);
printf("Ready\n");
portConnected[port] = 1;
}
if((state == PAD_STATE_DISCONN) && (portConnected[port] == 1))
{
printf("Controller (%i) disconnected\n", port);
portConnected[port] = 0;
}
if(portConnected[port] == 1)
{
s32 ret = padRead(port, 0, &buttons);
if(ret != 0)
{
paddata[port] = 0xffff ^ buttons.btns;
new_pad[port] = paddata[port] & ~old_pad[port];
old_pad[port] = paddata[port];
// Values 50 and 200 used because my controllers are worn out :-)
if((buttons.ljoy_h <= 50) || (buttons.ljoy_h >= 200)) printf("Left Analog X: %i\n", (int)buttons.ljoy_h);
if((buttons.ljoy_v <= 50) || (buttons.ljoy_v >= 200)) printf("Left Analog Y: %i\n", (int)buttons.ljoy_v);
if((buttons.rjoy_h <= 50) || (buttons.rjoy_h >= 200)) printf("Right Analog X: %i\n", (int)buttons.rjoy_h);
if((buttons.rjoy_v <= 50) || (buttons.rjoy_v >= 200)) printf("Right Analog Y: %i\n", (int)buttons.rjoy_v);
if(new_pad[port]) printf("Controller (%i) button(s) pressed: ", (int)port);
if(new_pad[port] & PAD_LEFT) printf("LEFT ");
if(new_pad[port] & PAD_RIGHT) printf("RIGHT ");
if(new_pad[port] & PAD_UP) printf("UP ");
if(new_pad[port] & PAD_DOWN) printf("DOWN ");
if(new_pad[port] & PAD_START) printf("START ");
if(new_pad[port] & PAD_SELECT) printf("SELECT ");
if(new_pad[port] & PAD_SQUARE) printf("SQUARE (Pressure: %i) ", (int)buttons.square_p);
if(new_pad[port] & PAD_TRIANGLE) printf("TRIANGLE (Pressure: %i) ", (int)buttons.triangle_p);
if(new_pad[port] & PAD_CIRCLE) printf("CIRCLE (Pressure: %i) ", (int)buttons.circle_p);
if(new_pad[port] & PAD_CROSS) printf("CROSS (Pressure: %i) ", (int)buttons.cross_p);
if(new_pad[port] & PAD_L1)
{
printf("L1 (Start Little Motor) ");
padStartAct(port, 0, 1);
}
if(new_pad[port] & PAD_L2)
{
printf("L2 (Stop Little Motor) ");
padStartAct(port, 0, 0);
}
if(new_pad[port] & PAD_L3) printf("L3 ");
if(new_pad[port] & PAD_R1)
{
printf("R1 (Start Big Motor) ");
padStartAct(port, 1, 255);
}
if(new_pad[port] & PAD_R2)
{
printf("R2 (Stop Big Motor) ");
padStopAct(port, 1);
}
if(new_pad[port] & PAD_R3) printf("R3 ");
if(new_pad[port]) printf("\n");
}
}
}
wait_vsync();
}
return 0;
}