[qemu.git] / hw / pl080.c

/* 
 * Arm PrimeCell PL080/PL081 DMA controller
 *
 * Copyright (c) 2006 CodeSourcery.
 * Written by Paul Brook
 *
 * This code is licenced under the GPL.
 */

#include "vl.h"

#define PL080_MAX_CHANNELS 8
#define PL080_CONF_E    0x1
#define PL080_CONF_M1   0x2
#define PL080_CONF_M2   0x4

#define PL080_CCONF_H   0x40000
#define PL080_CCONF_A   0x20000
#define PL080_CCONF_L   0x10000
#define PL080_CCONF_ITC 0x08000
#define PL080_CCONF_IE  0x04000
#define PL080_CCONF_E   0x00001

#define PL080_CCTRL_I   0x80000000
#define PL080_CCTRL_DI  0x08000000
#define PL080_CCTRL_SI  0x04000000
#define PL080_CCTRL_D   0x02000000
#define PL080_CCTRL_S   0x01000000

typedef struct {
    uint32_t src;
    uint32_t dest;
    uint32_t lli;
    uint32_t ctrl;
    uint32_t conf;
} pl080_channel;

typedef struct {
    uint32_t base;
    uint8_t tc_int;
    uint8_t tc_mask;
    uint8_t err_int;
    uint8_t err_mask;
    uint32_t conf;
    uint32_t sync;
    uint32_t req_single;
    uint32_t req_burst;
    pl080_channel chan[PL080_MAX_CHANNELS];
    int nchannels;
    /* Flag to avoid recursive DMA invocations.  */
    int running;
    void *pic;
    int irq;
} pl080_state;

static const unsigned char pl080_id[] =
{ 0x80, 0x10, 0x04, 0x0a, 0x0d, 0xf0, 0x05, 0xb1 };

static const unsigned char pl081_id[] =
{ 0x81, 0x10, 0x04, 0x0a, 0x0d, 0xf0, 0x05, 0xb1 };

static void pl080_update(pl080_state *s)
{
    if ((s->tc_int & s->tc_mask)
            || (s->err_int & s->err_mask))
        pic_set_irq_new(s->pic, s->irq, 1);
    else
        pic_set_irq_new(s->pic, s->irq, 1);
}

