Merged various SMC FDC67C6xx Super I/O chips into one file, re-added the UMC88xx 486 chipsets (and four machines for it) based on work by tiseno100 and my own work, various other fixes, and added quite a few machines (including the AOpen AP5VM which now works), also added the remaining ALi M6117 machine (Protech SBC with Award BIOS), and made the Intel Advanced/ATX's on-board S3 Trio64V+ work, as well as the on-board S3 Trio64/V2 of the two Compaq Presarios.
This commit is contained in:
OBattler
@@ -13,8 +13,8 @@
|
||||
# Copyright 2020,2021 David Hrdlička.
|
||||
#
|
||||
|
||||
add_library(sio OBJECT sio_acc3221.c sio_f82c710.c sio_82091aa.c sio_fdc37c651.c sio_fdc37c661.c
|
||||
sio_fdc37c66x.c sio_fdc37c67x.c sio_fdc37c669.c sio_fdc37c93x.c sio_fdc37m60x.c
|
||||
add_library(sio OBJECT sio_acc3221.c sio_f82c710.c sio_82091aa.c sio_fdc37c6xx.c
|
||||
sio_fdc37c67x.c sio_fdc37c669.c sio_fdc37c93x.c sio_fdc37m60x.c
|
||||
sio_it8661f.c
|
||||
sio_pc87306.c sio_pc87307.c sio_pc87309.c sio_pc87310.c sio_pc87311.c sio_pc87332.c
|
||||
sio_prime3b.c sio_prime3c.c
|
||||
|
||||
@@ -1,314 +0,0 @@
|
||||
/*
|
||||
* 86Box A hypervisor and IBM PC system emulator that specializes in
|
||||
* running old operating systems and software designed for IBM
|
||||
* PC systems and compatibles from 1981 through fairly recent
|
||||
* system designs based on the PCI bus.
|
||||
*
|
||||
* This file is part of the 86Box distribution.
|
||||
*
|
||||
* Implementation of the SMC FDC37C651 Super I/O Chip.
|
||||
*
|
||||
* Authors: Miran Grca, <mgrca8@gmail.com>
|
||||
*
|
||||
* Copyright 2021 Miran Grca.
|
||||
*/
|
||||
#include <stdarg.h>
|
||||
#include <stdio.h>
|
||||
#include <stdint.h>
|
||||
#include <stdlib.h>
|
||||
#include <string.h>
|
||||
#include <wchar.h>
|
||||
#define HAVE_STDARG_H
|
||||
#include <86box/86box.h>
|
||||
#include <86box/io.h>
|
||||
#include <86box/timer.h>
|
||||
#include <86box/device.h>
|
||||
#include <86box/lpt.h>
|
||||
#include <86box/serial.h>
|
||||
#include <86box/hdc.h>
|
||||
#include <86box/hdc_ide.h>
|
||||
#include <86box/fdd.h>
|
||||
#include <86box/fdc.h>
|
||||
#include <86box/sio.h>
|
||||
|
||||
|
||||
#ifdef ENABLE_FDC37C651_LOG
|
||||
int fdc37c651_do_log = ENABLE_FDC37C651_LOG;
|
||||
|
||||
|
||||
static void
|
||||
fdc37c651_log(const char *fmt, ...)
|
||||
{
|
||||
va_list ap;
|
||||
|
||||
if (fdc37c651_do_log) {
|
||||
va_start(ap, fmt);
|
||||
pclog_ex(fmt, ap);
|
||||
va_end(ap);
|
||||
}
|
||||
}
|
||||
#else
|
||||
#define fdc37c651_log(fmt, ...)
|
||||
#endif
|
||||
|
||||
|
||||
typedef struct {
|
||||
uint8_t tries, has_ide,
|
||||
regs[16];
|
||||
int cur_reg,
|
||||
com3_addr, com4_addr;
|
||||
fdc_t *fdc;
|
||||
serial_t *uart[2];
|
||||
} fdc37c651_t;
|
||||
|
||||
|
||||
static void
|
||||
set_com34_addr(fdc37c651_t *dev)
|
||||
{
|
||||
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_serial_addr(fdc37c651_t *dev, int port)
|
||||
{
|
||||
uint8_t shift = (port << 2);
|
||||
|
||||
serial_remove(dev->uart[port]);
|
||||
if (dev->regs[2] & (4 << shift)) {
|
||||
switch ((dev->regs[2] >> shift) & 3) {
|
||||
case 0:
|
||||
serial_setup(dev->uart[port], SERIAL1_ADDR, SERIAL1_IRQ);
|
||||
break;
|
||||
case 1:
|
||||
serial_setup(dev->uart[port], SERIAL2_ADDR, SERIAL2_IRQ);
|
||||
break;
|
||||
case 2:
|
||||
serial_setup(dev->uart[port], dev->com3_addr, 4);
|
||||
break;
|
||||
case 3:
|
||||
serial_setup(dev->uart[port], dev->com4_addr, 3);
|
||||
break;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
static void
|
||||
lpt1_handler(fdc37c651_t *dev)
|
||||
{
|
||||
lpt1_remove();
|
||||
switch (dev->regs[1] & 3) {
|
||||
case 1:
|
||||
lpt1_init(0x3bc);
|
||||
lpt1_irq(7);
|
||||
break;
|
||||
case 2:
|
||||
lpt1_init(0x378);
|
||||
lpt1_irq(7 /*5*/);
|
||||
break;
|
||||
case 3:
|
||||
lpt1_init(0x278);
|
||||
lpt1_irq(7 /*5*/);
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
static void
|
||||
fdc_handler(fdc37c651_t *dev)
|
||||
{
|
||||
fdc_remove(dev->fdc);
|
||||
if (dev->regs[0] & 0x10)
|
||||
fdc_set_base(dev->fdc, 0x03f0);
|
||||
}
|
||||
|
||||
|
||||
|
||||
static void
|
||||
ide_handler(fdc37c651_t *dev)
|
||||
{
|
||||
/* TODO: Make an ide_disable(channel) and ide_enable(channel) so we can simplify this. */
|
||||
if (dev->has_ide == 2) {
|
||||
ide_sec_disable();
|
||||
ide_set_base(1, 0x1f0);
|
||||
ide_set_side(1, 0x3f6);
|
||||
if (dev->regs[0x00] & 0x01)
|
||||
ide_sec_enable();
|
||||
} else if (dev->has_ide == 1) {
|
||||
ide_pri_disable();
|
||||
ide_set_base(0, 0x1f0);
|
||||
ide_set_side(0, 0x3f6);
|
||||
if (dev->regs[0x00] & 0x01)
|
||||
ide_pri_enable();
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
static void
|
||||
fdc37c651_write(uint16_t port, uint8_t val, void *priv)
|
||||
{
|
||||
fdc37c651_t *dev = (fdc37c651_t *) priv;
|
||||
uint8_t valxor = 0;
|
||||
|
||||
if (dev->tries == 2) {
|
||||
if (port == 0x3f0) {
|
||||
if (val == 0xaa)
|
||||
dev->tries = 0;
|
||||
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 0:
|
||||
if (dev->has_ide && (valxor & 0x01))
|
||||
ide_handler(dev);
|
||||
if (valxor & 0x10)
|
||||
fdc_handler(dev);
|
||||
break;
|
||||
case 1:
|
||||
if (valxor & 3)
|
||||
lpt1_handler(dev);
|
||||
if (valxor & 0x60) {
|
||||
set_com34_addr(dev);
|
||||
set_serial_addr(dev, 0);
|
||||
set_serial_addr(dev, 1);
|
||||
}
|
||||
break;
|
||||
case 2:
|
||||
if (valxor & 7)
|
||||
set_serial_addr(dev, 0);
|
||||
if (valxor & 0x70)
|
||||
set_serial_addr(dev, 1);
|
||||
break;
|
||||
}
|
||||
}
|
||||
} else if ((port == 0x3f0) && (val == 0x55))
|
||||
dev->tries++;
|
||||
}
|
||||
|
||||
|
||||
static uint8_t
|
||||
fdc37c651_read(uint16_t port, void *priv)
|
||||
{
|
||||
fdc37c651_t *dev = (fdc37c651_t *) priv;
|
||||
uint8_t ret = 0x00;
|
||||
|
||||
if (dev->tries == 2) {
|
||||
if (port == 0x3f1)
|
||||
ret = dev->regs[dev->cur_reg];
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
|
||||
static void
|
||||
fdc37c651_reset(fdc37c651_t *dev)
|
||||
{
|
||||
dev->com3_addr = 0x338;
|
||||
dev->com4_addr = 0x238;
|
||||
|
||||
serial_remove(dev->uart[0]);
|
||||
serial_setup(dev->uart[0], SERIAL1_ADDR, SERIAL1_IRQ);
|
||||
|
||||
serial_remove(dev->uart[1]);
|
||||
serial_setup(dev->uart[1], SERIAL2_ADDR, SERIAL2_IRQ);
|
||||
|
||||
lpt1_remove();
|
||||
lpt1_init(0x378);
|
||||
|
||||
fdc_reset(dev->fdc);
|
||||
fdc_remove(dev->fdc);
|
||||
|
||||
dev->tries = 0;
|
||||
memset(dev->regs, 0, 16);
|
||||
|
||||
dev->regs[0x0] = 0x3f;
|
||||
dev->regs[0x1] = 0x9f;
|
||||
dev->regs[0x2] = 0xdc;
|
||||
|
||||
set_serial_addr(dev, 0);
|
||||
set_serial_addr(dev, 1);
|
||||
|
||||
lpt1_handler(dev);
|
||||
|
||||
fdc_handler(dev);
|
||||
|
||||
if (dev->has_ide)
|
||||
ide_handler(dev);
|
||||
}
|
||||
|
||||
|
||||
static void
|
||||
fdc37c651_close(void *priv)
|
||||
{
|
||||
fdc37c651_t *dev = (fdc37c651_t *) priv;
|
||||
|
||||
free(dev);
|
||||
}
|
||||
|
||||
|
||||
static void *
|
||||
fdc37c651_init(const device_t *info)
|
||||
{
|
||||
fdc37c651_t *dev = (fdc37c651_t *) malloc(sizeof(fdc37c651_t));
|
||||
memset(dev, 0, sizeof(fdc37c651_t));
|
||||
|
||||
dev->fdc = device_add(&fdc_at_smc_device);
|
||||
|
||||
dev->uart[0] = device_add_inst(&ns16450_device, 1);
|
||||
dev->uart[1] = device_add_inst(&ns16450_device, 2);
|
||||
|
||||
dev->has_ide = (info->local >> 8) & 0xff;
|
||||
|
||||
io_sethandler(0x03f0, 0x0002,
|
||||
fdc37c651_read, NULL, NULL, fdc37c651_write, NULL, NULL, dev);
|
||||
|
||||
fdc37c651_reset(dev);
|
||||
|
||||
return dev;
|
||||
}
|
||||
|
||||
|
||||
/* The three appear to differ only in the chip ID, if I
|
||||
understood their datasheets correctly. */
|
||||
const device_t fdc37c651_device = {
|
||||
"SMC FDC37C651 Super I/O",
|
||||
0,
|
||||
0,
|
||||
fdc37c651_init, fdc37c651_close, NULL,
|
||||
{ NULL }, NULL, NULL,
|
||||
NULL
|
||||
};
|
||||
|
||||
const device_t fdc37c651_ide_device = {
|
||||
"SMC FDC37C651 Super I/O (With IDE)",
|
||||
0,
|
||||
0x100,
|
||||
fdc37c651_init, fdc37c651_close, NULL,
|
||||
{ NULL }, NULL, NULL,
|
||||
NULL
|
||||
};
|
||||
@@ -1,299 +0,0 @@
|
||||
/*
|
||||
* 86Box A hypervisor and IBM PC system emulator that specializes in
|
||||
* running old operating systems and software designed for IBM
|
||||
* PC systems and compatibles from 1981 through fairly recent
|
||||
* system designs based on the PCI bus.
|
||||
*
|
||||
* This file is part of the 86Box distribution.
|
||||
*
|
||||
* Implementation of the SMC FDC37C661 Super I/O Chip.
|
||||
*
|
||||
*
|
||||
*
|
||||
* Authors: Sarah Walker, <http://pcem-emulator.co.uk/>
|
||||
* Miran Grca, <mgrca8@gmail.com>
|
||||
*
|
||||
* Copyright 2008-2020 Sarah Walker.
|
||||
* Copyright 2016-2020 Miran Grca.
|
||||
*/
|
||||
#include <stdio.h>
|
||||
#include <stdint.h>
|
||||
#include <stdlib.h>
|
||||
#include <string.h>
|
||||
#include <wchar.h>
|
||||
#include <86box/86box.h>
|
||||
#include <86box/io.h>
|
||||
#include <86box/timer.h>
|
||||
#include <86box/device.h>
|
||||
#include <86box/pci.h>
|
||||
#include <86box/lpt.h>
|
||||
#include <86box/serial.h>
|
||||
#include <86box/hdc.h>
|
||||
#include <86box/hdc_ide.h>
|
||||
#include <86box/fdd.h>
|
||||
#include <86box/fdc.h>
|
||||
#include <86box/sio.h>
|
||||
|
||||
|
||||
typedef struct {
|
||||
uint8_t chip_id, tries,
|
||||
has_ide, regs[16];
|
||||
int cur_reg,
|
||||
com3_addr, com4_addr;
|
||||
fdc_t *fdc;
|
||||
serial_t *uart[2];
|
||||
} fdc37c661_t;
|
||||
|
||||
|
||||
static void
|
||||
set_com34_addr(fdc37c661_t *dev)
|
||||
{
|
||||
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_serial_addr(fdc37c661_t *dev, int port)
|
||||
{
|
||||
uint8_t shift = (port << 2);
|
||||
|
||||
serial_remove(dev->uart[port]);
|
||||
if (dev->regs[2] & (4 << shift)) {
|
||||
switch ((dev->regs[2] >> shift) & 3) {
|
||||
case 0:
|
||||
serial_setup(dev->uart[port], SERIAL1_ADDR, SERIAL1_IRQ);
|
||||
break;
|
||||
case 1:
|
||||
serial_setup(dev->uart[port], SERIAL2_ADDR, SERIAL2_IRQ);
|
||||
break;
|
||||
case 2:
|
||||
serial_setup(dev->uart[port], dev->com3_addr, 4);
|
||||
break;
|
||||
case 3:
|
||||
serial_setup(dev->uart[port], dev->com4_addr, 3);
|
||||
break;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
static void
|
||||
lpt1_handler(fdc37c661_t *dev)
|
||||
{
|
||||
lpt1_remove();
|
||||
switch (dev->regs[1] & 3) {
|
||||
case 1:
|
||||
lpt1_init(0x3bc);
|
||||
lpt1_irq(7);
|
||||
break;
|
||||
case 2:
|
||||
lpt1_init(0x378);
|
||||
lpt1_irq(7 /*5*/);
|
||||
break;
|
||||
case 3:
|
||||
lpt1_init(0x278);
|
||||
lpt1_irq(7 /*5*/);
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
static void
|
||||
fdc_handler(fdc37c661_t *dev)
|
||||
{
|
||||
fdc_remove(dev->fdc);
|
||||
if (dev->regs[0] & 0x10)
|
||||
fdc_set_base(dev->fdc, 0x03f0);
|
||||
}
|
||||
|
||||
|
||||
|
||||
static void
|
||||
ide_handler(fdc37c661_t *dev)
|
||||
{
|
||||
/* TODO: Make an ide_disable(channel) and ide_enable(channel) so we can simplify this. */
|
||||
if (dev->has_ide == 2) {
|
||||
ide_sec_disable();
|
||||
ide_set_base(1, 0x1f0);
|
||||
ide_set_side(1, 0x3f6);
|
||||
if (dev->regs[0x00] & 0x01)
|
||||
ide_sec_enable();
|
||||
} else if (dev->has_ide == 1) {
|
||||
ide_pri_disable();
|
||||
ide_set_base(0, 0x1f0);
|
||||
ide_set_side(0, 0x3f6);
|
||||
if (dev->regs[0x00] & 0x01)
|
||||
ide_pri_enable();
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
static void
|
||||
fdc37c661_write(uint16_t port, uint8_t val, void *priv)
|
||||
{
|
||||
fdc37c661_t *dev = (fdc37c661_t *) priv;
|
||||
uint8_t valxor = 0;
|
||||
|
||||
if (dev->tries == 2) {
|
||||
if (port == 0x3f0) {
|
||||
if (val == 0xaa)
|
||||
dev->tries = 0;
|
||||
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 0:
|
||||
if (dev->has_ide && (valxor & 0x01))
|
||||
ide_handler(dev);
|
||||
if (valxor & 0x10)
|
||||
fdc_handler(dev);
|
||||
break;
|
||||
case 1:
|
||||
if (valxor & 3)
|
||||
lpt1_handler(dev);
|
||||
if (valxor & 0x60) {
|
||||
set_com34_addr(dev);
|
||||
set_serial_addr(dev, 0);
|
||||
set_serial_addr(dev, 1);
|
||||
}
|
||||
break;
|
||||
case 2:
|
||||
if (valxor & 7)
|
||||
set_serial_addr(dev, 0);
|
||||
if (valxor & 0x70)
|
||||
set_serial_addr(dev, 1);
|
||||
break;
|
||||
}
|
||||
}
|
||||
} else if ((port == 0x3f0) && (val == 0x55))
|
||||
dev->tries++;
|
||||
}
|
||||
|
||||
|
||||
static uint8_t
|
||||
fdc37c661_read(uint16_t port, void *priv)
|
||||
{
|
||||
fdc37c661_t *dev = (fdc37c661_t *) priv;
|
||||
uint8_t ret = 0x00;
|
||||
|
||||
if (dev->tries == 2) {
|
||||
if (port == 0x3f1)
|
||||
ret = dev->regs[dev->cur_reg];
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
|
||||
static void
|
||||
fdc37c661_reset(fdc37c661_t *dev)
|
||||
{
|
||||
dev->com3_addr = 0x338;
|
||||
dev->com4_addr = 0x238;
|
||||
|
||||
serial_remove(dev->uart[0]);
|
||||
serial_setup(dev->uart[0], SERIAL1_ADDR, SERIAL1_IRQ);
|
||||
|
||||
serial_remove(dev->uart[1]);
|
||||
serial_setup(dev->uart[1], SERIAL2_ADDR, SERIAL2_IRQ);
|
||||
|
||||
lpt1_remove();
|
||||
lpt1_init(0x378);
|
||||
|
||||
fdc_reset(dev->fdc);
|
||||
fdc_remove(dev->fdc);
|
||||
|
||||
dev->tries = 0;
|
||||
memset(dev->regs, 0, 16);
|
||||
|
||||
dev->regs[0x0] = 0x3f;
|
||||
dev->regs[0x1] = 0x9f;
|
||||
dev->regs[0x2] = 0xdc;
|
||||
dev->regs[0x3] = 0x78;
|
||||
|
||||
set_serial_addr(dev, 0);
|
||||
set_serial_addr(dev, 1);
|
||||
|
||||
lpt1_handler(dev);
|
||||
|
||||
fdc_handler(dev);
|
||||
|
||||
if (dev->has_ide)
|
||||
ide_handler(dev);
|
||||
}
|
||||
|
||||
|
||||
static void
|
||||
fdc37c661_close(void *priv)
|
||||
{
|
||||
fdc37c661_t *dev = (fdc37c661_t *) priv;
|
||||
|
||||
free(dev);
|
||||
}
|
||||
|
||||
|
||||
static void *
|
||||
fdc37c661_init(const device_t *info)
|
||||
{
|
||||
fdc37c661_t *dev = (fdc37c661_t *) malloc(sizeof(fdc37c661_t));
|
||||
memset(dev, 0, sizeof(fdc37c661_t));
|
||||
|
||||
dev->fdc = device_add(&fdc_at_smc_device);
|
||||
|
||||
dev->uart[0] = device_add_inst(&ns16450_device, 1);
|
||||
dev->uart[1] = device_add_inst(&ns16450_device, 2);
|
||||
|
||||
dev->chip_id = info->local & 0xff;
|
||||
dev->has_ide = (info->local >> 8) & 0xff;
|
||||
|
||||
io_sethandler(0x03f0, 0x0002,
|
||||
fdc37c661_read, NULL, NULL, fdc37c661_write, NULL, NULL, dev);
|
||||
|
||||
fdc37c661_reset(dev);
|
||||
|
||||
return dev;
|
||||
}
|
||||
|
||||
|
||||
/* The three appear to differ only in the chip ID, if I
|
||||
understood their datasheets correctly. */
|
||||
const device_t fdc37c661_device = {
|
||||
"SMC FDC37C661 Super I/O",
|
||||
0,
|
||||
0x00,
|
||||
fdc37c661_init, fdc37c661_close, NULL,
|
||||
{ NULL }, NULL, NULL,
|
||||
NULL
|
||||
};
|
||||
|
||||
const device_t fdc37c661_ide_device = {
|
||||
"SMC FDC37C661 Super I/O (With IDE)",
|
||||
0,
|
||||
0x100,
|
||||
fdc37c661_init, fdc37c661_close, NULL,
|
||||
{ NULL }, NULL, NULL,
|
||||
NULL
|
||||
};
|
||||
@@ -37,17 +37,18 @@
|
||||
|
||||
|
||||
typedef struct {
|
||||
uint8_t chip_id, tries,
|
||||
has_ide, regs[16];
|
||||
uint8_t max_reg, chip_id,
|
||||
tries, has_ide,
|
||||
regs[16];
|
||||
int cur_reg,
|
||||
com3_addr, com4_addr;
|
||||
fdc_t *fdc;
|
||||
serial_t *uart[2];
|
||||
} fdc37c66x_t;
|
||||
} fdc37c6xx_t;
|
||||
|
||||
|
||||
static void
|
||||
set_com34_addr(fdc37c66x_t *dev)
|
||||
set_com34_addr(fdc37c6xx_t *dev)
|
||||
{
|
||||
switch (dev->regs[1] & 0x60) {
|
||||
case 0x00:
|
||||
@@ -71,7 +72,7 @@ set_com34_addr(fdc37c66x_t *dev)
|
||||
|
||||
|
||||
static void
|
||||
set_serial_addr(fdc37c66x_t *dev, int port)
|
||||
set_serial_addr(fdc37c6xx_t *dev, int port)
|
||||
{
|
||||
uint8_t shift = (port << 2);
|
||||
double clock_src = 24000000.0 / 13.0;
|
||||
@@ -102,7 +103,7 @@ set_serial_addr(fdc37c66x_t *dev, int port)
|
||||
|
||||
|
||||
static void
|
||||
lpt1_handler(fdc37c66x_t *dev)
|
||||
lpt1_handler(fdc37c6xx_t *dev)
|
||||
{
|
||||
lpt1_remove();
|
||||
switch (dev->regs[1] & 3) {
|
||||
@@ -123,7 +124,7 @@ lpt1_handler(fdc37c66x_t *dev)
|
||||
|
||||
|
||||
static void
|
||||
fdc_handler(fdc37c66x_t *dev)
|
||||
fdc_handler(fdc37c6xx_t *dev)
|
||||
{
|
||||
fdc_remove(dev->fdc);
|
||||
if (dev->regs[0] & 0x10)
|
||||
@@ -133,7 +134,7 @@ fdc_handler(fdc37c66x_t *dev)
|
||||
|
||||
|
||||
static void
|
||||
ide_handler(fdc37c66x_t *dev)
|
||||
ide_handler(fdc37c6xx_t *dev)
|
||||
{
|
||||
/* TODO: Make an ide_disable(channel) and ide_enable(channel) so we can simplify this. */
|
||||
if (dev->has_ide == 2) {
|
||||
@@ -153,9 +154,9 @@ ide_handler(fdc37c66x_t *dev)
|
||||
|
||||
|
||||
static void
|
||||
fdc37c66x_write(uint16_t port, uint8_t val, void *priv)
|
||||
fdc37c6xx_write(uint16_t port, uint8_t val, void *priv)
|
||||
{
|
||||
fdc37c66x_t *dev = (fdc37c66x_t *) priv;
|
||||
fdc37c6xx_t *dev = (fdc37c6xx_t *) priv;
|
||||
uint8_t valxor = 0;
|
||||
|
||||
if (dev->tries == 2) {
|
||||
@@ -165,7 +166,7 @@ fdc37c66x_write(uint16_t port, uint8_t val, void *priv)
|
||||
else
|
||||
dev->cur_reg = val;
|
||||
} else {
|
||||
if (dev->cur_reg > 15)
|
||||
if (dev->cur_reg > dev->max_reg)
|
||||
return;
|
||||
|
||||
valxor = val ^ dev->regs[dev->cur_reg];
|
||||
@@ -221,9 +222,9 @@ fdc37c66x_write(uint16_t port, uint8_t val, void *priv)
|
||||
|
||||
|
||||
static uint8_t
|
||||
fdc37c66x_read(uint16_t port, void *priv)
|
||||
fdc37c6xx_read(uint16_t port, void *priv)
|
||||
{
|
||||
fdc37c66x_t *dev = (fdc37c66x_t *) priv;
|
||||
fdc37c6xx_t *dev = (fdc37c6xx_t *) priv;
|
||||
uint8_t ret = 0x00;
|
||||
|
||||
if (dev->tries == 2) {
|
||||
@@ -236,7 +237,7 @@ fdc37c66x_read(uint16_t port, void *priv)
|
||||
|
||||
|
||||
static void
|
||||
fdc37c66x_reset(fdc37c66x_t *dev)
|
||||
fdc37c6xx_reset(fdc37c6xx_t *dev)
|
||||
{
|
||||
dev->com3_addr = 0x338;
|
||||
dev->com4_addr = 0x238;
|
||||
@@ -256,13 +257,33 @@ fdc37c66x_reset(fdc37c66x_t *dev)
|
||||
dev->tries = 0;
|
||||
memset(dev->regs, 0, 16);
|
||||
|
||||
dev->regs[0x0] = 0x3a;
|
||||
switch (dev->chip_id) {
|
||||
case 0x63: case 0x65:
|
||||
dev->max_reg = 0x0f;
|
||||
dev->regs[0x0] = 0x3b;
|
||||
break;
|
||||
case 0x64: case 0x66:
|
||||
dev->max_reg = 0x0f;
|
||||
dev->regs[0x0] = 0x2b;
|
||||
break;
|
||||
default:
|
||||
dev->max_reg = (dev->chip_id >= 0x61) ? 0x03 : 0x02;
|
||||
dev->regs[0x0] = 0x3f;
|
||||
break;
|
||||
}
|
||||
|
||||
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;
|
||||
|
||||
if (dev->chip_id >= 0x63) {
|
||||
dev->regs[0x6] = 0xff;
|
||||
dev->regs[0xd] = dev->chip_id;
|
||||
if (dev->chip_id >= 0x65)
|
||||
dev->regs[0xe] = 0x02;
|
||||
else
|
||||
dev->regs[0xe] = 0x01;
|
||||
}
|
||||
|
||||
set_serial_addr(dev, 0);
|
||||
set_serial_addr(dev, 1);
|
||||
@@ -277,32 +298,37 @@ fdc37c66x_reset(fdc37c66x_t *dev)
|
||||
|
||||
|
||||
static void
|
||||
fdc37c66x_close(void *priv)
|
||||
fdc37c6xx_close(void *priv)
|
||||
{
|
||||
fdc37c66x_t *dev = (fdc37c66x_t *) priv;
|
||||
fdc37c6xx_t *dev = (fdc37c6xx_t *) priv;
|
||||
|
||||
free(dev);
|
||||
}
|
||||
|
||||
|
||||
static void *
|
||||
fdc37c66x_init(const device_t *info)
|
||||
fdc37c6xx_init(const device_t *info)
|
||||
{
|
||||
fdc37c66x_t *dev = (fdc37c66x_t *) malloc(sizeof(fdc37c66x_t));
|
||||
memset(dev, 0, sizeof(fdc37c66x_t));
|
||||
fdc37c6xx_t *dev = (fdc37c6xx_t *) malloc(sizeof(fdc37c6xx_t));
|
||||
memset(dev, 0, sizeof(fdc37c6xx_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 & 0xff;
|
||||
dev->has_ide = (info->local >> 8) & 0xff;
|
||||
|
||||
io_sethandler(0x03f0, 0x0002,
|
||||
fdc37c66x_read, NULL, NULL, fdc37c66x_write, NULL, NULL, dev);
|
||||
if (dev->chip_id >= 0x63) {
|
||||
dev->uart[0] = device_add_inst(&ns16550_device, 1);
|
||||
dev->uart[1] = device_add_inst(&ns16550_device, 2);
|
||||
} else {
|
||||
dev->uart[0] = device_add_inst(&ns16450_device, 1);
|
||||
dev->uart[1] = device_add_inst(&ns16450_device, 2);
|
||||
}
|
||||
|
||||
fdc37c66x_reset(dev);
|
||||
io_sethandler(0x03f0, 0x0002,
|
||||
fdc37c6xx_read, NULL, NULL, fdc37c6xx_write, NULL, NULL, dev);
|
||||
|
||||
fdc37c6xx_reset(dev);
|
||||
|
||||
return dev;
|
||||
}
|
||||
@@ -310,11 +336,47 @@ fdc37c66x_init(const device_t *info)
|
||||
|
||||
/* The three appear to differ only in the chip ID, if I
|
||||
understood their datasheets correctly. */
|
||||
const device_t fdc37c651_device = {
|
||||
"SMC FDC37C651 Super I/O",
|
||||
0,
|
||||
0x51,
|
||||
fdc37c6xx_init, fdc37c6xx_close, NULL,
|
||||
{ NULL }, NULL, NULL,
|
||||
NULL
|
||||
};
|
||||
|
||||
const device_t fdc37c651_ide_device = {
|
||||
"SMC FDC37C651 Super I/O (With IDE)",
|
||||
0,
|
||||
0x151,
|
||||
fdc37c6xx_init, fdc37c6xx_close, NULL,
|
||||
{ NULL }, NULL, NULL,
|
||||
NULL
|
||||
};
|
||||
|
||||
const device_t fdc37c661_device = {
|
||||
"SMC FDC37C661 Super I/O",
|
||||
0,
|
||||
0x61,
|
||||
fdc37c6xx_init, fdc37c6xx_close, NULL,
|
||||
{ NULL }, NULL, NULL,
|
||||
NULL
|
||||
};
|
||||
|
||||
const device_t fdc37c661_ide_device = {
|
||||
"SMC FDC37C661 Super I/O (With IDE)",
|
||||
0,
|
||||
0x161,
|
||||
fdc37c6xx_init, fdc37c6xx_close, NULL,
|
||||
{ NULL }, NULL, NULL,
|
||||
NULL
|
||||
};
|
||||
|
||||
const device_t fdc37c663_device = {
|
||||
"SMC FDC37C663 Super I/O",
|
||||
0,
|
||||
0x63,
|
||||
fdc37c66x_init, fdc37c66x_close, NULL,
|
||||
fdc37c6xx_init, fdc37c6xx_close, NULL,
|
||||
{ NULL }, NULL, NULL,
|
||||
NULL
|
||||
};
|
||||
@@ -323,7 +385,7 @@ const device_t fdc37c663_ide_device = {
|
||||
"SMC FDC37C663 Super I/O (With IDE)",
|
||||
0,
|
||||
0x163,
|
||||
fdc37c66x_init, fdc37c66x_close, NULL,
|
||||
fdc37c6xx_init, fdc37c6xx_close, NULL,
|
||||
{ NULL }, NULL, NULL,
|
||||
NULL
|
||||
};
|
||||
@@ -332,7 +394,7 @@ const device_t fdc37c665_device = {
|
||||
"SMC FDC37C665 Super I/O",
|
||||
0,
|
||||
0x65,
|
||||
fdc37c66x_init, fdc37c66x_close, NULL,
|
||||
fdc37c6xx_init, fdc37c6xx_close, NULL,
|
||||
{ NULL }, NULL, NULL,
|
||||
NULL
|
||||
};
|
||||
@@ -341,7 +403,7 @@ const device_t fdc37c665_ide_device = {
|
||||
"SMC FDC37C665 Super I/O (With IDE)",
|
||||
0,
|
||||
0x265,
|
||||
fdc37c66x_init, fdc37c66x_close, NULL,
|
||||
fdc37c6xx_init, fdc37c6xx_close, NULL,
|
||||
{ NULL }, NULL, NULL,
|
||||
NULL
|
||||
};
|
||||
@@ -350,7 +412,7 @@ const device_t fdc37c666_device = {
|
||||
"SMC FDC37C666 Super I/O",
|
||||
0,
|
||||
0x66,
|
||||
fdc37c66x_init, fdc37c66x_close, NULL,
|
||||
fdc37c6xx_init, fdc37c6xx_close, NULL,
|
||||
{ NULL }, NULL, NULL,
|
||||
NULL
|
||||
};
|
||||
Reference in New Issue
Block a user