Files
2023-05-01 07:39:23 +02:00

498 lines
20 KiB
C++

//
// Copyright (C) 2008 by sinamas <sinamas at users.sourceforge.net>
//
// This program is free software; you can redistribute it and/or modify
// it under the terms of the GNU General Public License version 2 as
// published by the Free Software Foundation.
//
// 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 version 2 for more details.
//
// You should have received a copy of the GNU General Public License
// version 2 along with this program; if not, write to the
// Free Software Foundation, Inc.,
// 51 Franklin St, Fifth Floor, Boston, MA 02110-1301, USA.
//
#include "statesaver.h"
#include "savestate.h"
#include "array.h"
#include <algorithm>
#include <fstream>
#include <functional>
#include <vector>
#include <cstring>
namespace {
using namespace gambatte;
enum AsciiChar {
NUL, SOH, STX, ETX, EOT, ENQ, ACK, BEL, BS, TAB, LF, VT, FF, CR, SO, SI,
DLE, DC1, DC2, DC3, DC4, NAK, SYN, ETB, CAN, EM, SUB, ESC, FS, GS, RS, US,
SP, XCL, QOT, HSH, DLR, PRC, AMP, APO, LPA, RPA, AST, PLU, COM, HYP, STP, DIV,
NO0, NO1, NO2, NO3, NO4, NO5, NO6, NO7, NO8, NO9, CLN, SCL, LT, EQL, GT, QTN,
AT, A, B, C, D, E, F, G, H, I, J, K, L, M, N, O,
P, Q, R, S, T, U, V, W, X, Y, Z, LBX, BSL, RBX, CAT, UND,
ACN, a, b, c, d, e, f, g, h, i, j, k, l, m, n, o,
p, q, r, s, t, u, v, w, x, y, z, LBR, BAR, RBR, TLD, DEL
};
struct Saver {
char const *label;
void (*save)(std::ostream &file, SaveState const &state);
void (*load)(std::istream &file, SaveState &state);
std::size_t labelsize;
};
inline bool operator<(Saver const &l, Saver const &r) {
return std::strcmp(l.label, r.label) < 0;
}
void put24(std::ostream &stream, unsigned long data) {
stream.put(data >> 16 & 0xFF);
stream.put(data >> 8 & 0xFF);
stream.put(data & 0xFF);
}
void put32(std::ostream &stream, unsigned long data) {
stream.put(data >> 24 & 0xFF);
stream.put(data >> 16 & 0xFF);
stream.put(data >> 8 & 0xFF);
stream.put(data & 0xFF);
}
void write(std::ostream &stream, unsigned char data) {
static char const inf[] = { 0x00, 0x00, 0x01 };
stream.write(inf, sizeof inf);
stream.put(data & 0xFF);
}
void write(std::ostream &stream, unsigned short data) {
static char const inf[] = { 0x00, 0x00, 0x02 };
stream.write(inf, sizeof inf);
stream.put(data >> 8 & 0xFF);
stream.put(data & 0xFF);
}
void write(std::ostream &stream, unsigned long data) {
static char const inf[] = { 0x00, 0x00, 0x04 };
stream.write(inf, sizeof inf);
put32(stream, data);
}
void write(std::ostream &stream, unsigned char const *data, std::size_t size) {
put24(stream, size);
stream.write(reinterpret_cast<char const *>(data), size);
}
void write(std::ostream &stream, bool const *data, std::size_t size) {
put24(stream, size);
std::for_each(data, data + size,
std::bind1st(std::mem_fun(&std::ostream::put), &stream));
}
unsigned long get24(std::istream &stream) {
unsigned long tmp = stream.get() & 0xFF;
tmp = tmp << 8 | (stream.get() & 0xFF);
return tmp << 8 | (stream.get() & 0xFF);
}
unsigned long read(std::istream &stream) {
unsigned long size = get24(stream);
if (size > 4) {
stream.ignore(size - 4);
size = 4;
}
unsigned long out = 0;
switch (size) {
case 4: out = (out | (stream.get() & 0xFF)) << 8; // fall through.
case 3: out = (out | (stream.get() & 0xFF)) << 8; // fall through.
case 2: out = (out | (stream.get() & 0xFF)) << 8; // fall through.
case 1: out = out | (stream.get() & 0xFF);
}
return out;
}
inline void read(std::istream &stream, unsigned char &data) {
data = read(stream) & 0xFF;
}
inline void read(std::istream &stream, unsigned short &data) {
data = read(stream) & 0xFFFF;
}
inline void read(std::istream &stream, unsigned long &data) {
data = read(stream);
}
void read(std::istream &stream, unsigned char *buf, std::size_t bufsize) {
std::size_t const size = get24(stream);
std::size_t const minsize = std::min(size, bufsize);
stream.read(reinterpret_cast<char*>(buf), minsize);
stream.ignore(size - minsize);
if (static_cast<unsigned char>(0x100)) {
for (std::size_t i = 0; i < minsize; ++i)
buf[i] &= 0xFF;
}
}
void read(std::istream &stream, bool *buf, std::size_t bufsize) {
std::size_t const size = get24(stream);
std::size_t const minsize = std::min(size, bufsize);
for (std::size_t i = 0; i < minsize; ++i)
buf[i] = stream.get();
stream.ignore(size - minsize);
}
} // anon namespace
namespace gambatte {
class SaverList {
public:
typedef std::vector<Saver> list_t;
typedef list_t::const_iterator const_iterator;
SaverList();
const_iterator begin() const { return list.begin(); }
const_iterator end() const { return list.end(); }
std::size_t maxLabelsize() const { return maxLabelsize_; }
private:
list_t list;
std::size_t maxLabelsize_;
};
static void push(SaverList::list_t &list, char const *label,
void (*save)(std::ostream &stream, SaveState const &state),
void (*load)(std::istream &stream, SaveState &state),
std::size_t labelsize) {
Saver saver = { label, save, load, labelsize };
list.push_back(saver);
}
SaverList::SaverList()
: maxLabelsize_(0)
{
#define ADD(arg) do { \
struct Func { \
static void save(std::ostream &stream, SaveState const &state) { write(stream, state.arg); } \
static void load(std::istream &stream, SaveState &state) { read(stream, state.arg); } \
}; \
push(list, label, Func::save, Func::load, sizeof label); \
} while (0)
#define ADDPTR(arg) do { \
struct Func { \
static void save(std::ostream &stream, SaveState const &state) { \
write(stream, state.arg.get(), state.arg.size()); \
} \
static void load(std::istream &stream, SaveState &state) { \
read(stream, state.arg.ptr, state.arg.size()); \
} \
}; \
push(list, label, Func::save, Func::load, sizeof label); \
} while (0)
#define ADDARRAY(arg) do { \
struct Func { \
static void save(std::ostream &stream, SaveState const &state) { \
write(stream, state.arg, sizeof state.arg); \
} \
static void load(std::istream &stream, SaveState &state) { \
read(stream, state.arg, sizeof state.arg); \
} \
}; \
push(list, label, Func::save, Func::load, sizeof label); \
} while (0)
{ static char const label[] = { c,c, NUL }; ADD(cpu.cycleCounter); }
{ static char const label[] = { p,c, NUL }; ADD(cpu.pc); }
{ static char const label[] = { s,p, NUL }; ADD(cpu.sp); }
{ static char const label[] = { a, NUL }; ADD(cpu.a); }
{ static char const label[] = { b, NUL }; ADD(cpu.b); }
{ static char const label[] = { c, NUL }; ADD(cpu.c); }
{ static char const label[] = { d, NUL }; ADD(cpu.d); }
{ static char const label[] = { e, NUL }; ADD(cpu.e); }
{ static char const label[] = { f, NUL }; ADD(cpu.f); }
{ static char const label[] = { h, NUL }; ADD(cpu.h); }
{ static char const label[] = { l, NUL }; ADD(cpu.l); }
{ static char const label[] = { o,p, NUL }; ADD(cpu.opcode); }
{ static char const label[] = { f,e,t,c,h,e,d, NUL }; ADD(cpu.prefetched); }
{ static char const label[] = { s,k,i,p, NUL }; ADD(cpu.skip); }
{ static char const label[] = { h,a,l,t, NUL }; ADD(mem.halted); }
{ static char const label[] = { v,r,a,m, NUL }; ADDPTR(mem.vram); }
{ static char const label[] = { s,r,a,m, NUL }; ADDPTR(mem.sram); }
{ static char const label[] = { w,r,a,m, NUL }; ADDPTR(mem.wram); }
{ static char const label[] = { h,r,a,m, NUL }; ADDPTR(mem.ioamhram); }
{ static char const label[] = { l,d,i,v,u,p, NUL }; ADD(mem.divLastUpdate); }
{ static char const label[] = { l,t,i,m,a,u,p, NUL }; ADD(mem.timaLastUpdate); }
{ static char const label[] = { t,m,a,t,i,m,e, NUL }; ADD(mem.tmatime); }
{ static char const label[] = { s,e,r,i,a,l,t, NUL }; ADD(mem.nextSerialtime); }
{ static char const label[] = { l,o,d,m,a,u,p, NUL }; ADD(mem.lastOamDmaUpdate); }
{ static char const label[] = { m,i,n,i,n,t,t, NUL }; ADD(mem.minIntTime); }
{ static char const label[] = { u,n,h,a,l,t,t, NUL }; ADD(mem.unhaltTime); }
{ static char const label[] = { r,o,m,b,a,n,k, NUL }; ADD(mem.rombank); }
{ static char const label[] = { d,m,a,s,r,c, NUL }; ADD(mem.dmaSource); }
{ static char const label[] = { d,m,a,d,s,t, NUL }; ADD(mem.dmaDestination); }
{ static char const label[] = { r,a,m,b,a,n,k, NUL }; ADD(mem.rambank); }
{ static char const label[] = { o,d,m,a,p,o,s, NUL }; ADD(mem.oamDmaPos); }
{ static char const label[] = { h,l,t,h,d,m,a, NUL }; ADD(mem.haltHdmaState); }
{ static char const label[] = { i,m,e, NUL }; ADD(mem.IME); }
{ static char const label[] = { s,r,a,m,o,n, NUL }; ADD(mem.enableRam); }
{ static char const label[] = { r,a,m,b,m,o,d, NUL }; ADD(mem.rambankMode); }
{ static char const label[] = { h,d,m,a, NUL }; ADD(mem.hdmaTransfer); }
{ static char const label[] = { b,g,p, NUL }; ADDPTR(ppu.bgpData); }
{ static char const label[] = { o,b,j,p, NUL }; ADDPTR(ppu.objpData); }
{ static char const label[] = { s,p,o,s,b,u,f, NUL }; ADDPTR(ppu.oamReaderBuf); }
{ static char const label[] = { s,p,s,z,b,u,f, NUL }; ADDPTR(ppu.oamReaderSzbuf); }
{ static char const label[] = { s,p,a,t,t,r, NUL }; ADDARRAY(ppu.spAttribList); }
{ static char const label[] = { s,p,b,y,t,e,NO0, NUL }; ADDARRAY(ppu.spByte0List); }
{ static char const label[] = { s,p,b,y,t,e,NO1, NUL }; ADDARRAY(ppu.spByte1List); }
{ static char const label[] = { v,c,y,c,l,e,s, NUL }; ADD(ppu.videoCycles); }
{ static char const label[] = { e,d,M,NO0,t,i,m, NUL }; ADD(ppu.enableDisplayM0Time); }
{ static char const label[] = { m,NO0,t,i,m,e, NUL }; ADD(ppu.lastM0Time); }
{ static char const label[] = { n,m,NO0,i,r,q, NUL }; ADD(ppu.nextM0Irq); }
{ static char const label[] = { b,g,t,w, NUL }; ADD(ppu.tileword); }
{ static char const label[] = { b,g,n,t,w, NUL }; ADD(ppu.ntileword); }
{ static char const label[] = { w,i,n,y,p,o,s, NUL }; ADD(ppu.winYPos); }
{ static char const label[] = { x,p,o,s, NUL }; ADD(ppu.xpos); }
{ static char const label[] = { e,n,d,x, NUL }; ADD(ppu.endx); }
{ static char const label[] = { p,p,u,r,NO0, NUL }; ADD(ppu.reg0); }
{ static char const label[] = { p,p,u,r,NO1, NUL }; ADD(ppu.reg1); }
{ static char const label[] = { b,g,a,t,r,b, NUL }; ADD(ppu.attrib); }
{ static char const label[] = { b,g,n,a,t,r,b, NUL }; ADD(ppu.nattrib); }
{ static char const label[] = { p,p,u,s,t,a,t, NUL }; ADD(ppu.state); }
{ static char const label[] = { n,s,p,r,i,t,e, NUL }; ADD(ppu.nextSprite); }
{ static char const label[] = { c,s,p,r,i,t,e, NUL }; ADD(ppu.currentSprite); }
{ static char const label[] = { l,y,c, NUL }; ADD(ppu.lyc); }
{ static char const label[] = { m,NO0,l,y,c, NUL }; ADD(ppu.m0lyc); }
{ static char const label[] = { o,l,d,w,y, NUL }; ADD(ppu.oldWy); }
{ static char const label[] = { w,i,n,d,r,a,w, NUL }; ADD(ppu.winDrawState); }
{ static char const label[] = { w,s,c,x, NUL }; ADD(ppu.wscx); }
{ static char const label[] = { w,e,m,a,s,t,r, NUL }; ADD(ppu.weMaster); }
{ static char const label[] = { l,c,d,s,i,r,q, NUL }; ADD(ppu.pendingLcdstatIrq); }
{ static char const label[] = { s,p,u,c,n,t,r, NUL }; ADD(spu.cycleCounter); }
{ static char const label[] = { s,p,u,c,n,t,l, NUL }; ADD(spu.lastUpdate); }
{ static char const label[] = { s,w,p,c,n,t,r, NUL }; ADD(spu.ch1.sweep.counter); }
{ static char const label[] = { s,w,p,s,h,d,w, NUL }; ADD(spu.ch1.sweep.shadow); }
{ static char const label[] = { s,w,p,n,e,g, NUL }; ADD(spu.ch1.sweep.neg); }
{ static char const label[] = { d,u,t,NO1,c,t,r, NUL }; ADD(spu.ch1.duty.nextPosUpdate); }
{ static char const label[] = { d,u,t,NO1,p,o,s, NUL }; ADD(spu.ch1.duty.pos); }
{ static char const label[] = { d,u,t,NO1,h,i, NUL }; ADD(spu.ch1.duty.high); }
{ static char const label[] = { e,n,v,NO1,c,t,r, NUL }; ADD(spu.ch1.env.counter); }
{ static char const label[] = { e,n,v,NO1,v,o,l, NUL }; ADD(spu.ch1.env.volume); }
{ static char const label[] = { l,e,n,NO1,c,t,r, NUL }; ADD(spu.ch1.lcounter.counter); }
{ static char const label[] = { l,e,n,NO1,v,a,l, NUL }; ADD(spu.ch1.lcounter.lengthCounter); }
{ static char const label[] = { n,r,NO1,NO0, NUL }; ADD(spu.ch1.sweep.nr0); }
{ static char const label[] = { n,r,NO1,NO3, NUL }; ADD(spu.ch1.duty.nr3); }
{ static char const label[] = { n,r,NO1,NO4, NUL }; ADD(spu.ch1.nr4); }
{ static char const label[] = { c,NO1,m,a,s,t,r, NUL }; ADD(spu.ch1.master); }
{ static char const label[] = { d,u,t,NO2,c,t,r, NUL }; ADD(spu.ch2.duty.nextPosUpdate); }
{ static char const label[] = { d,u,t,NO2,p,o,s, NUL }; ADD(spu.ch2.duty.pos); }
{ static char const label[] = { d,u,t,NO2,h,i, NUL }; ADD(spu.ch2.duty.high); }
{ static char const label[] = { e,n,v,NO2,c,t,r, NUL }; ADD(spu.ch2.env.counter); }
{ static char const label[] = { e,n,v,NO2,v,o,l, NUL }; ADD(spu.ch2.env.volume); }
{ static char const label[] = { l,e,n,NO2,c,t,r, NUL }; ADD(spu.ch2.lcounter.counter); }
{ static char const label[] = { l,e,n,NO2,v,a,l, NUL }; ADD(spu.ch2.lcounter.lengthCounter); }
{ static char const label[] = { n,r,NO2,NO3, NUL }; ADD(spu.ch2.duty.nr3); }
{ static char const label[] = { n,r,NO2,NO4, NUL }; ADD(spu.ch2.nr4); }
{ static char const label[] = { c,NO2,m,a,s,t,r, NUL }; ADD(spu.ch2.master); }
{ static char const label[] = { w,a,v,e,r,a,m, NUL }; ADDPTR(spu.ch3.waveRam); }
{ static char const label[] = { l,e,n,NO3,c,t,r, NUL }; ADD(spu.ch3.lcounter.counter); }
{ static char const label[] = { l,e,n,NO3,v,a,l, NUL }; ADD(spu.ch3.lcounter.lengthCounter); }
{ static char const label[] = { w,a,v,e,c,t,r, NUL }; ADD(spu.ch3.waveCounter); }
{ static char const label[] = { l,w,a,v,r,d,t, NUL }; ADD(spu.ch3.lastReadTime); }
{ static char const label[] = { w,a,v,e,p,o,s, NUL }; ADD(spu.ch3.wavePos); }
{ static char const label[] = { w,a,v,s,m,p,l, NUL }; ADD(spu.ch3.sampleBuf); }
{ static char const label[] = { n,r,NO3,NO3, NUL }; ADD(spu.ch3.nr3); }
{ static char const label[] = { n,r,NO3,NO4, NUL }; ADD(spu.ch3.nr4); }
{ static char const label[] = { c,NO3,m,a,s,t,r, NUL }; ADD(spu.ch3.master); }
{ static char const label[] = { l,f,s,r,c,t,r, NUL }; ADD(spu.ch4.lfsr.counter); }
{ static char const label[] = { l,f,s,r,r,e,g, NUL }; ADD(spu.ch4.lfsr.reg); }
{ static char const label[] = { e,n,v,NO4,c,t,r, NUL }; ADD(spu.ch4.env.counter); }
{ static char const label[] = { e,n,v,NO4,v,o,l, NUL }; ADD(spu.ch4.env.volume); }
{ static char const label[] = { l,e,n,NO4,c,t,r, NUL }; ADD(spu.ch4.lcounter.counter); }
{ static char const label[] = { l,e,n,NO4,v,a,l, NUL }; ADD(spu.ch4.lcounter.lengthCounter); }
{ static char const label[] = { n,r,NO4,NO4, NUL }; ADD(spu.ch4.nr4); }
{ static char const label[] = { c,NO4,m,a,s,t,r, NUL }; ADD(spu.ch4.master); }
{ static char const label[] = { r,t,c,b,a,s,e, NUL }; ADD(rtc.baseTime); }
{ static char const label[] = { r,t,c,h,a,l,t, NUL }; ADD(rtc.haltTime); }
{ static char const label[] = { r,t,c,d,h, NUL }; ADD(rtc.dataDh); }
{ static char const label[] = { r,t,c,d,l, NUL }; ADD(rtc.dataDl); }
{ static char const label[] = { r,t,c,h, NUL }; ADD(rtc.dataH); }
{ static char const label[] = { r,t,c,m, NUL }; ADD(rtc.dataM); }
{ static char const label[] = { r,t,c,s, NUL }; ADD(rtc.dataS); }
{ static char const label[] = { r,t,c,l,l,d, NUL }; ADD(rtc.lastLatchData); }
#undef ADD
#undef ADDPTR
#undef ADDARRAY
// sort list for binary search/std::lower_bound use.
std::sort(list.begin(), list.end());
for (const_iterator it = list.begin(); it != list.end(); ++it)
maxLabelsize_ = std::max(maxLabelsize_, it->labelsize);
}
}
namespace {
struct RgbSum { unsigned long rb, g; };
void addPairs(RgbSum *const sum, uint_least32_t const *const p) {
sum[0].rb += (p[0] & 0xFF00FF) + (p[3] & 0xFF00FF);
sum[0].g += (p[0] & 0x00FF00) + (p[3] & 0x00FF00);
sum[1].rb += (p[1] & 0xFF00FF) + (p[2] & 0xFF00FF);
sum[1].g += (p[1] & 0x00FF00) + (p[2] & 0x00FF00);
}
void blendPairs(RgbSum *const dst, RgbSum const *const sums) {
dst->rb = sums[1].rb * 8 + (sums[0].rb - sums[1].rb) * 3;
dst->g = sums[1].g * 8 + (sums[0].g - sums[1].g ) * 3;
}
void writeSnapShot(std::ostream &stream, uint_least32_t const *src, std::ptrdiff_t const pitch) {
put24(stream, src ? StateSaver::ss_width * StateSaver::ss_height * sizeof *src : 0);
if (src) {
uint_least32_t buf[StateSaver::ss_width];
for (unsigned h = StateSaver::ss_height; h--;) {
for (unsigned x = 0; x < StateSaver::ss_width; ++x) {
uint_least32_t const *const p = src + x * StateSaver::ss_div;
RgbSum sum[] = { {0, 0}, {0, 0}, {0, 0}, {0, 0} };
addPairs(sum , p );
addPairs(sum + 2, p + pitch );
addPairs(sum + 2, p + pitch * 2);
addPairs(sum , p + pitch * 3);
blendPairs(sum, sum);
blendPairs(sum + 1, sum + 2);
blendPairs(sum, sum);
buf[x] = ((sum[0].rb & 0xFF00FF00) | (sum[0].g & 0x00FF0000)) >> 8;
}
stream.write(reinterpret_cast<char const *>(buf), sizeof buf);
src += pitch * StateSaver::ss_div;
}
}
}
SaverList list;
} // anon namespace
bool StateSaver::serializeState(SaveState const &state, std::ostream &stream) {
if (!stream)
return false;
{ static char const ver[] = { 0, 1 }; stream.write(ver, sizeof ver); }
writeSnapShot(stream, 0, 0);
for (SaverList::const_iterator it = list.begin(); it != list.end(); ++it) {
stream.write(it->label, it->labelsize);
(*it->save)(stream, state);
}
return !stream.fail();
}
bool StateSaver::deserializeState(SaveState &state, std::istream &stream) {
if (!stream || stream.get() != 0)
return false;
stream.ignore();
stream.ignore(get24(stream));
Array<char> const labelbuf(list.maxLabelsize());
Saver const labelbufSaver = { labelbuf, 0, 0, list.maxLabelsize() };
SaverList::const_iterator done = list.begin();
while (stream.good() && done != list.end()) {
stream.getline(labelbuf, list.maxLabelsize(), NUL);
SaverList::const_iterator it = done;
if (std::strcmp(labelbuf, it->label)) {
it = std::lower_bound(it + 1, list.end(), labelbufSaver);
if (it == list.end() || std::strcmp(labelbuf, it->label)) {
stream.ignore(get24(stream));
continue;
}
} else
++done;
(*it->load)(stream, state);
}
state.cpu.cycleCounter &= 0x7FFFFFFF;
state.spu.cycleCounter &= 0x7FFFFFFF;
return true;
}
bool StateSaver::saveState(SaveState const &state,
uint_least32_t const *videoBuf,
std::ptrdiff_t pitch, std::string const &filename) {
std::ofstream file(filename.c_str(), std::ios_base::binary);
if (!file)
return false;
{ static char const ver[] = { 0, 1 }; file.write(ver, sizeof ver); }
writeSnapShot(file, videoBuf, pitch);
for (SaverList::const_iterator it = list.begin(); it != list.end(); ++it) {
file.write(it->label, it->labelsize);
(*it->save)(file, state);
}
return !file.fail();
}
bool StateSaver::loadState(SaveState &state, std::string const &filename) {
std::ifstream file(filename.c_str(), std::ios_base::binary);
if (!file || file.get() != 0)
return false;
file.ignore();
file.ignore(get24(file));
Array<char> const labelbuf(list.maxLabelsize());
Saver const labelbufSaver = { labelbuf, 0, 0, list.maxLabelsize() };
SaverList::const_iterator done = list.begin();
while (file.good() && done != list.end()) {
file.getline(labelbuf, list.maxLabelsize(), NUL);
SaverList::const_iterator it = done;
if (std::strcmp(labelbuf, it->label)) {
it = std::lower_bound(it + 1, list.end(), labelbufSaver);
if (it == list.end() || std::strcmp(labelbuf, it->label)) {
file.ignore(get24(file));
continue;
}
} else
++done;
(*it->load)(file, state);
}
state.cpu.cycleCounter &= 0x7FFFFFFF;
state.spu.cycleCounter &= 0x7FFFFFFF;
return true;
}