/* * Copyright (c) 2009, Wei Mingzhi . * All Rights Reserved. * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by * the Free Software Foundation; either version 2 of the License, or * (at your option) any later version. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * You should have received a copy of the GNU General Public License * along with this program; if not, see . * * this is only pure emulation code to handle analogs, * extracted from dfinput. */ #include #include "../../libpcsxcore/psemu_plugin_defs.h" enum { ANALOG_LEFT = 0, ANALOG_RIGHT, ANALOG_TOTAL }; enum { CMD_READ_DATA_AND_VIBRATE = 0x42, CMD_CONFIG_MODE = 0x43, CMD_SET_MODE_AND_LOCK = 0x44, CMD_QUERY_MODEL_AND_MODE = 0x45, CMD_QUERY_ACT = 0x46, // ?? CMD_QUERY_COMB = 0x47, // ?? CMD_QUERY_MODE = 0x4C, // QUERY_MODE ?? CMD_VIBRATION_TOGGLE = 0x4D, }; static struct { uint8_t PadMode; uint8_t PadID; uint8_t ConfigMode; PadDataS pad; } padstate[2]; static uint8_t stdpar[2][8] = { {0xFF, 0x5A, 0xFF, 0xFF, 0x80, 0x80, 0x80, 0x80}, {0xFF, 0x5A, 0xFF, 0xFF, 0x80, 0x80, 0x80, 0x80} }; static uint8_t unk46[2][8] = { {0xFF, 0x5A, 0x00, 0x00, 0x01, 0x02, 0x00, 0x0A}, {0xFF, 0x5A, 0x00, 0x00, 0x01, 0x02, 0x00, 0x0A} }; static uint8_t unk47[2][8] = { {0xFF, 0x5A, 0x00, 0x00, 0x02, 0x00, 0x01, 0x00}, {0xFF, 0x5A, 0x00, 0x00, 0x02, 0x00, 0x01, 0x00} }; static uint8_t unk4c[2][8] = { {0xFF, 0x5A, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, {0xFF, 0x5A, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00} }; static uint8_t unk4d[2][8] = { {0xFF, 0x5A, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF}, {0xFF, 0x5A, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF} }; static uint8_t stdcfg[2][8] = { {0xFF, 0x5A, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, {0xFF, 0x5A, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00} }; static uint8_t stdmode[2][8] = { {0xFF, 0x5A, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, {0xFF, 0x5A, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00} }; static uint8_t stdmodel[2][8] = { {0xFF, 0x5A, 0x01, // 03 - dualshock2, 01 - dualshock 0x02, // number of modes 0x01, // current mode: 01 - analog, 00 - digital 0x02, 0x01, 0x00}, {0xFF, 0x5A, 0x01, // 03 - dualshock2, 01 - dualshock 0x02, // number of modes 0x01, // current mode: 01 - analog, 00 - digital 0x02, 0x01, 0x00} }; static uint8_t CurPad = 0, CurByte = 0, CurCmd = 0, CmdLen = 0; static uint8_t *buf; static uint8_t do_cmd(void) { PadDataS *pad = &padstate[CurPad].pad; int pad_num = CurPad; CmdLen = 8; switch (CurCmd) { case CMD_SET_MODE_AND_LOCK: buf = stdmode[pad_num]; return 0xF3; case CMD_QUERY_MODEL_AND_MODE: buf = stdmodel[pad_num]; buf[4] = padstate[pad_num].PadMode; return 0xF3; case CMD_QUERY_ACT: buf = unk46[pad_num]; return 0xF3; case CMD_QUERY_COMB: buf = unk47[pad_num]; return 0xF3; case CMD_QUERY_MODE: buf = unk4c[pad_num]; return 0xF3; case CMD_VIBRATION_TOGGLE: buf = unk4d[pad_num]; return 0xF3; case CMD_CONFIG_MODE: if (padstate[pad_num].ConfigMode) { buf = stdcfg[pad_num]; return 0xF3; } // else FALLTHROUGH case CMD_READ_DATA_AND_VIBRATE: default: buf = stdpar[pad_num]; buf[2] = pad->buttonStatus; buf[3] = pad->buttonStatus >> 8; if (padstate[pad_num].PadMode == 1) { buf[4] = pad->rightJoyX; buf[5] = pad->rightJoyY; buf[6] = pad->leftJoyX; buf[7] = pad->leftJoyY; } else { CmdLen = 4; } return padstate[pad_num].PadID; } } static void do_cmd2(unsigned char value) { switch (CurCmd) { case CMD_CONFIG_MODE: padstate[CurPad].ConfigMode = value; break; case CMD_SET_MODE_AND_LOCK: padstate[CurPad].PadMode = value; padstate[CurPad].PadID = value ? 0x73 : 0x41; break; case CMD_QUERY_ACT: switch (value) { case 0: // default buf[5] = 0x02; buf[6] = 0x00; buf[7] = 0x0A; break; case 1: // Param std conf change buf[5] = 0x01; buf[6] = 0x01; buf[7] = 0x14; break; } break; case CMD_QUERY_MODE: switch (value) { case 0: // mode 0 - digital mode buf[5] = PSE_PAD_TYPE_STANDARD; break; case 1: // mode 1 - analog mode buf[5] = PSE_PAD_TYPE_ANALOGPAD; break; } break; } } static unsigned char PADpoll_(unsigned char value) { if (CurByte == 0) { CurCmd = value; CurByte++; // Don't enable Analog/Vibration for a standard pad if (padstate[CurPad].pad.controllerType != PSE_PAD_TYPE_ANALOGPAD) CurCmd = CMD_READ_DATA_AND_VIBRATE; return do_cmd(); } if (CurByte == 2) do_cmd2(value); if (CurByte >= CmdLen) return 0xff; // verified return buf[CurByte++]; } #if 0 #include static unsigned char PADpoll(unsigned char value) { unsigned char b = CurByte, r = PADpoll_(value); printf("poll[%d] %02x %02x\n", b, value, r); return r; } #else #define PADpoll PADpoll_ #endif /* hack.. */ extern long (*PAD1_readPort1)(PadDataS *pad); static unsigned char PADstartPoll1(int pad) { CurPad = 0; CurByte = 0; PAD1_readPort1(&padstate[0].pad); return 0xFF; } /* some more hacks here but oh well */ extern void *PAD1_startPoll, *PAD1_poll; void dfinput_activate(int yes) { static void *old_start, *old_poll; if (!yes) { if (PAD1_startPoll == PADstartPoll1) PAD1_startPoll = old_start; if (PAD1_poll == PADpoll) PAD1_poll = old_poll; return; } if (PAD1_startPoll == PADstartPoll1 && PAD1_poll == PADpoll) return; old_start = PAD1_startPoll; old_poll = PAD1_poll; PAD1_startPoll = PADstartPoll1; PAD1_poll = PADpoll; PAD1_readPort1(&padstate[0].pad); padstate[0].PadID = padstate[0].pad.controllerType == PSE_PAD_TYPE_ANALOGPAD ? 0x73 : 0x41; padstate[0].PadMode = padstate[0].pad.controllerType == PSE_PAD_TYPE_ANALOGPAD; padstate[1].PadID = 0x41; padstate[1].PadMode = 0; }