/* FCEUmm - NES/Famicom Emulator
 *
 * Copyright notice for this file:
 *  Copyright (C) 2020
 *
 * 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 "mapinc.h"
#include "asic_vrc2and4.h"

static uint8 submapper;
static uint8 reg;

static void sync () {
	int prgAND = reg &0x10? 0x1F: 0x0F;
	int chrAND = reg &0x10? 0xFF: 0x7F;
	int prgOR = reg <<1;
	int chrOR = reg <<4;
	if (reg &0x20)
		VRC24_syncPRG(prgAND, prgOR &~prgAND);
	else
	if (submapper == 0 && reg &0x06 || submapper == 1 && reg &0x02 && reg &0x04)
		setprg32(0x8000, reg >>1);
	else {
		setprg16(0x8000, reg);
		setprg16(0xC000, reg);
	}
	VRC24_syncCHR(chrAND, chrOR &~chrAND);
	VRC24_syncMirror();
	if (reg &0x10)
		VRC24_reconfigure(8, 4);
	else
		VRC24_reconfigure(4, 8);
}

static DECLFW (writeReg) {
	if (~reg &0x01) {
		reg = A &0xFF;
		sync();
	}
}

static void reset () {
	reg = 0;
	sync();
}

static void power () {
	reg = 0;
	VRC24_power();
}

void Mapper571_Init (CartInfo *info) {
	submapper = info->submapper;
	VRC4_init(info, sync, 4, 8, 1, NULL, NULL, NULL, writeReg, NULL);
	info->Power = power;
	info->Reset = reset;
	AddExState(&reg, 1, 0, "EXPR");
}
