gdb/ser-go32.c - gdb
Global variables defined
Data types defined
Functions defined
Macros defined
Source code
- #include "defs.h"
- #include "gdbcmd.h"
- #include "serial.h"
- #define COM1ADDR 0x3f8
- #define COM2ADDR 0x2f8
- #define COM3ADDR 0x3e8
- #define COM4ADDR 0x3e0
- #define com_data 0
- #define com_dlbl 0
- #define com_ier 1
- #define com_dlbh 1
- #define com_iir 2
- #define com_fifo 2
- #define com_lctl 3
- #define com_cfcr 3
- #define com_mcr 4
- #define com_lsr 5
- #define com_msr 6
- #define COMTICK (1843200/16)
- #define SPEED_TOLERANCE 30
- #define IER_ERXRDY 0x1
- #define IER_ETXRDY 0x2
- #define IER_ERLS 0x4
- #define IER_EMSC 0x8
- #define IIR_FIFO_MASK 0xc0
- #define IIR_IMASK 0xf
- #define IIR_NOPEND 0x1
- #define IIR_RLS 0x6
- #define IIR_RXRDY 0x4
- #define IIR_RXTOUT 0xc
- #define IIR_TXRDY 0x2
- #define IIR_MLSC 0x0
- #define FIFO_ENABLE 0x01
- #define FIFO_RCV_RST 0x02
- #define FIFO_XMT_RST 0x04
- #define FIFO_DMA_MODE 0x08
- #define FIFO_TRIGGER_1 0x00
- #define FIFO_TRIGGER_4 0x40
- #define FIFO_TRIGGER_8 0x80
- #define FIFO_TRIGGER_14 0xc0
- #define CFCR_DLAB 0x80
- #define CFCR_SBREAK 0x40
- #define CFCR_PZERO 0x30
- #define CFCR_PONE 0x20
- #define CFCR_PEVEN 0x10
- #define CFCR_PODD 0x00
- #define CFCR_PENAB 0x08
- #define CFCR_STOPB 0x04
- #define CFCR_8BITS 0x03
- #define CFCR_7BITS 0x02
- #define CFCR_6BITS 0x01
- #define CFCR_5BITS 0x00
- #define MCR_LOOPBACK 0x10
- #define MCR_IENABLE 0x08
- #define MCR_DRS 0x04
- #define MCR_RTS 0x02
- #define MCR_DTR 0x01
- #define LSR_RCV_FIFO 0x80
- #define LSR_TSRE 0x40
- #define LSR_TXRDY 0x20
- #define LSR_BI 0x10
- #define LSR_FE 0x08
- #define LSR_PE 0x04
- #define LSR_OE 0x02
- #define LSR_RXRDY 0x01
- #define LSR_RCV_MASK 0x1f
- #define MSR_DCD 0x80
- #define MSR_RI 0x40
- #define MSR_DSR 0x20
- #define MSR_CTS 0x10
- #define MSR_DDCD 0x08
- #define MSR_TERI 0x04
- #define MSR_DDSR 0x02
- #define MSR_DCTS 0x01
- #include <time.h>
- #include <dos.h>
- #include <go32.h>
- #include <dpmi.h>
- typedef unsigned long u_long;
- #define FIFO_TRIGGER FIFO_TRIGGER_4
- #define CBSIZE 4096
- #define RAWHZ 18
- #ifdef DOS_STATS
- #define CNT_RX 16
- #define CNT_TX 17
- #define CNT_STRAY 18
- #define CNT_ORUN 19
- #define NCNT 20
- static int intrcnt;
- static size_t cnts[NCNT];
- static char *cntnames[NCNT] =
- {
-
- "mlsc", "nopend", "txrdy", "?3",
- "rxrdy", "?5", "rls", "?7",
- "?8", "?9", "?a", "?b",
- "rxtout", "?d", "?e", "?f",
-
- "rxcnt", "txcnt", "stray", "swoflo"
- };
- #define COUNT(x) cnts[x]++
- #else
- #define COUNT(x)
- #endif
- #define ICU_BASE 0x20
- #define ICU_OCW2 (ICU_BASE + 0)
- #define ICU_MASK (ICU_BASE + 1)
- unsigned char icu_oldmask;
- #define NINTR 8
- static struct intrupt
- {
- char inuse;
- struct dos_ttystate *port;
- _go32_dpmi_seginfo old_rmhandler;
- _go32_dpmi_seginfo old_pmhandler;
- _go32_dpmi_seginfo new_rmhandler;
- _go32_dpmi_seginfo new_pmhandler;
- _go32_dpmi_registers regs;
- }
- intrupts[NINTR];
- static struct dos_ttystate
- {
- int base;
- int irq;
- int refcnt;
- struct intrupt *intrupt;
- int fifo;
- int baudrate;
- unsigned char cbuf[CBSIZE];
- unsigned int first;
- unsigned int count;
- int txbusy;
- unsigned char old_mcr;
- int ferr;
- int perr;
- int oflo;
- int msr;
- }
- ports[4] =
- {
- {
- COM1ADDR, 4, 0, NULL, 0, 0, "", 0, 0, 0, 0, 0, 0, 0, 0
- }
- ,
- {
- COM2ADDR, 3, 0, NULL, 0, 0, "", 0, 0, 0, 0, 0, 0, 0, 0
- }
- ,
- {
- COM3ADDR, 4, 0, NULL, 0, 0, "", 0, 0, 0, 0, 0, 0, 0, 0
- }
- ,
- {
- COM4ADDR, 3, 0, NULL, 0, 0, "", 0, 0, 0, 0, 0, 0, 0, 0
- }
- };
- static int dos_open (struct serial *scb, const char *name);
- static void dos_raw (struct serial *scb);
- static int dos_readchar (struct serial *scb, int timeout);
- static int dos_setbaudrate (struct serial *scb, int rate);
- static int dos_write (struct serial *scb, const void *buf, size_t count);
- static void dos_close (struct serial *scb);
- static serial_ttystate dos_get_tty_state (struct serial *scb);
- static int dos_set_tty_state (struct serial *scb, serial_ttystate state);
- static int dos_baudconv (int rate);
- #define inb(p,a) inportb((p)->base + (a))
- #define outb(p,a,v) outportb((p)->base + (a), (v))
- #define disable() asm volatile ("cli");
- #define enable() asm volatile ("sti");
- static int
- dos_getc (volatile struct dos_ttystate *port)
- {
- int c;
- if (port->count == 0)
- return -1;
- c = port->cbuf[port->first];
- disable ();
- port->first = (port->first + 1) & (CBSIZE - 1);
- port->count--;
- enable ();
- return c;
- }
- static int
- dos_putc (int c, struct dos_ttystate *port)
- {
- if (port->count >= CBSIZE - 1)
- return -1;
- port->cbuf[(port->first + port->count) & (CBSIZE - 1)] = c;
- port->count++;
- return 0;
- }
- static void
- dos_comisr (int irq)
- {
- struct dos_ttystate *port;
- unsigned char iir, lsr, c;
- disable ();
- outportb (ICU_OCW2, 0x20);
- #ifdef DOS_STATS
- ++intrcnt;
- #endif
- port = intrupts[irq].port;
- if (!port)
- {
- COUNT (CNT_STRAY);
- return;
- }
- while (1)
- {
- iir = inb (port, com_iir) & IIR_IMASK;
- switch (iir)
- {
- case IIR_RLS:
- lsr = inb (port, com_lsr);
- goto rx;
- case IIR_RXTOUT:
- case IIR_RXRDY:
- lsr = 0;
- rx:
- do
- {
- c = inb (port, com_data);
- if (lsr & (LSR_BI | LSR_FE | LSR_PE | LSR_OE))
- {
- if (lsr & (LSR_BI | LSR_FE))
- port->ferr++;
- else if (lsr & LSR_PE)
- port->perr++;
- if (lsr & LSR_OE)
- port->oflo++;
- }
- if (dos_putc (c, port) < 0)
- {
- COUNT (CNT_ORUN);
- }
- else
- {
- COUNT (CNT_RX);
- }
- }
- while ((lsr = inb (port, com_lsr)) & LSR_RXRDY);
- break;
- case IIR_MLSC:
-
- port->msr = inb (port, com_msr);
- break;
- case IIR_TXRDY:
- port->txbusy = 0;
- break;
- case IIR_NOPEND:
-
- return;
- default:
-
- break;
- }
- COUNT (iir);
- }
- }
- #define ISRNAME(x) dos_comisr##x
- #define ISR(x) static void ISRNAME(x)(void) {dos_comisr(x);}
- ISR (0) ISR (1) ISR (2) ISR (3)
- ISR (4) ISR (5) ISR (6) ISR (7)
- typedef void (*isr_t) (void);
- static isr_t isrs[NINTR] =
- {
- ISRNAME (0), ISRNAME (1), ISRNAME (2), ISRNAME (3),
- ISRNAME (4), ISRNAME (5), ISRNAME (6), ISRNAME (7)
- };
- static struct intrupt *
- dos_hookirq (unsigned int irq)
- {
- struct intrupt *intr;
- unsigned int vec;
- isr_t isr;
- if (irq >= NINTR)
- return 0;
- intr = &intrupts[irq];
- if (intr->inuse)
- return 0;
- vec = 0x08 + irq;
- isr = isrs[irq];
-
- _go32_dpmi_get_real_mode_interrupt_vector (vec, &intr->old_rmhandler);
- intr->new_rmhandler.pm_selector = _go32_my_cs ();
- intr->new_rmhandler.pm_offset = (u_long) isr;
- if (_go32_dpmi_allocate_real_mode_callback_iret (&intr->new_rmhandler,
- &intr->regs))
- {
- return 0;
- }
- if (_go32_dpmi_set_real_mode_interrupt_vector (vec, &intr->new_rmhandler))
- {
- return 0;
- }
-
- _go32_dpmi_get_protected_mode_interrupt_vector (vec, &intr->old_pmhandler);
- intr->new_pmhandler.pm_selector = _go32_my_cs ();
- intr->new_pmhandler.pm_offset = (u_long) isr;
- _go32_dpmi_allocate_iret_wrapper (&intr->new_pmhandler);
- if (_go32_dpmi_set_protected_mode_interrupt_vector (vec,
- &intr->new_pmhandler))
- {
- return 0;
- }
-
- disable ();
- outportb (ICU_MASK, inportb (ICU_MASK) & ~(1 << irq));
- enable ();
- intr->inuse = 1;
- return intr;
- }
- static void
- dos_unhookirq (struct intrupt *intr)
- {
- unsigned int irq, vec;
- unsigned char mask;
- irq = intr - intrupts;
- vec = 0x08 + irq;
-
- mask = 1 << irq;
- disable ();
- outportb (ICU_MASK, inportb (ICU_MASK) | (mask & icu_oldmask));
- enable ();
-
- _go32_dpmi_set_real_mode_interrupt_vector (vec, &intr->old_rmhandler);
- _go32_dpmi_free_real_mode_callback (&intr->new_rmhandler);
-
- _go32_dpmi_set_protected_mode_interrupt_vector (vec, &intr->old_pmhandler);
- _go32_dpmi_free_iret_wrapper (&intr->new_pmhandler);
- intr->inuse = 0;
- }
- static int
- dos_open (struct serial *scb, const char *name)
- {
- struct dos_ttystate *port;
- int fd, i;
- if (strncasecmp (name, "/dev/", 5) == 0)
- name += 5;
- else if (strncasecmp (name, "\\dev\\", 5) == 0)
- name += 5;
- if (strlen (name) != 4 || strncasecmp (name, "com", 3) != 0)
- {
- errno = ENOENT;
- return -1;
- }
- if (name[3] < '1' || name[3] > '4')
- {
- errno = ENOENT;
- return -1;
- }
- FIXME
- fd = name[3] - '1';
- port = &ports[fd];
- if (port->refcnt++ > 0)
- {
-
- scb->fd = fd;
- return 0;
- }
-
- outb (port, com_cfcr, 0);
- outb (port, com_iir, 0);
- for (i = 0; i < 17; i++)
- {
- if ((inb (port, com_iir) & 0x38) == 0)
- goto ok;
- (void) inb (port, com_data);
- }
- errno = ENODEV;
- return -1;
- ok:
-
- outb (port, com_ier, 0);
-
- outb (port, com_fifo,
- FIFO_ENABLE | FIFO_RCV_RST | FIFO_XMT_RST | FIFO_TRIGGER);
- sleep (1);
- port->fifo = ((inb (port, com_iir) & IIR_FIFO_MASK) == IIR_FIFO_MASK);
-
- (void) inb (port, com_lsr);
- (void) inb (port, com_msr);
-
- outb (port, com_mcr, MCR_IENABLE);
-
- port->intrupt = dos_hookirq (port->irq);
- if (!port->intrupt)
- {
- outb (port, com_mcr, 0);
- outb (port, com_fifo, 0);
- errno = ENODEV;
- return -1;
- }
- disable ();
-
- port->intrupt->port = port;
- scb->fd = fd;
-
- port->first = port->count = 0;
- port->txbusy = 0;
- port->oflo = 0;
-
- i = dos_baudconv (port->baudrate = 9600);
- outb (port, com_cfcr, CFCR_DLAB);
- outb (port, com_dlbl, i & 0xff);
- outb (port, com_dlbh, i >> 8);
- outb (port, com_cfcr, CFCR_8BITS);
-
- outb (port, com_ier, IER_ETXRDY | IER_ERXRDY | IER_ERLS | IER_EMSC);
-
- outb (port, com_mcr, MCR_DTR | MCR_RTS | MCR_IENABLE);
- enable ();
- return 0;
- }
- static void
- dos_close (struct serial *scb)
- {
- struct dos_ttystate *port;
- struct intrupt *intrupt;
- if (!scb)
- return;
- port = &ports[scb->fd];
- if (port->refcnt-- > 1)
- return;
- if (!(intrupt = port->intrupt))
- return;
-
- disable ();
- port->intrupt = 0;
- intrupt->port = 0;
- outb (port, com_fifo, 0);
- outb (port, com_ier, 0);
- enable ();
-
- dos_unhookirq (intrupt);
- outb (port, com_mcr, 0);
-
- if (port->oflo)
- {
- fprintf_unfiltered (gdb_stderr,
- "Serial input overruns occurred.\n");
- fprintf_unfiltered (gdb_stderr, "This system %s handle %d baud.\n",
- port->fifo ? "cannot" : "needs a 16550 to",
- port->baudrate);
- }
- }
- static int
- dos_noop (struct serial *scb)
- {
- return 0;
- }
- static void
- dos_raw (struct serial *scb)
- {
-
- }
- static int
- dos_readchar (struct serial *scb, int timeout)
- {
- struct dos_ttystate *port = &ports[scb->fd];
- long then;
- int c;
- then = rawclock () + (timeout * RAWHZ);
- while ((c = dos_getc (port)) < 0)
- {
- if (timeout >= 0 && (rawclock () - then) >= 0)
- return SERIAL_TIMEOUT;
- }
- return c;
- }
- static serial_ttystate
- dos_get_tty_state (struct serial *scb)
- {
- struct dos_ttystate *port = &ports[scb->fd];
- struct dos_ttystate *state;
-
- if (port->refcnt <= 0)
- {
-
- if (scb->fd >= 3 || !isatty (scb->fd))
- return NULL;
- }
- state = (struct dos_ttystate *) xmalloc (sizeof *state);
- *state = *port;
- return (serial_ttystate) state;
- }
- static serial_ttystate
- dos_copy_tty_state (struct serial *scb, serial_ttystate ttystate)
- {
- struct dos_ttystate *state;
- state = (struct dos_ttystate *) xmalloc (sizeof *state);
- *state = *(struct dos_ttystate *) ttystate;
- return (serial_ttystate) state;
- }
- static int
- dos_set_tty_state (struct serial *scb, serial_ttystate ttystate)
- {
- struct dos_ttystate *state;
- state = (struct dos_ttystate *) ttystate;
- dos_setbaudrate (scb, state->baudrate);
- return 0;
- }
- static int
- dos_noflush_set_tty_state (struct serial *scb, serial_ttystate new_ttystate,
- serial_ttystate old_ttystate)
- {
- struct dos_ttystate *state;
- state = (struct dos_ttystate *) new_ttystate;
- dos_setbaudrate (scb, state->baudrate);
- return 0;
- }
- static int
- dos_flush_input (struct serial *scb)
- {
- struct dos_ttystate *port = &ports[scb->fd];
- disable ();
- port->first = port->count = 0;
- if (port->fifo)
- outb (port, com_fifo, FIFO_ENABLE | FIFO_RCV_RST | FIFO_TRIGGER);
- enable ();
- return 0;
- }
- static void
- dos_print_tty_state (struct serial *scb, serial_ttystate ttystate,
- struct ui_file *stream)
- {
-
- return;
- }
- static int
- dos_baudconv (int rate)
- {
- long x, err;
- if (rate <= 0)
- return -1;
- #define divrnd(n, q) (((n) * 2 / (q) + 1) / 2)
- x = divrnd (COMTICK, rate);
- if (x <= 0)
- return -1;
- err = divrnd (1000 * COMTICK, x * rate) - 1000;
- if (err < 0)
- err = -err;
- if (err > SPEED_TOLERANCE)
- return -1;
- #undef divrnd
- return x;
- }
- static int
- dos_setbaudrate (struct serial *scb, int rate)
- {
- struct dos_ttystate *port = &ports[scb->fd];
- if (port->baudrate != rate)
- {
- int x;
- unsigned char cfcr;
- x = dos_baudconv (rate);
- if (x <= 0)
- {
- fprintf_unfiltered (gdb_stderr, "%d: impossible baudrate\n", rate);
- errno = EINVAL;
- return -1;
- }
- disable ();
- cfcr = inb (port, com_cfcr);
- outb (port, com_cfcr, CFCR_DLAB);
- outb (port, com_dlbl, x & 0xff);
- outb (port, com_dlbh, x >> 8);
- outb (port, com_cfcr, cfcr);
- port->baudrate = rate;
- enable ();
- }
- return 0;
- }
- static int
- dos_setstopbits (struct serial *scb, int num)
- {
- struct dos_ttystate *port = &ports[scb->fd];
- unsigned char cfcr;
- disable ();
- cfcr = inb (port, com_cfcr);
- switch (num)
- {
- case SERIAL_1_STOPBITS:
- outb (port, com_cfcr, cfcr & ~CFCR_STOPB);
- break;
- case SERIAL_1_AND_A_HALF_STOPBITS:
- case SERIAL_2_STOPBITS:
- outb (port, com_cfcr, cfcr | CFCR_STOPB);
- break;
- default:
- enable ();
- return 1;
- }
- enable ();
- return 0;
- }
- static int
- dos_write (struct serial *scb, const void *buf, size_t count)
- {
- volatile struct dos_ttystate *port = &ports[scb->fd];
- size_t fifosize = port->fifo ? 16 : 1;
- long then;
- size_t cnt;
- const char *str = buf;
- while (count > 0)
- {
-
- cnt = fifosize > count ? count : fifosize;
- port->txbusy = 1;
-
- #ifdef UART_FIFO_WORKS
- outportsb (port->base + com_data, str, cnt);
- str += cnt;
- count -= cnt;
- #else
- for ( ; cnt > 0; cnt--, count--)
- outportb (port->base + com_data, *str++);
- #endif
- #ifdef DOS_STATS
- cnts[CNT_TX] += cnt;
- #endif
-
- then = rawclock () + RAWHZ;
- while (port->txbusy)
- {
- if ((rawclock () - then) >= 0)
- {
- errno = EIO;
- return SERIAL_ERROR;
- }
- }
- }
- return 0;
- }
- static int
- dos_sendbreak (struct serial *scb)
- {
- volatile struct dos_ttystate *port = &ports[scb->fd];
- unsigned char cfcr;
- long then;
- cfcr = inb (port, com_cfcr);
- outb (port, com_cfcr, cfcr | CFCR_SBREAK);
-
- then = rawclock () + RAWHZ / 4;
- while ((rawclock () - then) < 0)
- continue;
- outb (port, com_cfcr, cfcr);
- return 0;
- }
- static const struct serial_ops dos_ops =
- {
- "hardwire",
- dos_open,
- dos_close,
- NULL,
- dos_readchar,
- dos_write,
- dos_noop,
- dos_flush_input,
- dos_sendbreak,
- dos_raw,
- dos_get_tty_state,
- dos_copy_tty_state,
- dos_set_tty_state,
- dos_print_tty_state,
- dos_noflush_set_tty_state,
- dos_setbaudrate,
- dos_setstopbits,
- dos_noop,
- (void (*)(struct serial *, int))NULL
- };
- int
- gdb_pipe (int pdes[2])
- {
-
- errno = ENOSYS;
- return -1;
- }
- static void
- dos_info (char *arg, int from_tty)
- {
- struct dos_ttystate *port;
- #ifdef DOS_STATS
- int i;
- #endif
- for (port = ports; port < &ports[4]; port++)
- {
- if (port->baudrate == 0)
- continue;
- printf_filtered ("Port:\tCOM%ld (%sactive)\n", (long)(port - ports) + 1,
- port->intrupt ? "" : "not ");
- printf_filtered ("Addr:\t0x%03x (irq %d)\n", port->base, port->irq);
- printf_filtered ("16550:\t%s\n", port->fifo ? "yes" : "no");
- printf_filtered ("Speed:\t%d baud\n", port->baudrate);
- printf_filtered ("Errs:\tframing %d parity %d overflow %d\n\n",
- port->ferr, port->perr, port->oflo);
- }
- #ifdef DOS_STATS
- printf_filtered ("\nTotal interrupts: %d\n", intrcnt);
- for (i = 0; i < NCNT; i++)
- if (cnts[i])
- printf_filtered ("%s:\t%lu\n", cntnames[i], (unsigned long) cnts[i]);
- #endif
- }
- extern initialize_file_ftype _initialize_ser_dos;
- void
- _initialize_ser_dos (void)
- {
- serial_add_interface (&dos_ops);
-
- icu_oldmask = inportb (ICU_MASK);
-
- intrupts[0].inuse =
- intrupts[1].inuse =
- intrupts[2].inuse = 1;
- add_setshow_zinteger_cmd ("com1base", class_obscure, &ports[0].base, _("\
- Set COM1 base i/o port address."), _("\
- Show COM1 base i/o port address."), NULL,
- NULL,
- NULL, FIXME
- &setlist, &showlist);
- add_setshow_zinteger_cmd ("com1irq", class_obscure, &ports[0].irq, _("\
- Set COM1 interrupt request."), _("\
- Show COM1 interrupt request."), NULL,
- NULL,
- NULL, FIXME
- &setlist, &showlist);
- add_setshow_zinteger_cmd ("com2base", class_obscure, &ports[1].base, _("\
- Set COM2 base i/o port address."), _("\
- Show COM2 base i/o port address."), NULL,
- NULL,
- NULL, FIXME
- &setlist, &showlist);
- add_setshow_zinteger_cmd ("com2irq", class_obscure, &ports[1].irq, _("\
- Set COM2 interrupt request."), _("\
- Show COM2 interrupt request."), NULL,
- NULL,
- NULL, FIXME
- &setlist, &showlist);
- add_setshow_zinteger_cmd ("com3base", class_obscure, &ports[2].base, _("\
- Set COM3 base i/o port address."), _("\
- Show COM3 base i/o port address."), NULL,
- NULL,
- NULL, FIXME
- &setlist, &showlist);
- add_setshow_zinteger_cmd ("com3irq", class_obscure, &ports[2].irq, _("\
- Set COM3 interrupt request."), _("\
- Show COM3 interrupt request."), NULL,
- NULL,
- NULL, FIXME
- &setlist, &showlist);
- add_setshow_zinteger_cmd ("com4base", class_obscure, &ports[3].base, _("\
- Set COM4 base i/o port address."), _("\
- Show COM4 base i/o port address."), NULL,
- NULL,
- NULL, FIXME
- &setlist, &showlist);
- add_setshow_zinteger_cmd ("com4irq", class_obscure, &ports[3].irq, _("\
- Set COM4 interrupt request."), _("\
- Show COM4 interrupt request."), NULL,
- NULL,
- NULL, FIXME
- &setlist, &showlist);
- add_info ("serial", dos_info,
- _("Print DOS serial port status."));
- }