ETRAX-SER: Untabify.

Signed-off-by: Edgar E. Iglesias <edgar.iglesias@gmail.com>
This commit is contained in:
Edgar E. Iglesias 2009-05-16 01:44:24 +02:00
parent 4b816985b8
commit 2a9859e724

View file

@ -45,115 +45,115 @@
struct etrax_serial struct etrax_serial
{ {
SysBusDevice busdev; SysBusDevice busdev;
CharDriverState *chr; CharDriverState *chr;
qemu_irq irq; qemu_irq irq;
/* This pending thing is a hack. */ /* This pending thing is a hack. */
int pending_tx; int pending_tx;
/* Control registers. */ /* Control registers. */
uint32_t regs[R_MAX]; uint32_t regs[R_MAX];
}; };
static void ser_update_irq(struct etrax_serial *s) static void ser_update_irq(struct etrax_serial *s)
{ {
s->regs[R_INTR] &= ~(s->regs[RW_ACK_INTR]); s->regs[R_INTR] &= ~(s->regs[RW_ACK_INTR]);
s->regs[R_MASKED_INTR] = s->regs[R_INTR] & s->regs[RW_INTR_MASK]; s->regs[R_MASKED_INTR] = s->regs[R_INTR] & s->regs[RW_INTR_MASK];
qemu_set_irq(s->irq, !!s->regs[R_MASKED_INTR]); qemu_set_irq(s->irq, !!s->regs[R_MASKED_INTR]);
s->regs[RW_ACK_INTR] = 0; s->regs[RW_ACK_INTR] = 0;
} }
static uint32_t ser_readl (void *opaque, target_phys_addr_t addr) static uint32_t ser_readl (void *opaque, target_phys_addr_t addr)
{ {
struct etrax_serial *s = opaque; struct etrax_serial *s = opaque;
D(CPUState *env = s->env); D(CPUState *env = s->env);
uint32_t r = 0; uint32_t r = 0;
addr >>= 2; addr >>= 2;
switch (addr) switch (addr)
{ {
case R_STAT_DIN: case R_STAT_DIN:
r = s->regs[RS_STAT_DIN]; r = s->regs[RS_STAT_DIN];
break; break;
case RS_STAT_DIN: case RS_STAT_DIN:
r = s->regs[addr]; r = s->regs[addr];
/* Read side-effect: clear dav. */ /* Read side-effect: clear dav. */
s->regs[addr] &= ~(1 << STAT_DAV); s->regs[addr] &= ~(1 << STAT_DAV);
break; break;
default: default:
r = s->regs[addr]; r = s->regs[addr];
D(printf ("%s %x=%x\n", __func__, addr, r)); D(printf ("%s %x=%x\n", __func__, addr, r));
break; break;
} }
return r; return r;
} }
static void static void
ser_writel (void *opaque, target_phys_addr_t addr, uint32_t value) ser_writel (void *opaque, target_phys_addr_t addr, uint32_t value)
{ {
struct etrax_serial *s = opaque; struct etrax_serial *s = opaque;
unsigned char ch = value; unsigned char ch = value;
D(CPUState *env = s->env); D(CPUState *env = s->env);
D(printf ("%s %x %x\n", __func__, addr, value)); D(printf ("%s %x %x\n", __func__, addr, value));
addr >>= 2; addr >>= 2;
switch (addr) switch (addr)
{ {
case RW_DOUT: case RW_DOUT:
qemu_chr_write(s->chr, &ch, 1); qemu_chr_write(s->chr, &ch, 1);
s->regs[R_INTR] |= 1; s->regs[R_INTR] |= 1;
s->pending_tx = 1; s->pending_tx = 1;
s->regs[addr] = value; s->regs[addr] = value;
break; break;
case RW_ACK_INTR: case RW_ACK_INTR:
s->regs[addr] = value; s->regs[addr] = value;
if (s->pending_tx && (s->regs[addr] & 1)) { if (s->pending_tx && (s->regs[addr] & 1)) {
s->regs[R_INTR] |= 1; s->regs[R_INTR] |= 1;
s->pending_tx = 0; s->pending_tx = 0;
s->regs[addr] &= ~1; s->regs[addr] &= ~1;
} }
break; break;
default: default:
s->regs[addr] = value; s->regs[addr] = value;
break; break;
} }
ser_update_irq(s); ser_update_irq(s);
} }
static CPUReadMemoryFunc *ser_read[] = { static CPUReadMemoryFunc *ser_read[] = {
NULL, NULL, NULL, NULL,
&ser_readl, &ser_readl,
}; };
static CPUWriteMemoryFunc *ser_write[] = { static CPUWriteMemoryFunc *ser_write[] = {
NULL, NULL, NULL, NULL,
&ser_writel, &ser_writel,
}; };
static void serial_receive(void *opaque, const uint8_t *buf, int size) static void serial_receive(void *opaque, const uint8_t *buf, int size)
{ {
struct etrax_serial *s = opaque; struct etrax_serial *s = opaque;
s->regs[R_INTR] |= 8; s->regs[R_INTR] |= 8;
s->regs[RS_STAT_DIN] &= ~0xff; s->regs[RS_STAT_DIN] &= ~0xff;
s->regs[RS_STAT_DIN] |= (buf[0] & 0xff); s->regs[RS_STAT_DIN] |= (buf[0] & 0xff);
s->regs[RS_STAT_DIN] |= (1 << STAT_DAV); /* dav. */ s->regs[RS_STAT_DIN] |= (1 << STAT_DAV); /* dav. */
ser_update_irq(s); ser_update_irq(s);
} }
static int serial_can_receive(void *opaque) static int serial_can_receive(void *opaque)
{ {
struct etrax_serial *s = opaque; struct etrax_serial *s = opaque;
int r; int r;
/* Is the receiver enabled? */ /* Is the receiver enabled? */
r = s->regs[RW_REC_CTRL] & 1; r = s->regs[RW_REC_CTRL] & 1;
/* Pending rx data? */ /* Pending rx data? */
r |= !(s->regs[R_INTR] & 8); r |= !(s->regs[R_INTR] & 8);
return r; return r;
} }
static void serial_event(void *opaque, int event) static void serial_event(void *opaque, int event)
@ -163,27 +163,27 @@ static void serial_event(void *opaque, int event)
static void etraxfs_ser_init(SysBusDevice *dev) static void etraxfs_ser_init(SysBusDevice *dev)
{ {
struct etrax_serial *s = FROM_SYSBUS(typeof (*s), dev); struct etrax_serial *s = FROM_SYSBUS(typeof (*s), dev);
int ser_regs; int ser_regs;
/* transmitter begins ready and idle. */ /* transmitter begins ready and idle. */
s->regs[RS_STAT_DIN] |= (1 << STAT_TR_RDY); s->regs[RS_STAT_DIN] |= (1 << STAT_TR_RDY);
s->regs[RS_STAT_DIN] |= (1 << STAT_TR_IDLE); s->regs[RS_STAT_DIN] |= (1 << STAT_TR_IDLE);
sysbus_init_irq(dev, &s->irq); sysbus_init_irq(dev, &s->irq);
ser_regs = cpu_register_io_memory(0, ser_read, ser_write, s); ser_regs = cpu_register_io_memory(0, ser_read, ser_write, s);
sysbus_init_mmio(dev, R_MAX * 4, ser_regs); sysbus_init_mmio(dev, R_MAX * 4, ser_regs);
s->chr = qdev_init_chardev(&dev->qdev); s->chr = qdev_init_chardev(&dev->qdev);
if (s->chr) if (s->chr)
qemu_chr_add_handlers(s->chr, qemu_chr_add_handlers(s->chr,
serial_can_receive, serial_receive, serial_can_receive, serial_receive,
serial_event, s); serial_event, s);
} }
static void etraxfs_serial_register(void) static void etraxfs_serial_register(void)
{ {
sysbus_register_dev("etraxfs,serial", sizeof (struct etrax_serial), sysbus_register_dev("etraxfs,serial", sizeof (struct etrax_serial),
etraxfs_ser_init); etraxfs_ser_init);
} }
device_init(etraxfs_serial_register) device_init(etraxfs_serial_register)