Removed the file pointer from the hdd_t struct;
Partially split off the Logitech Serial Mouse emulation from Microsoft Serial Mouse; Slightly reworked serial port emulation (the two UART's are now device_t's, non-FIFO mode implemented and is now default, FIFO mode reimplemented from scratch so it's now actually correct); Added the emulation of the SiS 85c497 chip to the SiS 85c496/497 chipset; Bugfixes to the emulated Super I/O chips and made them all device_t's now.
This commit is contained in:
OBattler
@@ -9,7 +9,7 @@
|
||||
* Implementation of the SMC FDC37C663 and FDC37C665 Super
|
||||
* I/O Chips.
|
||||
*
|
||||
* Version: @(#)sio_fdc37c66x.c 1.0.12 2018/09/15
|
||||
* Version: @(#)sio_fdc37c66x.c 1.0.13 2018/11/05
|
||||
*
|
||||
* Authors: Sarah Walker, <http://pcem-emulator.co.uk/>
|
||||
* Miran Grca, <mgrca8@gmail.com>
|
||||
@@ -19,6 +19,7 @@
|
||||
*/
|
||||
#include <stdio.h>
|
||||
#include <stdint.h>
|
||||
#include <stdlib.h>
|
||||
#include <string.h>
|
||||
#include <wchar.h>
|
||||
#include "86box.h"
|
||||
@@ -34,294 +35,258 @@
|
||||
#include "sio.h"
|
||||
|
||||
|
||||
static uint8_t fdc37c66x_lock[2];
|
||||
static int fdc37c66x_curreg;
|
||||
static uint8_t fdc37c66x_regs[16];
|
||||
static int com3_addr, com4_addr;
|
||||
static fdc_t *fdc37c66x_fdc;
|
||||
typedef struct {
|
||||
uint8_t chip_id,
|
||||
lock[2],
|
||||
regs[16];
|
||||
int cur_reg,
|
||||
com3_addr, com4_addr;
|
||||
fdc_t *fdc;
|
||||
serial_t *uart[2];
|
||||
} fdc37c66x_t;
|
||||
|
||||
|
||||
static void write_lock(uint8_t val)
|
||||
static void
|
||||
write_lock(fdc37c66x_t *dev, uint8_t val)
|
||||
{
|
||||
if (val == 0x55 && fdc37c66x_lock[1] == 0x55)
|
||||
fdc_3f1_enable(fdc37c66x_fdc, 0);
|
||||
if (fdc37c66x_lock[0] == 0x55 && fdc37c66x_lock[1] == 0x55 && val != 0x55)
|
||||
fdc_3f1_enable(fdc37c66x_fdc, 1);
|
||||
if (val == 0x55 && dev->lock[1] == 0x55)
|
||||
fdc_3f1_enable(dev->fdc, 0);
|
||||
if ((dev->lock[0] == 0x55) && (dev->lock[1] == 0x55) && (val != 0x55))
|
||||
fdc_3f1_enable(dev->fdc, 1);
|
||||
|
||||
fdc37c66x_lock[0] = fdc37c66x_lock[1];
|
||||
fdc37c66x_lock[1] = val;
|
||||
dev->lock[0] = dev->lock[1];
|
||||
dev->lock[1] = val;
|
||||
}
|
||||
|
||||
static void ide_handler()
|
||||
|
||||
static void
|
||||
set_com34_addr(fdc37c66x_t *dev)
|
||||
{
|
||||
#if 0
|
||||
uint16_t or_value = 0;
|
||||
ide_pri_disable();
|
||||
if (fdc37c66x_regs[0] & 1)
|
||||
{
|
||||
if (fdc37c66x_regs[5] & 2)
|
||||
{
|
||||
or_value = 0;
|
||||
}
|
||||
else
|
||||
{
|
||||
or_value = 0x800;
|
||||
}
|
||||
ide_set_base(0, 0x170 | or_value);
|
||||
ide_set_side(0, 0x376 | or_value);
|
||||
ide_pri_enable();
|
||||
}
|
||||
#endif
|
||||
switch (dev->regs[1] & 0x60) {
|
||||
case 0x00:
|
||||
dev->com3_addr = 0x338;
|
||||
dev->com4_addr = 0x238;
|
||||
break;
|
||||
case 0x20:
|
||||
dev->com3_addr = 0x3e8;
|
||||
dev->com4_addr = 0x2e8;
|
||||
break;
|
||||
case 0x40:
|
||||
dev->com3_addr = 0x3e8;
|
||||
dev->com4_addr = 0x2e0;
|
||||
break;
|
||||
case 0x60:
|
||||
dev->com3_addr = 0x220;
|
||||
dev->com4_addr = 0x228;
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
static void set_com34_addr()
|
||||
|
||||
static void
|
||||
set_serial_addr(fdc37c66x_t *dev, int port)
|
||||
{
|
||||
switch (fdc37c66x_regs[1] & 0x60)
|
||||
{
|
||||
case 0x00:
|
||||
com3_addr = 0x338;
|
||||
com4_addr = 0x238;
|
||||
uint8_t shift = (port << 4);
|
||||
|
||||
if (dev->regs[2] & (4 << shift)) {
|
||||
switch (dev->regs[2] & (3 << shift)) {
|
||||
case 0:
|
||||
serial_setup(dev->uart[port], SERIAL1_ADDR, SERIAL1_IRQ);
|
||||
break;
|
||||
case 0x20:
|
||||
com3_addr = 0x3e8;
|
||||
com4_addr = 0x2e8;
|
||||
break;
|
||||
case 0x40:
|
||||
com3_addr = 0x3e8;
|
||||
com4_addr = 0x2e0;
|
||||
break;
|
||||
case 0x60:
|
||||
com3_addr = 0x220;
|
||||
com4_addr = 0x228;
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
static void set_serial1_addr()
|
||||
{
|
||||
if (fdc37c66x_regs[2] & 4)
|
||||
{
|
||||
switch (fdc37c66x_regs[2] & 3)
|
||||
{
|
||||
case 0:
|
||||
serial_setup(1, SERIAL1_ADDR, SERIAL1_IRQ);
|
||||
break;
|
||||
|
||||
case 1:
|
||||
serial_setup(1, SERIAL2_ADDR, SERIAL2_IRQ);
|
||||
break;
|
||||
|
||||
case 2:
|
||||
serial_setup(1, com3_addr, 4);
|
||||
break;
|
||||
|
||||
case 3:
|
||||
serial_setup(1, com4_addr, 3);
|
||||
break;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
static void set_serial2_addr()
|
||||
{
|
||||
if (fdc37c66x_regs[2] & 0x40)
|
||||
{
|
||||
switch (fdc37c66x_regs[2] & 0x30)
|
||||
{
|
||||
case 0:
|
||||
serial_setup(2, SERIAL1_ADDR, SERIAL1_IRQ);
|
||||
break;
|
||||
|
||||
case 1:
|
||||
serial_setup(2, SERIAL2_ADDR, SERIAL2_IRQ);
|
||||
break;
|
||||
|
||||
case 2:
|
||||
serial_setup(2, com3_addr, 4);
|
||||
break;
|
||||
|
||||
case 3:
|
||||
serial_setup(2, com4_addr, 3);
|
||||
break;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
static void lpt1_handler()
|
||||
{
|
||||
lpt1_remove();
|
||||
switch (fdc37c66x_regs[1] & 3)
|
||||
{
|
||||
case 1:
|
||||
lpt1_init(0x3bc);
|
||||
serial_setup(dev->uart[port], SERIAL2_ADDR, SERIAL2_IRQ);
|
||||
break;
|
||||
case 2:
|
||||
lpt1_init(0x378);
|
||||
serial_setup(dev->uart[port], dev->com3_addr, 4);
|
||||
break;
|
||||
case 3:
|
||||
lpt1_init(0x278);
|
||||
serial_setup(dev->uart[port], dev->com4_addr, 3);
|
||||
break;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
static void
|
||||
lpt1_handler(fdc37c66x_t *dev)
|
||||
{
|
||||
lpt1_remove();
|
||||
switch (dev->regs[1] & 3) {
|
||||
case 1:
|
||||
lpt1_init(0x3bc);
|
||||
break;
|
||||
case 2:
|
||||
lpt1_init(0x378);
|
||||
break;
|
||||
case 3:
|
||||
lpt1_init(0x278);
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
static void fdc37c66x_write(uint16_t port, uint8_t val, void *priv)
|
||||
{
|
||||
uint8_t valxor = 0;
|
||||
if (fdc37c66x_lock[0] == 0x55 && fdc37c66x_lock[1] == 0x55)
|
||||
{
|
||||
if (port == 0x3f0)
|
||||
{
|
||||
if (val == 0xaa)
|
||||
write_lock(val);
|
||||
else
|
||||
fdc37c66x_curreg = val;
|
||||
#if 0
|
||||
if (fdc37c66x_curreg != 0)
|
||||
{
|
||||
fdc37c66x_curreg = val & 0xf;
|
||||
}
|
||||
else
|
||||
{
|
||||
/* Hardcode the IDE to AT type. */
|
||||
fdc37c66x_curreg = (val & 0xf) | 2;
|
||||
}
|
||||
#endif
|
||||
}
|
||||
else
|
||||
{
|
||||
if (fdc37c66x_curreg > 15)
|
||||
return;
|
||||
fdc37c66x_t *dev = (fdc37c66x_t *) priv;
|
||||
uint8_t valxor = 0;
|
||||
|
||||
valxor = val ^ fdc37c66x_regs[fdc37c66x_curreg];
|
||||
fdc37c66x_regs[fdc37c66x_curreg] = val;
|
||||
|
||||
switch(fdc37c66x_curreg)
|
||||
{
|
||||
case 0:
|
||||
if (valxor & 1)
|
||||
{
|
||||
ide_handler();
|
||||
}
|
||||
break;
|
||||
case 1:
|
||||
if (valxor & 3)
|
||||
{
|
||||
lpt1_handler();
|
||||
}
|
||||
if (valxor & 0x60)
|
||||
{
|
||||
serial_remove(1);
|
||||
set_com34_addr();
|
||||
set_serial1_addr();
|
||||
set_serial2_addr();
|
||||
}
|
||||
break;
|
||||
case 2:
|
||||
if (valxor & 7)
|
||||
{
|
||||
serial_remove(1);
|
||||
set_serial1_addr();
|
||||
}
|
||||
if (valxor & 0x70)
|
||||
{
|
||||
serial_remove(2);
|
||||
set_serial2_addr();
|
||||
}
|
||||
break;
|
||||
case 3:
|
||||
if (valxor & 2)
|
||||
{
|
||||
fdc_update_enh_mode(fdc37c66x_fdc, (fdc37c66x_regs[3] & 2) ? 1 : 0);
|
||||
}
|
||||
break;
|
||||
if ((dev->lock[0] == 0x55) && (dev->lock[1] == 0x55)) {
|
||||
if (port == 0x3f0) {
|
||||
if (val == 0xaa)
|
||||
write_lock(dev, val);
|
||||
else
|
||||
dev->cur_reg = val;
|
||||
} else {
|
||||
if (dev->cur_reg > 15)
|
||||
return;
|
||||
|
||||
valxor = val ^ dev->regs[dev->cur_reg];
|
||||
dev->regs[dev->cur_reg] = val;
|
||||
|
||||
switch(dev->cur_reg) {
|
||||
case 1:
|
||||
if (valxor & 3)
|
||||
lpt1_handler(dev);
|
||||
if (valxor & 0x60) {
|
||||
serial_remove(dev->uart[0]);
|
||||
serial_remove(dev->uart[1]);
|
||||
set_com34_addr(dev);
|
||||
set_serial_addr(dev, 0);
|
||||
set_serial_addr(dev, 1);
|
||||
}
|
||||
break;
|
||||
case 2:
|
||||
if (valxor & 7) {
|
||||
serial_remove(dev->uart[0]);
|
||||
set_serial_addr(dev, 0);
|
||||
}
|
||||
if (valxor & 0x70) {
|
||||
serial_remove(dev->uart[1]);
|
||||
set_serial_addr(dev, 1);
|
||||
}
|
||||
break;
|
||||
case 3:
|
||||
if (valxor & 2)
|
||||
fdc_update_enh_mode(dev->fdc, (dev->regs[3] & 2) ? 1 : 0);
|
||||
break;
|
||||
case 5:
|
||||
if (valxor & 2)
|
||||
{
|
||||
ide_handler();
|
||||
}
|
||||
if (valxor & 0x18)
|
||||
{
|
||||
fdc_update_densel_force(fdc37c66x_fdc, (fdc37c66x_regs[5] & 0x18) >> 3);
|
||||
}
|
||||
if (valxor & 0x20)
|
||||
{
|
||||
fdc_set_swap(fdc37c66x_fdc, (fdc37c66x_regs[5] & 0x20) >> 5);
|
||||
}
|
||||
break;
|
||||
}
|
||||
}
|
||||
}
|
||||
else
|
||||
{
|
||||
if (port == 0x3f0)
|
||||
write_lock(val);
|
||||
}
|
||||
if (valxor & 0x18)
|
||||
fdc_update_densel_force(dev->fdc, (dev->regs[5] & 0x18) >> 3);
|
||||
if (valxor & 0x20)
|
||||
fdc_set_swap(dev->fdc, (dev->regs[5] & 0x20) >> 5);
|
||||
break;
|
||||
}
|
||||
}
|
||||
} else {
|
||||
if (port == 0x3f0)
|
||||
write_lock(dev, val);
|
||||
}
|
||||
}
|
||||
|
||||
static uint8_t fdc37c66x_read(uint16_t port, void *priv)
|
||||
|
||||
static uint8_t
|
||||
fdc37c66x_read(uint16_t port, void *priv)
|
||||
{
|
||||
if (fdc37c66x_lock[0] == 0x55 && fdc37c66x_lock[1] == 0x55)
|
||||
{
|
||||
if (port == 0x3f1)
|
||||
return fdc37c66x_regs[fdc37c66x_curreg];
|
||||
}
|
||||
return 0xff;
|
||||
fdc37c66x_t *dev = (fdc37c66x_t *) priv;
|
||||
uint8_t ret = 0xff;
|
||||
|
||||
if ((dev->lock[0] == 0x55) && (dev->lock[1] == 0x55)) {
|
||||
if (port == 0x3f1)
|
||||
ret = dev->regs[dev->cur_reg];
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static void fdc37c66x_reset(void)
|
||||
|
||||
static void
|
||||
fdc37c66x_reset(fdc37c66x_t *dev)
|
||||
{
|
||||
com3_addr = 0x338;
|
||||
com4_addr = 0x238;
|
||||
dev->com3_addr = 0x338;
|
||||
dev->com4_addr = 0x238;
|
||||
|
||||
serial_remove(1);
|
||||
serial_setup(1, SERIAL1_ADDR, SERIAL1_IRQ);
|
||||
serial_remove(dev->uart[0]);
|
||||
serial_setup(dev->uart[0], SERIAL1_ADDR, SERIAL1_IRQ);
|
||||
|
||||
serial_remove(2);
|
||||
serial_setup(2, SERIAL2_ADDR, SERIAL2_IRQ);
|
||||
serial_remove(dev->uart[0]);
|
||||
serial_setup(dev->uart[0], SERIAL2_ADDR, SERIAL2_IRQ);
|
||||
|
||||
lpt2_remove();
|
||||
lpt2_remove();
|
||||
|
||||
lpt1_remove();
|
||||
lpt1_init(0x378);
|
||||
lpt1_remove();
|
||||
lpt1_init(0x378);
|
||||
|
||||
fdc_reset(fdc37c66x_fdc);
|
||||
|
||||
memset(fdc37c66x_lock, 0, 2);
|
||||
memset(fdc37c66x_regs, 0, 16);
|
||||
fdc37c66x_regs[0x0] = 0x3a;
|
||||
fdc37c66x_regs[0x1] = 0x9f;
|
||||
fdc37c66x_regs[0x2] = 0xdc;
|
||||
fdc37c66x_regs[0x3] = 0x78;
|
||||
fdc37c66x_regs[0x6] = 0xff;
|
||||
fdc37c66x_regs[0xe] = 0x01;
|
||||
fdc_reset(dev->fdc);
|
||||
|
||||
memset(dev->lock, 0, 2);
|
||||
memset(dev->regs, 0, 16);
|
||||
|
||||
dev->regs[0x0] = 0x3a;
|
||||
dev->regs[0x1] = 0x9f;
|
||||
dev->regs[0x2] = 0xdc;
|
||||
dev->regs[0x3] = 0x78;
|
||||
dev->regs[0x6] = 0xff;
|
||||
dev->regs[0xd] = dev->chip_id;
|
||||
dev->regs[0xe] = 0x01;
|
||||
}
|
||||
|
||||
static void fdc37c663_reset(void)
|
||||
|
||||
static void
|
||||
fdc37c66x_close(void *priv)
|
||||
{
|
||||
fdc37c66x_reset();
|
||||
fdc37c66x_regs[0xd] = 0x63;
|
||||
fdc37c66x_t *dev = (fdc37c66x_t *) priv;
|
||||
|
||||
free(dev);
|
||||
}
|
||||
|
||||
static void fdc37c665_reset(void)
|
||||
|
||||
static void *
|
||||
fdc37c66x_init(const device_t *info)
|
||||
{
|
||||
fdc37c66x_reset();
|
||||
fdc37c66x_regs[0xd] = 0x65;
|
||||
fdc37c66x_t *dev = (fdc37c66x_t *) malloc(sizeof(fdc37c66x_t));
|
||||
memset(dev, 0, sizeof(fdc37c66x_t));
|
||||
|
||||
dev->fdc = device_add(&fdc_at_smc_device);
|
||||
|
||||
dev->uart[0] = device_add_inst(&ns16550_device, 1);
|
||||
dev->uart[1] = device_add_inst(&ns16550_device, 2);
|
||||
|
||||
dev->chip_id = info->local;
|
||||
|
||||
io_sethandler(0x03f0, 0x0002,
|
||||
fdc37c66x_read, NULL, NULL, fdc37c66x_write, NULL, NULL, dev);
|
||||
|
||||
fdc37c66x_reset(dev);
|
||||
|
||||
return dev;
|
||||
}
|
||||
|
||||
void fdc37c663_init()
|
||||
{
|
||||
fdc37c66x_fdc = device_add(&fdc_at_smc_device);
|
||||
|
||||
io_sethandler(0x03f0, 0x0002, fdc37c66x_read, NULL, NULL, fdc37c66x_write, NULL, NULL, NULL);
|
||||
/* The three appear to differ only in the chip ID, if I
|
||||
understood their datasheets correctly. */
|
||||
const device_t fdc37c663_device = {
|
||||
"SMC FDC37C663 Super I/O",
|
||||
0,
|
||||
0x63,
|
||||
fdc37c66x_init, fdc37c66x_close, NULL,
|
||||
NULL, NULL, NULL,
|
||||
NULL
|
||||
};
|
||||
|
||||
fdc37c663_reset();
|
||||
}
|
||||
const device_t fdc37c665_device = {
|
||||
"SMC FDC37C665 Super I/O",
|
||||
0,
|
||||
0x65,
|
||||
fdc37c66x_init, fdc37c66x_close, NULL,
|
||||
NULL, NULL, NULL,
|
||||
NULL
|
||||
};
|
||||
|
||||
void fdc37c665_init()
|
||||
{
|
||||
fdc37c66x_fdc = device_add(&fdc_at_smc_device);
|
||||
|
||||
io_sethandler(0x03f0, 0x0002, fdc37c66x_read, NULL, NULL, fdc37c66x_write, NULL, NULL, NULL);
|
||||
|
||||
fdc37c665_reset();
|
||||
}
|
||||
const device_t fdc37c666_device = {
|
||||
"SMC FDC37C666 Super I/O",
|
||||
0,
|
||||
0x66,
|
||||
fdc37c66x_init, fdc37c66x_close, NULL,
|
||||
NULL, NULL, NULL,
|
||||
NULL
|
||||
};
|
||||
|
||||
Reference in New Issue
Block a user