2007-11-11 01:04:49 +01:00
|
|
|
/*
|
|
|
|
* Arm PrimeCell PL022 Synchronous Serial Port
|
|
|
|
*
|
|
|
|
* Copyright (c) 2007 CodeSourcery.
|
|
|
|
* Written by Paul Brook
|
|
|
|
*
|
2011-06-26 04:21:35 +02:00
|
|
|
* This code is licensed under the GPL.
|
2007-11-11 01:04:49 +01:00
|
|
|
*/
|
|
|
|
|
2013-02-04 15:40:22 +01:00
|
|
|
#include "hw/sysbus.h"
|
|
|
|
#include "hw/ssi.h"
|
2007-11-11 01:04:49 +01:00
|
|
|
|
|
|
|
//#define DEBUG_PL022 1
|
|
|
|
|
|
|
|
#ifdef DEBUG_PL022
|
2009-05-13 19:53:17 +02:00
|
|
|
#define DPRINTF(fmt, ...) \
|
|
|
|
do { printf("pl022: " fmt , ## __VA_ARGS__); } while (0)
|
|
|
|
#define BADF(fmt, ...) \
|
|
|
|
do { fprintf(stderr, "pl022: error: " fmt , ## __VA_ARGS__); exit(1);} while (0)
|
2007-11-11 01:04:49 +01:00
|
|
|
#else
|
2009-05-13 19:53:17 +02:00
|
|
|
#define DPRINTF(fmt, ...) do {} while(0)
|
|
|
|
#define BADF(fmt, ...) \
|
|
|
|
do { fprintf(stderr, "pl022: error: " fmt , ## __VA_ARGS__);} while (0)
|
2007-11-11 01:04:49 +01:00
|
|
|
#endif
|
|
|
|
|
|
|
|
#define PL022_CR1_LBM 0x01
|
|
|
|
#define PL022_CR1_SSE 0x02
|
|
|
|
#define PL022_CR1_MS 0x04
|
|
|
|
#define PL022_CR1_SDO 0x08
|
|
|
|
|
|
|
|
#define PL022_SR_TFE 0x01
|
|
|
|
#define PL022_SR_TNF 0x02
|
|
|
|
#define PL022_SR_RNE 0x04
|
|
|
|
#define PL022_SR_RFF 0x08
|
|
|
|
#define PL022_SR_BSY 0x10
|
|
|
|
|
|
|
|
#define PL022_INT_ROR 0x01
|
|
|
|
#define PL022_INT_RT 0x04
|
|
|
|
#define PL022_INT_RX 0x04
|
|
|
|
#define PL022_INT_TX 0x08
|
|
|
|
|
2013-07-27 14:00:25 +02:00
|
|
|
typedef struct PL022State {
|
2009-05-14 23:35:09 +02:00
|
|
|
SysBusDevice busdev;
|
2011-10-10 17:15:47 +02:00
|
|
|
MemoryRegion iomem;
|
2007-11-11 01:04:49 +01:00
|
|
|
uint32_t cr0;
|
|
|
|
uint32_t cr1;
|
|
|
|
uint32_t bitmask;
|
|
|
|
uint32_t sr;
|
|
|
|
uint32_t cpsr;
|
|
|
|
uint32_t is;
|
|
|
|
uint32_t im;
|
|
|
|
/* The FIFO head points to the next empty entry. */
|
|
|
|
int tx_fifo_head;
|
|
|
|
int rx_fifo_head;
|
|
|
|
int tx_fifo_len;
|
|
|
|
int rx_fifo_len;
|
|
|
|
uint16_t tx_fifo[8];
|
|
|
|
uint16_t rx_fifo[8];
|
|
|
|
qemu_irq irq;
|
2009-05-14 23:35:09 +02:00
|
|
|
SSIBus *ssi;
|
2013-07-27 14:00:25 +02:00
|
|
|
} PL022State;
|
2007-11-11 01:04:49 +01:00
|
|
|
|
|
|
|
static const unsigned char pl022_id[8] =
|
|
|
|
{ 0x22, 0x10, 0x04, 0x00, 0x0d, 0xf0, 0x05, 0xb1 };
|
|
|
|
|
2013-07-27 14:00:25 +02:00
|
|
|
static void pl022_update(PL022State *s)
|
2007-11-11 01:04:49 +01:00
|
|
|
{
|
|
|
|
s->sr = 0;
|
|
|
|
if (s->tx_fifo_len == 0)
|
|
|
|
s->sr |= PL022_SR_TFE;
|
|
|
|
if (s->tx_fifo_len != 8)
|
|
|
|
s->sr |= PL022_SR_TNF;
|
|
|
|
if (s->rx_fifo_len != 0)
|
|
|
|
s->sr |= PL022_SR_RNE;
|
|
|
|
if (s->rx_fifo_len == 8)
|
|
|
|
s->sr |= PL022_SR_RFF;
|
|
|
|
if (s->tx_fifo_len)
|
|
|
|
s->sr |= PL022_SR_BSY;
|
|
|
|
s->is = 0;
|
|
|
|
if (s->rx_fifo_len >= 4)
|
|
|
|
s->is |= PL022_INT_RX;
|
|
|
|
if (s->tx_fifo_len <= 4)
|
|
|
|
s->is |= PL022_INT_TX;
|
|
|
|
|
|
|
|
qemu_set_irq(s->irq, (s->is & s->im) != 0);
|
|
|
|
}
|
|
|
|
|
2013-07-27 14:00:25 +02:00
|
|
|
static void pl022_xfer(PL022State *s)
|
2007-11-11 01:04:49 +01:00
|
|
|
{
|
|
|
|
int i;
|
|
|
|
int o;
|
|
|
|
int val;
|
|
|
|
|
|
|
|
if ((s->cr1 & PL022_CR1_SSE) == 0) {
|
|
|
|
pl022_update(s);
|
|
|
|
DPRINTF("Disabled\n");
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
DPRINTF("Maybe xfer %d/%d\n", s->tx_fifo_len, s->rx_fifo_len);
|
|
|
|
i = (s->tx_fifo_head - s->tx_fifo_len) & 7;
|
|
|
|
o = s->rx_fifo_head;
|
|
|
|
/* ??? We do not emulate the line speed.
|
|
|
|
This may break some applications. The are two problematic cases:
|
|
|
|
(a) A driver feeds data into the TX FIFO until it is full,
|
|
|
|
and only then drains the RX FIFO. On real hardware the CPU can
|
|
|
|
feed data fast enough that the RX fifo never gets chance to overflow.
|
|
|
|
(b) A driver transmits data, deliberately allowing the RX FIFO to
|
|
|
|
overflow because it ignores the RX data anyway.
|
|
|
|
|
|
|
|
We choose to support (a) by stalling the transmit engine if it would
|
|
|
|
cause the RX FIFO to overflow. In practice much transmit-only code
|
|
|
|
falls into (a) because it flushes the RX FIFO to determine when
|
|
|
|
the transfer has completed. */
|
|
|
|
while (s->tx_fifo_len && s->rx_fifo_len < 8) {
|
|
|
|
DPRINTF("xfer\n");
|
|
|
|
val = s->tx_fifo[i];
|
|
|
|
if (s->cr1 & PL022_CR1_LBM) {
|
|
|
|
/* Loopback mode. */
|
|
|
|
} else {
|
2009-05-14 23:35:09 +02:00
|
|
|
val = ssi_transfer(s->ssi, val);
|
2007-11-11 01:04:49 +01:00
|
|
|
}
|
|
|
|
s->rx_fifo[o] = val & s->bitmask;
|
|
|
|
i = (i + 1) & 7;
|
|
|
|
o = (o + 1) & 7;
|
|
|
|
s->tx_fifo_len--;
|
|
|
|
s->rx_fifo_len++;
|
|
|
|
}
|
|
|
|
s->rx_fifo_head = o;
|
|
|
|
pl022_update(s);
|
|
|
|
}
|
|
|
|
|
2012-10-23 12:30:10 +02:00
|
|
|
static uint64_t pl022_read(void *opaque, hwaddr offset,
|
2011-10-10 17:15:47 +02:00
|
|
|
unsigned size)
|
2007-11-11 01:04:49 +01:00
|
|
|
{
|
2013-07-27 14:00:25 +02:00
|
|
|
PL022State *s = (PL022State *)opaque;
|
2007-11-11 01:04:49 +01:00
|
|
|
int val;
|
|
|
|
|
|
|
|
if (offset >= 0xfe0 && offset < 0x1000) {
|
|
|
|
return pl022_id[(offset - 0xfe0) >> 2];
|
|
|
|
}
|
|
|
|
switch (offset) {
|
|
|
|
case 0x00: /* CR0 */
|
|
|
|
return s->cr0;
|
|
|
|
case 0x04: /* CR1 */
|
|
|
|
return s->cr1;
|
|
|
|
case 0x08: /* DR */
|
|
|
|
if (s->rx_fifo_len) {
|
|
|
|
val = s->rx_fifo[(s->rx_fifo_head - s->rx_fifo_len) & 7];
|
|
|
|
DPRINTF("RX %02x\n", val);
|
|
|
|
s->rx_fifo_len--;
|
|
|
|
pl022_xfer(s);
|
|
|
|
} else {
|
|
|
|
val = 0;
|
|
|
|
}
|
|
|
|
return val;
|
|
|
|
case 0x0c: /* SR */
|
|
|
|
return s->sr;
|
|
|
|
case 0x10: /* CPSR */
|
|
|
|
return s->cpsr;
|
|
|
|
case 0x14: /* IMSC */
|
|
|
|
return s->im;
|
|
|
|
case 0x18: /* RIS */
|
|
|
|
return s->is;
|
|
|
|
case 0x1c: /* MIS */
|
|
|
|
return s->im & s->is;
|
|
|
|
case 0x20: /* DMACR */
|
|
|
|
/* Not implemented. */
|
|
|
|
return 0;
|
|
|
|
default:
|
2012-10-18 15:11:41 +02:00
|
|
|
qemu_log_mask(LOG_GUEST_ERROR,
|
|
|
|
"pl022_read: Bad offset %x\n", (int)offset);
|
2007-11-11 01:04:49 +01:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2012-10-23 12:30:10 +02:00
|
|
|
static void pl022_write(void *opaque, hwaddr offset,
|
2011-10-10 17:15:47 +02:00
|
|
|
uint64_t value, unsigned size)
|
2007-11-11 01:04:49 +01:00
|
|
|
{
|
2013-07-27 14:00:25 +02:00
|
|
|
PL022State *s = (PL022State *)opaque;
|
2007-11-11 01:04:49 +01:00
|
|
|
|
|
|
|
switch (offset) {
|
|
|
|
case 0x00: /* CR0 */
|
|
|
|
s->cr0 = value;
|
|
|
|
/* Clock rate and format are ignored. */
|
|
|
|
s->bitmask = (1 << ((value & 15) + 1)) - 1;
|
|
|
|
break;
|
|
|
|
case 0x04: /* CR1 */
|
|
|
|
s->cr1 = value;
|
|
|
|
if ((s->cr1 & (PL022_CR1_MS | PL022_CR1_SSE))
|
|
|
|
== (PL022_CR1_MS | PL022_CR1_SSE)) {
|
|
|
|
BADF("SPI slave mode not implemented\n");
|
|
|
|
}
|
|
|
|
pl022_xfer(s);
|
|
|
|
break;
|
|
|
|
case 0x08: /* DR */
|
|
|
|
if (s->tx_fifo_len < 8) {
|
2011-10-10 17:15:47 +02:00
|
|
|
DPRINTF("TX %02x\n", (unsigned)value);
|
2007-11-11 01:04:49 +01:00
|
|
|
s->tx_fifo[s->tx_fifo_head] = value & s->bitmask;
|
|
|
|
s->tx_fifo_head = (s->tx_fifo_head + 1) & 7;
|
|
|
|
s->tx_fifo_len++;
|
|
|
|
pl022_xfer(s);
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
case 0x10: /* CPSR */
|
|
|
|
/* Prescaler. Ignored. */
|
|
|
|
s->cpsr = value & 0xff;
|
|
|
|
break;
|
|
|
|
case 0x14: /* IMSC */
|
|
|
|
s->im = value;
|
|
|
|
pl022_update(s);
|
|
|
|
break;
|
|
|
|
case 0x20: /* DMACR */
|
2009-05-08 03:35:15 +02:00
|
|
|
if (value) {
|
2012-10-18 15:11:41 +02:00
|
|
|
qemu_log_mask(LOG_UNIMP, "pl022: DMA not implemented\n");
|
2009-05-08 03:35:15 +02:00
|
|
|
}
|
2007-11-11 01:04:49 +01:00
|
|
|
break;
|
|
|
|
default:
|
2012-10-18 15:11:41 +02:00
|
|
|
qemu_log_mask(LOG_GUEST_ERROR,
|
|
|
|
"pl022_write: Bad offset %x\n", (int)offset);
|
2007-11-11 01:04:49 +01:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2013-07-27 14:00:25 +02:00
|
|
|
static void pl022_reset(PL022State *s)
|
2007-11-11 01:04:49 +01:00
|
|
|
{
|
|
|
|
s->rx_fifo_len = 0;
|
|
|
|
s->tx_fifo_len = 0;
|
|
|
|
s->im = 0;
|
|
|
|
s->is = PL022_INT_TX;
|
|
|
|
s->sr = PL022_SR_TFE | PL022_SR_TNF;
|
|
|
|
}
|
|
|
|
|
2011-10-10 17:15:47 +02:00
|
|
|
static const MemoryRegionOps pl022_ops = {
|
|
|
|
.read = pl022_read,
|
|
|
|
.write = pl022_write,
|
|
|
|
.endianness = DEVICE_NATIVE_ENDIAN,
|
2007-11-11 01:04:49 +01:00
|
|
|
};
|
|
|
|
|
2010-12-02 12:43:50 +01:00
|
|
|
static const VMStateDescription vmstate_pl022 = {
|
|
|
|
.name = "pl022_ssp",
|
|
|
|
.version_id = 1,
|
|
|
|
.minimum_version_id = 1,
|
|
|
|
.minimum_version_id_old = 1,
|
|
|
|
.fields = (VMStateField[]) {
|
2013-07-27 14:00:25 +02:00
|
|
|
VMSTATE_UINT32(cr0, PL022State),
|
|
|
|
VMSTATE_UINT32(cr1, PL022State),
|
|
|
|
VMSTATE_UINT32(bitmask, PL022State),
|
|
|
|
VMSTATE_UINT32(sr, PL022State),
|
|
|
|
VMSTATE_UINT32(cpsr, PL022State),
|
|
|
|
VMSTATE_UINT32(is, PL022State),
|
|
|
|
VMSTATE_UINT32(im, PL022State),
|
|
|
|
VMSTATE_INT32(tx_fifo_head, PL022State),
|
|
|
|
VMSTATE_INT32(rx_fifo_head, PL022State),
|
|
|
|
VMSTATE_INT32(tx_fifo_len, PL022State),
|
|
|
|
VMSTATE_INT32(rx_fifo_len, PL022State),
|
|
|
|
VMSTATE_UINT16(tx_fifo[0], PL022State),
|
|
|
|
VMSTATE_UINT16(rx_fifo[0], PL022State),
|
|
|
|
VMSTATE_UINT16(tx_fifo[1], PL022State),
|
|
|
|
VMSTATE_UINT16(rx_fifo[1], PL022State),
|
|
|
|
VMSTATE_UINT16(tx_fifo[2], PL022State),
|
|
|
|
VMSTATE_UINT16(rx_fifo[2], PL022State),
|
|
|
|
VMSTATE_UINT16(tx_fifo[3], PL022State),
|
|
|
|
VMSTATE_UINT16(rx_fifo[3], PL022State),
|
|
|
|
VMSTATE_UINT16(tx_fifo[4], PL022State),
|
|
|
|
VMSTATE_UINT16(rx_fifo[4], PL022State),
|
|
|
|
VMSTATE_UINT16(tx_fifo[5], PL022State),
|
|
|
|
VMSTATE_UINT16(rx_fifo[5], PL022State),
|
|
|
|
VMSTATE_UINT16(tx_fifo[6], PL022State),
|
|
|
|
VMSTATE_UINT16(rx_fifo[6], PL022State),
|
|
|
|
VMSTATE_UINT16(tx_fifo[7], PL022State),
|
|
|
|
VMSTATE_UINT16(rx_fifo[7], PL022State),
|
2010-12-02 12:43:50 +01:00
|
|
|
VMSTATE_END_OF_LIST()
|
2008-07-02 18:48:32 +02:00
|
|
|
}
|
2010-12-02 12:43:50 +01:00
|
|
|
};
|
2008-07-02 18:48:32 +02:00
|
|
|
|
2009-08-14 10:36:05 +02:00
|
|
|
static int pl022_init(SysBusDevice *dev)
|
2007-11-11 01:04:49 +01:00
|
|
|
{
|
2013-07-27 14:00:25 +02:00
|
|
|
PL022State *s = FROM_SYSBUS(PL022State, dev);
|
2007-11-11 01:04:49 +01:00
|
|
|
|
2013-06-07 03:25:08 +02:00
|
|
|
memory_region_init_io(&s->iomem, OBJECT(s), &pl022_ops, s, "pl022", 0x1000);
|
2011-11-27 10:38:10 +01:00
|
|
|
sysbus_init_mmio(dev, &s->iomem);
|
2009-05-14 23:35:09 +02:00
|
|
|
sysbus_init_irq(dev, &s->irq);
|
2009-05-23 01:05:19 +02:00
|
|
|
s->ssi = ssi_create_bus(&dev->qdev, "ssi");
|
2007-11-11 01:04:49 +01:00
|
|
|
pl022_reset(s);
|
2010-12-02 12:43:50 +01:00
|
|
|
vmstate_register(&dev->qdev, -1, &vmstate_pl022, s);
|
2009-08-14 10:36:05 +02:00
|
|
|
return 0;
|
2007-11-11 01:04:49 +01:00
|
|
|
}
|
2009-05-14 23:35:09 +02:00
|
|
|
|
2012-01-24 20:12:29 +01:00
|
|
|
static void pl022_class_init(ObjectClass *klass, void *data)
|
|
|
|
{
|
|
|
|
SysBusDeviceClass *sdc = SYS_BUS_DEVICE_CLASS(klass);
|
|
|
|
|
|
|
|
sdc->init = pl022_init;
|
|
|
|
}
|
|
|
|
|
2013-01-10 16:19:07 +01:00
|
|
|
static const TypeInfo pl022_info = {
|
2011-12-08 04:34:16 +01:00
|
|
|
.name = "pl022",
|
|
|
|
.parent = TYPE_SYS_BUS_DEVICE,
|
2013-07-27 14:00:25 +02:00
|
|
|
.instance_size = sizeof(PL022State),
|
2011-12-08 04:34:16 +01:00
|
|
|
.class_init = pl022_class_init,
|
2012-01-24 20:12:29 +01:00
|
|
|
};
|
|
|
|
|
2012-02-09 15:20:55 +01:00
|
|
|
static void pl022_register_types(void)
|
2009-05-14 23:35:09 +02:00
|
|
|
{
|
2011-12-08 04:34:16 +01:00
|
|
|
type_register_static(&pl022_info);
|
2009-05-14 23:35:09 +02:00
|
|
|
}
|
|
|
|
|
2012-02-09 15:20:55 +01:00
|
|
|
type_init(pl022_register_types)
|