#include "NuBusFPGADrvr.h"

#include <Traps.h>

#define SECO_WRITEREG(reg, val) \
	*((volatile UInt32*)(a32+GOBOFB_BASE+reg)) = (UInt32)val;

#pragma parameter __D0 Primary(__A0)
UInt32 Secondary(SEBlock* seblock) {
	UInt32 a32 = 0xF0000000 | ((UInt32)seblock->seSlot << 24);
	UInt32 a32_l0, a32_l1;
	UInt32 a32_4p0, a32_4p1;
	SpBlock spblock;
	/* UInt8 pram[8]; */
	OSErr err;
	UInt16 i,j;
	char busMode;
	UniversalProcPtr qd32ptr, unimpptr;
	
	busMode = 1;

	/* call SVersion to figure out if we have a recent SlotManager */
#if 0
	//spblock.spSlot = seblock->seSlot;
	//spblock.spExtDev = 0;
	err = SVersion(&spblock);

	busMode = 1;
	SwapMMUMode ( &busMode ); // to32
	if (err) {
		/* DCDMF3 p178: if error, old slot manager*/
		/* SECO_WRITEREG(GOBOFB_DEBUG, 0xFFFFFFFF);*/
		/* SECO_WRITEREG(GOBOFB_DEBUG, err);*/
	} else {
		/* DCDMF3 p178: new slot manager */
		/* SECO_WRITEREG(GOBOFB_DEBUG, 0);*/
		/* SECO_WRITEREG(GOBOFB_DEBUG, spblock.spResult);*/
	}
	SwapMMUMode ( &busMode ); // restore
#endif

#if 1
	/* check for 32-bits QuickDraw */
	qd32ptr = GetTrapAddress(Check32QDTrap);
	unimpptr = GetTrapAddress(_Unimplemented);
	
	busMode = 1;
	SwapMMUMode ( &busMode ); // to32
	if (qd32ptr == unimpptr) {
		/* no 32QD */
		SECO_WRITEREG(GOBOFB_DEBUG, 0xFFFFFFFF);
		SECO_WRITEREG(GOBOFB_DEBUG, unimpptr);
	} else {
		/* yes 32QD */
		SECO_WRITEREG(GOBOFB_DEBUG, 0x00C0FFEE);
	}
	SwapMMUMode ( &busMode ); // restore
#endif


#if 0
	/* check the content of the PRAM */
	spblock.spSlot = seblock->seSlot;
	spblock.spResult = (UInt32)pram;
	err = SReadPRAMRec(&spblock);

#if 0
	SECO_WRITEREG(GOBOFB_DEBUG, 0x88888888);
	for (j = 0 ; j < 8 ; j++)
		SECO_WRITEREG(GOBOFB_DEBUG, (uint32_t)pram[j]);
	SECO_WRITEREG(GOBOFB_DEBUG, 0x88888888);
#endif
#endif
	
#if 0
	busMode = 1;
	SwapMMUMode ( &busMode ); // to32
	if (err) {
		/* SECO_WRITEREG(GOBOFB_DEBUG, 0xFFFFFFFF);*/
		/* SECO_WRITEREG(GOBOFB_DEBUG, err);*/
	} else {
		/* SECO_WRITEREG(GOBOFB_DEBUG, 0xC0FFEE00);*/
		/* for (i = 0 ; i < 8 ; i++) */
		/* 	SECO_WRITEREG(GOBOFB_DEBUG, pram[i]);*/
	}
	SwapMMUMode ( &busMode ); // restore
#endif
	
	seblock->seStatus = 1;

	return 0;
}