static void pl080_run(pl080_state *s)
{
    int c;
    int flow;
    pl080_channel *ch;
    int swidth;
    int dwidth;
    int xsize;
    int n;
    int src_id;
    int dest_id;
    int size;
    char buff[4];
    uint32_t req;

    s->tc_mask = 0;
    for (c = 0; c < s->nchannels; c++) {
        if (s->chan[c].conf & PL080_CCONF_ITC)
            s->tc_mask |= 1 << c;
        if (s->chan[c].conf & PL080_CCONF_IE)
            s->err_mask |= 1 << c;
    }

    if ((s->conf & PL080_CONF_E) == 0)
        return;

cpu_abort(cpu_single_env, "DMA active\n");
    /* If we are already in the middle of a DMA operation then indicate that
       there may be new DMA requests and return immediately.  */
    if (s->running) {
        s->running++;
        return;
    }
    s->running = 1;
    while (s->running) {
        for (c = 0; c < s->nchannels; c++) {
            ch = &s->chan[c];
again:
            /* Test if thiws channel has any pending DMA requests.  */
            if ((ch->conf & (PL080_CCONF_H | PL080_CCONF_E))
                    != PL080_CCONF_E)
                continue;
            flow = (ch->conf >> 11) & 7;
            if (flow >= 4) {
                cpu_abort(cpu_single_env, 
                    "pl080_run: Peripheral flow control not implemented\n");
            }
            src_id = (ch->conf >> 1) & 0x1f;
            dest_id = (ch->conf >> 6) & 0x1f;
            size = ch->ctrl & 0xfff;
            req = s->req_single | s->req_burst;
            switch (flow) {
            case 0:
                break;
            case 1:
                if ((req & (1u << dest_id)) == 0)
                    size = 0;
                break;
            case 2:
                if ((req & (1u << src_id)) == 0)
                    size = 0;
                break;
            case 3:
                if ((req & (1u << src_id)) == 0
                        || (req & (1u << dest_id)) == 0)
                    size = 0;
                break;
            }
            if (!size)
                continue;

            /* Transfer one element.  */
            /* ??? Should transfer multiple elements for a burst request.  */
            /* ??? Unclear what the proper behavior is when source and
               destination widths are different.  */
            swidth = 1 << ((ch->ctrl >> 18) & 7);
            dwidth = 1 << ((ch->ctrl >> 21) & 7);
            for (n = 0; n < dwidth; n+= swidth) {
                cpu_physical_memory_read(ch->src, buff + n, swidth);
                if (ch->ctrl & PL080_CCTRL_SI)
                    ch->src += swidth;
            }
            xsize = (dwidth < swidth) ? swidth : dwidth;
            /* ??? This may pad the value incorrectly for dwidth < 32.  */
            for (n = 0; n < xsize; n += dwidth) {
                cpu_physical_memory_write(ch->dest + n, buff + n, dwidth);
                if (ch->ctrl & PL080_CCTRL_DI)
                    ch->dest += swidth;
            }

            size--;
            ch->ctrl = (ch->ctrl & 0xfffff000) | size;
            if (size == 0) {
                /* Transfer complete.  */
                if (ch->lli) {
                    ch->src = ldl_phys(ch->lli);
                    ch->dest = ldl_phys(ch->lli + 4);
                    ch->ctrl = ldl_phys(ch->lli + 12);
                    ch->lli = ldl_phys(ch->lli + 8);
                } else {
                    ch->conf &= ~PL080_CCONF_E;
                }
                if (ch->ctrl & PL080_CCTRL_I) {
                    s->tc_int |= 1 << c;
                }
            }
            goto again;
        }
        if (--s->running)
            s->running = 1;
    }
}

static uint32_t pl080_read(void *opaque, target_phys_addr_t offset)
{
    pl080_state *s = (pl080_state *)opaque;
    uint32_t i;
    uint32_t mask;

    offset -= s->base;
    if (offset >= 0xfe0 && offset < 0x1000) {
        if (s->nchannels == 8) {
            return pl080_id[(offset - 0xfe0) >> 2];
        } else {
            return pl081_id[(offset - 0xfe0) >> 2];
        }
    }
    if (offset >= 0x100 && offset < 0x200) {
        i = (offset & 0xe0) >> 5;
        if (i >= s->nchannels)
            goto bad_offset;
        switch (offset >> 2) {
        case 0: /* SrcAddr */
            return s->chan[i].src;
        case 1: /* DestAddr */
            return s->chan[i].dest;
        case 2: /* LLI */
            return s->chan[i].lli;
        case 3: /* Control */
            return s->chan[i].ctrl;
        case 4: /* Configuration */
            return s->chan[i].conf;
        default:
            goto bad_offset;
        }
    }
    switch (offset >> 2) {
    case 0: /* IntStatus */
        return (s->tc_int & s->tc_mask) | (s->err_int & s->err_mask);
    case 1: /* IntTCStatus */
        return (s->tc_int & s->tc_mask);
    case 3: /* IntErrorStatus */
        return (s->err_int & s->err_mask);
    case 5: /* RawIntTCStatus */
        return s->tc_int;
    case 6: /* RawIntErrorStatus */
        return s->err_int;
    case 7: /* EnbldChns */
        mask = 0;
        for (i = 0; i < s->nchannels; i++) {
            if (s->chan[i].conf & PL080_CCONF_E)
                mask |= 1 << i;
        }
        return mask;
    case 8: /* SoftBReq */
    case 9: /* SoftSReq */
    case 10: /* SoftLBReq */
    case 11: /* SoftLSReq */
        /* ??? Implement these. */
        return 0;
    case 12: /* Configuration */
        return s->conf;
    case 13: /* Sync */
        return s->sync;
    default:
    bad_offset:
        cpu_abort(cpu_single_env, "pl080_read: Bad offset %x\n", offset);
        return 0;
    }
}

