-/* FCE Ultra - NES/Famicom Emulator
- *
- * Copyright notice for this file:
- * Copyright (C) 2002 Ben Parnell
- *
- * 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., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
- */
-
-#include <stdio.h>
-#include <stdlib.h>
-#include <string.h>
-
-#include "types.h"
-#include "x6502.h"
-#include "version.h"
-#include "fce.h"
-#include "fds.h"
-#include "svga.h"
-#include "sound.h"
-#include "general.h"
-#include "state.h"
-#include "file.h"
-#include "memory.h"
-#include "cart.h"
-
-/* TODO: Add code to put a delay in between the time a disk is inserted
- and the when it can be successfully read/written to. This should
- prevent writes to wrong places OR add code to prevent disk ejects
- when the virtual motor is on(mmm...virtual motor).
-*/
-
-static DECLFR(FDSRead4030);
-static DECLFR(FDSRead4031);
-static DECLFR(FDSRead4032);
-static DECLFR(FDSRead4033);
-static DECLFW(FDSWrite4020);
-static DECLFW(FDSWrite4021);
-static DECLFW(FDSWrite4022);
-static DECLFW(FDSWrite4023);
-static DECLFW(FDSWrite4024);
-static DECLFW(FDSWrite4025);
-static DECLFW(FDSWaveWrite);
-static DECLFR(FDSWaveRead);
-
-static DECLFR(FDSSRead);
-static DECLFW(FDSSWrite);
-static DECLFR(FDSBIOSRead);
-static DECLFR(FDSRAMRead);
-static DECLFW(FDSRAMWrite);
-static void FDSInit(void);
-static void FDSReset(void);
-static void FP_FASTAPASS(1) FDSFix(int a);
-
-#define FDSRAM GameMemBlock
-#define mapbyte1 (GameMemBlock+32768)
-#define mapbyte2 (GameMemBlock+32768+8)
-#define mapbyte3 (GameMemBlock+32768+16)
-#define mapbyte4 (GameMemBlock+32768+24) // 8 bytes
-#define CHRRAM (GameMemBlock+32768+32+64)
-
-#define IRQLatch (*(int32*)(CHRRAM+8192))
-#define IRQCount (*(int32*)(CHRRAM+8192+4))
-#define IRQa (*(CHRRAM+8192+8))
-
-static void FDSClose(void);
-static uint8 header[16];
-#define writeskip mapbyte2[0]
-
-static char FDSSaveName[2048];
-
-uint8 FDSBIOS[8192];
-uint8 *diskdata[4]={0,0,0,0};
-
-#define SideWrite mapbyte2[1]
-#define DiskPtr (*(uint32*)(mapbyte2+4))
-#define dsr0 mapbyte2[2]
-#define dsr1 mapbyte2[3]
-
-#define DC_INC 1
-
-#define DiskSeekIRQ (*(int32*)(mapbyte3+4))
-#define SelectDisk mapbyte3[0]
-#define InDisk mapbyte3[1]
-
-static void FDSReset(void)
-{
- memset(mapbyte1,0,8);
- memset(mapbyte2,0,8);
- memset(mapbyte3+4,0,4);
- memset(mapbyte4,0,8);
-}
-
-void FDSGI(int h)
-{
- switch(h)
- {
- case GI_CLOSE: FDSClose();break;
- case GI_POWER: FDSReset();FDSInit();break;
- }
-}
-
-static void FDSStateRestore(int version)
-{
- setmirror(((mapbyte1[5]&8)>>3)^1);
-}
-
-void FDSSound();
-void FDSSoundReset(void);
-void FDSSoundStateAdd(void);
-static void RenderSound(void);
-
-static void FDSInit(void)
-{
- dsr0=0;
- dsr1=0x41;
- setmirror(1);
- if(InDisk!=255)
- dsr1&=0xFE;
-
- setprg8r(0,0xe000,0); // BIOS
- setprg32r(1,0x6000,0); // 32KB RAM
- setchr8(0); // 8KB CHR RAM
-
- MapIRQHook=FDSFix;
- GameStateRestore=FDSStateRestore;
-
- SetReadHandler(0x4030,0x4030,FDSRead4030);
- SetReadHandler(0x4031,0x4031,FDSRead4031);
- SetReadHandler(0x4032,0x4032,FDSRead4032);
- SetReadHandler(0x4033,0x4033,FDSRead4033);
-
- SetWriteHandler(0x4020,0x4020,FDSWrite4020);
- SetWriteHandler(0x4021,0x4021,FDSWrite4021);
- SetWriteHandler(0x4022,0x4022,FDSWrite4022);
- SetWriteHandler(0x4023,0x4023,FDSWrite4023);
- SetWriteHandler(0x4024,0x4024,FDSWrite4024);
- SetWriteHandler(0x4025,0x4025,FDSWrite4025);
-
- SetWriteHandler(0x6000,0xdfff,FDSRAMWrite);
- SetReadHandler(0x6000,0xdfff,FDSRAMRead);
- SetReadHandler(0xE000,0xFFFF,FDSBIOSRead);
-
- IRQCount=IRQLatch=IRQa=0;
-
- FDSSoundReset();
-}
-
-void FDSControl(int what)
-{
- switch(what)
- {
- case FDS_IDISK:dsr1&=0xFE;
- if(InDisk==255)
- {
- FCEU_DispMessage("Disk %d Side %s Inserted",
- SelectDisk>>1,(SelectDisk&1)?"B":"A");
- InDisk=SelectDisk;
- }
- else
- FCEU_DispMessage("Jamming disks is a BAD IDEA");
- break;
- case FDS_EJECT:
- if(InDisk!=255)
- FCEU_DispMessage("Disk Ejected");
- else
- FCEU_DispMessage("Cannot Eject Air");
- dsr1|=1;
- InDisk=255;
- break;
- case FDS_SELECT:
- if(InDisk!=255)
- {
- FCEU_DispMessage("Eject disk before selecting.");
- break;
- }
- SelectDisk=((SelectDisk+1)%header[4])&3;
- FCEU_DispMessage("Disk %d Side %s Selected",
- SelectDisk>>1,(SelectDisk&1)?"B":"A");
- break;
- }
-}
-
-static void FP_FASTAPASS(1) FDSFix(int a)
-{
- if(IRQa)
- {
- IRQCount-=a;
- if(IRQCount<=0)
- {
- IRQa=0;
- dsr0|=1;
- dsr0&=~2;
- IRQCount=0xFFFF;
- X6502_IRQBegin(FCEU_IQEXT);
- }
- }
- if(DiskSeekIRQ>0)
- {
- DiskSeekIRQ-=a;
- if(DiskSeekIRQ<=0)
- {
- if(mapbyte1[5]&0x80)
- {
- dsr0&=~1;
- dsr0|=2;
- TriggerIRQ();
- }
- }
- }
-}
-
-void DiskControl(int which)
-{
-if(mapbyte1[5]&1)
- {
- switch(which)
- {
- case DC_INC:
- if(DiskPtr<64999) DiskPtr++;
- //DiskSeekIRQ=160+100;
- //DiskSeekIRQ=140;
- //DiskSeekIRQ=160;
- DiskSeekIRQ=150;
- break;
- }
- }
-}
-static DECLFR(FDSRead4030)
-{
- X6502_IRQEnd(FCEU_IQEXT);
- return dsr0;
-}
-
-static DECLFR(FDSRead4031)
-{
- static uint8 z=0;
- if(InDisk!=255)
- {
- z=diskdata[InDisk][DiskPtr];
- DiskControl(DC_INC);
- }
- return z;
-}
-
-static DECLFR(FDSRead4032)
-{
- return dsr1;
-}
-
-static DECLFR(FDSRead4033)
-{
- return 0x80; // battery
-}
-
-static DECLFW(FDSRAMWrite)
-{
- (FDSRAM-0x6000)[A]=V;
-}
-
-static DECLFR(FDSBIOSRead)
-{
- return (FDSBIOS-0xE000)[A];
-}
-
-static DECLFR(FDSRAMRead)
-{
- return (FDSRAM-0x6000)[A];
-}
-
-/* Begin FDS sound */
-
-#define FDSClock (1789772.7272727272727272/8)
-
-typedef struct {
- int64 cycles; // Cycles per PCM sample
- int64 count; // Cycle counter
- int64 envcount; // Envelope cycle counter
- uint32 b19shiftreg60;
- uint32 b24adder66;
- uint32 b24latch68;
- uint32 b17latch76;
- int32 clockcount; // Counter to divide frequency by 8.
- uint8 b8shiftreg88; // Modulation register.
- uint8 amplitude[2]; // Current amplitudes.
- uint8 mwave[0x20]; // Modulation waveform
- uint8 cwave[0x40]; // Game-defined waveform(carrier)
- uint8 SPSG[0xB];
-} FDSSOUND;
-
-static FDSSOUND fdso;
-
-#define SPSG fdso.SPSG
-#define b19shiftreg60 fdso.b19shiftreg60
-#define b24adder66 fdso.b24adder66
-#define b24latch68 fdso.b24latch68
-#define b17latch76 fdso.b17latch76
-#define b8shiftreg88 fdso.b8shiftreg88
-#define clockcount fdso.clockcount
-#define amplitude fdso.amplitude
-
-void FDSSoundStateAdd(void)
-{
- AddExState(fdso.cwave,64,0,"WAVE");
- AddExState(fdso.mwave,32,0,"MWAV");
- AddExState(amplitude,2,0,"AMPL");
- AddExState(SPSG,0xB,0,"SPSG");
-
- AddExState(&b8shiftreg88,1,0,"B88");
-
- AddExState(&clockcount, 4, 1, "CLOC");
- AddExState(&b19shiftreg60,4,1,"B60");
- AddExState(&b24adder66,4,1,"B66");
- AddExState(&b24latch68,4,1,"B68");
- AddExState(&b17latch76,4,1,"B76");
-
-}
-
-static DECLFR(FDSSRead)
-{
- switch(A&0xF)
- {
- case 0x0:return(amplitude[0]|(X.DB&0xC0));
- case 0x2:return(amplitude[1]|(X.DB&0xC0));
- }
- return(X.DB);
-}
-
-static DECLFW(FDSSWrite)
-{
- if(FSettings.SndRate)
- RenderSound();
- A-=0x4080;
- switch(A)
- {
- case 0x0:
- case 0x4:
- if(!(V&0x80))
- {
- // if(V&0x40) amplitude[(A&0xF)>>2]=0;
- // else amplitude[(A&0xF)>>2]=0x3F;
- }
- else
- amplitude[(A&0xF)>>2]=V&0x3F;
- break;
- case 0x7: b17latch76=0;SPSG[0x5]=0;break;
- case 0x8:
- //printf("%d:$%02x\n",SPSG[0x5],V);
- fdso.mwave[SPSG[0x5]&0x1F]=V&0x7;
- SPSG[0x5]=(SPSG[0x5]+1)&0x1F;
- break;
- }
- //if(A>=0x7 && A!=0x8 && A<=0xF)
- //if(A==0xA || A==0x9) printf("$%04x:$%02x\n",A,V);
- SPSG[A]=V;
-}
-
-// $4080 - Fundamental wave amplitude data register 92
-// $4082 - Fundamental wave frequency data register 58
-// $4083 - Same as $4082($4083 is the upper 4 bits).
-
-// $4084 - Modulation amplitude data register 78
-// $4086 - Modulation frequency data register 72
-// $4087 - Same as $4086($4087 is the upper 4 bits)
-
-
-static void DoEnv()
-{
- int x;
-
- for(x=0;x<2;x++)
- if(!(SPSG[x<<2]&0x80) && !(SPSG[0x9+x]&0x80))
- {
- static int counto[2]={0,0};
-
- if(counto[x]<=0)
- {
- if(SPSG[x<<2]&0x40)
- {
- if(amplitude[x]<0x3F)
- amplitude[x]++;
- }
- else
- {
- if(amplitude[x]>0)
- amplitude[x]--;
- }
- counto[x]=(SPSG[x<<2]&0x3F);
- }
- else
- counto[x]--;
- }
-}
-
-static DECLFR(FDSWaveRead)
-{
- return(fdso.cwave[A&0x3f]|(X.DB&0xC0));
-}
-
-static DECLFW(FDSWaveWrite)
-{
- if(SPSG[0x9]&0x80)
- fdso.cwave[A&0x3f]=V&0x3F;
-}
-
-static INLINE void ClockRise(void)
-{
- if(!clockcount)
- {
- b19shiftreg60=(SPSG[0x2]|((SPSG[0x3]&0xF)<<8));
- b17latch76=(SPSG[0x6]|((SPSG[0x07]&0x3)<<8))+b17latch76;
-
- if(!(SPSG[0x7]&0x80))
- {
- b8shiftreg88=(amplitude[1]*((fdso.mwave[(b17latch76>>11)&0x1F]&7)));
- //b8shiftreg88=((fdso.mwave[(b17latch76>>11)&0x1F]&7))|(amplitude[1]<<3);
- }
- else
- { b8shiftreg88=0;}
- }
- else
- {
- b19shiftreg60<<=1;
- b8shiftreg88>>=1;
- }
- b24adder66=(b24latch68+b19shiftreg60)&0xFFFFFF;
-}
-
-static INLINE void ClockFall(void)
-{
-// if(!(SPSG[0x7]&0x80))
- {
- if(!(b8shiftreg88&1))
- b24latch68=b24adder66;
- }
- clockcount=(clockcount+1)&7;
-}
-
-static INLINE int32 FDSDoSound(void)
-{
- fdso.count+=fdso.cycles;
- if(fdso.count>=((int64)1<<40))
- {
- dogk:
- fdso.count-=(int64)1<<40;
- ClockRise();
- ClockFall();
- }
- if(fdso.count>=32768) goto dogk;
-
- fdso.envcount-=fdso.cycles;
- if(fdso.envcount<=0)
- {
- // Fix this?
- fdso.envcount+=((int64)1<<40)*FDSClock/1024;
- DoEnv();
- }
-
- // Might need to emulate applying the amplitude to the waveform a bit better...
- return (fdso.cwave[b24latch68>>18]*amplitude[0]);
-}
-
-static int32 FBC=0;
-
-static void RenderSound(void)
-{
- int32 end, start;
- int32 x;
-
- start=FBC;
- end=(SOUNDTS<<16)/soundtsinc;
- if(end<=start)
- return;
- FBC=end;
-
- if(!(SPSG[0x9]&0x80))
- for(x=start;x<end;x++)
- {
- uint32 t=FDSDoSound();
- Wave[x>>4]+=t>>3;
- }
-}
-
-void FDSSound(int c)
-{
- RenderSound();
- FBC=c;
-}
-
-static void FDS_ESI(void)
-{
- if(FSettings.SndRate)
- {
- fdso.cycles=((int64)1<<40)*FDSClock;
- fdso.cycles/=FSettings.SndRate OVERSAMPLE;
- }
-// fdso.cycles=(int64)32768*FDSClock/(FSettings.SndRate OVERSAMPLE);
- SetReadHandler(0x4040,0x407f,FDSWaveRead);
- SetWriteHandler(0x4040,0x407f,FDSWaveWrite);
- SetWriteHandler(0x4080,0x408A,FDSSWrite);
- SetReadHandler(0x4090,0x4092,FDSSRead);
-}
-
-void FDSSoundReset(void)
-{
- memset(&fdso,0,sizeof(fdso));
- FDS_ESI();
- GameExpSound.Fill=FDSSound;
- GameExpSound.RChange=FDS_ESI;
-}
-
-
-static DECLFW(FDSWrite4020)
-{
- X6502_IRQEnd(FCEU_IQEXT);
- IRQLatch&=0xFF00;
- IRQLatch|=V;
- mapbyte1[0]=V;
-}
-static DECLFW(FDSWrite4021)
-{
- X6502_IRQEnd(FCEU_IQEXT);
- IRQLatch&=0xFF;
- IRQLatch|=V<<8;
- mapbyte1[1]=V;
-}
-static DECLFW(FDSWrite4022)
-{
- X6502_IRQEnd(FCEU_IQEXT);
- IRQCount=IRQLatch;
- IRQa=V&2;
- mapbyte1[2]=V;
-}
-static DECLFW(FDSWrite4023)
-{
- mapbyte1[3]=V;
-}
-static DECLFW(FDSWrite4024)
-{
- if(InDisk!=255 && !(mapbyte1[5]&0x4) && mapbyte1[3]&0x1)
- {
- if(DiskPtr>=0 && DiskPtr<65000)
- {
- if(writeskip) writeskip--;
- else if(DiskPtr>=2)
- {
- SideWrite|=1<<InDisk;
- diskdata[InDisk][DiskPtr-2]=V;
- }
- }
- }
-}
-static DECLFW(FDSWrite4025)
-{
- if(InDisk!=255)
- {
- if(!(V&0x40))
- {
- if(mapbyte1[5]&0x40 && !(V&0x10))
- {
- DiskSeekIRQ=200;
- DiskPtr-=2;
- }
- if(DiskPtr<0) DiskPtr=0;
- }
- if(!(V&0x4)) writeskip=2;
- if(V&2) {DiskPtr=0;DiskSeekIRQ=200;}
- if(V&0x40) DiskSeekIRQ=200;
- }
- mapbyte1[5]=V;
- setmirror(((V>>3)&1)^1);
-}
-static void FreeFDSMemory(void)
-{
- int x;
-
- for(x=0;x<header[4];x++)
- if(diskdata[x])
- {
- free(diskdata[x]);
- diskdata[x]=0;
- }
-}
-
-int FDSLoad(char *name, int fp)
-{
- FILE *zp;
- int x;
-
- FCEU_fseek(fp,0,SEEK_SET);
- FCEU_fread(header,16,1,fp);
-
- if(memcmp(header,"FDS\x1a",4))
- {
- if(!(memcmp(header+1,"*NINTENDO-HVC*",14)))
- {
- long t;
- t=FCEU_fgetsize(fp);
- if(t<65500)
- t=65500;
- header[4]=t/65500;
- header[0]=0;
- FCEU_fseek(fp,0,SEEK_SET);
- }
- else
- return 0;
- }
-
- if(header[4]>4) header[4]=4;
- if(!header[4]) header[4]|=1;
- for(x=0;x<header[4];x++)
- {
- diskdata[x]=FCEU_malloc(65500);
- if(!diskdata[x])
- {
- int zol;
- for(zol=0;zol<x;zol++)
- free(diskdata[zol]);
- return 0;
- }
- FCEU_fread(diskdata[x],1,65500,fp);
- }
-
- if(!(zp=fopen(FCEU_MakeFName(FCEUMKF_FDSROM,0,0),"rb")))
- {
- FCEU_PrintError("FDS BIOS ROM image missing!");
- FreeFDSMemory();
- return 0;
- }
-
- if(fread(FDSBIOS,1,8192,zp)!=8192)
- {
- fclose(zp);
- FreeFDSMemory();
- FCEU_PrintError("Error reading FDS BIOS ROM image");
- return 0;
- }
-
- fclose(zp);
-
- FCEUGameInfo.type=GIT_FDS;
- strcpy(FDSSaveName,name);
- GameInterface=FDSGI;
-
- SelectDisk=0;
- InDisk=255;
-
- ResetExState();
- FDSSoundStateAdd();
-
- for(x=0;x<header[4];x++)
- {
- char temp[5];
- sprintf(temp,"DDT%d",x);
- AddExState(diskdata[x],65500,0,temp);
- }
-
- AddExState(FDSRAM,32768,0,"FDSR");
- AddExState(mapbyte1,32,0,"MPBY");
- AddExState(CHRRAM,8192,0,"CHRR");
- AddExState(&IRQCount, 4, 1, "IRQC");
- AddExState(&IRQLatch, 4, 1, "IQL1");
- AddExState(&IRQa, 1, 0, "IRQA");
-
-
- ResetCartMapping();
-
- SetupCartCHRMapping(0,CHRRAM,8192,1);
- SetupCartMirroring(0,0,0);
-
- return 1;
-}
-
-void FDSClose(void)
-{
- int fp;
- int x;
-
- fp=FCEU_fopen(FDSSaveName,"wb");
- if(!fp) return;
-
- if(header[0]) // Does it have a 16-byte FWNES-style header?
- if(FCEU_fwrite(header,1,16,fp)!=16) // Write it out. Should be nicer than fseek()'ing if the file is compressed. Hopefully...
- goto fdswerr;
-
- for(x=0;x<header[4];x++)
- {
- if(FCEU_fwrite(diskdata[x],1,65500,fp)!=65500)
- {
- fdswerr:
- FCEU_PrintError("Error writing FDS image \"%s\"!",FDSSaveName);
- FCEU_fclose(fp);
- return;
- }
- }
- FreeFDSMemory();
- FCEU_fclose(fp);
-}
+/* FCE Ultra - NES/Famicom Emulator\r
+ *\r
+ * Copyright notice for this file:\r
+ * Copyright (C) 2002 Xodnizel\r
+ *\r
+ * This program is free software; you can redistribute it and/or modify\r
+ * it under the terms of the GNU General Public License as published by\r
+ * the Free Software Foundation; either version 2 of the License, or\r
+ * (at your option) any later version.\r
+ *\r
+ * This program is distributed in the hope that it will be useful,\r
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of\r
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the\r
+ * GNU General Public License for more details.\r
+ *\r
+ * You should have received a copy of the GNU General Public License\r
+ * along with this program; if not, write to the Free Software\r
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA\r
+ */\r
+\r
+#include <stdio.h>\r
+#include <stdlib.h>\r
+#include <string.h>\r
+\r
+#ifdef GP2X\r
+#include <unistd.h> // for sync()\r
+#endif\r
+\r
+#include "types.h"\r
+#include "x6502.h"\r
+#include "fce.h"\r
+#include "fds.h"\r
+#include "sound.h"\r
+#include "general.h"\r
+#include "state.h"\r
+#include "file.h"\r
+#include "memory.h"\r
+#include "cart.h"\r
+#include "md5.h"\r
+#include "netplay.h"\r
+\r
+#include "svga.h"\r
+\r
+/* TODO: Add code to put a delay in between the time a disk is inserted\r
+ and the when it can be successfully read/written to. This should\r
+ prevent writes to wrong places OR add code to prevent disk ejects\r
+ when the virtual motor is on(mmm...virtual motor).\r
+*/\r
+\r
+static DECLFR(FDSRead4030);\r
+static DECLFR(FDSRead4031);\r
+static DECLFR(FDSRead4032);\r
+static DECLFR(FDSRead4033);\r
+\r
+static DECLFW(FDSWrite);\r
+\r
+static DECLFW(FDSWaveWrite);\r
+static DECLFR(FDSWaveRead);\r
+\r
+static DECLFR(FDSSRead);\r
+static DECLFW(FDSSWrite);\r
+static DECLFR(FDSBIOSRead);\r
+static DECLFR(FDSRAMRead);\r
+static DECLFW(FDSRAMWrite);\r
+static void FDSInit(void);\r
+static void FP_FASTAPASS(1) FDSFix(int a);\r
+\r
+#define FDSRAM GameMemBlock\r
+#define CHRRAM (GameMemBlock+32768)\r
+\r
+static uint8 FDSRegs[6];\r
+static int32 IRQLatch,IRQCount;\r
+static uint8 IRQa;\r
+static void FDSClose(void);\r
+\r
+static uint8 FDSBIOS[8192];\r
+\r
+/* Original disk data backup, to help in creating save states. */\r
+static uint8 *diskdatao[8]={0,0,0,0,0,0,0,0};\r
+\r
+static uint8 *diskdata[8]={0,0,0,0,0,0,0,0};\r
+\r
+static unsigned int TotalSides;\r
+static uint8 DiskWritten=0; /* Set to 1 if disk was written to. */\r
+static uint8 writeskip;\r
+static uint32 DiskPtr;\r
+static int32 DiskSeekIRQ;\r
+static uint8 SelectDisk,InDisk;\r
+\r
+#define DC_INC 1\r
+\r
+void FDSGI(int h, void *param)\r
+{\r
+ switch(h)\r
+ {\r
+ case GI_CLOSE: FDSClose();break;\r
+ case GI_POWER: FDSInit();break;\r
+ case GI_INFOSTRING: sprintf(param, "FDS, Sides: %d", TotalSides);break;\r
+ }\r
+}\r
+\r
+static void FDSStateRestore(int version)\r
+{\r
+ int x;\r
+\r
+ setmirror(((FDSRegs[5]&8)>>3)^1);\r
+\r
+ if(version >= 9810)\r
+ for(x=0;x<TotalSides;x++)\r
+ {\r
+ int b;\r
+ for(b=0; b<65500; b++)\r
+ diskdata[x][b] ^= diskdatao[x][b];\r
+ }\r
+\r
+}\r
+\r
+void FDSSound();\r
+void FDSSoundReset(void);\r
+void FDSSoundStateAdd(void);\r
+static void RenderSound(void);\r
+//static void RenderSoundHQ(void);\r
+\r
+static void FDSInit(void)\r
+{\r
+ memset(FDSRegs,0,sizeof(FDSRegs));\r
+ writeskip=DiskPtr=DiskSeekIRQ=0;\r
+ setmirror(1);\r
+\r
+ setprg8r(0,0xe000,0); // BIOS\r
+ setprg32r(1,0x6000,0); // 32KB RAM\r
+ setchr8(0); // 8KB CHR RAM\r
+\r
+ MapIRQHook=FDSFix;\r
+ GameStateRestore=FDSStateRestore;\r
+\r
+ SetReadHandler(0x4030,0x4030,FDSRead4030);\r
+ SetReadHandler(0x4031,0x4031,FDSRead4031);\r
+ SetReadHandler(0x4032,0x4032,FDSRead4032);\r
+ SetReadHandler(0x4033,0x4033,FDSRead4033);\r
+\r
+ SetWriteHandler(0x4020,0x4025,FDSWrite);\r
+\r
+ SetWriteHandler(0x6000,0xdfff,FDSRAMWrite);\r
+ SetReadHandler(0x6000,0xdfff,FDSRAMRead);\r
+ SetReadHandler(0xE000,0xFFFF,FDSBIOSRead);\r
+ IRQCount=IRQLatch=IRQa=0;\r
+\r
+ FDSSoundReset();\r
+ InDisk=0;\r
+ SelectDisk=0;\r
+\r
+#ifdef ASM_6502\r
+ {\r
+ int page;\r
+ // asm code needs pages to be set again..\r
+ for (page=12; page<28; page++) // 0x6000-0xdfff 32K RAM\r
+ Page[page]=FDSRAM - (12<<11);\r
+ for (; page<32; page++) // 0xe000-0xffff 8K BIOS\r
+ Page[page]=FDSBIOS - (28<<11);\r
+ }\r
+#endif\r
+}\r
+\r
+void FCEU_FDSInsert(void)\r
+{\r
+ if(TotalSides==0)\r
+ {\r
+ FCEU_DispMessage("Not FDS; can't eject disk.");\r
+ return;\r
+ }\r
+ if(InDisk==255)\r
+ {\r
+ FCEU_DispMessage("Disk %d Side %s Inserted",SelectDisk>>1,(SelectDisk&1)?"B":"A");\r
+ InDisk=SelectDisk;\r
+ }\r
+ else\r
+ {\r
+ FCEU_DispMessage("Disk %d Side %s Ejected",SelectDisk>>1,(SelectDisk&1)?"B":"A");\r
+ InDisk=255;\r
+ }\r
+}\r
+/*\r
+void FCEU_FDSEject(void)\r
+{\r
+ InDisk=255;\r
+}\r
+*/\r
+void FCEU_FDSSelect(void)\r
+{\r
+ if(TotalSides==0)\r
+ {\r
+ FCEU_DispMessage("Not FDS; can't select disk.");\r
+ return;\r
+ }\r
+ if(InDisk!=255)\r
+ {\r
+ FCEU_DispMessage("Eject disk before selecting.");\r
+ return;\r
+ }\r
+ SelectDisk=((SelectDisk+1)%TotalSides)&3;\r
+ FCEU_DispMessage("Disk %d Side %c Selected",SelectDisk>>1,(SelectDisk&1)?'B':'A');\r
+}\r
+\r
+static void FP_FASTAPASS(1) FDSFix(int a)\r
+{\r
+ if(IRQCount && (IRQa&2))\r
+ {\r
+ IRQCount-=a;\r
+ if(IRQCount<=0)\r
+ {\r
+ if(!(IRQa&1))\r
+ {\r
+ IRQa&=~2;\r
+ IRQCount=IRQLatch=0;\r
+ }\r
+ else\r
+ IRQCount=IRQLatch;\r
+ //IRQCount=IRQLatch; //0xFFFF;\r
+ X6502_IRQBegin(FCEU_IQEXT);\r
+ //printf("IRQ: %d\n",timestamp);\r
+// printf("IRQ: %d\n",scanline);\r
+ }\r
+ }\r
+ if(DiskSeekIRQ>0)\r
+ {\r
+ DiskSeekIRQ-=a;\r
+ if(DiskSeekIRQ<=0)\r
+ {\r
+ if(FDSRegs[5]&0x80)\r
+ {\r
+ X6502_IRQBegin(FCEU_IQEXT2);\r
+ }\r
+ }\r
+ }\r
+}\r
+\r
+static DECLFR(FDSRead4030)\r
+{\r
+ uint8 ret=0;\r
+\r
+ /* Cheap hack. */\r
+#ifndef ASM_6502\r
+ if(X.IRQlow&FCEU_IQEXT) ret|=1;\r
+ if(X.IRQlow&FCEU_IQEXT2) ret|=2;\r
+#else\r
+ if((nes_registers[4]>>8)&FCEU_IQEXT) ret|=1;\r
+ if((nes_registers[4]>>8)&FCEU_IQEXT2) ret|=2;\r
+#endif\r
+\r
+ if(!fceuindbg)\r
+ {\r
+ X6502_IRQEnd(FCEU_IQEXT);\r
+ X6502_IRQEnd(FCEU_IQEXT2);\r
+ }\r
+ return ret;\r
+}\r
+\r
+static DECLFR(FDSRead4031)\r
+{\r
+ static uint8 z=0;\r
+ if(InDisk!=255)\r
+ {\r
+ z=diskdata[InDisk][DiskPtr];\r
+ if(!fceuindbg)\r
+ {\r
+ if(DiskPtr<64999) DiskPtr++;\r
+ DiskSeekIRQ=150;\r
+ X6502_IRQEnd(FCEU_IQEXT2);\r
+ }\r
+ }\r
+ return z;\r
+}\r
+static DECLFR(FDSRead4032)\r
+{\r
+ uint8 ret;\r
+\r
+ ret=X.DB&~7;\r
+ if(InDisk==255)\r
+ ret|=5;\r
+\r
+ if(InDisk==255 || !(FDSRegs[5]&1) || (FDSRegs[5]&2))\r
+ ret|=2;\r
+ return ret;\r
+}\r
+\r
+static DECLFR(FDSRead4033)\r
+{\r
+ return 0x80; // battery\r
+}\r
+\r
+static DECLFW(FDSRAMWrite)\r
+{\r
+ (FDSRAM-0x6000)[A]=V;\r
+}\r
+\r
+static DECLFR(FDSBIOSRead)\r
+{\r
+ return (FDSBIOS-0xE000)[A];\r
+}\r
+\r
+static DECLFR(FDSRAMRead)\r
+{\r
+ return (FDSRAM-0x6000)[A];\r
+}\r
+\r
+/* Begin FDS sound */\r
+\r
+#define FDSClock (1789772.7272727272727272/2)\r
+\r
+typedef struct {\r
+ int64 cycles; // Cycles per PCM sample\r
+ int64 count; // Cycle counter\r
+ int64 envcount; // Envelope cycle counter\r
+ uint32 b19shiftreg60;\r
+ uint32 b24adder66;\r
+ uint32 b24latch68;\r
+ uint32 b17latch76;\r
+ int32 clockcount; // Counter to divide frequency by 8.\r
+ uint8 b8shiftreg88; // Modulation register.\r
+ uint8 amplitude[2]; // Current amplitudes.\r
+ uint8 speedo[2];\r
+ uint8 mwcount;\r
+ uint8 mwstart;\r
+ uint8 mwave[0x20]; // Modulation waveform\r
+ uint8 cwave[0x40]; // Game-defined waveform(carrier)\r
+ uint8 SPSG[0xB];\r
+} FDSSOUND;\r
+\r
+static FDSSOUND fdso;\r
+\r
+#define SPSG fdso.SPSG\r
+#define b19shiftreg60 fdso.b19shiftreg60\r
+#define b24adder66 fdso.b24adder66\r
+#define b24latch68 fdso.b24latch68\r
+#define b17latch76 fdso.b17latch76\r
+#define b8shiftreg88 fdso.b8shiftreg88\r
+#define clockcount fdso.clockcount\r
+#define amplitude fdso.amplitude\r
+#define speedo fdso.speedo\r
+\r
+void FDSSoundStateAdd(void)\r
+{\r
+ AddExState(fdso.cwave,64,0,"WAVE");\r
+ AddExState(fdso.mwave,32,0,"MWAV");\r
+ AddExState(amplitude,2,0,"AMPL");\r
+ AddExState(SPSG,0xB,0,"SPSG");\r
+\r
+ AddExState(&b8shiftreg88,1,0,"B88");\r
+\r
+ AddExState(&clockcount, 4, 1, "CLOC");\r
+ AddExState(&b19shiftreg60,4,1,"B60");\r
+ AddExState(&b24adder66,4,1,"B66");\r
+ AddExState(&b24latch68,4,1,"B68");\r
+ AddExState(&b17latch76,4,1,"B76");\r
+\r
+}\r
+\r
+static DECLFR(FDSSRead)\r
+{\r
+ switch(A&0xF)\r
+ {\r
+ case 0x0:return(amplitude[0]|(X.DB&0xC0));\r
+ case 0x2:return(amplitude[1]|(X.DB&0xC0));\r
+ }\r
+ return(X.DB);\r
+}\r
+\r
+static DECLFW(FDSSWrite)\r
+{\r
+ if(FSettings.SndRate)\r
+ {\r
+#if 0\r
+ if(FSettings.soundq>=1)\r
+ RenderSoundHQ();\r
+ else\r
+#endif\r
+ RenderSound();\r
+ }\r
+ A-=0x4080;\r
+ switch(A)\r
+ {\r
+ case 0x0:\r
+ case 0x4: if(V&0x80)\r
+ amplitude[(A&0xF)>>2]=V&0x3F; //)>0x20?0x20:(V&0x3F);\r
+ break;\r
+ case 0x5://printf("$%04x:$%02x\n",A,V);\r
+ break;\r
+ case 0x7: b17latch76=0;SPSG[0x5]=0;//printf("$%04x:$%02x\n",A,V);\r
+ break;\r
+ case 0x8:\r
+ b17latch76=0;\r
+ // printf("%d:$%02x, $%02x\n",SPSG[0x5],V,b17latch76);\r
+ fdso.mwave[SPSG[0x5]&0x1F]=V&0x7;\r
+ SPSG[0x5]=(SPSG[0x5]+1)&0x1F;\r
+ break;\r
+ }\r
+ //if(A>=0x7 && A!=0x8 && A<=0xF)\r
+ //if(A==0xA || A==0x9)\r
+ //printf("$%04x:$%02x\n",A,V);\r
+ SPSG[A]=V;\r
+}\r
+\r
+// $4080 - Fundamental wave amplitude data register 92\r
+// $4082 - Fundamental wave frequency data register 58\r
+// $4083 - Same as $4082($4083 is the upper 4 bits).\r
+\r
+// $4084 - Modulation amplitude data register 78\r
+// $4086 - Modulation frequency data register 72\r
+// $4087 - Same as $4086($4087 is the upper 4 bits)\r
+\r
+\r
+static void DoEnv()\r
+{\r
+ int x;\r
+\r
+ for(x=0;x<2;x++)\r
+ if(!(SPSG[x<<2]&0x80) && !(SPSG[0x3]&0x40))\r
+ {\r
+ static int counto[2]={0,0};\r
+\r
+ if(counto[x]<=0)\r
+ {\r
+ if(!(SPSG[x<<2]&0x80))\r
+ {\r
+ if(SPSG[x<<2]&0x40)\r
+ {\r
+ if(amplitude[x]<0x3F)\r
+ amplitude[x]++;\r
+ }\r
+ else\r
+ {\r
+ if(amplitude[x]>0)\r
+ amplitude[x]--;\r
+ }\r
+ }\r
+ counto[x]=(SPSG[x<<2]&0x3F);\r
+ }\r
+ else\r
+ counto[x]--;\r
+ }\r
+}\r
+\r
+static DECLFR(FDSWaveRead)\r
+{\r
+ return(fdso.cwave[A&0x3f]|(X.DB&0xC0));\r
+}\r
+\r
+static DECLFW(FDSWaveWrite)\r
+{\r
+ //printf("$%04x:$%02x, %d\n",A,V,SPSG[0x9]&0x80);\r
+ if(SPSG[0x9]&0x80)\r
+ fdso.cwave[A&0x3f]=V&0x3F;\r
+}\r
+\r
+static int ta;\r
+static INLINE void ClockRise(void)\r
+{\r
+ if(!clockcount)\r
+ {\r
+ ta++;\r
+\r
+ b19shiftreg60=(SPSG[0x2]|((SPSG[0x3]&0xF)<<8));\r
+ b17latch76=(SPSG[0x6]|((SPSG[0x07]&0xF)<<8))+b17latch76;\r
+\r
+ if(!(SPSG[0x7]&0x80))\r
+ {\r
+ int t=fdso.mwave[(b17latch76>>13)&0x1F]&7;\r
+ int t2=amplitude[1];\r
+ int adj = 0;\r
+\r
+ if((t&3))\r
+ {\r
+ if((t&4))\r
+ adj -= (t2 * ((4 - (t&3) ) ));\r
+ else\r
+ adj += (t2 * ( (t&3) ));\r
+ }\r
+ adj *= 2;\r
+ if(adj > 0x7F) adj = 0x7F;\r
+ if(adj < -0x80) adj = -0x80;\r
+ //if(adj) printf("%d ",adj);\r
+ b8shiftreg88=0x80 + adj;\r
+ }\r
+ else\r
+ {\r
+ b8shiftreg88=0x80;\r
+ }\r
+ }\r
+ else\r
+ {\r
+ b19shiftreg60<<=1;\r
+ b8shiftreg88>>=1;\r
+ }\r
+// b24adder66=(b24latch68+b19shiftreg60)&0x3FFFFFF;\r
+ b24adder66=(b24latch68+b19shiftreg60)&0x1FFFFFF;\r
+}\r
+\r
+static INLINE void ClockFall(void)\r
+{\r
+ //if(!(SPSG[0x7]&0x80))\r
+ {\r
+ if((b8shiftreg88&1)) // || clockcount==7)\r
+ b24latch68=b24adder66;\r
+ }\r
+ clockcount=(clockcount+1)&7;\r
+}\r
+\r
+static INLINE int32 FDSDoSound(int32 mul)\r
+{\r
+ fdso.count+=fdso.cycles;\r
+ if(fdso.count>=((int64)1<<40))\r
+ {\r
+ dogk:\r
+ fdso.count-=(int64)1<<40;\r
+ ClockRise();\r
+ ClockFall();\r
+ fdso.envcount--;\r
+ if(fdso.envcount<=0)\r
+ {\r
+ fdso.envcount+=SPSG[0xA]*3;\r
+ DoEnv();\r
+ }\r
+ }\r
+ if(fdso.count>=32768) goto dogk;\r
+\r
+ // Might need to emulate applying the amplitude to the waveform a bit better...\r
+/*\r
+ {\r
+ int k=amplitude[0];\r
+ if(k>0x20) k=0x20;\r
+ return (fdso.cwave[b24latch68>>19]*k)*4/((SPSG[0x9]&0x3)+2);\r
+ }\r
+*/\r
+ return (fdso.cwave[b24latch68>>19]*mul)>>16;\r
+}\r
+\r
+static int32 FBC=0;\r
+\r
+static void RenderSound(void)\r
+{\r
+ int32 end, start;\r
+ int32 x;\r
+ int32 mul;\r
+\r
+ start=FBC;\r
+ end=(SOUNDTS<<16)/soundtsinc;\r
+ if(end<=start)\r
+ return;\r
+ FBC=end;\r
+\r
+ // hack for performance, might produce bad results..\r
+ if (!amplitude[0])\r
+ return;\r
+\r
+ switch (SPSG[0x9]&0x3)\r
+ {\r
+ default:mul = (4<<16)/2;\r
+ case 1: mul = (4<<16)/3;\r
+ case 2: mul = (4<<16)/4;\r
+ case 3: mul = (4<<16)/5;\r
+ }\r
+ {\r
+ int k=amplitude[0];\r
+ if(k>0x20) k=0x20;\r
+ mul *= k;\r
+ }\r
+\r
+ if(!(SPSG[0x9]&0x80))\r
+ for(x=start;x<end;x++)\r
+ {\r
+ uint32 t=FDSDoSound(mul);\r
+ t+=t>>1;\r
+ t>>=4;\r
+ Wave[x>>4]+=t; //(t>>2)-(t>>3); //>>3;\r
+ }\r
+}\r
+\r
+#if 0\r
+static void RenderSoundHQ(void)\r
+{\r
+ int32 x;\r
+\r
+ if(!(SPSG[0x9]&0x80))\r
+ for(x=FBC;x<SOUNDTS;x++)\r
+ {\r
+ uint32 t=FDSDoSound();\r
+ t+=t>>1;\r
+ WaveHi[x]+=t; //(t<<2)-(t<<1);\r
+ }\r
+ FBC=SOUNDTS;\r
+}\r
+#endif\r
+\r
+static void HQSync(int32 ts)\r
+{\r
+ FBC=ts;\r
+}\r
+\r
+void FDSSound(int c)\r
+{\r
+ RenderSound();\r
+ FBC=c;\r
+}\r
+\r
+/*\r
+static DECLFR(FDSBIOSPatch)\r
+{\r
+ if(FDSRegs[5]&0x4)\r
+ {\r
+ X.X=FDSRead4031(0x4031);\r
+ FDSWrite(0x4024,X.A);\r
+ X.A=X.X;\r
+ return(0x60);\r
+ }\r
+ else\r
+ {\r
+ return(0x58);\r
+ //puts("Write");\r
+ }\r
+}\r
+*/\r
+\r
+static void FDS_ESI(void)\r
+{\r
+ if(FSettings.SndRate)\r
+ {\r
+#if 0\r
+ if(FSettings.soundq>=1)\r
+ {\r
+ fdso.cycles=(int64)1<<39;\r
+ }\r
+ else\r
+#endif\r
+ {\r
+ fdso.cycles=((int64)1<<40)*FDSClock;\r
+ fdso.cycles/=FSettings.SndRate *16;\r
+ }\r
+ }\r
+// fdso.cycles=(int64)32768*FDSClock/(FSettings.SndRate *16);\r
+ SetReadHandler(0x4040,0x407f,FDSWaveRead);\r
+ SetWriteHandler(0x4040,0x407f,FDSWaveWrite);\r
+ SetWriteHandler(0x4080,0x408A,FDSSWrite);\r
+ SetReadHandler(0x4090,0x4092,FDSSRead);\r
+\r
+ //SetReadHandler(0xE7A3,0xE7A3,FDSBIOSPatch);\r
+}\r
+\r
+void FDSSoundReset(void)\r
+{\r
+ memset(&fdso,0,sizeof(fdso));\r
+ FDS_ESI();\r
+ GameExpSound.HiSync=HQSync;\r
+ GameExpSound.HiFill=0;//RenderSoundHQ;\r
+ GameExpSound.Fill=FDSSound;\r
+ GameExpSound.RChange=FDS_ESI;\r
+}\r
+\r
+static DECLFW(FDSWrite)\r
+{\r
+ //extern int scanline;\r
+ //FCEU_printf("$%04x:$%02x, %d\n",A,V,scanline);\r
+ switch(A)\r
+ {\r
+ case 0x4020:\r
+ X6502_IRQEnd(FCEU_IQEXT);\r
+ IRQLatch&=0xFF00;\r
+ IRQLatch|=V;\r
+// printf("$%04x:$%02x\n",A,V);\r
+ break;\r
+ case 0x4021:\r
+ X6502_IRQEnd(FCEU_IQEXT);\r
+ IRQLatch&=0xFF;\r
+ IRQLatch|=V<<8;\r
+// printf("$%04x:$%02x\n",A,V);\r
+ break;\r
+ case 0x4022:\r
+ X6502_IRQEnd(FCEU_IQEXT);\r
+ IRQCount=IRQLatch;\r
+ IRQa=V&3;\r
+// printf("$%04x:$%02x\n",A,V);\r
+ break;\r
+ case 0x4023:break;\r
+ case 0x4024:\r
+ if(InDisk!=255 && !(FDSRegs[5]&0x4) && (FDSRegs[3]&0x1))\r
+ {\r
+ if(DiskPtr>=0 && DiskPtr<65500)\r
+ {\r
+ if(writeskip) writeskip--;\r
+ else if(DiskPtr>=2)\r
+ {\r
+ DiskWritten=1;\r
+ diskdata[InDisk][DiskPtr-2]=V;\r
+ }\r
+ }\r
+ }\r
+ break;\r
+ case 0x4025:\r
+ X6502_IRQEnd(FCEU_IQEXT2);\r
+ if(InDisk!=255)\r
+ {\r
+ if(!(V&0x40))\r
+ {\r
+ if(FDSRegs[5]&0x40 && !(V&0x10))\r
+ {\r
+ DiskSeekIRQ=200;\r
+ DiskPtr-=2;\r
+ }\r
+ if(DiskPtr<0) DiskPtr=0;\r
+ }\r
+ if(!(V&0x4)) writeskip=2;\r
+ if(V&2) {DiskPtr=0;DiskSeekIRQ=200;}\r
+ if(V&0x40) DiskSeekIRQ=200;\r
+ }\r
+ setmirror(((V>>3)&1)^1);\r
+ break;\r
+ }\r
+ FDSRegs[A&7]=V;\r
+}\r
+\r
+static void FreeFDSMemory(void)\r
+{\r
+ int x;\r
+\r
+ for(x=0;x<TotalSides;x++)\r
+ if(diskdata[x])\r
+ {\r
+ free(diskdata[x]);\r
+ diskdata[x]=0;\r
+ }\r
+}\r
+\r
+static int SubLoad(int fp)\r
+{\r
+ struct md5_context md5;\r
+ uint8 header[16];\r
+ int x;\r
+\r
+ FCEU_fread(header,16,1,fp);\r
+\r
+ if(memcmp(header,"FDS\x1a",4))\r
+ {\r
+ if(!(memcmp(header+1,"*NINTENDO-HVC*",14)))\r
+ {\r
+ long t;\r
+ t=FCEU_fgetsize(fp);\r
+ if(t<65500)\r
+ t=65500;\r
+ TotalSides=t/65500;\r
+ FCEU_fseek(fp,0,SEEK_SET);\r
+ }\r
+ else\r
+ return(0);\r
+ }\r
+ else\r
+ TotalSides=header[4];\r
+\r
+ md5_starts(&md5);\r
+\r
+ if(TotalSides>8) TotalSides=8;\r
+ if(TotalSides<1) TotalSides=1;\r
+\r
+ for(x=0;x<TotalSides;x++)\r
+ {\r
+ diskdata[x]=(uint8 *)FCEU_malloc(65500);\r
+ if(!diskdata[x])\r
+ {\r
+ int zol;\r
+ for(zol=0;zol<x;zol++)\r
+ free(diskdata[zol]);\r
+ return 0;\r
+ }\r
+ FCEU_fread(diskdata[x],1,65500,fp);\r
+ md5_update(&md5,diskdata[x],65500);\r
+ }\r
+ md5_finish(&md5,FCEUGameInfo.MD5);\r
+ return(1);\r
+}\r
+\r
+static void PreSave(void)\r
+{\r
+ int x;\r
+\r
+ //if(DiskWritten)\r
+ for(x=0;x<TotalSides;x++)\r
+ {\r
+ int b;\r
+ for(b=0; b<65500; b++)\r
+ diskdata[x][b] ^= diskdatao[x][b];\r
+ }\r
+}\r
+\r
+static void PostSave(void)\r
+{\r
+ int x;\r
+\r
+ //if(DiskWritten)\r
+ for(x=0;x<TotalSides;x++)\r
+ {\r
+ int b;\r
+\r
+ for(b=0; b<65500; b++)\r
+ diskdata[x][b] ^= diskdatao[x][b];\r
+ }\r
+\r
+}\r
+\r
+int FDSLoad(const char *name, int fp)\r
+{\r
+ FILE *zp;\r
+ int x;\r
+ char *fn;\r
+\r
+ FCEU_fseek(fp,0,SEEK_SET);\r
+\r
+ if(!SubLoad(fp))\r
+ return(0);\r
+\r
+\r
+ fn = FCEU_MakeFName(FCEUMKF_FDSROM,0,0);\r
+\r
+ if(!(zp=FCEUD_UTF8fopen(fn,"rb")))\r
+ {\r
+ FCEU_PrintError("FDS BIOS ROM image missing!");\r
+ FreeFDSMemory();\r
+ free(fn);\r
+ LoadGameLastError = 10;\r
+ return 0;\r
+ }\r
+\r
+ free(fn);\r
+\r
+ if(fread(FDSBIOS,1,8192,zp)!=8192)\r
+ {\r
+ fclose(zp);\r
+ FreeFDSMemory();\r
+ FCEU_PrintError("Error reading FDS BIOS ROM image.");\r
+ LoadGameLastError = 10;\r
+ return 0;\r
+ }\r
+\r
+ fclose(zp);\r
+\r
+\r
+ {\r
+ int tp;\r
+ char *fn=FCEU_MakeFName(FCEUMKF_FDS,0,0);\r
+\r
+ int x;\r
+ for(x=0;x<TotalSides;x++)\r
+ {\r
+ diskdatao[x]=(uint8 *)FCEU_malloc(65500);\r
+ memcpy(diskdatao[x],diskdata[x],65500);\r
+ }\r
+\r
+ if((tp=FCEU_fopen(fn,"rb")))\r
+ {\r
+ FreeFDSMemory();\r
+ if(!SubLoad(tp))\r
+ {\r
+ FCEU_PrintError("Error reading auxillary FDS file.");\r
+ free(fn);\r
+ LoadGameLastError = 11;\r
+ return(0);\r
+ }\r
+ FCEU_fclose(tp);\r
+ DiskWritten=1; /* For save state handling. */\r
+ }\r
+ free(fn);\r
+ }\r
+\r
+ FCEUGameInfo.type=GIT_FDS;\r
+ GameInterface=FDSGI;\r
+\r
+ SelectDisk=0;\r
+ InDisk=255;\r
+\r
+ ResetExState(PreSave,PostSave);\r
+ FDSSoundStateAdd();\r
+\r
+ for(x=0;x<TotalSides;x++)\r
+ {\r
+ char temp[5];\r
+ sprintf(temp,"DDT%d",x);\r
+ AddExState(diskdata[x],65500,0,temp);\r
+ }\r
+\r
+ AddExState(FDSRAM,32768,0,"FDSR");\r
+ AddExState(FDSRegs,sizeof(FDSRegs),0,"FREG");\r
+ AddExState(CHRRAM,8192,0,"CHRR");\r
+ AddExState(&IRQCount, 4, 1, "IRQC");\r
+ AddExState(&IRQLatch, 4, 1, "IQL1");\r
+ AddExState(&IRQa, 1, 0, "IRQA");\r
+ AddExState(&writeskip,1,0,"WSKI");\r
+ AddExState(&DiskPtr,4,1,"DPTR");\r
+ AddExState(&DiskSeekIRQ,4,1,"DSIR");\r
+ AddExState(&SelectDisk,1,0,"SELD");\r
+ AddExState(&InDisk,1,0,"INDI");\r
+ AddExState(&DiskWritten,1,0,"DSKW");\r
+\r
+ ResetCartMapping();\r
+ SetupCartCHRMapping(0,CHRRAM,8192,1);\r
+ SetupCartMirroring(0,0,0);\r
+ memset(CHRRAM,0,8192);\r
+ memset(FDSRAM,0,32768);\r
+\r
+ FCEU_printf(" Sides: %d\n\n",TotalSides);\r
+\r
+ FCEUI_SetVidSystem(0);\r
+\r
+ return 1;\r
+}\r
+\r
+void FDSClose(void)\r
+{\r
+ FILE *fp;\r
+ int x;\r
+ char *fn;\r
+\r
+ if(!DiskWritten)\r
+ {\r
+ fn=FCEU_MakeFName(FCEUMKF_FDS,0,0);\r
+\r
+ if(!(fp=FCEUD_UTF8fopen(fn,"wb")))\r
+ {\r
+ free(fn);\r
+ return;\r
+ }\r
+ free(fn);\r
+\r
+ for(x=0;x<TotalSides;x++)\r
+ {\r
+ if(fwrite(diskdata[x],1,65500,fp)!=65500)\r
+ {\r
+ FCEU_PrintError("Error saving FDS image!");\r
+ fclose(fp);\r
+ return;\r
+ }\r
+ }\r
+ fclose(fp);\r
+#ifdef GP2X\r
+ sync();\r
+#endif\r
+ }\r
+\r
+ FreeFDSMemory();\r
+ for(x=0;x<TotalSides;x++)\r
+ if(diskdatao[x])\r
+ {\r
+ free(diskdatao[x]);\r
+ diskdatao[x]=0;\r
+ }\r
+ ResetExState(0,0);\r
+}\r
+\r