Serial receive/transmit rework (uses the new fifo.c API) and a small GDB stub fix.
This commit is contained in:
@@ -20,7 +20,8 @@ endif()
|
|||||||
|
|
||||||
add_executable(86Box 86box.c config.c log.c random.c timer.c io.c acpi.c apm.c
|
add_executable(86Box 86box.c config.c log.c random.c timer.c io.c acpi.c apm.c
|
||||||
dma.c ddma.c nmi.c pic.c pit.c pit_fast.c port_6x.c port_92.c ppi.c pci.c
|
dma.c ddma.c nmi.c pic.c pit.c pit_fast.c port_6x.c port_92.c ppi.c pci.c
|
||||||
mca.c usb.c fifo8.c device.c nvr.c nvr_at.c nvr_ps2.c machine_status.c ini.c)
|
mca.c usb.c fifo.c fifo8.c device.c nvr.c nvr_at.c nvr_ps2.c
|
||||||
|
machine_status.c ini.c)
|
||||||
|
|
||||||
if(CMAKE_SYSTEM_NAME MATCHES "Linux")
|
if(CMAKE_SYSTEM_NAME MATCHES "Linux")
|
||||||
add_compile_definitions(_FILE_OFFSET_BITS=64 _LARGEFILE_SOURCE=1 _LARGEFILE64_SOURCE=1)
|
add_compile_definitions(_FILE_OFFSET_BITS=64 _LARGEFILE_SOURCE=1 _LARGEFILE64_SOURCE=1)
|
||||||
|
@@ -35,6 +35,7 @@
|
|||||||
#include <86box/pic.h>
|
#include <86box/pic.h>
|
||||||
#include <86box/mem.h>
|
#include <86box/mem.h>
|
||||||
#include <86box/rom.h>
|
#include <86box/rom.h>
|
||||||
|
#include <86box/fifo.h>
|
||||||
#include <86box/serial.h>
|
#include <86box/serial.h>
|
||||||
#include <86box/mouse.h>
|
#include <86box/mouse.h>
|
||||||
|
|
||||||
@@ -42,10 +43,12 @@ serial_port_t com_ports[SERIAL_MAX];
|
|||||||
|
|
||||||
enum {
|
enum {
|
||||||
SERIAL_INT_LSR = 1,
|
SERIAL_INT_LSR = 1,
|
||||||
SERIAL_INT_RECEIVE = 2,
|
SERIAL_INT_TIMEOUT = 2,
|
||||||
SERIAL_INT_TRANSMIT = 4,
|
SERIAL_INT_RECEIVE = 4,
|
||||||
SERIAL_INT_MSR = 8,
|
SERIAL_INT_TRANSMIT = 8,
|
||||||
SERIAL_INT_TIMEOUT = 16
|
SERIAL_INT_MSR = 16,
|
||||||
|
SERIAL_INT_RX_DMA_TC = 32,
|
||||||
|
SERIAL_INT_TX_DMA_TC = 64
|
||||||
};
|
};
|
||||||
|
|
||||||
void serial_update_ints(serial_t *dev);
|
void serial_update_ints(serial_t *dev);
|
||||||
@@ -53,7 +56,7 @@ void serial_update_ints(serial_t *dev);
|
|||||||
static int next_inst = 0;
|
static int next_inst = 0;
|
||||||
static serial_device_t serial_devices[SERIAL_MAX];
|
static serial_device_t serial_devices[SERIAL_MAX];
|
||||||
|
|
||||||
// #define ENABLE_SERIAL_CONSOLE 1
|
static void serial_xmit_d_empty_evt(void *priv);
|
||||||
|
|
||||||
#ifdef ENABLE_SERIAL_LOG
|
#ifdef ENABLE_SERIAL_LOG
|
||||||
int serial_do_log = ENABLE_SERIAL_LOG;
|
int serial_do_log = ENABLE_SERIAL_LOG;
|
||||||
@@ -76,16 +79,23 @@ serial_log(const char *fmt, ...)
|
|||||||
void
|
void
|
||||||
serial_reset_port(serial_t *dev)
|
serial_reset_port(serial_t *dev)
|
||||||
{
|
{
|
||||||
|
if (dev->type >= SERIAL_16550) {
|
||||||
|
if (dev->fifo_enabled)
|
||||||
|
fifo_reset_evt(dev->xmit_fifo);
|
||||||
|
else
|
||||||
|
fifo_reset(dev->xmit_fifo);
|
||||||
|
}
|
||||||
|
|
||||||
dev->lsr = 0x60; /* Mark that both THR/FIFO and TXSR are empty. */
|
dev->lsr = 0x60; /* Mark that both THR/FIFO and TXSR are empty. */
|
||||||
dev->iir = dev->ier = dev->lcr = dev->fcr = 0;
|
dev->iir = dev->ier = dev->lcr = dev->fcr = 0;
|
||||||
|
|
||||||
dev->fifo_enabled = 0;
|
dev->fifo_enabled = 0;
|
||||||
dev->xmit_fifo_pos = dev->rcvr_fifo_pos = 0;
|
|
||||||
dev->xmit_fifo_end = dev->rcvr_fifo_end = 0;
|
|
||||||
dev->rcvr_fifo_full = 0;
|
|
||||||
dev->baud_cycles = 0;
|
dev->baud_cycles = 0;
|
||||||
dev->out_new = 0xffff;
|
dev->out_new = 0xffff;
|
||||||
memset(dev->xmit_fifo, 0, 16);
|
|
||||||
memset(dev->rcvr_fifo, 0, 16);
|
dev->txsr_empty = 1;
|
||||||
|
dev->thr_empty = 1;
|
||||||
|
|
||||||
serial_update_ints(dev);
|
serial_update_ints(dev);
|
||||||
dev->irq_state = 0;
|
dev->irq_state = 0;
|
||||||
}
|
}
|
||||||
@@ -120,33 +130,22 @@ serial_do_irq(serial_t *dev, int set)
|
|||||||
void
|
void
|
||||||
serial_update_ints(serial_t *dev)
|
serial_update_ints(serial_t *dev)
|
||||||
{
|
{
|
||||||
int stat = 0;
|
/* TODO: The IRQ priorities are 6 - we need to find a way to treat timeout and receive
|
||||||
|
as equal and still somehow distinguish them. */
|
||||||
|
uint8_t ier_map[7] = { 0x04, 0x01, 0x01, 0x02, 0x08, 0x40, 0x80 };
|
||||||
|
uint8_t iir_map[7] = { 0x06, 0x0c, 0x04, 0x02, 0x00, 0x0e, 0x0a };
|
||||||
|
int i;
|
||||||
|
|
||||||
dev->iir = 1;
|
dev->iir = (dev->iir & 0xf0) | 0x01;
|
||||||
|
|
||||||
if ((dev->ier & 4) && (dev->int_status & SERIAL_INT_LSR)) {
|
for (i = 0; i < 7; i++) {
|
||||||
/* Line status interrupt */
|
if ((dev->ier & ier_map[i]) && (dev->int_status & (1 << i))) {
|
||||||
stat = 1;
|
dev->iir = (dev->iir & 0xf0) | iir_map[i];
|
||||||
dev->iir = 6;
|
break;
|
||||||
} else if ((dev->ier & 1) && (dev->int_status & SERIAL_INT_TIMEOUT)) {
|
}
|
||||||
/* Received data available */
|
|
||||||
stat = 1;
|
|
||||||
dev->iir = 0x0c;
|
|
||||||
} else if ((dev->ier & 1) && (dev->int_status & SERIAL_INT_RECEIVE)) {
|
|
||||||
/* Received data available */
|
|
||||||
stat = 1;
|
|
||||||
dev->iir = 4;
|
|
||||||
} else if ((dev->ier & 2) && (dev->int_status & SERIAL_INT_TRANSMIT)) {
|
|
||||||
/* Transmit data empty */
|
|
||||||
stat = 1;
|
|
||||||
dev->iir = 2;
|
|
||||||
} else if ((dev->ier & 8) && (dev->int_status & SERIAL_INT_MSR)) {
|
|
||||||
/* Modem status interrupt */
|
|
||||||
stat = 1;
|
|
||||||
dev->iir = 0;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
serial_do_irq(dev, stat && ((dev->mctrl & 8) || (dev->type == SERIAL_8250_PCJR)));
|
serial_do_irq(dev, !(dev->iir & 0x01) && ((dev->mctrl & 8) || (dev->type == SERIAL_8250_PCJR)));
|
||||||
}
|
}
|
||||||
|
|
||||||
static void
|
static void
|
||||||
@@ -163,60 +162,46 @@ serial_receive_timer(void *priv)
|
|||||||
{
|
{
|
||||||
serial_t *dev = (serial_t *) priv;
|
serial_t *dev = (serial_t *) priv;
|
||||||
|
|
||||||
#if 0
|
|
||||||
serial_log("serial_receive_timer()\n");
|
serial_log("serial_receive_timer()\n");
|
||||||
#endif
|
|
||||||
|
|
||||||
timer_on_auto(&dev->receive_timer, /* dev->bits * */ dev->transmit_period);
|
timer_on_auto(&dev->receive_timer, /* dev->bits * */ dev->transmit_period);
|
||||||
|
|
||||||
if ((dev->type >= SERIAL_16550) && dev->fifo_enabled) {
|
if (dev->fifo_enabled) {
|
||||||
/* FIFO mode. */
|
/* FIFO mode. */
|
||||||
|
|
||||||
if (dev->out_new != 0xffff) {
|
if (dev->out_new != 0xffff) {
|
||||||
/* We have received a byte into the RSR. */
|
/* We have received a byte into the RSR. */
|
||||||
|
|
||||||
/* Clear FIFO timeout. */
|
/* Clear FIFO timeout. */
|
||||||
serial_clear_timeout(dev);
|
serial_clear_timeout(dev);
|
||||||
|
|
||||||
if (dev->rcvr_fifo_full) {
|
fifo_write_evt((uint8_t) (dev->out_new & 0xff), dev->rcvr_fifo);
|
||||||
/* Overrun - just discard the byte in the RSR. */
|
|
||||||
serial_log("FIFO overrun\n");
|
|
||||||
dev->lsr |= 0x02;
|
|
||||||
} else {
|
|
||||||
/* We can input data into the FIFO. */
|
|
||||||
dev->rcvr_fifo[dev->rcvr_fifo_end] = (uint8_t) (dev->out_new & 0xff);
|
|
||||||
#if 0
|
|
||||||
dev->rcvr_fifo_end = (dev->rcvr_fifo_end + 1) & 0x0f;
|
|
||||||
#endif
|
|
||||||
/* Do not wrap around, makes sure it still triggers the interrupt
|
|
||||||
at 16 bytes. */
|
|
||||||
dev->rcvr_fifo_end++;
|
|
||||||
|
|
||||||
serial_log("To FIFO: %02X (%i, %i, %i)\n", (uint8_t) (dev->out_new & 0xff),
|
|
||||||
abs(dev->rcvr_fifo_end - dev->rcvr_fifo_pos),
|
|
||||||
dev->rcvr_fifo_end, dev->rcvr_fifo_pos);
|
|
||||||
dev->out_new = 0xffff;
|
dev->out_new = 0xffff;
|
||||||
|
|
||||||
if (abs(dev->rcvr_fifo_end - dev->rcvr_fifo_pos) >= dev->rcvr_fifo_len) {
|
/* pclog("serial_receive_timer(): lsr = %02X, ier = %02X, iir = %02X, int_status = %02X\n",
|
||||||
/* We have >= trigger level bytes, raise Data Ready interrupt. */
|
dev->lsr, dev->ier, dev->iir, dev->int_status); */
|
||||||
serial_log("We have >= %i bytes in the FIFO, data ready!\n", dev->rcvr_fifo_len);
|
|
||||||
dev->lsr |= 0x01;
|
|
||||||
dev->int_status |= SERIAL_INT_RECEIVE;
|
|
||||||
serial_update_ints(dev);
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Now wrap around. */
|
|
||||||
dev->rcvr_fifo_end &= 0x0f;
|
|
||||||
|
|
||||||
if (dev->rcvr_fifo_end == dev->rcvr_fifo_pos)
|
|
||||||
dev->rcvr_fifo_full = 1;
|
|
||||||
|
|
||||||
timer_on_auto(&dev->timeout_timer, 4.0 * dev->bits * dev->transmit_period);
|
timer_on_auto(&dev->timeout_timer, 4.0 * dev->bits * dev->transmit_period);
|
||||||
}
|
}
|
||||||
}
|
} else {
|
||||||
}
|
/* Non-FIFO mode. */
|
||||||
|
if (dev->out_new != 0xffff) {
|
||||||
|
/* We have received a byte into the RSR. */
|
||||||
|
serial_log("Byte received: %04X\n", dev->out_new);
|
||||||
|
|
||||||
|
/* Indicate overrun. */
|
||||||
|
if (dev->lsr & 0x01)
|
||||||
|
dev->lsr |= 0x02;
|
||||||
|
|
||||||
|
dev->dat = (uint8_t) (dev->out_new & 0xff);
|
||||||
|
dev->out_new = 0xffff;
|
||||||
|
|
||||||
|
/* Raise Data Ready interrupt. */
|
||||||
|
dev->lsr |= 0x01;
|
||||||
|
dev->int_status |= SERIAL_INT_RECEIVE;
|
||||||
|
|
||||||
serial_update_ints(dev);
|
serial_update_ints(dev);
|
||||||
|
}
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
static void
|
static void
|
||||||
@@ -224,26 +209,8 @@ write_fifo(serial_t *dev, uint8_t dat)
|
|||||||
{
|
{
|
||||||
serial_log("write_fifo(%08X, %02X, %i, %i)\n", dev, dat,
|
serial_log("write_fifo(%08X, %02X, %i, %i)\n", dev, dat,
|
||||||
(dev->type >= SERIAL_16550) && dev->fifo_enabled,
|
(dev->type >= SERIAL_16550) && dev->fifo_enabled,
|
||||||
((dev->type >= SERIAL_16550) && dev->fifo_enabled) ? (dev->rcvr_fifo_pos % dev->rcvr_fifo_len) : 0);
|
((dev->type >= SERIAL_16550) && dev->fifo_enabled) ?
|
||||||
|
fifo_get_count(dev->rcvr_fifo) : 0);
|
||||||
if ((dev->type >= SERIAL_16550) && dev->fifo_enabled) {
|
|
||||||
/* FIFO mode. */
|
|
||||||
|
|
||||||
/* This is the first phase, we are sending the data to the RSR (Receiver Shift
|
|
||||||
Register), from where it's going to get dispatched to the FIFO. */
|
|
||||||
} else {
|
|
||||||
/* Non-FIFO mode. */
|
|
||||||
|
|
||||||
/* Indicate overrun. */
|
|
||||||
if (dev->lsr & 0x01)
|
|
||||||
dev->lsr |= 0x02;
|
|
||||||
|
|
||||||
/* Raise Data Ready interrupt. */
|
|
||||||
serial_log("To RHR: %02X\n", dat);
|
|
||||||
dev->lsr |= 0x01;
|
|
||||||
dev->int_status |= SERIAL_INT_RECEIVE;
|
|
||||||
serial_update_ints(dev);
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Do this here, because in non-FIFO mode, this is read directly. */
|
/* Do this here, because in non-FIFO mode, this is read directly. */
|
||||||
dev->out_new = (uint16_t) dat;
|
dev->out_new = (uint16_t) dat;
|
||||||
@@ -252,7 +219,10 @@ write_fifo(serial_t *dev, uint8_t dat)
|
|||||||
void
|
void
|
||||||
serial_write_fifo(serial_t *dev, uint8_t dat)
|
serial_write_fifo(serial_t *dev, uint8_t dat)
|
||||||
{
|
{
|
||||||
serial_log("serial_write_fifo(%08X, %02X, %i, %i)\n", dev, dat, (dev->type >= SERIAL_16550) && dev->fifo_enabled, dev->rcvr_fifo_pos & 0x0f);
|
serial_log("serial_write_fifo(%08X, %02X, %i, %i)\n", dev, dat,
|
||||||
|
(dev->type >= SERIAL_16550) && dev->fifo_enabled,
|
||||||
|
((dev->type >= SERIAL_16550) && dev->fifo_enabled) ?
|
||||||
|
fifo_get_count(dev->rcvr_fifo) : 0);
|
||||||
|
|
||||||
if (!(dev->mctrl & 0x10))
|
if (!(dev->mctrl & 0x10))
|
||||||
write_fifo(dev, dat);
|
write_fifo(dev, dat);
|
||||||
@@ -265,48 +235,43 @@ serial_transmit(serial_t *dev, uint8_t val)
|
|||||||
write_fifo(dev, val);
|
write_fifo(dev, val);
|
||||||
else if (dev->sd->dev_write)
|
else if (dev->sd->dev_write)
|
||||||
dev->sd->dev_write(dev, dev->sd->priv, val);
|
dev->sd->dev_write(dev, dev->sd->priv, val);
|
||||||
|
|
||||||
#ifdef ENABLE_SERIAL_CONSOLE
|
#ifdef ENABLE_SERIAL_CONSOLE
|
||||||
if ((val >= ' ' && val <= '~') || val == '\r' || val == '\n') {
|
if ((val >= ' ' && val <= '~') || val == '\r' || val == '\n') {
|
||||||
fputc(val, stdout);
|
fputc(val, stdout);
|
||||||
if (val == '\n')
|
if (val == '\n')
|
||||||
fflush(stdout);
|
fflush(stdout);
|
||||||
} else {
|
} else
|
||||||
fprintf(stdout, "[%02X]", val);
|
fprintf(stdout, "[%02X]", val);
|
||||||
}
|
|
||||||
#endif
|
#endif
|
||||||
}
|
}
|
||||||
|
|
||||||
static void
|
static void
|
||||||
serial_move_to_txsr(serial_t *dev)
|
serial_move_to_txsr(serial_t *dev)
|
||||||
{
|
{
|
||||||
if (dev->fifo_enabled) {
|
dev->txsr_empty = 0;
|
||||||
dev->txsr = dev->xmit_fifo[0];
|
if (dev->fifo_enabled)
|
||||||
if (dev->xmit_fifo_pos > 0) {
|
dev->txsr = fifo_read_evt(dev->xmit_fifo);
|
||||||
/* Move the entire fifo forward by one byte. */
|
else {
|
||||||
for (uint8_t i = 1; i < 16; i++)
|
|
||||||
dev->xmit_fifo[i - 1] = dev->xmit_fifo[i];
|
|
||||||
/* Decrease FIFO position. */
|
|
||||||
dev->xmit_fifo_pos--;
|
|
||||||
}
|
|
||||||
} else {
|
|
||||||
dev->txsr = dev->thr;
|
dev->txsr = dev->thr;
|
||||||
dev->thr = 0;
|
dev->thr = 0;
|
||||||
|
dev->thr_empty = 1;
|
||||||
|
serial_xmit_d_empty_evt(dev);
|
||||||
}
|
}
|
||||||
|
|
||||||
dev->lsr &= ~0x40;
|
dev->lsr &= ~0x40;
|
||||||
serial_log("serial_move_to_txsr(): FIFO %sabled, FIFO pos = %i\n", dev->fifo_enabled ? "en" : "dis", dev->xmit_fifo_pos & 0x0f);
|
serial_log("serial_move_to_txsr(): FIFO %sabled, FIFO pos = %i\n", dev->fifo_enabled ? "en" : "dis",
|
||||||
|
fifo_get_count(dev->xmit_fifo) & 0x0f);
|
||||||
|
|
||||||
if (!dev->fifo_enabled || (dev->xmit_fifo_pos == 0x0)) {
|
if (!dev->fifo_enabled || (fifo_get_count(dev->xmit_fifo) == 0x0)) {
|
||||||
/* Update interrupts to signal THRE and that TXSR is no longer empty. */
|
/* Update interrupts to signal THRE and that TXSR is no longer empty. */
|
||||||
dev->lsr |= 0x20;
|
|
||||||
dev->int_status |= SERIAL_INT_TRANSMIT;
|
|
||||||
serial_update_ints(dev);
|
serial_update_ints(dev);
|
||||||
}
|
}
|
||||||
if (dev->transmit_enabled & 2)
|
if (dev->transmit_enabled & 2)
|
||||||
dev->baud_cycles++;
|
dev->baud_cycles++;
|
||||||
else
|
else
|
||||||
dev->baud_cycles = 0; /* If not moving while transmitting, reset BAUDOUT cycle count. */
|
dev->baud_cycles = 0; /* If not moving while transmitting, reset BAUDOUT cycle count. */
|
||||||
if (!dev->fifo_enabled || (dev->xmit_fifo_pos == 0x0))
|
if (!dev->fifo_enabled || (fifo_get_count(dev->xmit_fifo) == 0x0))
|
||||||
dev->transmit_enabled &= ~1; /* Stop moving. */
|
dev->transmit_enabled &= ~1; /* Stop moving. */
|
||||||
dev->transmit_enabled |= 2; /* Start transmitting. */
|
dev->transmit_enabled |= 2; /* Start transmitting. */
|
||||||
}
|
}
|
||||||
@@ -317,20 +282,18 @@ serial_process_txsr(serial_t *dev)
|
|||||||
serial_log("serial_process_txsr(): FIFO %sabled\n", dev->fifo_enabled ? "en" : "dis");
|
serial_log("serial_process_txsr(): FIFO %sabled\n", dev->fifo_enabled ? "en" : "dis");
|
||||||
serial_transmit(dev, dev->txsr);
|
serial_transmit(dev, dev->txsr);
|
||||||
dev->txsr = 0;
|
dev->txsr = 0;
|
||||||
|
dev->txsr_empty = 1;
|
||||||
|
serial_xmit_d_empty_evt(dev);
|
||||||
/* Reset BAUDOUT cycle count. */
|
/* Reset BAUDOUT cycle count. */
|
||||||
dev->baud_cycles = 0;
|
dev->baud_cycles = 0;
|
||||||
/* If FIFO is enabled and there are bytes left to transmit,
|
/* If FIFO is enabled and there are bytes left to transmit,
|
||||||
continue with the FIFO, otherwise stop. */
|
continue with the FIFO, otherwise stop. */
|
||||||
if (dev->fifo_enabled && (dev->xmit_fifo_pos != 0x0))
|
if (dev->fifo_enabled && (fifo_get_count(dev->xmit_fifo) != 0x0))
|
||||||
dev->transmit_enabled |= 1;
|
dev->transmit_enabled |= 1;
|
||||||
else {
|
|
||||||
/* Both FIFO/THR and TXSR are empty. */
|
/* Both FIFO/THR and TXSR are empty. */
|
||||||
/* If bit 5 is set, also set bit 6 to mark both THR and shift register as empty. */
|
else
|
||||||
if (dev->lsr & 0x20)
|
|
||||||
dev->lsr |= 0x40;
|
|
||||||
dev->transmit_enabled &= ~2;
|
dev->transmit_enabled &= ~2;
|
||||||
}
|
|
||||||
dev->int_status &= ~SERIAL_INT_TRANSMIT;
|
|
||||||
serial_update_ints(dev);
|
serial_update_ints(dev);
|
||||||
}
|
}
|
||||||
|
|
||||||
@@ -370,9 +333,7 @@ serial_timeout_timer(void *priv)
|
|||||||
{
|
{
|
||||||
serial_t *dev = (serial_t *) priv;
|
serial_t *dev = (serial_t *) priv;
|
||||||
|
|
||||||
#ifdef ENABLE_SERIAL_LOG
|
|
||||||
serial_log("serial_timeout_timer()\n");
|
serial_log("serial_timeout_timer()\n");
|
||||||
#endif
|
|
||||||
|
|
||||||
dev->lsr |= 0x01;
|
dev->lsr |= 0x01;
|
||||||
dev->int_status |= SERIAL_INT_TIMEOUT;
|
dev->int_status |= SERIAL_INT_TIMEOUT;
|
||||||
@@ -384,9 +345,7 @@ serial_device_timeout(void *priv)
|
|||||||
{
|
{
|
||||||
serial_t *dev = (serial_t *) priv;
|
serial_t *dev = (serial_t *) priv;
|
||||||
|
|
||||||
#ifdef ENABLE_SERIAL_LOG
|
|
||||||
serial_log("serial_device_timeout()\n");
|
serial_log("serial_device_timeout()\n");
|
||||||
#endif
|
|
||||||
|
|
||||||
if (!dev->fifo_enabled) {
|
if (!dev->fifo_enabled) {
|
||||||
dev->lsr |= 0x10;
|
dev->lsr |= 0x10;
|
||||||
@@ -398,6 +357,7 @@ serial_device_timeout(void *priv)
|
|||||||
static void
|
static void
|
||||||
serial_update_speed(serial_t *dev)
|
serial_update_speed(serial_t *dev)
|
||||||
{
|
{
|
||||||
|
serial_log("serial_update_speed(%lf)\n", dev->transmit_period);
|
||||||
timer_on_auto(&dev->receive_timer, /* dev->bits * */ dev->transmit_period);
|
timer_on_auto(&dev->receive_timer, /* dev->bits * */ dev->transmit_period);
|
||||||
|
|
||||||
if (dev->transmit_enabled & 3)
|
if (dev->transmit_enabled & 3)
|
||||||
@@ -410,11 +370,10 @@ serial_update_speed(serial_t *dev)
|
|||||||
static void
|
static void
|
||||||
serial_reset_fifo(serial_t *dev)
|
serial_reset_fifo(serial_t *dev)
|
||||||
{
|
{
|
||||||
dev->lsr = (dev->lsr & 0xfe) | 0x60;
|
fifo_reset_evt(dev->xmit_fifo);
|
||||||
dev->int_status = (dev->int_status & ~SERIAL_INT_RECEIVE) | SERIAL_INT_TRANSMIT;
|
fifo_reset_evt(dev->rcvr_fifo);
|
||||||
|
|
||||||
serial_update_ints(dev);
|
serial_update_ints(dev);
|
||||||
dev->xmit_fifo_pos = dev->rcvr_fifo_pos = 0;
|
|
||||||
dev->rcvr_fifo_full = 0;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
void
|
void
|
||||||
@@ -490,7 +449,6 @@ serial_write(uint16_t addr, uint8_t val, void *p)
|
|||||||
uint8_t new_msr;
|
uint8_t new_msr;
|
||||||
uint8_t old;
|
uint8_t old;
|
||||||
|
|
||||||
// serial_log("UART: Write %02X to port %02X\n", val, addr);
|
|
||||||
serial_log("UART: [%04X:%08X] Write %02X to port %02X\n", CS, cpu_state.pc, val, addr);
|
serial_log("UART: [%04X:%08X] Write %02X to port %02X\n", CS, cpu_state.pc, val, addr);
|
||||||
|
|
||||||
cycles -= ISA_CYCLES(8);
|
cycles -= ISA_CYCLES(8);
|
||||||
@@ -504,21 +462,22 @@ serial_write(uint16_t addr, uint8_t val, void *p)
|
|||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
/* Indicate FIFO/THR is no longer empty. */
|
if (dev->fifo_enabled && (fifo_get_count(dev->xmit_fifo) < 16)) {
|
||||||
|
/* FIFO mode, begin transmitting. */
|
||||||
|
timer_on_auto(&dev->transmit_timer, dev->transmit_period);
|
||||||
|
dev->transmit_enabled |= 1; /* Start moving. */
|
||||||
|
fifo_write_evt(val, dev->xmit_fifo);
|
||||||
|
} else if (!dev->fifo_enabled) {
|
||||||
|
/* Indicate THR is no longer empty. */
|
||||||
dev->lsr &= 0x9f;
|
dev->lsr &= 0x9f;
|
||||||
dev->int_status &= ~SERIAL_INT_TRANSMIT;
|
dev->int_status &= ~SERIAL_INT_TRANSMIT;
|
||||||
serial_update_ints(dev);
|
serial_update_ints(dev);
|
||||||
|
|
||||||
if ((dev->type >= SERIAL_16550) && dev->fifo_enabled && (dev->xmit_fifo_pos < 16)) {
|
|
||||||
/* FIFO mode, begin transmitting. */
|
|
||||||
timer_on_auto(&dev->transmit_timer, dev->transmit_period);
|
|
||||||
dev->transmit_enabled |= 1; /* Start moving. */
|
|
||||||
dev->xmit_fifo[dev->xmit_fifo_pos++] = val;
|
|
||||||
} else {
|
|
||||||
/* Non-FIFO mode, begin transmitting. */
|
/* Non-FIFO mode, begin transmitting. */
|
||||||
timer_on_auto(&dev->transmit_timer, dev->transmit_period);
|
timer_on_auto(&dev->transmit_timer, dev->transmit_period);
|
||||||
dev->transmit_enabled |= 1; /* Start moving. */
|
dev->transmit_enabled |= 1; /* Start moving. */
|
||||||
dev->thr = val;
|
dev->thr = val;
|
||||||
|
dev->thr_empty = 0;
|
||||||
}
|
}
|
||||||
break;
|
break;
|
||||||
case 1:
|
case 1:
|
||||||
@@ -539,42 +498,42 @@ serial_write(uint16_t addr, uint8_t val, void *p)
|
|||||||
serial_reset_fifo(dev);
|
serial_reset_fifo(dev);
|
||||||
dev->fcr = val & 0xf9;
|
dev->fcr = val & 0xf9;
|
||||||
dev->fifo_enabled = val & 0x01;
|
dev->fifo_enabled = val & 0x01;
|
||||||
|
/* TODO: When switching modes, shouldn't we reset the LSR
|
||||||
|
based on the new conditions? */
|
||||||
if (!dev->fifo_enabled) {
|
if (!dev->fifo_enabled) {
|
||||||
memset(dev->rcvr_fifo, 0, 14);
|
fifo_reset(dev->xmit_fifo);
|
||||||
memset(dev->xmit_fifo, 0, 16);
|
fifo_reset(dev->rcvr_fifo);
|
||||||
dev->xmit_fifo_pos = dev->rcvr_fifo_pos = 0;
|
|
||||||
dev->rcvr_fifo_full = 0;
|
|
||||||
dev->rcvr_fifo_len = 1;
|
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
if (val & 0x02) {
|
if (val & 0x02) {
|
||||||
memset(dev->rcvr_fifo, 0, 14);
|
if (dev->fifo_enabled)
|
||||||
dev->rcvr_fifo_pos = 0;
|
fifo_reset_evt(dev->rcvr_fifo);
|
||||||
dev->rcvr_fifo_end = 0;
|
else
|
||||||
dev->rcvr_fifo_full = 0;
|
fifo_reset(dev->rcvr_fifo);
|
||||||
}
|
}
|
||||||
if (val & 0x04) {
|
if (val & 0x04) {
|
||||||
memset(dev->xmit_fifo, 0, 16);
|
if (dev->fifo_enabled)
|
||||||
dev->xmit_fifo_pos = 0;
|
fifo_reset_evt(dev->xmit_fifo);
|
||||||
|
else
|
||||||
|
fifo_reset(dev->xmit_fifo);
|
||||||
}
|
}
|
||||||
switch ((val >> 6) & 0x03) {
|
switch ((val >> 6) & 0x03) {
|
||||||
case 0:
|
case 0:
|
||||||
dev->rcvr_fifo_len = 1;
|
fifo_set_trigger_len(dev->rcvr_fifo, 1);
|
||||||
break;
|
break;
|
||||||
case 1:
|
case 1:
|
||||||
dev->rcvr_fifo_len = 4;
|
fifo_set_trigger_len(dev->rcvr_fifo, 4);
|
||||||
break;
|
break;
|
||||||
case 2:
|
case 2:
|
||||||
dev->rcvr_fifo_len = 8;
|
fifo_set_trigger_len(dev->rcvr_fifo, 8);
|
||||||
break;
|
break;
|
||||||
case 3:
|
case 3:
|
||||||
dev->rcvr_fifo_len = 14;
|
fifo_set_trigger_len(dev->rcvr_fifo, 14);
|
||||||
break;
|
|
||||||
default:
|
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
|
fifo_set_trigger_len(dev->xmit_fifo, 16);
|
||||||
dev->out_new = 0xffff;
|
dev->out_new = 0xffff;
|
||||||
serial_log("FIFO now %sabled, receive FIFO length = %i\n", dev->fifo_enabled ? "en" : "dis", dev->rcvr_fifo_len);
|
serial_log("FIFO now %sabled\n", dev->fifo_enabled ? "en" : "dis");
|
||||||
}
|
}
|
||||||
break;
|
break;
|
||||||
case 3:
|
case 3:
|
||||||
@@ -600,9 +559,11 @@ serial_write(uint16_t addr, uint8_t val, void *p)
|
|||||||
break;
|
break;
|
||||||
case 4:
|
case 4:
|
||||||
if ((val & 2) && !(dev->mctrl & 2)) {
|
if ((val & 2) && !(dev->mctrl & 2)) {
|
||||||
if (dev->sd && dev->sd->rcr_callback)
|
if (dev->sd && dev->sd->rcr_callback) {
|
||||||
|
serial_log("RTS toggle callback\n");
|
||||||
dev->sd->rcr_callback(dev, dev->sd->priv);
|
dev->sd->rcr_callback(dev, dev->sd->priv);
|
||||||
}
|
}
|
||||||
|
}
|
||||||
if (!(val & 8) && (dev->mctrl & 8))
|
if (!(val & 8) && (dev->mctrl & 8))
|
||||||
serial_do_irq(dev, 0);
|
serial_do_irq(dev, 0);
|
||||||
if ((val ^ dev->mctrl) & 0x10)
|
if ((val ^ dev->mctrl) & 0x10)
|
||||||
@@ -624,8 +585,9 @@ serial_write(uint16_t addr, uint8_t val, void *p)
|
|||||||
|
|
||||||
dev->msr = new_msr;
|
dev->msr = new_msr;
|
||||||
|
|
||||||
dev->xmit_fifo_pos = dev->rcvr_fifo_pos = 0;
|
/* TODO: Why reset the FIFO's here?! */
|
||||||
dev->rcvr_fifo_full = 0;
|
fifo_reset(dev->xmit_fifo);
|
||||||
|
fifo_reset(dev->rcvr_fifo);
|
||||||
}
|
}
|
||||||
break;
|
break;
|
||||||
case 5:
|
case 5:
|
||||||
@@ -674,41 +636,16 @@ serial_read(uint16_t addr, void *p)
|
|||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
|
|
||||||
/* Clear timeout. */
|
if (dev->fifo_enabled) {
|
||||||
serial_clear_timeout(dev);
|
|
||||||
|
|
||||||
if ((dev->type >= SERIAL_16550) && dev->fifo_enabled) {
|
|
||||||
/* FIFO mode. */
|
/* FIFO mode. */
|
||||||
|
serial_clear_timeout(dev);
|
||||||
|
ret = fifo_read_evt(dev->rcvr_fifo);
|
||||||
|
|
||||||
if (dev->rcvr_fifo_full || (dev->rcvr_fifo_pos != dev->rcvr_fifo_end)) {
|
if (dev->lsr & 0x01)
|
||||||
/* There is data in the FIFO. */
|
|
||||||
ret = dev->rcvr_fifo[dev->rcvr_fifo_pos];
|
|
||||||
dev->rcvr_fifo_pos = (dev->rcvr_fifo_pos + 1) & 0x0f;
|
|
||||||
|
|
||||||
/* Make sure to clear the FIFO full condition. */
|
|
||||||
dev->rcvr_fifo_full = 0;
|
|
||||||
|
|
||||||
if (abs(dev->rcvr_fifo_pos - dev->rcvr_fifo_end) < dev->rcvr_fifo_len) {
|
|
||||||
/* Amount of data in the FIFO below trigger level,
|
|
||||||
clear Data Ready interrupt. */
|
|
||||||
dev->int_status &= ~SERIAL_INT_RECEIVE;
|
|
||||||
serial_update_ints(dev);
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Make sure the Data Ready bit of the LSR is set if we still have
|
|
||||||
bytes left in the FIFO. */
|
|
||||||
if (dev->rcvr_fifo_pos != dev->rcvr_fifo_end) {
|
|
||||||
dev->lsr |= 0x01;
|
|
||||||
/* There are bytes left in the FIFO, activate the FIFO Timeout timer. */
|
|
||||||
timer_on_auto(&dev->timeout_timer, 4.0 * dev->bits * dev->transmit_period);
|
timer_on_auto(&dev->timeout_timer, 4.0 * dev->bits * dev->transmit_period);
|
||||||
} else
|
|
||||||
dev->lsr &= 0xfe;
|
|
||||||
}
|
|
||||||
} else {
|
} else {
|
||||||
/* Non-FIFO mode. */
|
/* Non-FIFO mode. */
|
||||||
|
ret = dev->dat;
|
||||||
ret = (uint8_t) (dev->out_new & 0xffff);
|
|
||||||
dev->out_new = 0xffff;
|
|
||||||
|
|
||||||
/* Always clear Data Ready interrupt. */
|
/* Always clear Data Ready interrupt. */
|
||||||
dev->lsr &= 0xfe;
|
dev->lsr &= 0xfe;
|
||||||
@@ -716,7 +653,7 @@ serial_read(uint16_t addr, void *p)
|
|||||||
serial_update_ints(dev);
|
serial_update_ints(dev);
|
||||||
}
|
}
|
||||||
|
|
||||||
// serial_log("Read data: %02X\n", ret);
|
serial_log("Read data: %02X\n", ret);
|
||||||
break;
|
break;
|
||||||
case 1:
|
case 1:
|
||||||
if (dev->lcr & 0x80)
|
if (dev->lcr & 0x80)
|
||||||
@@ -759,7 +696,6 @@ serial_read(uint16_t addr, void *p)
|
|||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
|
|
||||||
// serial_log("UART: Read %02X from port %02X\n", ret, addr);
|
|
||||||
serial_log("UART: [%04X:%08X] Read %02X from port %02X\n", CS, cpu_state.pc, ret, addr);
|
serial_log("UART: [%04X:%08X] Read %02X from port %02X\n", CS, cpu_state.pc, ret, addr);
|
||||||
return ret;
|
return ret;
|
||||||
}
|
}
|
||||||
@@ -801,6 +737,42 @@ serial_setup(serial_t *dev, uint16_t addr, uint8_t irq)
|
|||||||
dev->irq = irq;
|
dev->irq = irq;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static void
|
||||||
|
serial_rcvr_d_empty_evt(void *priv)
|
||||||
|
{
|
||||||
|
serial_t *dev = (serial_t *) priv;
|
||||||
|
|
||||||
|
dev->lsr = (dev->lsr & 0xfe) | !fifo_get_empty(dev->rcvr_fifo);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void
|
||||||
|
serial_rcvr_d_overrun_evt(void *priv)
|
||||||
|
{
|
||||||
|
serial_t *dev = (serial_t *) priv;
|
||||||
|
|
||||||
|
dev->lsr = (dev->lsr & 0xfd) | (fifo_get_overrun(dev->rcvr_fifo) << 1);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void
|
||||||
|
serial_rcvr_d_ready_evt(void *priv)
|
||||||
|
{
|
||||||
|
serial_t *dev = (serial_t *) priv;
|
||||||
|
|
||||||
|
dev->int_status = (dev->int_status & ~SERIAL_INT_RECEIVE) |
|
||||||
|
(fifo_get_ready(dev->rcvr_fifo) ? SERIAL_INT_RECEIVE : 0);
|
||||||
|
serial_update_ints(dev);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void
|
||||||
|
serial_xmit_d_empty_evt(void *priv)
|
||||||
|
{
|
||||||
|
serial_t *dev = (serial_t *) priv;
|
||||||
|
uint8_t is_empty = dev->fifo_enabled ? fifo_get_empty(dev->xmit_fifo) : dev->thr_empty;
|
||||||
|
|
||||||
|
dev->lsr = (dev->lsr & 0x9f) | (is_empty << 5) | ((dev->txsr_empty && is_empty) << 6);
|
||||||
|
dev->int_status = (dev->int_status & ~SERIAL_INT_TRANSMIT) | (is_empty ? SERIAL_INT_TRANSMIT : 0);
|
||||||
|
}
|
||||||
|
|
||||||
serial_t *
|
serial_t *
|
||||||
serial_attach_ex(int port,
|
serial_attach_ex(int port,
|
||||||
void (*rcr_callback)(struct serial_s *serial, void *p),
|
void (*rcr_callback)(struct serial_s *serial, void *p),
|
||||||
@@ -835,6 +807,9 @@ serial_close(void *priv)
|
|||||||
|
|
||||||
next_inst--;
|
next_inst--;
|
||||||
|
|
||||||
|
if (com_ports[dev->inst].enabled)
|
||||||
|
fifo_close(dev->rcvr_fifo);
|
||||||
|
|
||||||
free(dev);
|
free(dev);
|
||||||
}
|
}
|
||||||
|
|
||||||
@@ -843,6 +818,7 @@ serial_reset(void *priv)
|
|||||||
{
|
{
|
||||||
serial_t *dev = (serial_t *) priv;
|
serial_t *dev = (serial_t *) priv;
|
||||||
|
|
||||||
|
if (com_ports[dev->inst].enabled) {
|
||||||
timer_disable(&dev->transmit_timer);
|
timer_disable(&dev->transmit_timer);
|
||||||
timer_disable(&dev->timeout_timer);
|
timer_disable(&dev->timeout_timer);
|
||||||
timer_disable(&dev->receive_timer);
|
timer_disable(&dev->receive_timer);
|
||||||
@@ -850,12 +826,16 @@ serial_reset(void *priv)
|
|||||||
dev->lsr = dev->thr = dev->mctrl = dev->rcr = 0x00;
|
dev->lsr = dev->thr = dev->mctrl = dev->rcr = 0x00;
|
||||||
dev->iir = dev->ier = dev->lcr = dev->msr = 0x00;
|
dev->iir = dev->ier = dev->lcr = dev->msr = 0x00;
|
||||||
dev->dat = dev->int_status = dev->scratch = dev->fcr = 0x00;
|
dev->dat = dev->int_status = dev->scratch = dev->fcr = 0x00;
|
||||||
dev->fifo_enabled = dev->rcvr_fifo_len = dev->bits = dev->data_bits = 0x00;
|
dev->fifo_enabled = dev->bits = 0x000;
|
||||||
dev->baud_cycles = dev->rcvr_fifo_full = dev->txsr = dev->out = 0x00;
|
dev->data_bits = dev->baud_cycles = 0x00;
|
||||||
|
dev->txsr = 0x00;
|
||||||
|
dev->txsr_empty = 0x01;
|
||||||
|
dev->thr_empty = 0x0001;
|
||||||
|
|
||||||
dev->dlab = dev->out_new = 0x0000;
|
dev->dlab = dev->out_new = 0x0000;
|
||||||
|
|
||||||
dev->rcvr_fifo_pos = dev->xmit_fifo_pos = dev->rcvr_fifo_end = dev->xmit_fifo_end = 0x00;
|
if (dev->rcvr_fifo != NULL)
|
||||||
|
fifo_reset(dev->rcvr_fifo);
|
||||||
|
|
||||||
serial_reset_port(dev);
|
serial_reset_port(dev);
|
||||||
|
|
||||||
@@ -864,6 +844,7 @@ serial_reset(void *priv)
|
|||||||
|
|
||||||
serial_transmit_period(dev);
|
serial_transmit_period(dev);
|
||||||
serial_update_speed(dev);
|
serial_update_speed(dev);
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
static void *
|
static void *
|
||||||
@@ -880,7 +861,6 @@ serial_init(const device_t *info)
|
|||||||
memset(&(serial_devices[next_inst]), 0, sizeof(serial_device_t));
|
memset(&(serial_devices[next_inst]), 0, sizeof(serial_device_t));
|
||||||
dev->sd = &(serial_devices[next_inst]);
|
dev->sd = &(serial_devices[next_inst]);
|
||||||
dev->sd->serial = dev;
|
dev->sd->serial = dev;
|
||||||
serial_reset_port(dev);
|
|
||||||
if (next_inst == 3)
|
if (next_inst == 3)
|
||||||
serial_setup(dev, COM4_ADDR, COM4_IRQ);
|
serial_setup(dev, COM4_ADDR, COM4_IRQ);
|
||||||
else if (next_inst == 2)
|
else if (next_inst == 2)
|
||||||
@@ -902,6 +882,22 @@ serial_init(const device_t *info)
|
|||||||
timer_add(&dev->receive_timer, serial_receive_timer, dev, 0);
|
timer_add(&dev->receive_timer, serial_receive_timer, dev, 0);
|
||||||
serial_transmit_period(dev);
|
serial_transmit_period(dev);
|
||||||
serial_update_speed(dev);
|
serial_update_speed(dev);
|
||||||
|
|
||||||
|
dev->rcvr_fifo = fifo64_init();
|
||||||
|
fifo_set_priv(dev->rcvr_fifo, dev);
|
||||||
|
fifo_set_d_empty_evt(dev->rcvr_fifo, serial_rcvr_d_empty_evt);
|
||||||
|
fifo_set_d_overrun_evt(dev->rcvr_fifo, serial_rcvr_d_overrun_evt);
|
||||||
|
fifo_set_d_ready_evt(dev->rcvr_fifo, serial_rcvr_d_ready_evt);
|
||||||
|
fifo_reset_evt(dev->rcvr_fifo);
|
||||||
|
fifo_set_len(dev->rcvr_fifo, 16);
|
||||||
|
|
||||||
|
dev->xmit_fifo = fifo64_init();
|
||||||
|
fifo_set_priv(dev->xmit_fifo, dev);
|
||||||
|
fifo_set_d_empty_evt(dev->xmit_fifo, serial_xmit_d_empty_evt);
|
||||||
|
fifo_reset_evt(dev->xmit_fifo);
|
||||||
|
fifo_set_len(dev->xmit_fifo, 16);
|
||||||
|
|
||||||
|
serial_reset_port(dev);
|
||||||
}
|
}
|
||||||
|
|
||||||
next_inst++;
|
next_inst++;
|
||||||
|
@@ -25,6 +25,7 @@
|
|||||||
#define HAVE_STDARG_H
|
#define HAVE_STDARG_H
|
||||||
#include <86box/86box.h>
|
#include <86box/86box.h>
|
||||||
#include <86box/device.h>
|
#include <86box/device.h>
|
||||||
|
#include <86box/fifo.h>
|
||||||
#include <86box/timer.h>
|
#include <86box/timer.h>
|
||||||
#include <86box/serial.h>
|
#include <86box/serial.h>
|
||||||
#include <86box/serial_passthrough.h>
|
#include <86box/serial_passthrough.h>
|
||||||
@@ -78,7 +79,7 @@ host_to_serial_cb(void *priv)
|
|||||||
* can never fetch the bytes in time, so check if the fifo is full if in
|
* can never fetch the bytes in time, so check if the fifo is full if in
|
||||||
* fifo mode or if lsr has bit 0 set if not in fifo mode */
|
* fifo mode or if lsr has bit 0 set if not in fifo mode */
|
||||||
if ((dev->serial->type >= SERIAL_16550) && dev->serial->fifo_enabled) {
|
if ((dev->serial->type >= SERIAL_16550) && dev->serial->fifo_enabled) {
|
||||||
if (dev->serial->rcvr_fifo_full) {
|
if (fifo_get_full(dev->serial->rcvr_fifo)) {
|
||||||
goto no_write_to_machine;
|
goto no_write_to_machine;
|
||||||
}
|
}
|
||||||
} else {
|
} else {
|
||||||
|
582
src/fifo.c
Normal file
582
src/fifo.c
Normal file
@@ -0,0 +1,582 @@
|
|||||||
|
/*
|
||||||
|
* 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.
|
||||||
|
*
|
||||||
|
* FIFO infrastructure.
|
||||||
|
*
|
||||||
|
* Authors: Miran Grca, <mgrca8@gmail.com>
|
||||||
|
*
|
||||||
|
* Copyright 2023 Miran Grca.
|
||||||
|
*/
|
||||||
|
#include <stdarg.h>
|
||||||
|
#include <stdint.h>
|
||||||
|
#include <stdio.h>
|
||||||
|
#include <stdlib.h>
|
||||||
|
#include <string.h>
|
||||||
|
#ifdef FIFO_STANDALONE
|
||||||
|
#define fatal printf
|
||||||
|
#define pclog_ex printf
|
||||||
|
#define pclog printf
|
||||||
|
#include "include/86box/fifo.h"
|
||||||
|
#else
|
||||||
|
#define HAVE_STDARG_H
|
||||||
|
#include <86box/86box.h>
|
||||||
|
#include <86box/fifo.h>
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#ifdef ENABLE_FIFO_LOG
|
||||||
|
int fifo_do_log = ENABLE_FIFO_LOG;
|
||||||
|
|
||||||
|
static void
|
||||||
|
fifo_log(const char *fmt, ...)
|
||||||
|
{
|
||||||
|
va_list ap;
|
||||||
|
|
||||||
|
if (fifo_do_log) {
|
||||||
|
va_start(ap, fmt);
|
||||||
|
pclog_ex(fmt, ap);
|
||||||
|
va_end(ap);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
#else
|
||||||
|
# define fifo_log(fmt, ...)
|
||||||
|
#endif
|
||||||
|
|
||||||
|
int
|
||||||
|
fifo_get_count(void *priv)
|
||||||
|
{
|
||||||
|
fifo_t *fifo = (fifo_t *) priv;
|
||||||
|
int ret = fifo->len;
|
||||||
|
|
||||||
|
if (fifo->end == fifo->start)
|
||||||
|
ret = fifo->full ? fifo->len : 0;
|
||||||
|
else
|
||||||
|
ret = abs(fifo->end - fifo->start);
|
||||||
|
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
void
|
||||||
|
fifo_write(uint8_t val, void *priv)
|
||||||
|
{
|
||||||
|
fifo_t *fifo = (fifo_t *) priv;
|
||||||
|
|
||||||
|
fifo->d_full = fifo->d_empty = 0;
|
||||||
|
fifo->d_ready = fifo->d_overrun = 0;
|
||||||
|
|
||||||
|
if (fifo->full)
|
||||||
|
fifo->overrun = 1;
|
||||||
|
else {
|
||||||
|
fifo->buf[fifo->end] = val;
|
||||||
|
fifo->end = (fifo->end + 1) & 0x0f;
|
||||||
|
|
||||||
|
if (fifo->end == fifo->start)
|
||||||
|
fifo->full = 1;
|
||||||
|
|
||||||
|
fifo->empty = 0;
|
||||||
|
|
||||||
|
if (fifo_get_count(fifo) >= fifo->trigger_len)
|
||||||
|
fifo->ready = 1;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
void
|
||||||
|
fifo_write_evt(uint8_t val, void *priv)
|
||||||
|
{
|
||||||
|
fifo_t *fifo = (fifo_t *) priv;
|
||||||
|
|
||||||
|
fifo->d_full = fifo->d_empty = 0;
|
||||||
|
fifo->d_ready = fifo->d_overrun = 0;
|
||||||
|
|
||||||
|
if (fifo->full) {
|
||||||
|
fifo->d_overrun = (fifo->overrun != 1);
|
||||||
|
fifo->overrun = 1;
|
||||||
|
if (fifo->d_overrun && (fifo->d_overrun_evt != NULL))
|
||||||
|
fifo->d_overrun_evt(fifo->priv);
|
||||||
|
} else {
|
||||||
|
fifo->buf[fifo->end] = val;
|
||||||
|
fifo->end = (fifo->end + 1) & 0x0f;
|
||||||
|
|
||||||
|
if (fifo->end == fifo->start) {
|
||||||
|
fifo->d_full = (fifo->full != 1);
|
||||||
|
fifo->full = 1;
|
||||||
|
if (fifo->d_full && (fifo->d_full_evt != NULL))
|
||||||
|
fifo->d_full_evt(fifo->priv);
|
||||||
|
}
|
||||||
|
|
||||||
|
fifo->d_empty = (fifo->empty != 0);
|
||||||
|
fifo->empty = 0;
|
||||||
|
if (fifo->d_empty && (fifo->d_empty_evt != NULL))
|
||||||
|
fifo->d_empty_evt(fifo->priv);
|
||||||
|
|
||||||
|
if (fifo_get_count(fifo) >= fifo->trigger_len) {
|
||||||
|
fifo->d_ready = (fifo->ready != 1);
|
||||||
|
fifo->ready = 1;
|
||||||
|
if (fifo->d_ready && (fifo->d_ready_evt != NULL))
|
||||||
|
fifo->d_ready_evt(fifo->priv);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
uint8_t
|
||||||
|
fifo_read(void *priv)
|
||||||
|
{
|
||||||
|
fifo_t *fifo = (fifo_t *) priv;
|
||||||
|
uint8_t ret = 0x00;
|
||||||
|
int count;
|
||||||
|
|
||||||
|
if (!fifo->empty) {
|
||||||
|
ret = fifo->buf[fifo->start];
|
||||||
|
fifo->start = (fifo->start + 1) & 0x0f;
|
||||||
|
|
||||||
|
fifo->full = 0;
|
||||||
|
|
||||||
|
count = fifo_get_count(fifo);
|
||||||
|
|
||||||
|
if (count < fifo->trigger_len) {
|
||||||
|
fifo->ready = 0;
|
||||||
|
|
||||||
|
if (count == 0)
|
||||||
|
fifo->empty = 1;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
uint8_t
|
||||||
|
fifo_read_evt(void *priv)
|
||||||
|
{
|
||||||
|
fifo_t *fifo = (fifo_t *) priv;
|
||||||
|
uint8_t ret = 0x00;
|
||||||
|
int count;
|
||||||
|
|
||||||
|
fifo->d_full = fifo->d_empty = 0;
|
||||||
|
fifo->d_ready = 0;
|
||||||
|
|
||||||
|
if (!fifo->empty) {
|
||||||
|
ret = fifo->buf[fifo->start];
|
||||||
|
fifo->start = (fifo->start + 1) & 0x0f;
|
||||||
|
|
||||||
|
fifo->d_full = (fifo->full != 0);
|
||||||
|
fifo->full = 0;
|
||||||
|
if (fifo->d_full && (fifo->d_full_evt != NULL))
|
||||||
|
fifo->d_full_evt(fifo->priv);
|
||||||
|
|
||||||
|
count = fifo_get_count(fifo);
|
||||||
|
|
||||||
|
if (count < fifo->trigger_len) {
|
||||||
|
fifo->d_ready = (fifo->ready != 0);
|
||||||
|
fifo->ready = 0;
|
||||||
|
if (fifo->d_ready && (fifo->d_ready_evt != NULL))
|
||||||
|
fifo->d_ready_evt(fifo->priv);
|
||||||
|
|
||||||
|
if (count == 0) {
|
||||||
|
fifo->d_empty = (fifo->empty != 1);
|
||||||
|
fifo->empty = 1;
|
||||||
|
if (fifo->d_empty && (fifo->d_empty_evt != NULL))
|
||||||
|
fifo->d_empty_evt(fifo->priv);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
void
|
||||||
|
fifo_clear_overrun(void *priv)
|
||||||
|
{
|
||||||
|
fifo_t *fifo = (fifo_t *) priv;
|
||||||
|
|
||||||
|
fifo->d_overrun = (fifo->overrun != 0);
|
||||||
|
fifo->overrun = 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
int
|
||||||
|
fifo_get_full(void *priv)
|
||||||
|
{
|
||||||
|
fifo_t *fifo = (fifo_t *) priv;
|
||||||
|
|
||||||
|
return fifo->full;
|
||||||
|
}
|
||||||
|
|
||||||
|
int
|
||||||
|
fifo_get_d_full(void *priv)
|
||||||
|
{
|
||||||
|
fifo_t *fifo = (fifo_t *) priv;
|
||||||
|
int ret = fifo->d_full;
|
||||||
|
|
||||||
|
fifo->d_full = 0;
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
int
|
||||||
|
fifo_get_empty(void *priv)
|
||||||
|
{
|
||||||
|
fifo_t *fifo = (fifo_t *) priv;
|
||||||
|
|
||||||
|
return fifo->empty;
|
||||||
|
}
|
||||||
|
|
||||||
|
int
|
||||||
|
fifo_get_d_empty(void *priv)
|
||||||
|
{
|
||||||
|
fifo_t *fifo = (fifo_t *) priv;
|
||||||
|
int ret = fifo->d_empty;
|
||||||
|
|
||||||
|
fifo->d_empty = 0;
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
int
|
||||||
|
fifo_get_overrun(void *priv)
|
||||||
|
{
|
||||||
|
fifo_t *fifo = (fifo_t *) priv;
|
||||||
|
|
||||||
|
return fifo->overrun;
|
||||||
|
}
|
||||||
|
|
||||||
|
int
|
||||||
|
fifo_get_d_overrun(void *priv)
|
||||||
|
{
|
||||||
|
fifo_t *fifo = (fifo_t *) priv;
|
||||||
|
int ret = fifo->d_overrun;
|
||||||
|
|
||||||
|
fifo->d_overrun = 0;
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
int
|
||||||
|
fifo_get_ready(void *priv)
|
||||||
|
{
|
||||||
|
fifo_t *fifo = (fifo_t *) priv;
|
||||||
|
|
||||||
|
return fifo->ready;
|
||||||
|
}
|
||||||
|
|
||||||
|
int
|
||||||
|
fifo_get_d_ready(void *priv)
|
||||||
|
{
|
||||||
|
fifo_t *fifo = (fifo_t *) priv;
|
||||||
|
int ret = fifo->d_ready;
|
||||||
|
|
||||||
|
fifo->d_ready = 0;
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
int
|
||||||
|
fifo_get_trigger_len(void *priv)
|
||||||
|
{
|
||||||
|
fifo_t *fifo = (fifo_t *) priv;
|
||||||
|
|
||||||
|
return fifo->trigger_len;
|
||||||
|
}
|
||||||
|
|
||||||
|
void
|
||||||
|
fifo_set_trigger_len(void *priv, int trigger_len)
|
||||||
|
{
|
||||||
|
fifo_t *fifo = (fifo_t *) priv;
|
||||||
|
|
||||||
|
fifo->trigger_len = trigger_len;
|
||||||
|
}
|
||||||
|
|
||||||
|
void
|
||||||
|
fifo_set_len(void *priv, int len)
|
||||||
|
{
|
||||||
|
fifo_t *fifo = (fifo_t *) priv;
|
||||||
|
|
||||||
|
fifo->len = len;
|
||||||
|
}
|
||||||
|
|
||||||
|
void
|
||||||
|
fifo_set_d_full_evt(void *priv, void (*d_full_evt)(void *))
|
||||||
|
{
|
||||||
|
fifo_t *fifo = (fifo_t *) priv;
|
||||||
|
|
||||||
|
fifo->d_full_evt = d_full_evt;
|
||||||
|
}
|
||||||
|
|
||||||
|
void
|
||||||
|
fifo_set_d_empty_evt(void *priv, void (*d_empty_evt)(void *))
|
||||||
|
{
|
||||||
|
fifo_t *fifo = (fifo_t *) priv;
|
||||||
|
|
||||||
|
fifo->d_empty_evt = d_empty_evt;
|
||||||
|
}
|
||||||
|
|
||||||
|
void
|
||||||
|
fifo_set_d_overrun_evt(void *priv, void (*d_overrun_evt)(void *))
|
||||||
|
{
|
||||||
|
fifo_t *fifo = (fifo_t *) priv;
|
||||||
|
|
||||||
|
fifo->d_overrun_evt = d_overrun_evt;
|
||||||
|
}
|
||||||
|
|
||||||
|
void
|
||||||
|
fifo_set_d_ready_evt(void *priv, void (*d_ready_evt)(void *))
|
||||||
|
{
|
||||||
|
fifo_t *fifo = (fifo_t *) priv;
|
||||||
|
|
||||||
|
fifo->d_ready_evt = d_ready_evt;
|
||||||
|
}
|
||||||
|
|
||||||
|
void
|
||||||
|
fifo_set_priv(void *priv, void *sub_priv)
|
||||||
|
{
|
||||||
|
fifo_t *fifo = (fifo_t *) priv;
|
||||||
|
|
||||||
|
fifo->priv = sub_priv;
|
||||||
|
}
|
||||||
|
|
||||||
|
void
|
||||||
|
fifo_reset(void *priv)
|
||||||
|
{
|
||||||
|
fifo_t *fifo = (fifo_t *) priv;
|
||||||
|
|
||||||
|
fifo->start = fifo->end = 0;
|
||||||
|
fifo->full = fifo->overrun = 0;
|
||||||
|
fifo->empty = 1;
|
||||||
|
fifo->ready = 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
void
|
||||||
|
fifo_reset_evt(void *priv)
|
||||||
|
{
|
||||||
|
fifo_t *fifo = (fifo_t *) priv;
|
||||||
|
|
||||||
|
fifo->start = fifo->end = 0;
|
||||||
|
fifo->full = fifo->overrun = 0;
|
||||||
|
fifo->empty = 1;
|
||||||
|
fifo->ready = 0;
|
||||||
|
fifo->d_full = fifo->d_overrun = 0;
|
||||||
|
fifo->d_empty = fifo->d_ready = 0;
|
||||||
|
|
||||||
|
if (fifo->d_full_evt != NULL)
|
||||||
|
fifo->d_full_evt(fifo->priv);
|
||||||
|
|
||||||
|
if (fifo->d_overrun_evt != NULL)
|
||||||
|
fifo->d_overrun_evt(fifo->priv);
|
||||||
|
|
||||||
|
if (fifo->d_empty_evt != NULL)
|
||||||
|
fifo->d_empty_evt(fifo->priv);
|
||||||
|
|
||||||
|
if (fifo->d_ready_evt != NULL)
|
||||||
|
fifo->d_ready_evt(fifo->priv);
|
||||||
|
}
|
||||||
|
|
||||||
|
void
|
||||||
|
fifo_close(void *priv)
|
||||||
|
{
|
||||||
|
free(priv);
|
||||||
|
}
|
||||||
|
|
||||||
|
void *
|
||||||
|
fifo_init(int len)
|
||||||
|
{
|
||||||
|
void *fifo = NULL;
|
||||||
|
|
||||||
|
if (len == 64)
|
||||||
|
fifo = (void *) calloc(1, sizeof(fifo64_t));
|
||||||
|
else if (len == 16)
|
||||||
|
fifo = (void *) calloc(1, sizeof(fifo16_t));
|
||||||
|
else {
|
||||||
|
fatal("FIFO : Invalid FIFO length: %i\n", len);
|
||||||
|
return NULL;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (fifo == NULL)
|
||||||
|
fatal("FIFO%i: Failed to allocate memory for the FIFO\n", len);
|
||||||
|
else
|
||||||
|
((fifo_t *) fifo)->len = len;
|
||||||
|
|
||||||
|
return fifo;
|
||||||
|
}
|
||||||
|
|
||||||
|
#ifdef FIFO_STANDALONE
|
||||||
|
enum {
|
||||||
|
SERIAL_INT_LSR = 1,
|
||||||
|
SERIAL_INT_RECEIVE = 2,
|
||||||
|
SERIAL_INT_TRANSMIT = 4,
|
||||||
|
SERIAL_INT_MSR = 8,
|
||||||
|
SERIAL_INT_TIMEOUT = 16
|
||||||
|
};
|
||||||
|
|
||||||
|
typedef struct
|
||||||
|
{
|
||||||
|
uint8_t lsr, int_status, tsr, tsr_empty;
|
||||||
|
|
||||||
|
fifo16_t *rcvr_fifo, *xmit_fifo;
|
||||||
|
} serial_t;
|
||||||
|
|
||||||
|
static void
|
||||||
|
serial_receive_timer(fifo16_t *f16, uint8_t val)
|
||||||
|
{
|
||||||
|
fifo_write_evt(val, f16);
|
||||||
|
|
||||||
|
printf("Write %02X to FIFO [F: %i, E: %i, O: %i, R: %i]\n", val,
|
||||||
|
fifo_get_full(f16), fifo_get_empty(f16),
|
||||||
|
fifo_get_overrun(f16), fifo_get_ready(f16));
|
||||||
|
|
||||||
|
/*
|
||||||
|
if (fifo_get_d_overrun(f16))
|
||||||
|
dev->lsr = (dev->lsr & 0xfd) | (fifo_get_overrun(f16) << 1);
|
||||||
|
*/
|
||||||
|
if (fifo_get_d_overrun(f16)) printf(" FIFO overrun state changed: %i -> %i\n",
|
||||||
|
!fifo_get_overrun(f16), fifo_get_overrun(f16));
|
||||||
|
|
||||||
|
/*
|
||||||
|
if (fifo_get_d_empty(f16)) {
|
||||||
|
dev->lsr = (dev->lsr & 0xfe) | !fifo_get_empty(f16);
|
||||||
|
timer_on_auto(&dev->timeout_timer, 4.0 * dev->bits * dev->transmit_period);
|
||||||
|
}
|
||||||
|
*/
|
||||||
|
if (fifo_get_d_empty(f16)) printf(" FIFO empty state changed: %i -> %i\n",
|
||||||
|
!fifo_get_empty(f16), fifo_get_empty(f16));
|
||||||
|
|
||||||
|
/*
|
||||||
|
if (fifo_get_d_ready(f16)) {
|
||||||
|
dev->int_status = (dev->int_status & ~SERIAL_INT_RECEIVE) |
|
||||||
|
(fifo_get_ready(f16) ? SERIAL_INT_RECEIVE : 0);
|
||||||
|
serial_update_ints();
|
||||||
|
}
|
||||||
|
*/
|
||||||
|
if (fifo_get_d_ready(f16)) printf(" FIFO ready state changed: %i -> %i\n",
|
||||||
|
!fifo_get_ready(f16), fifo_get_ready(f16));
|
||||||
|
}
|
||||||
|
|
||||||
|
static uint8_t
|
||||||
|
serial_read(fifo16_t *f16)
|
||||||
|
{
|
||||||
|
uint8_t ret;
|
||||||
|
|
||||||
|
ret = fifo_read_evt(f16);
|
||||||
|
|
||||||
|
printf("Read %02X from FIFO [F: %i, E: %i, O: %i, R: %i]\n", ret,
|
||||||
|
fifo_get_full(f16), fifo_get_empty(f16),
|
||||||
|
fifo_get_overrun(f16), fifo_get_ready(f16));
|
||||||
|
|
||||||
|
/*
|
||||||
|
if (fifo_get_d_ready(f16)) {
|
||||||
|
dev->int_status = (dev->int_status & ~SERIAL_INT_RECEIVE) |
|
||||||
|
(fifo_get_ready(f16) ? SERIAL_INT_RECEIVE : 0);
|
||||||
|
serial_update_ints();
|
||||||
|
}
|
||||||
|
*/
|
||||||
|
if (fifo_get_d_ready(f16)) printf(" FIFO ready state changed: %i -> %i\n",
|
||||||
|
!fifo_get_ready(f16), fifo_get_ready(f16));
|
||||||
|
|
||||||
|
/*
|
||||||
|
if (fifo_get_d_empty(f16)) {
|
||||||
|
dev->lsr = (dev->lsr & 0xfe) | !fifo_get_empty(f16);
|
||||||
|
timer_on_auto(&dev->timeout_timer, 4.0 * dev->bits * dev->transmit_period);
|
||||||
|
}
|
||||||
|
*/
|
||||||
|
if (fifo_get_d_empty(f16)) printf(" FIFO empty state changed: %i -> %i\n",
|
||||||
|
!fifo_get_empty(f16), fifo_get_empty(f16));
|
||||||
|
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
static void
|
||||||
|
serial_xmit_d_empty_evt(void *priv)
|
||||||
|
{
|
||||||
|
serial_t *dev = (serial_t *) priv;
|
||||||
|
|
||||||
|
dev->lsr = (dev->lsr & 0x9f) | (fifo_get_empty(dev->xmit_fifo) << 5) |
|
||||||
|
((dev->tsr_empty && fifo_get_empty(dev->xmit_fifo)) << 6);
|
||||||
|
dev->int_status = (dev->int_status & ~SERIAL_INT_TRANSMIT) |
|
||||||
|
(fifo_get_empty(dev->xmit_fifo) ? SERIAL_INT_TRANSMIT : 0);
|
||||||
|
// serial_update_ints();
|
||||||
|
|
||||||
|
printf("NS16550: serial_xmit_d_empty_evt(%08X): dev->lsr = %02X\n", priv, dev->lsr);
|
||||||
|
printf("NS16550: serial_xmit_d_empty_evt(%08X): dev->int_status = %02X\n", priv, dev->int_status);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void
|
||||||
|
serial_rcvr_d_empty_evt(void *priv)
|
||||||
|
{
|
||||||
|
serial_t *dev = (serial_t *) priv;
|
||||||
|
|
||||||
|
dev->lsr = (dev->lsr & 0xfe) | !fifo_get_empty(dev->rcvr_fifo);
|
||||||
|
// timer_on_auto(&dev->timeout_timer, 4.0 * dev->bits * dev->transmit_period);
|
||||||
|
|
||||||
|
printf("NS16550: serial_rcvr_d_empty_evt(%08X): dev->lsr = %02X\n", priv, dev->lsr);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void
|
||||||
|
serial_rcvr_d_overrun_evt(void *priv)
|
||||||
|
{
|
||||||
|
serial_t *dev = (serial_t *) priv;
|
||||||
|
|
||||||
|
dev->lsr = (dev->lsr & 0xfd) | (fifo_get_overrun(dev->rcvr_fifo) << 1);
|
||||||
|
|
||||||
|
printf("NS16550: serial_rcvr_d_overrun_evt(%08X): dev->lsr = %02X\n", priv, dev->lsr);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void
|
||||||
|
serial_rcvr_d_ready_evt(void *priv)
|
||||||
|
{
|
||||||
|
serial_t *dev = (serial_t *) priv;
|
||||||
|
|
||||||
|
dev->int_status = (dev->int_status & ~SERIAL_INT_RECEIVE) |
|
||||||
|
(fifo_get_ready(dev->rcvr_fifo) ? SERIAL_INT_RECEIVE : 0);
|
||||||
|
// serial_update_ints();
|
||||||
|
|
||||||
|
printf("NS16550: serial_rcvr_d_ready_evt(%08X): dev->int_status = %02X\n", priv, dev->int_status);
|
||||||
|
}
|
||||||
|
|
||||||
|
int
|
||||||
|
main(int argc, char *argv[])
|
||||||
|
{
|
||||||
|
uint8_t val, ret;
|
||||||
|
|
||||||
|
printf("Initializing serial...\n");
|
||||||
|
serial_t *dev = (serial_t *) calloc(1, sizeof(serial_t));
|
||||||
|
dev->tsr_empty = 1;
|
||||||
|
|
||||||
|
printf("Initializing dev->xmit_fifo...\n");
|
||||||
|
dev->xmit_fifo = fifo16_init();
|
||||||
|
fifo_set_trigger_len(dev->xmit_fifo, 255);
|
||||||
|
|
||||||
|
fifo_set_priv(dev->xmit_fifo, dev);
|
||||||
|
fifo_set_d_empty_evt(dev->xmit_fifo, serial_xmit_d_empty_evt);
|
||||||
|
|
||||||
|
printf("\nResetting dev->xmit_fifo...\n");
|
||||||
|
fifo_reset_evt(dev->xmit_fifo);
|
||||||
|
|
||||||
|
printf("\nInitializing dev->rcvr_fifo...\n");
|
||||||
|
dev->rcvr_fifo = fifo16_init();
|
||||||
|
fifo_set_trigger_len(dev->rcvr_fifo, 4);
|
||||||
|
|
||||||
|
fifo_set_priv(dev->rcvr_fifo, dev);
|
||||||
|
fifo_set_d_empty_evt(dev->rcvr_fifo, serial_rcvr_d_empty_evt);
|
||||||
|
fifo_set_d_overrun_evt(dev->rcvr_fifo, serial_rcvr_d_overrun_evt);
|
||||||
|
fifo_set_d_ready_evt(dev->rcvr_fifo, serial_rcvr_d_ready_evt);
|
||||||
|
|
||||||
|
printf("\nResetting dev->rcvr_fifo...\n");
|
||||||
|
fifo_reset_evt(dev->rcvr_fifo);
|
||||||
|
|
||||||
|
printf("\nSending/receiving data...\n");
|
||||||
|
serial_receive_timer(dev->rcvr_fifo, '8');
|
||||||
|
serial_receive_timer(dev->rcvr_fifo, '6');
|
||||||
|
ret = serial_read(dev->rcvr_fifo);
|
||||||
|
serial_receive_timer(dev->rcvr_fifo, 'B');
|
||||||
|
ret = serial_read(dev->rcvr_fifo);
|
||||||
|
serial_receive_timer(dev->rcvr_fifo, 'o');
|
||||||
|
ret = serial_read(dev->rcvr_fifo);
|
||||||
|
serial_receive_timer(dev->rcvr_fifo, 'x');
|
||||||
|
ret = serial_read(dev->rcvr_fifo);
|
||||||
|
ret = serial_read(dev->rcvr_fifo);
|
||||||
|
|
||||||
|
fifo_close(dev->rcvr_fifo);
|
||||||
|
fifo_close(dev->xmit_fifo);
|
||||||
|
|
||||||
|
free(dev);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
#endif
|
@@ -75,8 +75,10 @@ enum {
|
|||||||
GDB_REG_ES,
|
GDB_REG_ES,
|
||||||
GDB_REG_FS,
|
GDB_REG_FS,
|
||||||
GDB_REG_GS,
|
GDB_REG_GS,
|
||||||
|
#if 0
|
||||||
GDB_REG_FS_BASE,
|
GDB_REG_FS_BASE,
|
||||||
GDB_REG_GS_BASE,
|
GDB_REG_GS_BASE,
|
||||||
|
#endif
|
||||||
GDB_REG_CR0,
|
GDB_REG_CR0,
|
||||||
GDB_REG_CR2,
|
GDB_REG_CR2,
|
||||||
GDB_REG_CR3,
|
GDB_REG_CR3,
|
||||||
@@ -678,9 +680,11 @@ gdbstub_client_read_reg(int index, uint8_t *buf)
|
|||||||
*((uint16_t *) buf) = segment_regs[index - GDB_REG_CS]->seg;
|
*((uint16_t *) buf) = segment_regs[index - GDB_REG_CS]->seg;
|
||||||
break;
|
break;
|
||||||
|
|
||||||
|
#if 0
|
||||||
case GDB_REG_FS_BASE ... GDB_REG_GS_BASE:
|
case GDB_REG_FS_BASE ... GDB_REG_GS_BASE:
|
||||||
*((uint32_t *) buf) = segment_regs[(index - 16) + (GDB_REG_FS - GDB_REG_CS)]->base;
|
*((uint32_t *) buf) = segment_regs[(index - 16) + (GDB_REG_FS - GDB_REG_CS)]->base;
|
||||||
break;
|
break;
|
||||||
|
#endif
|
||||||
|
|
||||||
case GDB_REG_CR0 ... GDB_REG_CR4:
|
case GDB_REG_CR0 ... GDB_REG_CR4:
|
||||||
*((uint32_t *) buf) = *cr_regs[index - GDB_REG_CR0];
|
*((uint32_t *) buf) = *cr_regs[index - GDB_REG_CR0];
|
||||||
|
68
src/include/86box/fifo.h
Normal file
68
src/include/86box/fifo.h
Normal file
@@ -0,0 +1,68 @@
|
|||||||
|
/*
|
||||||
|
* 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.
|
||||||
|
*
|
||||||
|
* FIFO infrastructure header.
|
||||||
|
*
|
||||||
|
* Authors: Miran Grca, <mgrca8@gmail.com>
|
||||||
|
*
|
||||||
|
* Copyright 2023 Miran Grca.
|
||||||
|
*/
|
||||||
|
#define FIFO(size) \
|
||||||
|
typedef struct \
|
||||||
|
{ \
|
||||||
|
int start, end, \
|
||||||
|
trigger_len, len, \
|
||||||
|
empty, overrun, \
|
||||||
|
full, ready, \
|
||||||
|
d_empty, d_overrun, \
|
||||||
|
d_full, d_ready; \
|
||||||
|
\
|
||||||
|
void *priv; \
|
||||||
|
\
|
||||||
|
void (*d_empty_evt)(void *); \
|
||||||
|
void (*d_overrun_evt)(void *); \
|
||||||
|
void (*d_full_evt)(void *); \
|
||||||
|
void (*d_ready_evt)(void *); \
|
||||||
|
\
|
||||||
|
uint8_t buf[size]; \
|
||||||
|
} fifo## size ##_t;
|
||||||
|
|
||||||
|
FIFO()
|
||||||
|
|
||||||
|
FIFO(16)
|
||||||
|
#define fifo16_init() fifo_init(16)
|
||||||
|
|
||||||
|
FIFO(64)
|
||||||
|
#define fifo64_init() fifo_init(64)
|
||||||
|
|
||||||
|
extern int fifo_get_count(void *priv);
|
||||||
|
extern void fifo_write(uint8_t val, void *priv);
|
||||||
|
extern void fifo_write_evt(uint8_t val, void *priv);
|
||||||
|
extern uint8_t fifo_read(void *priv);
|
||||||
|
extern uint8_t fifo_read_evt(void *priv);
|
||||||
|
extern void fifo_clear_overrun(void *priv);
|
||||||
|
extern int fifo_get_full(void *priv);
|
||||||
|
extern int fifo_get_d_full(void *priv);
|
||||||
|
extern int fifo_get_empty(void *priv);
|
||||||
|
extern int fifo_get_d_empty(void *priv);
|
||||||
|
extern int fifo_get_overrun(void *priv);
|
||||||
|
extern int fifo_get_d_overrun(void *priv);
|
||||||
|
extern int fifo_get_ready(void *priv);
|
||||||
|
extern int fifo_get_d_ready(void *priv);
|
||||||
|
extern int fifo_get_trigger_len(void *priv);
|
||||||
|
extern void fifo_set_trigger_len(void *priv, int trigger_len);
|
||||||
|
extern void fifo_set_len(void *priv, int len);
|
||||||
|
extern void fifo_set_d_full_evt(void *priv, void (*d_full_evt)(void *));
|
||||||
|
extern void fifo_set_d_empty_evt(void *priv, void (*d_empty_evt)(void *));
|
||||||
|
extern void fifo_set_d_overrun_evt(void *priv, void (*d_overrun_evt)(void *));
|
||||||
|
extern void fifo_set_d_ready_evt(void *priv, void (*d_ready_evt)(void *));
|
||||||
|
extern void fifo_set_priv(void *priv, void *sub_priv);
|
||||||
|
extern void fifo_reset(void *priv);
|
||||||
|
extern void fifo_reset_evt(void *priv);
|
||||||
|
extern void fifo_close(void *priv);
|
||||||
|
extern void * fifo_init(int len);
|
@@ -65,29 +65,21 @@ typedef struct serial_s {
|
|||||||
uint8_t inst;
|
uint8_t inst;
|
||||||
uint8_t transmit_enabled;
|
uint8_t transmit_enabled;
|
||||||
uint8_t fifo_enabled;
|
uint8_t fifo_enabled;
|
||||||
uint8_t rcvr_fifo_len;
|
|
||||||
uint8_t bits;
|
uint8_t bits;
|
||||||
uint8_t data_bits;
|
uint8_t data_bits;
|
||||||
uint8_t baud_cycles;
|
uint8_t baud_cycles;
|
||||||
uint8_t rcvr_fifo_full;
|
|
||||||
uint8_t txsr;
|
uint8_t txsr;
|
||||||
uint8_t out;
|
uint8_t txsr_empty;
|
||||||
uint8_t msr_set;
|
uint8_t msr_set;
|
||||||
uint8_t pad;
|
|
||||||
uint8_t irq_state;
|
uint8_t irq_state;
|
||||||
uint8_t pad0;
|
|
||||||
|
|
||||||
uint16_t dlab;
|
uint16_t dlab;
|
||||||
uint16_t base_address;
|
uint16_t base_address;
|
||||||
uint16_t out_new;
|
uint16_t out_new;
|
||||||
uint16_t pad1;
|
uint16_t thr_empty;
|
||||||
|
|
||||||
uint8_t rcvr_fifo_pos;
|
void *rcvr_fifo;
|
||||||
uint8_t xmit_fifo_pos;
|
void *xmit_fifo;
|
||||||
uint8_t rcvr_fifo_end;
|
|
||||||
uint8_t xmit_fifo_end;
|
|
||||||
uint8_t rcvr_fifo[SERIAL_FIFO_SIZE];
|
|
||||||
uint8_t xmit_fifo[SERIAL_FIFO_SIZE];
|
|
||||||
|
|
||||||
pc_timer_t transmit_timer;
|
pc_timer_t transmit_timer;
|
||||||
pc_timer_t timeout_timer;
|
pc_timer_t timeout_timer;
|
||||||
|
@@ -2695,6 +2695,7 @@ mem_reset(void)
|
|||||||
}
|
}
|
||||||
memset(ram, 0x00, ram_size);
|
memset(ram, 0x00, ram_size);
|
||||||
ram2_size = m - (1 << 30);
|
ram2_size = m - (1 << 30);
|
||||||
|
/* Allocate 16 extra bytes of RAM to mitigate some dynarec recompiler memory access quirks. */
|
||||||
ram2 = (uint8_t *) plat_mmap(ram2_size + 16, 0); /* allocate and clear the RAM block above 1 GB */
|
ram2 = (uint8_t *) plat_mmap(ram2_size + 16, 0); /* allocate and clear the RAM block above 1 GB */
|
||||||
if (ram2 == NULL) {
|
if (ram2 == NULL) {
|
||||||
if (config_changed == 2)
|
if (config_changed == 2)
|
||||||
@@ -2703,17 +2704,18 @@ mem_reset(void)
|
|||||||
fatal("Failed to allocate secondary RAM block. Make sure you have enough RAM available.\n");
|
fatal("Failed to allocate secondary RAM block. Make sure you have enough RAM available.\n");
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
memset(ram2, 0x00, ram2_size);
|
memset(ram2, 0x00, ram2_size + 16);
|
||||||
} else
|
} else
|
||||||
#endif
|
#endif
|
||||||
{
|
{
|
||||||
ram_size = m;
|
ram_size = m;
|
||||||
|
/* Allocate 16 extra bytes of RAM to mitigate some dynarec recompiler memory access quirks. */
|
||||||
ram = (uint8_t *) plat_mmap(ram_size + 16, 0); /* allocate and clear the RAM block */
|
ram = (uint8_t *) plat_mmap(ram_size + 16, 0); /* allocate and clear the RAM block */
|
||||||
if (ram == NULL) {
|
if (ram == NULL) {
|
||||||
fatal("Failed to allocate RAM block. Make sure you have enough RAM available.\n");
|
fatal("Failed to allocate RAM block. Make sure you have enough RAM available.\n");
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
memset(ram, 0x00, ram_size);
|
memset(ram, 0x00, ram_size + 16);
|
||||||
if (mem_size > 1048576)
|
if (mem_size > 1048576)
|
||||||
ram2 = &(ram[1 << 30]);
|
ram2 = &(ram[1 << 30]);
|
||||||
}
|
}
|
||||||
|
@@ -564,8 +564,8 @@ CFLAGS += -Werror=implicit-int -Werror=implicit-function-declaration \
|
|||||||
# Create the (final) list of objects to build. #
|
# Create the (final) list of objects to build. #
|
||||||
#########################################################################
|
#########################################################################
|
||||||
MAINOBJ := 86box.o config.o log.o random.o timer.o io.o acpi.o apm.o dma.o ddma.o \
|
MAINOBJ := 86box.o config.o log.o random.o timer.o io.o acpi.o apm.o dma.o ddma.o \
|
||||||
nmi.o pic.o pit.o pit_fast.o port_6x.o port_92.o ppi.o pci.o mca.o fifo8.o \
|
nmi.o pic.o pit.o pit_fast.o port_6x.o port_92.o ppi.o pci.o mca.o fifo.o \
|
||||||
usb.o device.o nvr.o nvr_at.o nvr_ps2.o machine_status.o ini.o \
|
fifo8.o usb.o device.o nvr.o nvr_at.o nvr_ps2.o machine_status.o ini.o \
|
||||||
$(VNCOBJ)
|
$(VNCOBJ)
|
||||||
|
|
||||||
MEMOBJ := catalyst_flash.o i2c_eeprom.o intel_flash.o mem.o mmu_2386.o rom.o row.o \
|
MEMOBJ := catalyst_flash.o i2c_eeprom.o intel_flash.o mem.o mmu_2386.o rom.o row.o \
|
||||||
|
Reference in New Issue
Block a user