static void pl080_write(void *opaque, target_phys_addr_t offset,
                          uint32_t value)
{
    pl080_state *s = (pl080_state *)opaque;
    int i;

    offset -= s->base;
    if (offset >= 0x100 && offset < 0x200) {
        i = (offset & 0xe0) >> 5;
        if (i >= s->nchannels)
            goto bad_offset;
        switch (offset >> 2) {
        case 0: /* SrcAddr */
            s->chan[i].src = value;
            break;
        case 1: /* DestAddr */
            s->chan[i].dest = value;
            break;
        case 2: /* LLI */
            s->chan[i].lli = value;
            break;
        case 3: /* Control */
            s->chan[i].ctrl = value;
            break;
        case 4: /* Configuration */
            s->chan[i].conf = value;
            pl080_run(s);
            break;
        }
    }
    switch (offset >> 2) {
    case 2: /* IntTCClear */
        s->tc_int &= ~value;
        break;
    case 4: /* IntErrorClear */
        s->err_int &= ~value;
        break;
    case 8: /* SoftBReq */
    case 9: /* SoftSReq */
    case 10: /* SoftLBReq */
    case 11: /* SoftLSReq */
        /* ??? Implement these.  */
        cpu_abort(cpu_single_env, "pl080_write: Soft DMA not implemented\n");
        break;
    case 12: /* Configuration */
        s->conf = value;
        if (s->conf & (PL080_CONF_M1 | PL080_CONF_M1)) {
            cpu_abort(cpu_single_env,
                      "pl080_write: Big-endian DMA not implemented\n");
        }
        pl080_run(s);
        break;
    case 13: /* Sync */
        s->sync = value;
        break;
    default:
    bad_offset:
        cpu_abort(cpu_single_env, "pl080_write: Bad offset %x\n", offset);
    }
    pl080_update(s);
}

static CPUReadMemoryFunc *pl080_readfn[] = {
   pl080_read,
   pl080_read,
   pl080_read
};

static CPUWriteMemoryFunc *pl080_writefn[] = {
   pl080_write,
   pl080_write,
   pl080_write
};

/* The PL080 and PL081 are the same except for the number of channels
   they implement (8 and 2 respectively).  */
void *pl080_init(uint32_t base, void *pic, int irq, int nchannels)
{
    int iomemtype;
    pl080_state *s;

    s = (pl080_state *)qemu_mallocz(sizeof(pl080_state));
    iomemtype = cpu_register_io_memory(0, pl080_readfn,
                                       pl080_writefn, s);
    cpu_register_physical_memory(base, 0x00000fff, iomemtype);
    s->base = base;
    s->pic = pic;
    s->irq = irq;
    s->nchannels = nchannels;
    /* ??? Save/restore.  */
    return s;
}
Commit	Line	Data
cdbdb648	1	/*
e69954b9	2	* Arm PrimeCell PL080/PL081 DMA controller
cdbdb648 PB	3	*
	4	* Copyright (c) 2006 CodeSourcery.
	5	* Written by Paul Brook
	6	*
	7	* This code is licenced under the GPL.
	8	*/
	9
	10	#include "vl.h"
	11
