--- /dev/null
+/* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * *
+ * Mupen64plus - pif.c *
+ * Mupen64Plus homepage: http://code.google.com/p/mupen64plus/ *
+ * Copyright (C) 2002 Hacktarux *
+ * *
+ * 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, write to the *
+ * Free Software Foundation, Inc., *
+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA. *
+ * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * */
+
+#include <stdio.h>
+#include <string.h>
+#include <stdlib.h>
+#include <time.h>
+
+#include "memory.h"
+#include "pif.h"
+#include "n64_cic_nus_6105.h"
+
+#include "r4300/r4300.h"
+#include "r4300/interupt.h"
+
+#include "api/m64p_types.h"
+#include "api/callbacks.h"
+#include "api/debugger.h"
+#include "main/main.h"
+#include "main/rom.h"
+#include "main/util.h"
+#include "plugin/plugin.h"
+
+static unsigned char eeprom[0x800];
+static unsigned char mempack[4][0x8000];
+
+static char *get_eeprom_path(void)
+{
+ return formatstr("%s%s.eep", get_savesrampath(), ROM_SETTINGS.goodname);
+}
+
+static void eeprom_format(void)
+{
+ memset(eeprom, 0, sizeof(eeprom));
+}
+
+static void eeprom_read_file(void)
+{
+ char *filename = get_eeprom_path();
+
+ switch (read_from_file(filename, eeprom, sizeof(eeprom)))
+ {
+ case file_open_error:
+ DebugMessage(M64MSG_VERBOSE, "couldn't open eeprom file '%s' for reading", filename);
+ eeprom_format();
+ break;
+ case file_read_error:
+ DebugMessage(M64MSG_WARNING, "fread() failed for 2kb eeprom file '%s'", filename);
+ break;
+ default: break;
+ }
+
+ free(filename);
+}
+
+static void eeprom_write_file(void)
+{
+ char *filename = get_eeprom_path();
+
+ switch (write_to_file(filename, eeprom, sizeof(eeprom)))
+ {
+ case file_open_error:
+ DebugMessage(M64MSG_WARNING, "couldn't open eeprom file '%s' for writing", filename);
+ break;
+ case file_write_error:
+ DebugMessage(M64MSG_WARNING, "fwrite() failed for 2kb eeprom file '%s'", filename);
+ break;
+ default: break;
+ }
+
+ free(filename);
+}
+
+static char *get_mempack_path(void)
+{
+ return formatstr("%s%s.mpk", get_savesrampath(), ROM_SETTINGS.goodname);
+}
+
+static void mempack_format(void)
+{
+ unsigned char init[] =
+ {
+ 0x81,0x01,0x02,0x03, 0x04,0x05,0x06,0x07, 0x08,0x09,0x0a,0x0b, 0x0c,0x0d,0x0e,0x0f,
+ 0x10,0x11,0x12,0x13, 0x14,0x15,0x16,0x17, 0x18,0x19,0x1a,0x1b, 0x1c,0x1d,0x1e,0x1f,
+ 0xff,0xff,0xff,0xff, 0x05,0x1a,0x5f,0x13, 0x00,0x00,0x00,0x00, 0x00,0x00,0x00,0x00,
+ 0xff,0xff,0xff,0xff, 0xff,0xff,0xff,0xff, 0xff,0xff,0x01,0xff, 0x66,0x25,0x99,0xcd,
+ 0x00,0x00,0x00,0x00, 0x00,0x00,0x00,0x00, 0x00,0x00,0x00,0x00, 0x00,0x00,0x00,0x00,
+ 0x00,0x00,0x00,0x00, 0x00,0x00,0x00,0x00, 0x00,0x00,0x00,0x00, 0x00,0x00,0x00,0x00,
+ 0xff,0xff,0xff,0xff, 0x05,0x1a,0x5f,0x13, 0x00,0x00,0x00,0x00, 0x00,0x00,0x00,0x00,
+ 0xff,0xff,0xff,0xff, 0xff,0xff,0xff,0xff, 0xff,0xff,0x01,0xff, 0x66,0x25,0x99,0xcd,
+ 0xff,0xff,0xff,0xff, 0x05,0x1a,0x5f,0x13, 0x00,0x00,0x00,0x00, 0x00,0x00,0x00,0x00,
+ 0xff,0xff,0xff,0xff, 0xff,0xff,0xff,0xff, 0xff,0xff,0x01,0xff, 0x66,0x25,0x99,0xcd,
+ 0x00,0x00,0x00,0x00, 0x00,0x00,0x00,0x00, 0x00,0x00,0x00,0x00, 0x00,0x00,0x00,0x00,
+ 0x00,0x00,0x00,0x00, 0x00,0x00,0x00,0x00, 0x00,0x00,0x00,0x00, 0x00,0x00,0x00,0x00,
+ 0xff,0xff,0xff,0xff, 0x05,0x1a,0x5f,0x13, 0x00,0x00,0x00,0x00, 0x00,0x00,0x00,0x00,
+ 0xff,0xff,0xff,0xff, 0xff,0xff,0xff,0xff, 0xff,0xff,0x01,0xff, 0x66,0x25,0x99,0xcd,
+ 0x00,0x00,0x00,0x00, 0x00,0x00,0x00,0x00, 0x00,0x00,0x00,0x00, 0x00,0x00,0x00,0x00,
+ 0x00,0x00,0x00,0x00, 0x00,0x00,0x00,0x00, 0x00,0x00,0x00,0x00, 0x00,0x00,0x00,0x00,
+ 0x00,0x71,0x00,0x03, 0x00,0x03,0x00,0x03, 0x00,0x03,0x00,0x03, 0x00,0x03,0x00,0x03
+ };
+ int i,j;
+ for (i=0; i<4; i++)
+ {
+ for (j=0; j<0x8000; j+=2)
+ {
+ mempack[i][j] = 0;
+ mempack[i][j+1] = 0x03;
+ }
+ memcpy(mempack[i], init, 272);
+ }
+}
+
+static void mempack_read_file(void)
+{
+ char *filename = get_mempack_path();
+
+ switch (read_from_file(filename, mempack, sizeof(mempack)))
+ {
+ case file_open_error:
+ DebugMessage(M64MSG_VERBOSE, "couldn't open memory pack file '%s' for reading", filename);
+ mempack_format();
+ break;
+ case file_read_error:
+ DebugMessage(M64MSG_WARNING, "fread() failed for 128kb mempack file '%s'", filename);
+ break;
+ default: break;
+ }
+
+ free(filename);
+}
+
+static void mempack_write_file(void)
+{
+ char *filename = get_mempack_path();
+
+ switch (write_to_file(filename, mempack, sizeof(mempack)))
+ {
+ case file_open_error:
+ DebugMessage(M64MSG_WARNING, "couldn't open memory pack file '%s' for writing", filename);
+ break;
+ case file_write_error:
+ DebugMessage(M64MSG_WARNING, "fwrite() failed for 128kb mempack file '%s'", filename);
+ break;
+ default: break;
+ }
+
+ free(filename);
+}
+
+//#define DEBUG_PIF
+#ifdef DEBUG_PIF
+void print_pif(void)
+{
+ int i;
+ for (i=0; i<(64/8); i++)
+ DebugMessage(M64MSG_INFO, "%x %x %x %x | %x %x %x %x",
+ PIF_RAMb[i*8+0], PIF_RAMb[i*8+1],PIF_RAMb[i*8+2], PIF_RAMb[i*8+3],
+ PIF_RAMb[i*8+4], PIF_RAMb[i*8+5],PIF_RAMb[i*8+6], PIF_RAMb[i*8+7]);
+}
+#endif
+
+static unsigned char byte2bcd(int n)
+{
+ n %= 100;
+ return ((n / 10) << 4) | (n % 10);
+}
+
+static void EepromCommand(unsigned char *Command)
+{
+ time_t curtime_time;
+ struct tm *curtime;
+
+ switch (Command[2])
+ {
+ case 0: // check
+#ifdef DEBUG_PIF
+ DebugMessage(M64MSG_INFO, "EepromCommand() check size");
+#endif
+ if (Command[1] != 3)
+ {
+ Command[1] |= 0x40;
+ if ((Command[1] & 3) > 0)
+ Command[3] = 0;
+ if ((Command[1] & 3) > 1)
+ Command[4] = (ROM_SETTINGS.savetype != EEPROM_16KB) ? 0x80 : 0xc0;
+ if ((Command[1] & 3) > 2)
+ Command[5] = 0;
+ }
+ else
+ {
+ Command[3] = 0;
+ Command[4] = (ROM_SETTINGS.savetype != EEPROM_16KB) ? 0x80 : 0xc0;
+ Command[5] = 0;
+ }
+ break;
+ case 4: // read
+ {
+#ifdef DEBUG_PIF
+ DebugMessage(M64MSG_INFO, "EepromCommand() read 8-byte block %i", Command[3]);
+#endif
+ eeprom_read_file();
+ memcpy(&Command[4], eeprom + Command[3]*8, 8);
+ }
+ break;
+ case 5: // write
+ {
+#ifdef DEBUG_PIF
+ DebugMessage(M64MSG_INFO, "EepromCommand() write 8-byte block %i", Command[3]);
+#endif
+ eeprom_read_file();
+ memcpy(eeprom + Command[3]*8, &Command[4], 8);
+ eeprom_write_file();
+ }
+ break;
+ case 6:
+#ifdef DEBUG_PIF
+ DebugMessage(M64MSG_INFO, "EepromCommand() RTC status query");
+#endif
+ // RTCstatus query
+ Command[3] = 0x00;
+ Command[4] = 0x10;
+ Command[5] = 0x00;
+ break;
+ case 7:
+#ifdef DEBUG_PIF
+ DebugMessage(M64MSG_INFO, "EepromCommand() read RTC block %i", Command[3]);
+#endif
+ // read RTC block
+ switch (Command[3]) { // block number
+ case 0:
+ Command[4] = 0x00;
+ Command[5] = 0x02;
+ Command[12] = 0x00;
+ break;
+ case 1:
+ DebugMessage(M64MSG_ERROR, "RTC command in EepromCommand(): read block %d", Command[2]);
+ break;
+ case 2:
+ time(&curtime_time);
+ curtime = localtime(&curtime_time);
+ Command[4] = byte2bcd(curtime->tm_sec);
+ Command[5] = byte2bcd(curtime->tm_min);
+ Command[6] = 0x80 + byte2bcd(curtime->tm_hour);
+ Command[7] = byte2bcd(curtime->tm_mday);
+ Command[8] = byte2bcd(curtime->tm_wday);
+ Command[9] = byte2bcd(curtime->tm_mon + 1);
+ Command[10] = byte2bcd(curtime->tm_year);
+ Command[11] = byte2bcd(curtime->tm_year / 100);
+ Command[12] = 0x00; // status
+ break;
+ }
+ break;
+ case 8:
+ // write RTC block
+ DebugMessage(M64MSG_ERROR, "RTC write in EepromCommand(): %d not yet implemented", Command[2]);
+ break;
+ default:
+ DebugMessage(M64MSG_ERROR, "unknown command in EepromCommand(): %x", Command[2]);
+ }
+}
+
+static unsigned char mempack_crc(unsigned char *data)
+{
+ int i;
+ unsigned char CRC = 0;
+ for (i=0; i<=0x20; i++)
+ {
+ int mask;
+ for (mask = 0x80; mask >= 1; mask >>= 1)
+ {
+ int xor_tap = (CRC & 0x80) ? 0x85 : 0x00;
+ CRC <<= 1;
+ if (i != 0x20 && (data[i] & mask)) CRC |= 1;
+ CRC ^= xor_tap;
+ }
+ }
+ return CRC;
+}
+
+static void internal_ReadController(int Control, unsigned char *Command)
+{
+ switch (Command[2])
+ {
+ case 1:
+#ifdef DEBUG_PIF
+ DebugMessage(M64MSG_INFO, "internal_ReadController() Channel %i Command 1 read buttons", Control);
+#endif
+ if (Controls[Control].Present)
+ {
+ BUTTONS Keys;
+ input.getKeys(Control, &Keys);
+ *((unsigned int *)(Command + 3)) = Keys.Value;
+#ifdef COMPARE_CORE
+ CoreCompareDataSync(4, Command+3);
+#endif
+ }
+ break;
+ case 2: // read controller pack
+#ifdef DEBUG_PIF
+ DebugMessage(M64MSG_INFO, "internal_ReadController() Channel %i Command 2 read controller pack (in Input plugin)", Control);
+#endif
+ if (Controls[Control].Present)
+ {
+ if (Controls[Control].Plugin == PLUGIN_RAW)
+ if (input.readController)
+ input.readController(Control, Command);
+ }
+ break;
+ case 3: // write controller pack
+#ifdef DEBUG_PIF
+ DebugMessage(M64MSG_INFO, "internal_ReadController() Channel %i Command 3 write controller pack (in Input plugin)", Control);
+#endif
+ if (Controls[Control].Present)
+ {
+ if (Controls[Control].Plugin == PLUGIN_RAW)
+ if (input.readController)
+ input.readController(Control, Command);
+ }
+ break;
+ }
+}
+
+static void internal_ControllerCommand(int Control, unsigned char *Command)
+{
+ switch (Command[2])
+ {
+ case 0x00: // read status
+ case 0xFF: // reset
+ if ((Command[1] & 0x80))
+ break;
+#ifdef DEBUG_PIF
+ DebugMessage(M64MSG_INFO, "internal_ControllerCommand() Channel %i Command %02x check pack present", Control, Command[2]);
+#endif
+ if (Controls[Control].Present)
+ {
+ Command[3] = 0x05;
+ Command[4] = 0x00;
+ switch (Controls[Control].Plugin)
+ {
+ case PLUGIN_MEMPAK:
+ Command[5] = 1;
+ break;
+ case PLUGIN_RAW:
+ Command[5] = 1;
+ break;
+ default:
+ Command[5] = 0;
+ break;
+ }
+ }
+ else
+ Command[1] |= 0x80;
+ break;
+ case 0x01:
+#ifdef DEBUG_PIF
+ DebugMessage(M64MSG_INFO, "internal_ControllerCommand() Channel %i Command 1 check controller present", Control);
+#endif
+ if (!Controls[Control].Present)
+ Command[1] |= 0x80;
+ break;
+ case 0x02: // read controller pack
+ if (Controls[Control].Present)
+ {
+ switch (Controls[Control].Plugin)
+ {
+ case PLUGIN_MEMPAK:
+ {
+ int address = (Command[3] << 8) | Command[4];
+#ifdef DEBUG_PIF
+ DebugMessage(M64MSG_INFO, "internal_ControllerCommand() Channel %i Command 2 read mempack address %04x", Control, address);
+#endif
+ if (address == 0x8001)
+ {
+ memset(&Command[5], 0, 0x20);
+ Command[0x25] = mempack_crc(&Command[5]);
+ }
+ else
+ {
+ address &= 0xFFE0;
+ if (address <= 0x7FE0)
+ {
+ mempack_read_file();
+ memcpy(&Command[5], &mempack[Control][address], 0x20);
+ }
+ else
+ {
+ memset(&Command[5], 0, 0x20);
+ }
+ Command[0x25] = mempack_crc(&Command[5]);
+ }
+ }
+ break;
+ case PLUGIN_RAW:
+#ifdef DEBUG_PIF
+ DebugMessage(M64MSG_INFO, "internal_ControllerCommand() Channel %i Command 2 controllerCommand (in Input plugin)", Control);
+#endif
+ if (input.controllerCommand)
+ input.controllerCommand(Control, Command);
+ break;
+ default:
+#ifdef DEBUG_PIF
+ DebugMessage(M64MSG_INFO, "internal_ControllerCommand() Channel %i Command 2 (no pack plugged in)", Control);
+#endif
+ memset(&Command[5], 0, 0x20);
+ Command[0x25] = 0;
+ }
+ }
+ else
+ Command[1] |= 0x80;
+ break;
+ case 0x03: // write controller pack
+ if (Controls[Control].Present)
+ {
+ switch (Controls[Control].Plugin)
+ {
+ case PLUGIN_MEMPAK:
+ {
+ int address = (Command[3] << 8) | Command[4];
+#ifdef DEBUG_PIF
+ DebugMessage(M64MSG_INFO, "internal_ControllerCommand() Channel %i Command 3 write mempack address %04x", Control, address);
+#endif
+ if (address == 0x8001)
+ Command[0x25] = mempack_crc(&Command[5]);
+ else
+ {
+ address &= 0xFFE0;
+ if (address <= 0x7FE0)
+ {
+ mempack_read_file();
+ memcpy(&mempack[Control][address], &Command[5], 0x20);
+ mempack_write_file();
+ }
+ Command[0x25] = mempack_crc(&Command[5]);
+ }
+ }
+ break;
+ case PLUGIN_RAW:
+#ifdef DEBUG_PIF
+ DebugMessage(M64MSG_INFO, "internal_ControllerCommand() Channel %i Command 3 controllerCommand (in Input plugin)", Control);
+#endif
+ if (input.controllerCommand)
+ input.controllerCommand(Control, Command);
+ break;
+ default:
+#ifdef DEBUG_PIF
+ DebugMessage(M64MSG_INFO, "internal_ControllerCommand() Channel %i Command 3 (no pack plugged in)", Control);
+#endif
+ Command[0x25] = mempack_crc(&Command[5]);
+ }
+ }
+ else
+ Command[1] |= 0x80;
+ break;
+ }
+}
+
+void update_pif_write(void)
+{
+ char challenge[30], response[30];
+ int i=0, channel=0;
+ if (PIF_RAMb[0x3F] > 1)
+ {
+ switch (PIF_RAMb[0x3F])
+ {
+ case 0x02:
+#ifdef DEBUG_PIF
+ DebugMessage(M64MSG_INFO, "update_pif_write() pif_ram[0x3f] = 2 - CIC challenge");
+#endif
+ // format the 'challenge' message into 30 nibbles for X-Scale's CIC code
+ for (i = 0; i < 15; i++)
+ {
+ challenge[i*2] = (PIF_RAMb[48+i] >> 4) & 0x0f;
+ challenge[i*2+1] = PIF_RAMb[48+i] & 0x0f;
+ }
+ // calculate the proper response for the given challenge (X-Scale's algorithm)
+ n64_cic_nus_6105(challenge, response, CHL_LEN - 2);
+ // re-format the 'response' into a byte stream
+ for (i = 0; i < 15; i++)
+ {
+ PIF_RAMb[48+i] = (response[i*2] << 4) + response[i*2+1];
+ }
+ // the last byte (2 nibbles) is always 0
+ PIF_RAMb[63] = 0;
+ break;
+ case 0x08:
+#ifdef DEBUG_PIF
+ DebugMessage(M64MSG_INFO, "update_pif_write() pif_ram[0x3f] = 8");
+#endif
+ PIF_RAMb[0x3F] = 0;
+ break;
+ default:
+ DebugMessage(M64MSG_ERROR, "error in update_pif_write(): %x", PIF_RAMb[0x3F]);
+ }
+ return;
+ }
+ while (i<0x40)
+ {
+ switch (PIF_RAMb[i])
+ {
+ case 0x00:
+ channel++;
+ if (channel > 6) i=0x40;
+ break;
+ case 0xFF:
+ break;
+ default:
+ if (!(PIF_RAMb[i] & 0xC0))
+ {
+ if (channel < 4)
+ {
+ if (Controls[channel].Present &&
+ Controls[channel].RawData)
+ input.controllerCommand(channel, &PIF_RAMb[i]);
+ else
+ internal_ControllerCommand(channel, &PIF_RAMb[i]);
+ }
+ else if (channel == 4)
+ EepromCommand(&PIF_RAMb[i]);
+ else
+ DebugMessage(M64MSG_ERROR, "channel >= 4 in update_pif_write");
+ i += PIF_RAMb[i] + (PIF_RAMb[(i+1)] & 0x3F) + 1;
+ channel++;
+ }
+ else
+ i=0x40;
+ }
+ i++;
+ }
+ //PIF_RAMb[0x3F] = 0;
+ input.controllerCommand(-1, NULL);
+}
+
+void update_pif_read(void)
+{
+ int i=0, channel=0;
+ while (i<0x40)
+ {
+ switch (PIF_RAMb[i])
+ {
+ case 0x00:
+ channel++;
+ if (channel > 6) i=0x40;
+ break;
+ case 0xFE:
+ i = 0x40;
+ break;
+ case 0xFF:
+ break;
+ case 0xB4:
+ case 0x56:
+ case 0xB8:
+ break;
+ default:
+ if (!(PIF_RAMb[i] & 0xC0))
+ {
+ if (channel < 4)
+ {
+ if (Controls[channel].Present &&
+ Controls[channel].RawData)
+ input.readController(channel, &PIF_RAMb[i]);
+ else
+ internal_ReadController(channel, &PIF_RAMb[i]);
+ }
+ i += PIF_RAMb[i] + (PIF_RAMb[(i+1)] & 0x3F) + 1;
+ channel++;
+ }
+ else
+ i=0x40;
+ }
+ i++;
+ }
+ input.readController(-1, NULL);
+}
+
notaz.gp2x.de / mupen64plus-pandora.git / blobdiff