/* FCE Ultra - NES/Famicom Emulator
 *
 * Copyright notice for this file:
 *  Copyright (C) 2002 Xodnizel
 *
 * 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        <string.h>
#include        <stdlib.h>
#include        "share.h"


static char side;
static uint32_t pprsb[2];
static uint32_t pprdata[2];

static uint8_t FP_FASTAPASS(1) ReadPP(int w) {
	uint8_t ret = 0;
	ret |= ((pprdata[w] >> pprsb[w]) & 1) << 3;
	ret |= ((pprdata[w] >> (pprsb[w] + 8)) & 1) << 4;
	if (pprsb[w] >= 4) {
		ret |= 0x10;
		if (pprsb[w] >= 8)
			ret |= 0x08;
	}
	pprsb[w]++;
	return ret;
}

static void FP_FASTAPASS(1) StrobePP(int w) {
	pprsb[w] = 0;
}

void FP_FASTAPASS(3) UpdatePP(int w, void *data, int arg) {
	static const char shifttableA[12] = { 8, 9, 0, 1, 11, 7, 4, 2, 10, 6, 5, 3 };
	static const char shifttableB[12] = { 1, 0, 9, 8, 2, 4, 7, 11, 3, 5, 6, 10 };
	int x;

	pprdata[w] = 0;

	if (side == 'A')
		for (x = 0; x < 12; x++)
			pprdata[w] |= (((*(uint32_t*)data) >> x) & 1) << shifttableA[x];
	else
		for (x = 0; x < 12; x++)
			pprdata[w] |= (((*(uint32_t*)data) >> x) & 1) << shifttableB[x];
}

static INPUTC PwrPadCtrl = { ReadPP, 0, StrobePP, UpdatePP, 0, 0 };

static INPUTC *FCEU_InitPowerpad(int w) {
	pprsb[w] = pprdata[w] = 0;
	return(&PwrPadCtrl);
}

INPUTC *FCEU_InitPowerpadA(int w) {
	side = 'A';
	return(FCEU_InitPowerpad(w));
}

INPUTC *FCEU_InitPowerpadB(int w) {
	side = 'B';
	return(FCEU_InitPowerpad(w));
}