minimacplus/components/tme/iwm.c
Jeroen Domburg acf550b667 It boots!
2017-03-08 20:29:10 +08:00

55 lines
1.1 KiB
C

#include <stdio.h>
/*
At the moment, this only emulates enough of the IWM to make the Plus boot.
*/
#define IWM_CA0 (1<<0)
#define IWM_CA1 (1<<1)
#define IWM_CA2 (1<<2)
#define IWM_LSTRB (1<<3)
#define IWM_ENABLE (1<<4)
#define IWM_SELECT (1<<5)
#define IWM_Q6 (1<<6)
#define IWM_Q7 (1<<7)
int iwmLines, iwmModeReg;
void iwmAccess(unsigned int addr) {
if (addr&1) {
iwmLines|=(1<<(addr>>1));
} else {
iwmLines&=~(1<<(addr>>1));
}
}
void iwmWrite(unsigned int addr, unsigned int val) {
iwmAccess(addr);
int reg=iwmLines&(IWM_Q7|IWM_Q6);
if (reg==0xC0) iwmModeReg=val;
// printf("IWM write %x (iwm reg %x) val %x\n", addr, reg, val);
}
unsigned int iwmRead(unsigned int addr) {
unsigned int val=0;
iwmAccess(addr);
int reg=iwmLines&(IWM_Q7|IWM_Q6);
if (reg==0) {
//Data register
val=0;
} else if (reg==IWM_Q6) {
//Status register
if (iwmLines&IWM_ENABLE) val|=0x20; //enable
val|=iwmModeReg&0x1F;
} else if (reg==IWM_Q7) {
//Read handshake register
val=0xC0;
} else {
//Mode reg?
if (iwmLines&IWM_ENABLE) val|=0x20; //enable
val|=iwmModeReg&0x1F;
}
// printf("IWM read %x (iwm reg %x) val %x\n", addr, reg, val);
return val;
}