e69954b9	12	#define PL080_MAX_CHANNELS 8
cdbdb648 PB	13	#define PL080_CONF_E 0x1
	14	#define PL080_CONF_M1 0x2
	15	#define PL080_CONF_M2 0x4
	16
	17	#define PL080_CCONF_H 0x40000
	18	#define PL080_CCONF_A 0x20000
	19	#define PL080_CCONF_L 0x10000
	20	#define PL080_CCONF_ITC 0x08000
	21	#define PL080_CCONF_IE 0x04000
	22	#define PL080_CCONF_E 0x00001
	23
	24	#define PL080_CCTRL_I 0x80000000
	25	#define PL080_CCTRL_DI 0x08000000
	26	#define PL080_CCTRL_SI 0x04000000
	27	#define PL080_CCTRL_D 0x02000000
	28	#define PL080_CCTRL_S 0x01000000
	29
	30	typedef struct {
	31	uint32_t src;
	32	uint32_t dest;
	33	uint32_t lli;
	34	uint32_t ctrl;
	35	uint32_t conf;
	36	} pl080_channel;
	37
	38	typedef struct {
	39	uint32_t base;
	40	uint8_t tc_int;
	41	uint8_t tc_mask;
	42	uint8_t err_int;
	43	uint8_t err_mask;
	44	uint32_t conf;
	45	uint32_t sync;
	46	uint32_t req_single;
	47	uint32_t req_burst;
e69954b9 PB	48	pl080_channel chan[PL080_MAX_CHANNELS];
e69954b9 PB	49	int nchannels;
cdbdb648 PB	50	/* Flag to avoid recursive DMA invocations. */
	51	int running;
	52	void *pic;
	53	int irq;
	54	} pl080_state;
	55
	56	static const unsigned char pl080_id[] =
	57	{ 0x80, 0x10, 0x04, 0x0a, 0x0d, 0xf0, 0x05, 0xb1 };
	58
e69954b9 PB	59	static const unsigned char pl081_id[] =
	60	{ 0x81, 0x10, 0x04, 0x0a, 0x0d, 0xf0, 0x05, 0xb1 };
	61
