59 lines
1.4 KiB
C
59 lines
1.4 KiB
C
|
#include "ibm.h"
|
||
|
|
|
||
|
|
#include "io.h"
|
||
|
|
#include "ide.h"
|
||
|
|
#include "xtide.h"
|
||
|
|
|
||
|
|
uint8_t xtide_high;
|
||
|
|
|
||
|
|
void xtide_write(uint16_t port, uint8_t val, void *priv)
|
||
|
|
{
|
||
|
|
switch (port & 0xf)
|
||
|
|
{
|
||
|
|
case 0x0:
|
||
|
|
writeidew(0, val | (xtide_high << 8));
|
||
|
|
return;
|
||
|
|
|
||
|
|
case 0x1: case 0x2: case 0x3:
|
||
|
|
case 0x4: case 0x5: case 0x6: case 0x7:
|
||
|
|
writeide(0, (port & 0xf) | 0x1f0, val);
|
||
|
|
return;
|
||
|
|
|
||
|
|
case 0x8:
|
||
|
|
xtide_high = val;
|
||
|
|
return;
|
||
|
|
|
||
|
|
case 0xe:
|
||
|
|
writeide(0, 0x3f6, val);
|
||
|
|
return;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
uint8_t xtide_read(uint16_t port, void *priv)
|
||
|
|
{
|
||
|
|
uint16_t tempw;
|
||
|
|
switch (port & 0xf)
|
||
|
|
{
|
||
|
|
case 0x0:
|
||
|
|
tempw = readidew(0);
|
||
|
|
xtide_high = tempw >> 8;
|
||
|
|
return tempw & 0xff;
|
||
|
|
|
||
|
|
case 0x1: case 0x2: case 0x3:
|
||
|
|
case 0x4: case 0x5: case 0x6: case 0x7:
|
||
|
|
return readide(0, (port & 0xf) | 0x1f0);
|
||
|
|
|
||
|
|
case 0x8:
|
||
|
|
return xtide_high;
|
||
|
|
|
||
|
|
case 0xe:
|
||
|
|
return readide(0, 0x3f6);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
void xtide_init()
|
||
|
|
{
|
||
|
|
ide_init();
|
||
|
|
io_sethandler(0x0300, 0x0010, xtide_read, NULL, NULL, xtide_write, NULL, NULL, NULL);
|
||
|
|
}
|