Preliminary ALi M5123 code.
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_fdc37c6xx.c
|
||||
sio_fdc37c67x.c sio_fdc37c669.c sio_fdc37c93x.c sio_fdc37m60x.c
|
||||
add_library(sio OBJECT sio_acc3221.c sio_ali5123.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
|
||||
|
||||
479
src/sio/sio_ali5123.c
Normal file
479
src/sio/sio_ali5123.c
Normal file
@@ -0,0 +1,479 @@
|
||||
/*
|
||||
* 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 ALi M5123/1543C Super I/O Chip.
|
||||
*
|
||||
*
|
||||
*
|
||||
* Author: Miran Grca, <mgrca8@gmail.com>
|
||||
* Copyright 2016-2018 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/pic.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 "cpu.h"
|
||||
#include <86box/sio.h>
|
||||
|
||||
|
||||
#define AB_RST 0x80
|
||||
|
||||
|
||||
typedef struct {
|
||||
uint8_t chip_id, is_apm,
|
||||
tries,
|
||||
regs[48],
|
||||
ld_regs[11][256];
|
||||
int locked,
|
||||
cur_reg;
|
||||
fdc_t *fdc;
|
||||
serial_t *uart[3];
|
||||
} ali5123_t;
|
||||
|
||||
|
||||
static void ali5123_write(uint16_t port, uint8_t val, void *priv);
|
||||
static uint8_t ali5123_read(uint16_t port, void *priv);
|
||||
|
||||
|
||||
static uint16_t
|
||||
make_port(ali5123_t *dev, uint8_t ld)
|
||||
{
|
||||
uint16_t r0 = dev->ld_regs[ld][0x60];
|
||||
uint16_t r1 = dev->ld_regs[ld][0x61];
|
||||
|
||||
uint16_t p = (r0 << 8) + r1;
|
||||
|
||||
return p;
|
||||
}
|
||||
|
||||
|
||||
static void
|
||||
ali5123_fdc_handler(ali5123_t *dev)
|
||||
{
|
||||
uint16_t ld_port = 0;
|
||||
uint8_t global_enable = !!(dev->regs[0x22] & (1 << 0));
|
||||
uint8_t local_enable = !!dev->ld_regs[0][0x30];
|
||||
|
||||
fdc_remove(dev->fdc);
|
||||
if (global_enable && local_enable) {
|
||||
ld_port = make_port(dev, 0) & 0xFFF8;
|
||||
if ((ld_port >= 0x0100) && (ld_port <= 0x0FF8))
|
||||
fdc_set_base(dev->fdc, ld_port);
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
static void
|
||||
ali5123_lpt_handler(ali5123_t *dev)
|
||||
{
|
||||
uint16_t ld_port = 0;
|
||||
uint8_t global_enable = !!(dev->regs[0x22] & (1 << 3));
|
||||
uint8_t local_enable = !!dev->ld_regs[3][0x30];
|
||||
uint8_t lpt_irq = dev->ld_regs[3][0x70];
|
||||
|
||||
if (lpt_irq > 15)
|
||||
lpt_irq = 0xff;
|
||||
|
||||
lpt1_remove();
|
||||
if (global_enable && local_enable) {
|
||||
ld_port = make_port(dev, 3) & 0xFFFC;
|
||||
if ((ld_port >= 0x0100) && (ld_port <= 0x0FFC))
|
||||
lpt1_init(ld_port);
|
||||
}
|
||||
lpt1_irq(lpt_irq);
|
||||
}
|
||||
|
||||
|
||||
static void
|
||||
ali5123_serial_handler(ali5123_t *dev, int uart)
|
||||
{
|
||||
uint16_t ld_port = 0;
|
||||
uint8_t uart_no = (uart == 2) ? 0x0b : (4 + uart);
|
||||
uint8_t global_enable = !!(dev->regs[0x22] & (1 << uart_no));
|
||||
uint8_t local_enable = !!dev->ld_regs[uart_no][0x30];
|
||||
uint8_t mask = (uart == 1) ? 0x04 : 0x05;
|
||||
|
||||
serial_remove(dev->uart[uart]);
|
||||
if (global_enable && local_enable) {
|
||||
ld_port = make_port(dev, uart_no) & 0xFFF8;
|
||||
if ((ld_port >= 0x0100) && (ld_port <= 0x0FF8))
|
||||
serial_setup(dev->uart[uart], ld_port, dev->ld_regs[uart_no][0x70]);
|
||||
}
|
||||
|
||||
switch (dev->dev_regs[uart_no][0xc0] & mask) {
|
||||
case 0x00:
|
||||
serial_set_clock_src(dev->uart[uart], 1843200.0);
|
||||
break;
|
||||
case 0x04:
|
||||
serial_set_clock_src(dev->uart[uart], 8000000.0);
|
||||
break;
|
||||
case 0x01: case 0x05:
|
||||
serial_set_clock_src(dev->uart[uart], 2000000.0);
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
static void
|
||||
ali5123_reset(ali5123_t *dev)
|
||||
{
|
||||
int i = 0;
|
||||
|
||||
memset(dev->regs, 0, 48);
|
||||
|
||||
dev->regs[0x20] = 0x43;
|
||||
dev->regs[0x21] = 0x15;
|
||||
dev->regs[0x2d] = 0x20;
|
||||
|
||||
for (i = 0; i < 13; i++)
|
||||
memset(dev->ld_regs[i], 0, 256);
|
||||
|
||||
/* Logical device 0: FDD */
|
||||
dev->ld_regs[0][0x60] = 3;
|
||||
dev->ld_regs[0][0x61] = 0xf0;
|
||||
dev->ld_regs[0][0x70] = 6;
|
||||
dev->ld_regs[0][0x74] = 2;
|
||||
dev->ld_regs[0][0xf0] = 0x08;
|
||||
dev->ld_regs[0][0xf2] = 0xff;
|
||||
|
||||
/* Logical device 3: Parallel Port */
|
||||
dev->ld_regs[3][0x60] = 3;
|
||||
dev->ld_regs[3][0x61] = 0x78;
|
||||
dev->ld_regs[3][0x70] = 5;
|
||||
dev->ld_regs[3][0x74] = 4;
|
||||
dev->ld_regs[3][0xf0] = 0x8c;
|
||||
dev->ld_regs[3][0xf1] = 0x85;
|
||||
|
||||
/* Logical device 4: Serial Port 1 */
|
||||
dev->ld_regs[4][0x60] = 3;
|
||||
dev->ld_regs[4][0x61] = 0xf8;
|
||||
dev->ld_regs[4][0x70] = 4;
|
||||
dev->ld_regs[4][0xf2] = 0x0c;
|
||||
serial_setup(dev->uart[0], COM1_ADDR, dev->ld_regs[4][0x70]);
|
||||
|
||||
/* Logical device 5: Serial Port 2 - HP like module */
|
||||
dev->ld_regs[5][0x60] = 3;
|
||||
dev->ld_regs[5][0x61] = 0xe8;
|
||||
dev->ld_regs[5][0x70] = 9;
|
||||
dev->ld_regs[5][0xf0] = 0x80;
|
||||
dev->ld_regs[4][0xf2] = 0x0c;
|
||||
serial_setup(dev->uart[1], 0x03e8, dev->ld_regs[5][0x70]);
|
||||
|
||||
/* Logical device 7: Keyboard */
|
||||
dev->ld_regs[7][0x70] = 1;
|
||||
/* TODO: Register F0 bit 6: 0 = PS/2, 1 = AT */
|
||||
|
||||
/* Logical device B: Serial Port 2 - HP like module */
|
||||
dev->ld_regs[0x0b][0x60] = 2;
|
||||
dev->ld_regs[0x0b][0x61] = 0xf8;
|
||||
dev->ld_regs[0x0b][0x70] = 3;
|
||||
dev->ld_regs[0x0b][0xf0] = 0x00;
|
||||
dev->ld_regs[0x0b][0xf2] = 0x0c;
|
||||
serial_setup(dev->uart[2], COM2_ADDR, dev->ld_regs[0x0b][0x70]);
|
||||
|
||||
/* Logical device C: Hotkey */
|
||||
dev->ld_regs[0x0c][0xf0] = 0x35;
|
||||
dev->ld_regs[0x0c][0xf1] = 0x14;
|
||||
dev->ld_regs[0x0c][0xf2] = 0x11;
|
||||
dev->ld_regs[0x0c][0xf3] = 0x71;
|
||||
dev->ld_regs[0x0c][0xf4] = 0x42;
|
||||
|
||||
ali5123_lpt_handler(dev);
|
||||
ali5123_serial_handler(dev, 0);
|
||||
ali5123_serial_handler(dev, 1);
|
||||
ali5123_serial_handler(dev, 2);
|
||||
|
||||
fdc_reset(dev->fdc);
|
||||
ali5123_fdc_handler(dev);
|
||||
|
||||
dev->locked = 0;
|
||||
}
|
||||
|
||||
|
||||
static void
|
||||
ali5123_write(uint16_t port, uint8_t val, void *priv)
|
||||
{
|
||||
ali5123_t *dev = (ali5123_t *) priv;
|
||||
uint8_t index = (port & 1) ? 0 : 1;
|
||||
uint8_t valxor = 0x00, keep = 0x00;
|
||||
uint8_t cur_ld;
|
||||
|
||||
if (index) {
|
||||
if (((val == 0x51) && !dev->tries && !dev->locked) ||
|
||||
((val == 0x23) && dev->tries && !dev->locked))
|
||||
if (dev->tries) {
|
||||
dev->locked = 1;
|
||||
fdc_3f1_enable(dev->fdc, 0);
|
||||
dev->tries = 0;
|
||||
} else
|
||||
dev->tries++;
|
||||
} else {
|
||||
if (dev->locked) {
|
||||
if (val == 0xbb) {
|
||||
dev->locked = 0;
|
||||
fdc_3f1_enable(dev->fdc, 1);
|
||||
return;
|
||||
}
|
||||
dev->cur_reg = val;
|
||||
} else {
|
||||
if (dev->tries)
|
||||
dev->tries = 0;
|
||||
}
|
||||
}
|
||||
return;
|
||||
} else {
|
||||
if (dev->locked) {
|
||||
if (dev->cur_reg < 48) {
|
||||
valxor = val ^ dev->regs[dev->cur_reg];
|
||||
if ((val == 0x1f) || (val == 0x20) || (val == 0x21))
|
||||
return;
|
||||
dev->regs[dev->cur_reg] = val;
|
||||
} else {
|
||||
valxor = val ^ dev->ld_regs[dev->regs[7]][dev->cur_reg];
|
||||
if (((dev->cur_reg & 0xf0) == 0x70) && (dev->regs[7] < 4))
|
||||
return;
|
||||
/* Block writes to some logical devices. */
|
||||
if (dev->regs[7] > 0x0c)
|
||||
return;
|
||||
else switch (dev->regs[7]) {
|
||||
case 0x01: case 0x02: case 0x06: case 0x08:
|
||||
case 0x09: case 0x0a:
|
||||
return;
|
||||
}
|
||||
dev->ld_regs[dev->regs[7]][dev->cur_reg] = val | keep;
|
||||
}
|
||||
} else
|
||||
return;
|
||||
}
|
||||
|
||||
if (dev->cur_reg < 48) {
|
||||
switch(dev->cur_reg) {
|
||||
case 0x02:
|
||||
if (val & 0x01)
|
||||
ali5123_reset(dev);
|
||||
dev->regs[0x02] = 0x00;
|
||||
break;
|
||||
case 0x22:
|
||||
if (valxor & 0x01)
|
||||
ali5123_fdc_handler(dev);
|
||||
if (valxor & 0x08)
|
||||
ali5123_lpt_handler(dev);
|
||||
if (valxor & 0x10)
|
||||
ali5123_serial_handler(dev, 0);
|
||||
if (valxor & 0x20)
|
||||
ali5123_serial_handler(dev, 1);
|
||||
if (valxor & 0x40)
|
||||
ali5123_serial_handler(dev, 2);
|
||||
break;
|
||||
}
|
||||
|
||||
return;
|
||||
}
|
||||
|
||||
cur_ld = dev->regs[7];
|
||||
if ((dev->regs[7] == 5) && (dev->regs[0x2d] & 0x20))
|
||||
cur_ld = 0x0b;
|
||||
else if ((dev->regs[7] == 0x0b) && (dev->regs[0x2d] & 0x20))
|
||||
cur_ld = 5;
|
||||
switch(cur_ld) {
|
||||
case 0:
|
||||
/* FDD */
|
||||
switch(dev->cur_reg) {
|
||||
case 0x30:
|
||||
case 0x60:
|
||||
case 0x61:
|
||||
if ((dev->cur_reg == 0x30) && (val & 0x01))
|
||||
dev->regs[0x22] |= 0x01;
|
||||
if (valxor)
|
||||
ali5123_fdc_handler(dev);
|
||||
break;
|
||||
case 0xf0:
|
||||
if (valxor & 0x08)
|
||||
fdc_update_enh_mode(dev->fdc, !(val & 0x08));
|
||||
if (valxor & 0x10)
|
||||
fdc_set_swap(dev->fdc, (val & 0x10) >> 4);
|
||||
break;
|
||||
case 0xf1:
|
||||
if (valxor & 0xc)
|
||||
fdc_update_densel_force(dev->fdc, (val & 0xc) >> 2);
|
||||
break;
|
||||
case 0xf4:
|
||||
if (valxor & 0x08)
|
||||
fdc_update_drvrate(dev->fdc, 0, (val & 0x08) >> 3);
|
||||
break;
|
||||
case 0xf5:
|
||||
if (valxor & 0x08)
|
||||
fdc_update_drvrate(dev->fdc, 1, (val & 0x08) >> 3);
|
||||
break;
|
||||
case 0xf6:
|
||||
if (valxor & 0x08)
|
||||
fdc_update_drvrate(dev->fdc, 2, (val & 0x08) >> 3);
|
||||
break;
|
||||
case 0xf7:
|
||||
if (valxor & 0x08)
|
||||
fdc_update_drvrate(dev->fdc, 3, (val & 0x08) >> 3);
|
||||
break;
|
||||
}
|
||||
break;
|
||||
case 3:
|
||||
/* Parallel port */
|
||||
switch(dev->cur_reg) {
|
||||
case 0x30:
|
||||
case 0x60:
|
||||
case 0x61:
|
||||
case 0x70:
|
||||
if ((dev->cur_reg == 0x30) && (val & 0x01))
|
||||
dev->regs[0x22] |= 0x08;
|
||||
if (valxor)
|
||||
ali5123_lpt_handler(dev);
|
||||
break;
|
||||
}
|
||||
break;
|
||||
case 4:
|
||||
/* Serial port 1 */
|
||||
switch(dev->cur_reg) {
|
||||
case 0x30:
|
||||
case 0x60:
|
||||
case 0x61:
|
||||
case 0x70:
|
||||
case 0xf0:
|
||||
if ((dev->cur_reg == 0x30) && (val & 0x01))
|
||||
dev->regs[0x22] |= 0x10;
|
||||
if (valxor)
|
||||
ali5123_serial_handler(dev, 0);
|
||||
break;
|
||||
}
|
||||
break;
|
||||
case 5:
|
||||
/* Serial port 2 - HP like module */
|
||||
switch(dev->cur_reg) {
|
||||
case 0x30:
|
||||
case 0x60:
|
||||
case 0x61:
|
||||
case 0x70:
|
||||
case 0xf0:
|
||||
if ((dev->cur_reg == 0x30) && (val & 0x01))
|
||||
dev->regs[0x22] |= 0x20;
|
||||
if (valxor)
|
||||
ali5123_serial_handler(dev, 1);
|
||||
break;
|
||||
}
|
||||
break;
|
||||
case 0x0b:
|
||||
/* Serial port 3 */
|
||||
switch(dev->cur_reg) {
|
||||
case 0x30:
|
||||
case 0x60:
|
||||
case 0x61:
|
||||
case 0x70:
|
||||
case 0xf0:
|
||||
if ((dev->cur_reg == 0x30) && (val & 0x01))
|
||||
dev->regs[0x22] |= 0x40;
|
||||
if (valxor)
|
||||
ali5123_serial_handler(dev, 2);
|
||||
break;
|
||||
}
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
static uint8_t
|
||||
ali5123_read(uint16_t port, void *priv)
|
||||
{
|
||||
ali5123_t *dev = (ali5123_t *) priv;
|
||||
uint8_t index = (port & 1) ? 0 : 1;
|
||||
uint8_t ret = 0xff, cur_ld;
|
||||
int f_irq = dev->ld_regs[0][0x70];
|
||||
int p_irq = dev->ld_regs[3][0x70];
|
||||
int s1_irq = dev->ld_regs[4][0x70];
|
||||
int s2_irq = dev->ld_regs[5][0x70];
|
||||
|
||||
if (dev->locked) {
|
||||
if (index)
|
||||
ret = dev->cur_reg;
|
||||
else {
|
||||
if (dev->cur_reg < 0x30) {
|
||||
if (dev->cur_reg == 0x20)
|
||||
ret = dev->chip_id;
|
||||
else
|
||||
ret = dev->regs[dev->cur_reg];
|
||||
} else {
|
||||
cur_ld = dev->regs[7];
|
||||
if ((dev->regs[7] == 5) && (dev->regs[0x2d] & 0x20))
|
||||
cur_ld = 0x0b;
|
||||
else if ((dev->regs[7] == 0x0b) && (dev->regs[0x2d] & 0x20))
|
||||
cur_ld = 5;
|
||||
|
||||
ret = dev->ld_regs[cur_ld][dev->cur_reg];
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
|
||||
static void
|
||||
ali5123_close(void *priv)
|
||||
{
|
||||
ali5123_t *dev = (ali5123_t *) priv;
|
||||
|
||||
free(dev);
|
||||
}
|
||||
|
||||
|
||||
static void *
|
||||
ali5123_init(const device_t *info)
|
||||
{
|
||||
ali5123_t *dev = (ali5123_t *) malloc(sizeof(ali5123_t));
|
||||
memset(dev, 0, sizeof(ali5123_t));
|
||||
|
||||
dev->fdc = device_add(&fdc_at_ali_device);
|
||||
|
||||
dev->uart[0] = device_add_inst(&ns16550_device, 1);
|
||||
dev->uart[1] = device_add_inst(&ns16550_device, 2);
|
||||
dev->uart[2] = device_add_inst(&ns16550_device, 3);
|
||||
|
||||
dev->chip_id = info->local & 0xff;
|
||||
|
||||
ali5123_reset(dev);
|
||||
|
||||
io_sethandler(FDC_PRIMARY_ADDR, 0x0002,
|
||||
ali5123_read, NULL, NULL, ali5123_write, NULL, NULL, dev);
|
||||
|
||||
return dev;
|
||||
}
|
||||
|
||||
|
||||
const device_t ali5123_device = {
|
||||
.name = "ALi M5123/M1543C Super I/O",
|
||||
.internal_name = "ali5123",
|
||||
.flags = 0,
|
||||
.local = 0x40,
|
||||
.init = ali5123_init,
|
||||
.close = ali5123_close,
|
||||
.reset = NULL,
|
||||
{ .available = NULL },
|
||||
.speed_changed = NULL,
|
||||
.force_redraw = NULL,
|
||||
.config = NULL
|
||||
};
|
||||
Reference in New Issue
Block a user