cdbdb648 PB	62	static void pl080_update(pl080_state *s)
	63	{
	64	if ((s->tc_int & s->tc_mask)
	65	\|\| (s->err_int & s->err_mask))
	66	pic_set_irq_new(s->pic, s->irq, 1);
	67	else
	68	pic_set_irq_new(s->pic, s->irq, 1);
	69	}
	70
	71	static void pl080_run(pl080_state *s)
	72	{
	73	int c;
	74	int flow;
	75	pl080_channel *ch;
	76	int swidth;
	77	int dwidth;
	78	int xsize;
	79	int n;
	80	int src_id;
	81	int dest_id;
	82	int size;
	83	char buff[4];
	84	uint32_t req;
	85
	86	s->tc_mask = 0;
e69954b9	87	for (c = 0; c < s->nchannels; c++) {
cdbdb648 PB	88	if (s->chan[c].conf & PL080_CCONF_ITC)
	89	s->tc_mask \|= 1 << c;
	90	if (s->chan[c].conf & PL080_CCONF_IE)
	91	s->err_mask \|= 1 << c;
	92	}
	93
	94	if ((s->conf & PL080_CONF_E) == 0)
	95	return;
	96
	97	cpu_abort(cpu_single_env, "DMA active\n");
	98	/* If we are already in the middle of a DMA operation then indicate that
	99	there may be new DMA requests and return immediately. */
	100	if (s->running) {
	101	s->running++;
	102	return;
	103	}
	104	s->running = 1;
	105	while (s->running) {
e69954b9	106	for (c = 0; c < s->nchannels; c++) {
cdbdb648 PB	107	ch = &s->chan[c];
	108	again:
	109	/* Test if thiws channel has any pending DMA requests. */
	110	if ((ch->conf & (PL080_CCONF_H \| PL080_CCONF_E))
	111	!= PL080_CCONF_E)
	112	continue;
	113	flow = (ch->conf >> 11) & 7;
	114	if (flow >= 4) {
	115	cpu_abort(cpu_single_env,
	116	"pl080_run: Peripheral flow control not implemented\n");
	117	}
	118	src_id = (ch->conf >> 1) & 0x1f;
	119	dest_id = (ch->conf >> 6) & 0x1f;
	120	size = ch->ctrl & 0xfff;
	121	req = s->req_single \| s->req_burst;
	122	switch (flow) {
	123	case 0:
	124	break;
	125	case 1:
	126	if ((req & (1u << dest_id)) == 0)
	127	size = 0;
	128	break;
	129	case 2:
	130	if ((req & (1u << src_id)) == 0)
	131	size = 0;
	132	break;
	133	case 3:
	134	if ((req & (1u << src_id)) == 0
	135	\|\| (req & (1u << dest_id)) == 0)
	136	size = 0;
	137	break;
	138	}
	139	if (!size)
	140	continue;
	141
	142	/* Transfer one element. */
	143	/* ??? Should transfer multiple elements for a burst request. */
	144	/* ??? Unclear what the proper behavior is when source and
	145	destination widths are different. */
	146	swidth = 1 << ((ch->ctrl >> 18) & 7);
	147	dwidth = 1 << ((ch->ctrl >> 21) & 7);
	148	for (n = 0; n < dwidth; n+= swidth) {
	149	cpu_physical_memory_read(ch->src, buff + n, swidth);
	150	if (ch->ctrl & PL080_CCTRL_SI)
	151	ch->src += swidth;
	152	}
	153	xsize = (dwidth < swidth) ? swidth : dwidth;
	154	/* ??? This may pad the value incorrectly for dwidth < 32. */
	155	for (n = 0; n < xsize; n += dwidth) {
	156	cpu_physical_memory_write(ch->dest + n, buff + n, dwidth);
	157	if (ch->ctrl & PL080_CCTRL_DI)
	158	ch->dest += swidth;
	159	}
	160
	161	size--;
	162	ch->ctrl = (ch->ctrl & 0xfffff000) \| size;
	163	if (size == 0) {
	164	/* Transfer complete. */
	165	if (ch->lli) {
	166	ch->src = ldl_phys(ch->lli);
	167	ch->dest = ldl_phys(ch->lli + 4);
	168	ch->ctrl = ldl_phys(ch->lli + 12);
	169	ch->lli = ldl_phys(ch->lli + 8);
	170	} else {
171	ch->conf &= ~PL080_CCONF_E;
172	}
173	if (ch->ctrl & PL080_CCTRL_I) {
174	s->tc_int \|= 1 << c;
175	}
176	}
177	goto again;
178	}
179	if (--s->running)
180	s->running = 1;
181	}
182	}
183
184	static uint32_t pl080_read(void *opaque, target_phys_addr_t offset)
185	{
186	pl080_state s = (pl080_state )opaque;
187	uint32_t i;
188	uint32_t mask;
189
190	offset -= s->base;
191	if (offset >= 0xfe0 && offset < 0x1000) {
e69954b9 PB	192	if (s->nchannels == 8) {
	193	return pl080_id[(offset - 0xfe0) >> 2];
	194	} else {
	195	return pl081_id[(offset - 0xfe0) >> 2];
	196	}
cdbdb648 PB	197	}
	198	if (offset >= 0x100 && offset < 0x200) {
	199	i = (offset & 0xe0) >> 5;
e69954b9 PB	200	if (i >= s->nchannels)
e69954b9 PB	201	goto bad_offset;
cdbdb648 PB	202	switch (offset >> 2) {
	203	case 0: /* SrcAddr */
	204	return s->chan[i].src;
	205	case 1: /* DestAddr */
	206	return s->chan[i].dest;
	207	case 2: /* LLI */
	208	return s->chan[i].lli;
	209	case 3: /* Control */
	210	return s->chan[i].ctrl;
	211	case 4: /* Configuration */
	212	return s->chan[i].conf;
	213	default:
	214	goto bad_offset;
	215	}
	216	}
	217	switch (offset >> 2) {
	218	case 0: /* IntStatus */
	219	return (s->tc_int & s->tc_mask) \| (s->err_int & s->err_mask);
	220	case 1: /* IntTCStatus */
	221	return (s->tc_int & s->tc_mask);
	222	case 3: /* IntErrorStatus */
	223	return (s->err_int & s->err_mask);
	224	case 5: /* RawIntTCStatus */
	225	return s->tc_int;
	226	case 6: /* RawIntErrorStatus */
	227	return s->err_int;
	228	case 7: /* EnbldChns */
	229	mask = 0;
e69954b9	230	for (i = 0; i < s->nchannels; i++) {
cdbdb648 PB	231	if (s->chan[i].conf & PL080_CCONF_E)
	232	mask \|= 1 << i;
	233	}
	234	return mask;
	235	case 8: /* SoftBReq */
	236	case 9: /* SoftSReq */
	237	case 10: /* SoftLBReq */
	238	case 11: /* SoftLSReq */
	239	/* ??? Implement these. */
	240	return 0;
	241	case 12: /* Configuration */
	242	return s->conf;
	243	case 13: /* Sync */
	244	return s->sync;
	245	default:
	246	bad_offset:
	247	cpu_abort(cpu_single_env, "pl080_read: Bad offset %x\n", offset);
	248	return 0;
	249	}
	250	}
	251
	252	static void pl080_write(void *opaque, target_phys_addr_t offset,
	253	uint32_t value)
	254	{
	255	pl080_state s = (pl080_state )opaque;
	256	int i;
	257
	258	offset -= s->base;
	259	if (offset >= 0x100 && offset < 0x200) {
	260	i = (offset & 0xe0) >> 5;
e69954b9 PB	261	if (i >= s->nchannels)
e69954b9 PB	262	goto bad_offset;
cdbdb648 PB	263	switch (offset >> 2) {
	264	case 0: /* SrcAddr */
	265	s->chan[i].src = value;
	266	break;
	267	case 1: /* DestAddr */
	268	s->chan[i].dest = value;
	269	break;
	270	case 2: /* LLI */
	271	s->chan[i].lli = value;
	272	break;
	273	case 3: /* Control */
	274	s->chan[i].ctrl = value;
	275	break;
	276	case 4: /* Configuration */
	277	s->chan[i].conf = value;
	278	pl080_run(s);
	279	break;
	280	}
	281	}
	282	switch (offset >> 2) {
	283	case 2: /* IntTCClear */
	284	s->tc_int &= ~value;
	285	break;
	286	case 4: /* IntErrorClear */
	287	s->err_int &= ~value;
	288	break;
	289	case 8: /* SoftBReq */
	290	case 9: /* SoftSReq */
	291	case 10: /* SoftLBReq */
	292	case 11: /* SoftLSReq */
	293	/* ??? Implement these. */
	294	cpu_abort(cpu_single_env, "pl080_write: Soft DMA not implemented\n");
	295	break;
	296	case 12: /* Configuration */
	297	s->conf = value;
	298	if (s->conf & (PL080_CONF_M1 \| PL080_CONF_M1)) {
	299	cpu_abort(cpu_single_env,
	300	"pl080_write: Big-endian DMA not implemented\n");
	301	}
	302	pl080_run(s);
	303	break;
	304	case 13: /* Sync */
	305	s->sync = value;
	306	break;
	307	default:
e69954b9	308	bad_offset:
cdbdb648 PB	309	cpu_abort(cpu_single_env, "pl080_write: Bad offset %x\n", offset);
	310	}
	311	pl080_update(s);
	312	}
	313
	314	static CPUReadMemoryFunc *pl080_readfn[] = {
	315	pl080_read,
	316	pl080_read,
	317	pl080_read
	318	};
	319
	320	static CPUWriteMemoryFunc *pl080_writefn[] = {
	321	pl080_write,
	322	pl080_write,
	323	pl080_write
	324	};
	325
e69954b9 PB	326	/* The PL080 and PL081 are the same except for the number of channels
	327	they implement (8 and 2 respectively). */
	328	void pl080_init(uint32_t base, void pic, int irq, int nchannels)
cdbdb648 PB	329	{
	330	int iomemtype;
	331	pl080_state *s;
	332
	333	s = (pl080_state *)qemu_mallocz(sizeof(pl080_state));
	334	iomemtype = cpu_register_io_memory(0, pl080_readfn,
	335	pl080_writefn, s);
	336	cpu_register_physical_memory(base, 0x00000fff, iomemtype);
	337	s->base = base;
	338	s->pic = pic;
	339	s->irq = irq;
e69954b9	340	s->nchannels = nchannels;
cdbdb648 PB	341	/* ??? Save/restore. */
	342	return s;
	343	}
	344