94 lines
2.1 KiB
C
94 lines
2.1 KiB
C
#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;
|
|
}
|
|
|