xref: /openbmc/qemu/hw/misc/macio/mac_dbdma.c (revision 2c9b15cab12c21e32dffb67c5e18f3dc407ca224)
149ab747fSPaolo Bonzini /*
249ab747fSPaolo Bonzini  * PowerMac descriptor-based DMA emulation
349ab747fSPaolo Bonzini  *
449ab747fSPaolo Bonzini  * Copyright (c) 2005-2007 Fabrice Bellard
549ab747fSPaolo Bonzini  * Copyright (c) 2007 Jocelyn Mayer
649ab747fSPaolo Bonzini  * Copyright (c) 2009 Laurent Vivier
749ab747fSPaolo Bonzini  *
849ab747fSPaolo Bonzini  * some parts from linux-2.6.28, arch/powerpc/include/asm/dbdma.h
949ab747fSPaolo Bonzini  *
1049ab747fSPaolo Bonzini  *   Definitions for using the Apple Descriptor-Based DMA controller
1149ab747fSPaolo Bonzini  *   in Power Macintosh computers.
1249ab747fSPaolo Bonzini  *
1349ab747fSPaolo Bonzini  *   Copyright (C) 1996 Paul Mackerras.
1449ab747fSPaolo Bonzini  *
1549ab747fSPaolo Bonzini  * some parts from mol 0.9.71
1649ab747fSPaolo Bonzini  *
1749ab747fSPaolo Bonzini  *   Descriptor based DMA emulation
1849ab747fSPaolo Bonzini  *
1949ab747fSPaolo Bonzini  *   Copyright (C) 1998-2004 Samuel Rydh (samuel@ibrium.se)
2049ab747fSPaolo Bonzini  *
2149ab747fSPaolo Bonzini  * Permission is hereby granted, free of charge, to any person obtaining a copy
2249ab747fSPaolo Bonzini  * of this software and associated documentation files (the "Software"), to deal
2349ab747fSPaolo Bonzini  * in the Software without restriction, including without limitation the rights
2449ab747fSPaolo Bonzini  * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
2549ab747fSPaolo Bonzini  * copies of the Software, and to permit persons to whom the Software is
2649ab747fSPaolo Bonzini  * furnished to do so, subject to the following conditions:
2749ab747fSPaolo Bonzini  *
2849ab747fSPaolo Bonzini  * The above copyright notice and this permission notice shall be included in
2949ab747fSPaolo Bonzini  * all copies or substantial portions of the Software.
3049ab747fSPaolo Bonzini  *
3149ab747fSPaolo Bonzini  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
3249ab747fSPaolo Bonzini  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
3349ab747fSPaolo Bonzini  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
3449ab747fSPaolo Bonzini  * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
3549ab747fSPaolo Bonzini  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
3649ab747fSPaolo Bonzini  * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
3749ab747fSPaolo Bonzini  * THE SOFTWARE.
3849ab747fSPaolo Bonzini  */
3949ab747fSPaolo Bonzini #include "hw/hw.h"
4049ab747fSPaolo Bonzini #include "hw/isa/isa.h"
4149ab747fSPaolo Bonzini #include "hw/ppc/mac_dbdma.h"
4249ab747fSPaolo Bonzini #include "qemu/main-loop.h"
4349ab747fSPaolo Bonzini 
4449ab747fSPaolo Bonzini /* debug DBDMA */
4549ab747fSPaolo Bonzini //#define DEBUG_DBDMA
4649ab747fSPaolo Bonzini 
4749ab747fSPaolo Bonzini #ifdef DEBUG_DBDMA
4849ab747fSPaolo Bonzini #define DBDMA_DPRINTF(fmt, ...)                                 \
4949ab747fSPaolo Bonzini     do { printf("DBDMA: " fmt , ## __VA_ARGS__); } while (0)
5049ab747fSPaolo Bonzini #else
5149ab747fSPaolo Bonzini #define DBDMA_DPRINTF(fmt, ...)
5249ab747fSPaolo Bonzini #endif
5349ab747fSPaolo Bonzini 
5449ab747fSPaolo Bonzini /*
5549ab747fSPaolo Bonzini  */
5649ab747fSPaolo Bonzini 
5749ab747fSPaolo Bonzini /*
5849ab747fSPaolo Bonzini  * DBDMA control/status registers.  All little-endian.
5949ab747fSPaolo Bonzini  */
6049ab747fSPaolo Bonzini 
6149ab747fSPaolo Bonzini #define DBDMA_CONTROL         0x00
6249ab747fSPaolo Bonzini #define DBDMA_STATUS          0x01
6349ab747fSPaolo Bonzini #define DBDMA_CMDPTR_HI       0x02
6449ab747fSPaolo Bonzini #define DBDMA_CMDPTR_LO       0x03
6549ab747fSPaolo Bonzini #define DBDMA_INTR_SEL        0x04
6649ab747fSPaolo Bonzini #define DBDMA_BRANCH_SEL      0x05
6749ab747fSPaolo Bonzini #define DBDMA_WAIT_SEL        0x06
6849ab747fSPaolo Bonzini #define DBDMA_XFER_MODE       0x07
6949ab747fSPaolo Bonzini #define DBDMA_DATA2PTR_HI     0x08
7049ab747fSPaolo Bonzini #define DBDMA_DATA2PTR_LO     0x09
7149ab747fSPaolo Bonzini #define DBDMA_RES1            0x0A
7249ab747fSPaolo Bonzini #define DBDMA_ADDRESS_HI      0x0B
7349ab747fSPaolo Bonzini #define DBDMA_BRANCH_ADDR_HI  0x0C
7449ab747fSPaolo Bonzini #define DBDMA_RES2            0x0D
7549ab747fSPaolo Bonzini #define DBDMA_RES3            0x0E
7649ab747fSPaolo Bonzini #define DBDMA_RES4            0x0F
7749ab747fSPaolo Bonzini 
7849ab747fSPaolo Bonzini #define DBDMA_REGS            16
7949ab747fSPaolo Bonzini #define DBDMA_SIZE            (DBDMA_REGS * sizeof(uint32_t))
8049ab747fSPaolo Bonzini 
8149ab747fSPaolo Bonzini #define DBDMA_CHANNEL_SHIFT   7
8249ab747fSPaolo Bonzini #define DBDMA_CHANNEL_SIZE    (1 << DBDMA_CHANNEL_SHIFT)
8349ab747fSPaolo Bonzini 
8449ab747fSPaolo Bonzini #define DBDMA_CHANNELS        (0x1000 >> DBDMA_CHANNEL_SHIFT)
8549ab747fSPaolo Bonzini 
8649ab747fSPaolo Bonzini /* Bits in control and status registers */
8749ab747fSPaolo Bonzini 
8849ab747fSPaolo Bonzini #define RUN	0x8000
8949ab747fSPaolo Bonzini #define PAUSE	0x4000
9049ab747fSPaolo Bonzini #define FLUSH	0x2000
9149ab747fSPaolo Bonzini #define WAKE	0x1000
9249ab747fSPaolo Bonzini #define DEAD	0x0800
9349ab747fSPaolo Bonzini #define ACTIVE	0x0400
9449ab747fSPaolo Bonzini #define BT	0x0100
9549ab747fSPaolo Bonzini #define DEVSTAT	0x00ff
9649ab747fSPaolo Bonzini 
9749ab747fSPaolo Bonzini /*
9849ab747fSPaolo Bonzini  * DBDMA command structure.  These fields are all little-endian!
9949ab747fSPaolo Bonzini  */
10049ab747fSPaolo Bonzini 
10149ab747fSPaolo Bonzini typedef struct dbdma_cmd {
10249ab747fSPaolo Bonzini     uint16_t req_count;	  /* requested byte transfer count */
10349ab747fSPaolo Bonzini     uint16_t command;	  /* command word (has bit-fields) */
10449ab747fSPaolo Bonzini     uint32_t phy_addr;	  /* physical data address */
10549ab747fSPaolo Bonzini     uint32_t cmd_dep;	  /* command-dependent field */
10649ab747fSPaolo Bonzini     uint16_t res_count;	  /* residual count after completion */
10749ab747fSPaolo Bonzini     uint16_t xfer_status; /* transfer status */
10849ab747fSPaolo Bonzini } dbdma_cmd;
10949ab747fSPaolo Bonzini 
11049ab747fSPaolo Bonzini /* DBDMA command values in command field */
11149ab747fSPaolo Bonzini 
11249ab747fSPaolo Bonzini #define COMMAND_MASK    0xf000
11349ab747fSPaolo Bonzini #define OUTPUT_MORE	0x0000	/* transfer memory data to stream */
11449ab747fSPaolo Bonzini #define OUTPUT_LAST	0x1000	/* ditto followed by end marker */
11549ab747fSPaolo Bonzini #define INPUT_MORE	0x2000	/* transfer stream data to memory */
11649ab747fSPaolo Bonzini #define INPUT_LAST	0x3000	/* ditto, expect end marker */
11749ab747fSPaolo Bonzini #define STORE_WORD	0x4000	/* write word (4 bytes) to device reg */
11849ab747fSPaolo Bonzini #define LOAD_WORD	0x5000	/* read word (4 bytes) from device reg */
11949ab747fSPaolo Bonzini #define DBDMA_NOP	0x6000	/* do nothing */
12049ab747fSPaolo Bonzini #define DBDMA_STOP	0x7000	/* suspend processing */
12149ab747fSPaolo Bonzini 
12249ab747fSPaolo Bonzini /* Key values in command field */
12349ab747fSPaolo Bonzini 
12449ab747fSPaolo Bonzini #define KEY_MASK        0x0700
12549ab747fSPaolo Bonzini #define KEY_STREAM0	0x0000	/* usual data stream */
12649ab747fSPaolo Bonzini #define KEY_STREAM1	0x0100	/* control/status stream */
12749ab747fSPaolo Bonzini #define KEY_STREAM2	0x0200	/* device-dependent stream */
12849ab747fSPaolo Bonzini #define KEY_STREAM3	0x0300	/* device-dependent stream */
12949ab747fSPaolo Bonzini #define KEY_STREAM4	0x0400	/* reserved */
13049ab747fSPaolo Bonzini #define KEY_REGS	0x0500	/* device register space */
13149ab747fSPaolo Bonzini #define KEY_SYSTEM	0x0600	/* system memory-mapped space */
13249ab747fSPaolo Bonzini #define KEY_DEVICE	0x0700	/* device memory-mapped space */
13349ab747fSPaolo Bonzini 
13449ab747fSPaolo Bonzini /* Interrupt control values in command field */
13549ab747fSPaolo Bonzini 
13649ab747fSPaolo Bonzini #define INTR_MASK       0x0030
13749ab747fSPaolo Bonzini #define INTR_NEVER	0x0000	/* don't interrupt */
13849ab747fSPaolo Bonzini #define INTR_IFSET	0x0010	/* intr if condition bit is 1 */
13949ab747fSPaolo Bonzini #define INTR_IFCLR	0x0020	/* intr if condition bit is 0 */
14049ab747fSPaolo Bonzini #define INTR_ALWAYS	0x0030	/* always interrupt */
14149ab747fSPaolo Bonzini 
14249ab747fSPaolo Bonzini /* Branch control values in command field */
14349ab747fSPaolo Bonzini 
14449ab747fSPaolo Bonzini #define BR_MASK         0x000c
14549ab747fSPaolo Bonzini #define BR_NEVER	0x0000	/* don't branch */
14649ab747fSPaolo Bonzini #define BR_IFSET	0x0004	/* branch if condition bit is 1 */
14749ab747fSPaolo Bonzini #define BR_IFCLR	0x0008	/* branch if condition bit is 0 */
14849ab747fSPaolo Bonzini #define BR_ALWAYS	0x000c	/* always branch */
14949ab747fSPaolo Bonzini 
15049ab747fSPaolo Bonzini /* Wait control values in command field */
15149ab747fSPaolo Bonzini 
15249ab747fSPaolo Bonzini #define WAIT_MASK       0x0003
15349ab747fSPaolo Bonzini #define WAIT_NEVER	0x0000	/* don't wait */
15449ab747fSPaolo Bonzini #define WAIT_IFSET	0x0001	/* wait if condition bit is 1 */
15549ab747fSPaolo Bonzini #define WAIT_IFCLR	0x0002	/* wait if condition bit is 0 */
15649ab747fSPaolo Bonzini #define WAIT_ALWAYS	0x0003	/* always wait */
15749ab747fSPaolo Bonzini 
15849ab747fSPaolo Bonzini typedef struct DBDMA_channel {
15949ab747fSPaolo Bonzini     int channel;
16049ab747fSPaolo Bonzini     uint32_t regs[DBDMA_REGS];
16149ab747fSPaolo Bonzini     qemu_irq irq;
16249ab747fSPaolo Bonzini     DBDMA_io io;
16349ab747fSPaolo Bonzini     DBDMA_rw rw;
16449ab747fSPaolo Bonzini     DBDMA_flush flush;
16549ab747fSPaolo Bonzini     dbdma_cmd current;
16649ab747fSPaolo Bonzini     int processing;
16749ab747fSPaolo Bonzini } DBDMA_channel;
16849ab747fSPaolo Bonzini 
16949ab747fSPaolo Bonzini typedef struct {
17049ab747fSPaolo Bonzini     MemoryRegion mem;
17149ab747fSPaolo Bonzini     DBDMA_channel channels[DBDMA_CHANNELS];
17249ab747fSPaolo Bonzini } DBDMAState;
17349ab747fSPaolo Bonzini 
17449ab747fSPaolo Bonzini #ifdef DEBUG_DBDMA
17549ab747fSPaolo Bonzini static void dump_dbdma_cmd(dbdma_cmd *cmd)
17649ab747fSPaolo Bonzini {
17749ab747fSPaolo Bonzini     printf("dbdma_cmd %p\n", cmd);
17849ab747fSPaolo Bonzini     printf("    req_count 0x%04x\n", le16_to_cpu(cmd->req_count));
17949ab747fSPaolo Bonzini     printf("    command 0x%04x\n", le16_to_cpu(cmd->command));
18049ab747fSPaolo Bonzini     printf("    phy_addr 0x%08x\n", le32_to_cpu(cmd->phy_addr));
18149ab747fSPaolo Bonzini     printf("    cmd_dep 0x%08x\n", le32_to_cpu(cmd->cmd_dep));
18249ab747fSPaolo Bonzini     printf("    res_count 0x%04x\n", le16_to_cpu(cmd->res_count));
18349ab747fSPaolo Bonzini     printf("    xfer_status 0x%04x\n", le16_to_cpu(cmd->xfer_status));
18449ab747fSPaolo Bonzini }
18549ab747fSPaolo Bonzini #else
18649ab747fSPaolo Bonzini static void dump_dbdma_cmd(dbdma_cmd *cmd)
18749ab747fSPaolo Bonzini {
18849ab747fSPaolo Bonzini }
18949ab747fSPaolo Bonzini #endif
19049ab747fSPaolo Bonzini static void dbdma_cmdptr_load(DBDMA_channel *ch)
19149ab747fSPaolo Bonzini {
19249ab747fSPaolo Bonzini     DBDMA_DPRINTF("dbdma_cmdptr_load 0x%08x\n",
19349ab747fSPaolo Bonzini                   ch->regs[DBDMA_CMDPTR_LO]);
19449ab747fSPaolo Bonzini     cpu_physical_memory_read(ch->regs[DBDMA_CMDPTR_LO],
195e1fe50dcSStefan Weil                              &ch->current, sizeof(dbdma_cmd));
19649ab747fSPaolo Bonzini }
19749ab747fSPaolo Bonzini 
19849ab747fSPaolo Bonzini static void dbdma_cmdptr_save(DBDMA_channel *ch)
19949ab747fSPaolo Bonzini {
20049ab747fSPaolo Bonzini     DBDMA_DPRINTF("dbdma_cmdptr_save 0x%08x\n",
20149ab747fSPaolo Bonzini                   ch->regs[DBDMA_CMDPTR_LO]);
20249ab747fSPaolo Bonzini     DBDMA_DPRINTF("xfer_status 0x%08x res_count 0x%04x\n",
20349ab747fSPaolo Bonzini                   le16_to_cpu(ch->current.xfer_status),
20449ab747fSPaolo Bonzini                   le16_to_cpu(ch->current.res_count));
20549ab747fSPaolo Bonzini     cpu_physical_memory_write(ch->regs[DBDMA_CMDPTR_LO],
206e1fe50dcSStefan Weil                               &ch->current, sizeof(dbdma_cmd));
20749ab747fSPaolo Bonzini }
20849ab747fSPaolo Bonzini 
20949ab747fSPaolo Bonzini static void kill_channel(DBDMA_channel *ch)
21049ab747fSPaolo Bonzini {
21149ab747fSPaolo Bonzini     DBDMA_DPRINTF("kill_channel\n");
21249ab747fSPaolo Bonzini 
21349ab747fSPaolo Bonzini     ch->regs[DBDMA_STATUS] |= DEAD;
21449ab747fSPaolo Bonzini     ch->regs[DBDMA_STATUS] &= ~ACTIVE;
21549ab747fSPaolo Bonzini 
21649ab747fSPaolo Bonzini     qemu_irq_raise(ch->irq);
21749ab747fSPaolo Bonzini }
21849ab747fSPaolo Bonzini 
21949ab747fSPaolo Bonzini static void conditional_interrupt(DBDMA_channel *ch)
22049ab747fSPaolo Bonzini {
22149ab747fSPaolo Bonzini     dbdma_cmd *current = &ch->current;
22249ab747fSPaolo Bonzini     uint16_t intr;
22349ab747fSPaolo Bonzini     uint16_t sel_mask, sel_value;
22449ab747fSPaolo Bonzini     uint32_t status;
22549ab747fSPaolo Bonzini     int cond;
22649ab747fSPaolo Bonzini 
22749ab747fSPaolo Bonzini     DBDMA_DPRINTF("conditional_interrupt\n");
22849ab747fSPaolo Bonzini 
22949ab747fSPaolo Bonzini     intr = le16_to_cpu(current->command) & INTR_MASK;
23049ab747fSPaolo Bonzini 
23149ab747fSPaolo Bonzini     switch(intr) {
23249ab747fSPaolo Bonzini     case INTR_NEVER:  /* don't interrupt */
23349ab747fSPaolo Bonzini         return;
23449ab747fSPaolo Bonzini     case INTR_ALWAYS: /* always interrupt */
23549ab747fSPaolo Bonzini         qemu_irq_raise(ch->irq);
23649ab747fSPaolo Bonzini         return;
23749ab747fSPaolo Bonzini     }
23849ab747fSPaolo Bonzini 
23949ab747fSPaolo Bonzini     status = ch->regs[DBDMA_STATUS] & DEVSTAT;
24049ab747fSPaolo Bonzini 
24149ab747fSPaolo Bonzini     sel_mask = (ch->regs[DBDMA_INTR_SEL] >> 16) & 0x0f;
24249ab747fSPaolo Bonzini     sel_value = ch->regs[DBDMA_INTR_SEL] & 0x0f;
24349ab747fSPaolo Bonzini 
24449ab747fSPaolo Bonzini     cond = (status & sel_mask) == (sel_value & sel_mask);
24549ab747fSPaolo Bonzini 
24649ab747fSPaolo Bonzini     switch(intr) {
24749ab747fSPaolo Bonzini     case INTR_IFSET:  /* intr if condition bit is 1 */
24849ab747fSPaolo Bonzini         if (cond)
24949ab747fSPaolo Bonzini             qemu_irq_raise(ch->irq);
25049ab747fSPaolo Bonzini         return;
25149ab747fSPaolo Bonzini     case INTR_IFCLR:  /* intr if condition bit is 0 */
25249ab747fSPaolo Bonzini         if (!cond)
25349ab747fSPaolo Bonzini             qemu_irq_raise(ch->irq);
25449ab747fSPaolo Bonzini         return;
25549ab747fSPaolo Bonzini     }
25649ab747fSPaolo Bonzini }
25749ab747fSPaolo Bonzini 
25849ab747fSPaolo Bonzini static int conditional_wait(DBDMA_channel *ch)
25949ab747fSPaolo Bonzini {
26049ab747fSPaolo Bonzini     dbdma_cmd *current = &ch->current;
26149ab747fSPaolo Bonzini     uint16_t wait;
26249ab747fSPaolo Bonzini     uint16_t sel_mask, sel_value;
26349ab747fSPaolo Bonzini     uint32_t status;
26449ab747fSPaolo Bonzini     int cond;
26549ab747fSPaolo Bonzini 
26649ab747fSPaolo Bonzini     DBDMA_DPRINTF("conditional_wait\n");
26749ab747fSPaolo Bonzini 
26849ab747fSPaolo Bonzini     wait = le16_to_cpu(current->command) & WAIT_MASK;
26949ab747fSPaolo Bonzini 
27049ab747fSPaolo Bonzini     switch(wait) {
27149ab747fSPaolo Bonzini     case WAIT_NEVER:  /* don't wait */
27249ab747fSPaolo Bonzini         return 0;
27349ab747fSPaolo Bonzini     case WAIT_ALWAYS: /* always wait */
27449ab747fSPaolo Bonzini         return 1;
27549ab747fSPaolo Bonzini     }
27649ab747fSPaolo Bonzini 
27749ab747fSPaolo Bonzini     status = ch->regs[DBDMA_STATUS] & DEVSTAT;
27849ab747fSPaolo Bonzini 
27949ab747fSPaolo Bonzini     sel_mask = (ch->regs[DBDMA_WAIT_SEL] >> 16) & 0x0f;
28049ab747fSPaolo Bonzini     sel_value = ch->regs[DBDMA_WAIT_SEL] & 0x0f;
28149ab747fSPaolo Bonzini 
28249ab747fSPaolo Bonzini     cond = (status & sel_mask) == (sel_value & sel_mask);
28349ab747fSPaolo Bonzini 
28449ab747fSPaolo Bonzini     switch(wait) {
28549ab747fSPaolo Bonzini     case WAIT_IFSET:  /* wait if condition bit is 1 */
28649ab747fSPaolo Bonzini         if (cond)
28749ab747fSPaolo Bonzini             return 1;
28849ab747fSPaolo Bonzini         return 0;
28949ab747fSPaolo Bonzini     case WAIT_IFCLR:  /* wait if condition bit is 0 */
29049ab747fSPaolo Bonzini         if (!cond)
29149ab747fSPaolo Bonzini             return 1;
29249ab747fSPaolo Bonzini         return 0;
29349ab747fSPaolo Bonzini     }
29449ab747fSPaolo Bonzini     return 0;
29549ab747fSPaolo Bonzini }
29649ab747fSPaolo Bonzini 
29749ab747fSPaolo Bonzini static void next(DBDMA_channel *ch)
29849ab747fSPaolo Bonzini {
29949ab747fSPaolo Bonzini     uint32_t cp;
30049ab747fSPaolo Bonzini 
30149ab747fSPaolo Bonzini     ch->regs[DBDMA_STATUS] &= ~BT;
30249ab747fSPaolo Bonzini 
30349ab747fSPaolo Bonzini     cp = ch->regs[DBDMA_CMDPTR_LO];
30449ab747fSPaolo Bonzini     ch->regs[DBDMA_CMDPTR_LO] = cp + sizeof(dbdma_cmd);
30549ab747fSPaolo Bonzini     dbdma_cmdptr_load(ch);
30649ab747fSPaolo Bonzini }
30749ab747fSPaolo Bonzini 
30849ab747fSPaolo Bonzini static void branch(DBDMA_channel *ch)
30949ab747fSPaolo Bonzini {
31049ab747fSPaolo Bonzini     dbdma_cmd *current = &ch->current;
31149ab747fSPaolo Bonzini 
31249ab747fSPaolo Bonzini     ch->regs[DBDMA_CMDPTR_LO] = current->cmd_dep;
31349ab747fSPaolo Bonzini     ch->regs[DBDMA_STATUS] |= BT;
31449ab747fSPaolo Bonzini     dbdma_cmdptr_load(ch);
31549ab747fSPaolo Bonzini }
31649ab747fSPaolo Bonzini 
31749ab747fSPaolo Bonzini static void conditional_branch(DBDMA_channel *ch)
31849ab747fSPaolo Bonzini {
31949ab747fSPaolo Bonzini     dbdma_cmd *current = &ch->current;
32049ab747fSPaolo Bonzini     uint16_t br;
32149ab747fSPaolo Bonzini     uint16_t sel_mask, sel_value;
32249ab747fSPaolo Bonzini     uint32_t status;
32349ab747fSPaolo Bonzini     int cond;
32449ab747fSPaolo Bonzini 
32549ab747fSPaolo Bonzini     DBDMA_DPRINTF("conditional_branch\n");
32649ab747fSPaolo Bonzini 
32749ab747fSPaolo Bonzini     /* check if we must branch */
32849ab747fSPaolo Bonzini 
32949ab747fSPaolo Bonzini     br = le16_to_cpu(current->command) & BR_MASK;
33049ab747fSPaolo Bonzini 
33149ab747fSPaolo Bonzini     switch(br) {
33249ab747fSPaolo Bonzini     case BR_NEVER:  /* don't branch */
33349ab747fSPaolo Bonzini         next(ch);
33449ab747fSPaolo Bonzini         return;
33549ab747fSPaolo Bonzini     case BR_ALWAYS: /* always branch */
33649ab747fSPaolo Bonzini         branch(ch);
33749ab747fSPaolo Bonzini         return;
33849ab747fSPaolo Bonzini     }
33949ab747fSPaolo Bonzini 
34049ab747fSPaolo Bonzini     status = ch->regs[DBDMA_STATUS] & DEVSTAT;
34149ab747fSPaolo Bonzini 
34249ab747fSPaolo Bonzini     sel_mask = (ch->regs[DBDMA_BRANCH_SEL] >> 16) & 0x0f;
34349ab747fSPaolo Bonzini     sel_value = ch->regs[DBDMA_BRANCH_SEL] & 0x0f;
34449ab747fSPaolo Bonzini 
34549ab747fSPaolo Bonzini     cond = (status & sel_mask) == (sel_value & sel_mask);
34649ab747fSPaolo Bonzini 
34749ab747fSPaolo Bonzini     switch(br) {
34849ab747fSPaolo Bonzini     case BR_IFSET:  /* branch if condition bit is 1 */
34949ab747fSPaolo Bonzini         if (cond)
35049ab747fSPaolo Bonzini             branch(ch);
35149ab747fSPaolo Bonzini         else
35249ab747fSPaolo Bonzini             next(ch);
35349ab747fSPaolo Bonzini         return;
35449ab747fSPaolo Bonzini     case BR_IFCLR:  /* branch if condition bit is 0 */
35549ab747fSPaolo Bonzini         if (!cond)
35649ab747fSPaolo Bonzini             branch(ch);
35749ab747fSPaolo Bonzini         else
35849ab747fSPaolo Bonzini             next(ch);
35949ab747fSPaolo Bonzini         return;
36049ab747fSPaolo Bonzini     }
36149ab747fSPaolo Bonzini }
36249ab747fSPaolo Bonzini 
36349ab747fSPaolo Bonzini static QEMUBH *dbdma_bh;
36449ab747fSPaolo Bonzini static void channel_run(DBDMA_channel *ch);
36549ab747fSPaolo Bonzini 
36649ab747fSPaolo Bonzini static void dbdma_end(DBDMA_io *io)
36749ab747fSPaolo Bonzini {
36849ab747fSPaolo Bonzini     DBDMA_channel *ch = io->channel;
36949ab747fSPaolo Bonzini     dbdma_cmd *current = &ch->current;
37049ab747fSPaolo Bonzini 
37149ab747fSPaolo Bonzini     if (conditional_wait(ch))
37249ab747fSPaolo Bonzini         goto wait;
37349ab747fSPaolo Bonzini 
37449ab747fSPaolo Bonzini     current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]);
37549ab747fSPaolo Bonzini     current->res_count = cpu_to_le16(io->len);
37649ab747fSPaolo Bonzini     dbdma_cmdptr_save(ch);
37749ab747fSPaolo Bonzini     if (io->is_last)
37849ab747fSPaolo Bonzini         ch->regs[DBDMA_STATUS] &= ~FLUSH;
37949ab747fSPaolo Bonzini 
38049ab747fSPaolo Bonzini     conditional_interrupt(ch);
38149ab747fSPaolo Bonzini     conditional_branch(ch);
38249ab747fSPaolo Bonzini 
38349ab747fSPaolo Bonzini wait:
38449ab747fSPaolo Bonzini     ch->processing = 0;
38549ab747fSPaolo Bonzini     if ((ch->regs[DBDMA_STATUS] & RUN) &&
38649ab747fSPaolo Bonzini         (ch->regs[DBDMA_STATUS] & ACTIVE))
38749ab747fSPaolo Bonzini         channel_run(ch);
38849ab747fSPaolo Bonzini }
38949ab747fSPaolo Bonzini 
39049ab747fSPaolo Bonzini static void start_output(DBDMA_channel *ch, int key, uint32_t addr,
39149ab747fSPaolo Bonzini                         uint16_t req_count, int is_last)
39249ab747fSPaolo Bonzini {
39349ab747fSPaolo Bonzini     DBDMA_DPRINTF("start_output\n");
39449ab747fSPaolo Bonzini 
39549ab747fSPaolo Bonzini     /* KEY_REGS, KEY_DEVICE and KEY_STREAM
39649ab747fSPaolo Bonzini      * are not implemented in the mac-io chip
39749ab747fSPaolo Bonzini      */
39849ab747fSPaolo Bonzini 
39949ab747fSPaolo Bonzini     DBDMA_DPRINTF("addr 0x%x key 0x%x\n", addr, key);
40049ab747fSPaolo Bonzini     if (!addr || key > KEY_STREAM3) {
40149ab747fSPaolo Bonzini         kill_channel(ch);
40249ab747fSPaolo Bonzini         return;
40349ab747fSPaolo Bonzini     }
40449ab747fSPaolo Bonzini 
40549ab747fSPaolo Bonzini     ch->io.addr = addr;
40649ab747fSPaolo Bonzini     ch->io.len = req_count;
40749ab747fSPaolo Bonzini     ch->io.is_last = is_last;
40849ab747fSPaolo Bonzini     ch->io.dma_end = dbdma_end;
40949ab747fSPaolo Bonzini     ch->io.is_dma_out = 1;
41049ab747fSPaolo Bonzini     ch->processing = 1;
41149ab747fSPaolo Bonzini     if (ch->rw) {
41249ab747fSPaolo Bonzini         ch->rw(&ch->io);
41349ab747fSPaolo Bonzini     }
41449ab747fSPaolo Bonzini }
41549ab747fSPaolo Bonzini 
41649ab747fSPaolo Bonzini static void start_input(DBDMA_channel *ch, int key, uint32_t addr,
41749ab747fSPaolo Bonzini                        uint16_t req_count, int is_last)
41849ab747fSPaolo Bonzini {
41949ab747fSPaolo Bonzini     DBDMA_DPRINTF("start_input\n");
42049ab747fSPaolo Bonzini 
42149ab747fSPaolo Bonzini     /* KEY_REGS, KEY_DEVICE and KEY_STREAM
42249ab747fSPaolo Bonzini      * are not implemented in the mac-io chip
42349ab747fSPaolo Bonzini      */
42449ab747fSPaolo Bonzini 
42549ab747fSPaolo Bonzini     if (!addr || key > KEY_STREAM3) {
42649ab747fSPaolo Bonzini         kill_channel(ch);
42749ab747fSPaolo Bonzini         return;
42849ab747fSPaolo Bonzini     }
42949ab747fSPaolo Bonzini 
43049ab747fSPaolo Bonzini     ch->io.addr = addr;
43149ab747fSPaolo Bonzini     ch->io.len = req_count;
43249ab747fSPaolo Bonzini     ch->io.is_last = is_last;
43349ab747fSPaolo Bonzini     ch->io.dma_end = dbdma_end;
43449ab747fSPaolo Bonzini     ch->io.is_dma_out = 0;
43549ab747fSPaolo Bonzini     ch->processing = 1;
43649ab747fSPaolo Bonzini     if (ch->rw) {
43749ab747fSPaolo Bonzini         ch->rw(&ch->io);
43849ab747fSPaolo Bonzini     }
43949ab747fSPaolo Bonzini }
44049ab747fSPaolo Bonzini 
44149ab747fSPaolo Bonzini static void load_word(DBDMA_channel *ch, int key, uint32_t addr,
44249ab747fSPaolo Bonzini                      uint16_t len)
44349ab747fSPaolo Bonzini {
44449ab747fSPaolo Bonzini     dbdma_cmd *current = &ch->current;
44549ab747fSPaolo Bonzini     uint32_t val;
44649ab747fSPaolo Bonzini 
44749ab747fSPaolo Bonzini     DBDMA_DPRINTF("load_word\n");
44849ab747fSPaolo Bonzini 
44949ab747fSPaolo Bonzini     /* only implements KEY_SYSTEM */
45049ab747fSPaolo Bonzini 
45149ab747fSPaolo Bonzini     if (key != KEY_SYSTEM) {
45249ab747fSPaolo Bonzini         printf("DBDMA: LOAD_WORD, unimplemented key %x\n", key);
45349ab747fSPaolo Bonzini         kill_channel(ch);
45449ab747fSPaolo Bonzini         return;
45549ab747fSPaolo Bonzini     }
45649ab747fSPaolo Bonzini 
457e1fe50dcSStefan Weil     cpu_physical_memory_read(addr, &val, len);
45849ab747fSPaolo Bonzini 
45949ab747fSPaolo Bonzini     if (len == 2)
46049ab747fSPaolo Bonzini         val = (val << 16) | (current->cmd_dep & 0x0000ffff);
46149ab747fSPaolo Bonzini     else if (len == 1)
46249ab747fSPaolo Bonzini         val = (val << 24) | (current->cmd_dep & 0x00ffffff);
46349ab747fSPaolo Bonzini 
46449ab747fSPaolo Bonzini     current->cmd_dep = val;
46549ab747fSPaolo Bonzini 
46649ab747fSPaolo Bonzini     if (conditional_wait(ch))
46749ab747fSPaolo Bonzini         goto wait;
46849ab747fSPaolo Bonzini 
46949ab747fSPaolo Bonzini     current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]);
47049ab747fSPaolo Bonzini     dbdma_cmdptr_save(ch);
47149ab747fSPaolo Bonzini     ch->regs[DBDMA_STATUS] &= ~FLUSH;
47249ab747fSPaolo Bonzini 
47349ab747fSPaolo Bonzini     conditional_interrupt(ch);
47449ab747fSPaolo Bonzini     next(ch);
47549ab747fSPaolo Bonzini 
47649ab747fSPaolo Bonzini wait:
47749ab747fSPaolo Bonzini     qemu_bh_schedule(dbdma_bh);
47849ab747fSPaolo Bonzini }
47949ab747fSPaolo Bonzini 
48049ab747fSPaolo Bonzini static void store_word(DBDMA_channel *ch, int key, uint32_t addr,
48149ab747fSPaolo Bonzini                       uint16_t len)
48249ab747fSPaolo Bonzini {
48349ab747fSPaolo Bonzini     dbdma_cmd *current = &ch->current;
48449ab747fSPaolo Bonzini     uint32_t val;
48549ab747fSPaolo Bonzini 
48649ab747fSPaolo Bonzini     DBDMA_DPRINTF("store_word\n");
48749ab747fSPaolo Bonzini 
48849ab747fSPaolo Bonzini     /* only implements KEY_SYSTEM */
48949ab747fSPaolo Bonzini 
49049ab747fSPaolo Bonzini     if (key != KEY_SYSTEM) {
49149ab747fSPaolo Bonzini         printf("DBDMA: STORE_WORD, unimplemented key %x\n", key);
49249ab747fSPaolo Bonzini         kill_channel(ch);
49349ab747fSPaolo Bonzini         return;
49449ab747fSPaolo Bonzini     }
49549ab747fSPaolo Bonzini 
49649ab747fSPaolo Bonzini     val = current->cmd_dep;
49749ab747fSPaolo Bonzini     if (len == 2)
49849ab747fSPaolo Bonzini         val >>= 16;
49949ab747fSPaolo Bonzini     else if (len == 1)
50049ab747fSPaolo Bonzini         val >>= 24;
50149ab747fSPaolo Bonzini 
502e1fe50dcSStefan Weil     cpu_physical_memory_write(addr, &val, len);
50349ab747fSPaolo Bonzini 
50449ab747fSPaolo Bonzini     if (conditional_wait(ch))
50549ab747fSPaolo Bonzini         goto wait;
50649ab747fSPaolo Bonzini 
50749ab747fSPaolo Bonzini     current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]);
50849ab747fSPaolo Bonzini     dbdma_cmdptr_save(ch);
50949ab747fSPaolo Bonzini     ch->regs[DBDMA_STATUS] &= ~FLUSH;
51049ab747fSPaolo Bonzini 
51149ab747fSPaolo Bonzini     conditional_interrupt(ch);
51249ab747fSPaolo Bonzini     next(ch);
51349ab747fSPaolo Bonzini 
51449ab747fSPaolo Bonzini wait:
51549ab747fSPaolo Bonzini     qemu_bh_schedule(dbdma_bh);
51649ab747fSPaolo Bonzini }
51749ab747fSPaolo Bonzini 
51849ab747fSPaolo Bonzini static void nop(DBDMA_channel *ch)
51949ab747fSPaolo Bonzini {
52049ab747fSPaolo Bonzini     dbdma_cmd *current = &ch->current;
52149ab747fSPaolo Bonzini 
52249ab747fSPaolo Bonzini     if (conditional_wait(ch))
52349ab747fSPaolo Bonzini         goto wait;
52449ab747fSPaolo Bonzini 
52549ab747fSPaolo Bonzini     current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]);
52649ab747fSPaolo Bonzini     dbdma_cmdptr_save(ch);
52749ab747fSPaolo Bonzini 
52849ab747fSPaolo Bonzini     conditional_interrupt(ch);
52949ab747fSPaolo Bonzini     conditional_branch(ch);
53049ab747fSPaolo Bonzini 
53149ab747fSPaolo Bonzini wait:
53249ab747fSPaolo Bonzini     qemu_bh_schedule(dbdma_bh);
53349ab747fSPaolo Bonzini }
53449ab747fSPaolo Bonzini 
53549ab747fSPaolo Bonzini static void stop(DBDMA_channel *ch)
53649ab747fSPaolo Bonzini {
53749ab747fSPaolo Bonzini     ch->regs[DBDMA_STATUS] &= ~(ACTIVE|DEAD|FLUSH);
53849ab747fSPaolo Bonzini 
53949ab747fSPaolo Bonzini     /* the stop command does not increment command pointer */
54049ab747fSPaolo Bonzini }
54149ab747fSPaolo Bonzini 
54249ab747fSPaolo Bonzini static void channel_run(DBDMA_channel *ch)
54349ab747fSPaolo Bonzini {
54449ab747fSPaolo Bonzini     dbdma_cmd *current = &ch->current;
54549ab747fSPaolo Bonzini     uint16_t cmd, key;
54649ab747fSPaolo Bonzini     uint16_t req_count;
54749ab747fSPaolo Bonzini     uint32_t phy_addr;
54849ab747fSPaolo Bonzini 
54949ab747fSPaolo Bonzini     DBDMA_DPRINTF("channel_run\n");
55049ab747fSPaolo Bonzini     dump_dbdma_cmd(current);
55149ab747fSPaolo Bonzini 
55249ab747fSPaolo Bonzini     /* clear WAKE flag at command fetch */
55349ab747fSPaolo Bonzini 
55449ab747fSPaolo Bonzini     ch->regs[DBDMA_STATUS] &= ~WAKE;
55549ab747fSPaolo Bonzini 
55649ab747fSPaolo Bonzini     cmd = le16_to_cpu(current->command) & COMMAND_MASK;
55749ab747fSPaolo Bonzini 
55849ab747fSPaolo Bonzini     switch (cmd) {
55949ab747fSPaolo Bonzini     case DBDMA_NOP:
56049ab747fSPaolo Bonzini         nop(ch);
56149ab747fSPaolo Bonzini 	return;
56249ab747fSPaolo Bonzini 
56349ab747fSPaolo Bonzini     case DBDMA_STOP:
56449ab747fSPaolo Bonzini         stop(ch);
56549ab747fSPaolo Bonzini 	return;
56649ab747fSPaolo Bonzini     }
56749ab747fSPaolo Bonzini 
56849ab747fSPaolo Bonzini     key = le16_to_cpu(current->command) & 0x0700;
56949ab747fSPaolo Bonzini     req_count = le16_to_cpu(current->req_count);
57049ab747fSPaolo Bonzini     phy_addr = le32_to_cpu(current->phy_addr);
57149ab747fSPaolo Bonzini 
57249ab747fSPaolo Bonzini     if (key == KEY_STREAM4) {
57349ab747fSPaolo Bonzini         printf("command %x, invalid key 4\n", cmd);
57449ab747fSPaolo Bonzini         kill_channel(ch);
57549ab747fSPaolo Bonzini         return;
57649ab747fSPaolo Bonzini     }
57749ab747fSPaolo Bonzini 
57849ab747fSPaolo Bonzini     switch (cmd) {
57949ab747fSPaolo Bonzini     case OUTPUT_MORE:
58049ab747fSPaolo Bonzini         start_output(ch, key, phy_addr, req_count, 0);
58149ab747fSPaolo Bonzini 	return;
58249ab747fSPaolo Bonzini 
58349ab747fSPaolo Bonzini     case OUTPUT_LAST:
58449ab747fSPaolo Bonzini         start_output(ch, key, phy_addr, req_count, 1);
58549ab747fSPaolo Bonzini 	return;
58649ab747fSPaolo Bonzini 
58749ab747fSPaolo Bonzini     case INPUT_MORE:
58849ab747fSPaolo Bonzini         start_input(ch, key, phy_addr, req_count, 0);
58949ab747fSPaolo Bonzini 	return;
59049ab747fSPaolo Bonzini 
59149ab747fSPaolo Bonzini     case INPUT_LAST:
59249ab747fSPaolo Bonzini         start_input(ch, key, phy_addr, req_count, 1);
59349ab747fSPaolo Bonzini 	return;
59449ab747fSPaolo Bonzini     }
59549ab747fSPaolo Bonzini 
59649ab747fSPaolo Bonzini     if (key < KEY_REGS) {
59749ab747fSPaolo Bonzini         printf("command %x, invalid key %x\n", cmd, key);
59849ab747fSPaolo Bonzini         key = KEY_SYSTEM;
59949ab747fSPaolo Bonzini     }
60049ab747fSPaolo Bonzini 
60149ab747fSPaolo Bonzini     /* for LOAD_WORD and STORE_WORD, req_count is on 3 bits
60249ab747fSPaolo Bonzini      * and BRANCH is invalid
60349ab747fSPaolo Bonzini      */
60449ab747fSPaolo Bonzini 
60549ab747fSPaolo Bonzini     req_count = req_count & 0x0007;
60649ab747fSPaolo Bonzini     if (req_count & 0x4) {
60749ab747fSPaolo Bonzini         req_count = 4;
60849ab747fSPaolo Bonzini         phy_addr &= ~3;
60949ab747fSPaolo Bonzini     } else if (req_count & 0x2) {
61049ab747fSPaolo Bonzini         req_count = 2;
61149ab747fSPaolo Bonzini         phy_addr &= ~1;
61249ab747fSPaolo Bonzini     } else
61349ab747fSPaolo Bonzini         req_count = 1;
61449ab747fSPaolo Bonzini 
61549ab747fSPaolo Bonzini     switch (cmd) {
61649ab747fSPaolo Bonzini     case LOAD_WORD:
61749ab747fSPaolo Bonzini         load_word(ch, key, phy_addr, req_count);
61849ab747fSPaolo Bonzini 	return;
61949ab747fSPaolo Bonzini 
62049ab747fSPaolo Bonzini     case STORE_WORD:
62149ab747fSPaolo Bonzini         store_word(ch, key, phy_addr, req_count);
62249ab747fSPaolo Bonzini 	return;
62349ab747fSPaolo Bonzini     }
62449ab747fSPaolo Bonzini }
62549ab747fSPaolo Bonzini 
62649ab747fSPaolo Bonzini static void DBDMA_run(DBDMAState *s)
62749ab747fSPaolo Bonzini {
62849ab747fSPaolo Bonzini     int channel;
62949ab747fSPaolo Bonzini 
63049ab747fSPaolo Bonzini     for (channel = 0; channel < DBDMA_CHANNELS; channel++) {
63149ab747fSPaolo Bonzini         DBDMA_channel *ch = &s->channels[channel];
63249ab747fSPaolo Bonzini         uint32_t status = ch->regs[DBDMA_STATUS];
63349ab747fSPaolo Bonzini         if (!ch->processing && (status & RUN) && (status & ACTIVE)) {
63449ab747fSPaolo Bonzini             channel_run(ch);
63549ab747fSPaolo Bonzini         }
63649ab747fSPaolo Bonzini     }
63749ab747fSPaolo Bonzini }
63849ab747fSPaolo Bonzini 
63949ab747fSPaolo Bonzini static void DBDMA_run_bh(void *opaque)
64049ab747fSPaolo Bonzini {
64149ab747fSPaolo Bonzini     DBDMAState *s = opaque;
64249ab747fSPaolo Bonzini 
64349ab747fSPaolo Bonzini     DBDMA_DPRINTF("DBDMA_run_bh\n");
64449ab747fSPaolo Bonzini 
64549ab747fSPaolo Bonzini     DBDMA_run(s);
64649ab747fSPaolo Bonzini }
64749ab747fSPaolo Bonzini 
64849ab747fSPaolo Bonzini void DBDMA_register_channel(void *dbdma, int nchan, qemu_irq irq,
64949ab747fSPaolo Bonzini                             DBDMA_rw rw, DBDMA_flush flush,
65049ab747fSPaolo Bonzini                             void *opaque)
65149ab747fSPaolo Bonzini {
65249ab747fSPaolo Bonzini     DBDMAState *s = dbdma;
65349ab747fSPaolo Bonzini     DBDMA_channel *ch = &s->channels[nchan];
65449ab747fSPaolo Bonzini 
65549ab747fSPaolo Bonzini     DBDMA_DPRINTF("DBDMA_register_channel 0x%x\n", nchan);
65649ab747fSPaolo Bonzini 
65749ab747fSPaolo Bonzini     ch->irq = irq;
65849ab747fSPaolo Bonzini     ch->channel = nchan;
65949ab747fSPaolo Bonzini     ch->rw = rw;
66049ab747fSPaolo Bonzini     ch->flush = flush;
66149ab747fSPaolo Bonzini     ch->io.opaque = opaque;
66249ab747fSPaolo Bonzini     ch->io.channel = ch;
66349ab747fSPaolo Bonzini }
66449ab747fSPaolo Bonzini 
66549ab747fSPaolo Bonzini static void
66649ab747fSPaolo Bonzini dbdma_control_write(DBDMA_channel *ch)
66749ab747fSPaolo Bonzini {
66849ab747fSPaolo Bonzini     uint16_t mask, value;
66949ab747fSPaolo Bonzini     uint32_t status;
67049ab747fSPaolo Bonzini 
67149ab747fSPaolo Bonzini     mask = (ch->regs[DBDMA_CONTROL] >> 16) & 0xffff;
67249ab747fSPaolo Bonzini     value = ch->regs[DBDMA_CONTROL] & 0xffff;
67349ab747fSPaolo Bonzini 
67449ab747fSPaolo Bonzini     value &= (RUN | PAUSE | FLUSH | WAKE | DEVSTAT);
67549ab747fSPaolo Bonzini 
67649ab747fSPaolo Bonzini     status = ch->regs[DBDMA_STATUS];
67749ab747fSPaolo Bonzini 
67849ab747fSPaolo Bonzini     status = (value & mask) | (status & ~mask);
67949ab747fSPaolo Bonzini 
68049ab747fSPaolo Bonzini     if (status & WAKE)
68149ab747fSPaolo Bonzini         status |= ACTIVE;
68249ab747fSPaolo Bonzini     if (status & RUN) {
68349ab747fSPaolo Bonzini         status |= ACTIVE;
68449ab747fSPaolo Bonzini         status &= ~DEAD;
68549ab747fSPaolo Bonzini     }
68649ab747fSPaolo Bonzini     if (status & PAUSE)
68749ab747fSPaolo Bonzini         status &= ~ACTIVE;
68849ab747fSPaolo Bonzini     if ((ch->regs[DBDMA_STATUS] & RUN) && !(status & RUN)) {
68949ab747fSPaolo Bonzini         /* RUN is cleared */
69049ab747fSPaolo Bonzini         status &= ~(ACTIVE|DEAD);
69149ab747fSPaolo Bonzini         if ((status & FLUSH) && ch->flush) {
69249ab747fSPaolo Bonzini             ch->flush(&ch->io);
69349ab747fSPaolo Bonzini             status &= ~FLUSH;
69449ab747fSPaolo Bonzini         }
69549ab747fSPaolo Bonzini     }
69649ab747fSPaolo Bonzini 
69749ab747fSPaolo Bonzini     DBDMA_DPRINTF("    status 0x%08x\n", status);
69849ab747fSPaolo Bonzini 
69949ab747fSPaolo Bonzini     ch->regs[DBDMA_STATUS] = status;
70049ab747fSPaolo Bonzini 
70149ab747fSPaolo Bonzini     if (status & ACTIVE)
70249ab747fSPaolo Bonzini         qemu_bh_schedule(dbdma_bh);
70349ab747fSPaolo Bonzini     if ((status & FLUSH) && ch->flush)
70449ab747fSPaolo Bonzini         ch->flush(&ch->io);
70549ab747fSPaolo Bonzini }
70649ab747fSPaolo Bonzini 
70749ab747fSPaolo Bonzini static void dbdma_write(void *opaque, hwaddr addr,
70849ab747fSPaolo Bonzini                         uint64_t value, unsigned size)
70949ab747fSPaolo Bonzini {
71049ab747fSPaolo Bonzini     int channel = addr >> DBDMA_CHANNEL_SHIFT;
71149ab747fSPaolo Bonzini     DBDMAState *s = opaque;
71249ab747fSPaolo Bonzini     DBDMA_channel *ch = &s->channels[channel];
71349ab747fSPaolo Bonzini     int reg = (addr - (channel << DBDMA_CHANNEL_SHIFT)) >> 2;
71449ab747fSPaolo Bonzini 
71549ab747fSPaolo Bonzini     DBDMA_DPRINTF("writel 0x" TARGET_FMT_plx " <= 0x%08x\n", addr, value);
71649ab747fSPaolo Bonzini     DBDMA_DPRINTF("channel 0x%x reg 0x%x\n",
71749ab747fSPaolo Bonzini                   (uint32_t)addr >> DBDMA_CHANNEL_SHIFT, reg);
71849ab747fSPaolo Bonzini 
71949ab747fSPaolo Bonzini     /* cmdptr cannot be modified if channel is RUN or ACTIVE */
72049ab747fSPaolo Bonzini 
72149ab747fSPaolo Bonzini     if (reg == DBDMA_CMDPTR_LO &&
72249ab747fSPaolo Bonzini         (ch->regs[DBDMA_STATUS] & (RUN | ACTIVE)))
72349ab747fSPaolo Bonzini 	return;
72449ab747fSPaolo Bonzini 
72549ab747fSPaolo Bonzini     ch->regs[reg] = value;
72649ab747fSPaolo Bonzini 
72749ab747fSPaolo Bonzini     switch(reg) {
72849ab747fSPaolo Bonzini     case DBDMA_CONTROL:
72949ab747fSPaolo Bonzini         dbdma_control_write(ch);
73049ab747fSPaolo Bonzini         break;
73149ab747fSPaolo Bonzini     case DBDMA_CMDPTR_LO:
73249ab747fSPaolo Bonzini         /* 16-byte aligned */
73349ab747fSPaolo Bonzini         ch->regs[DBDMA_CMDPTR_LO] &= ~0xf;
73449ab747fSPaolo Bonzini         dbdma_cmdptr_load(ch);
73549ab747fSPaolo Bonzini         break;
73649ab747fSPaolo Bonzini     case DBDMA_STATUS:
73749ab747fSPaolo Bonzini     case DBDMA_INTR_SEL:
73849ab747fSPaolo Bonzini     case DBDMA_BRANCH_SEL:
73949ab747fSPaolo Bonzini     case DBDMA_WAIT_SEL:
74049ab747fSPaolo Bonzini         /* nothing to do */
74149ab747fSPaolo Bonzini         break;
74249ab747fSPaolo Bonzini     case DBDMA_XFER_MODE:
74349ab747fSPaolo Bonzini     case DBDMA_CMDPTR_HI:
74449ab747fSPaolo Bonzini     case DBDMA_DATA2PTR_HI:
74549ab747fSPaolo Bonzini     case DBDMA_DATA2PTR_LO:
74649ab747fSPaolo Bonzini     case DBDMA_ADDRESS_HI:
74749ab747fSPaolo Bonzini     case DBDMA_BRANCH_ADDR_HI:
74849ab747fSPaolo Bonzini     case DBDMA_RES1:
74949ab747fSPaolo Bonzini     case DBDMA_RES2:
75049ab747fSPaolo Bonzini     case DBDMA_RES3:
75149ab747fSPaolo Bonzini     case DBDMA_RES4:
75249ab747fSPaolo Bonzini         /* unused */
75349ab747fSPaolo Bonzini         break;
75449ab747fSPaolo Bonzini     }
75549ab747fSPaolo Bonzini }
75649ab747fSPaolo Bonzini 
75749ab747fSPaolo Bonzini static uint64_t dbdma_read(void *opaque, hwaddr addr,
75849ab747fSPaolo Bonzini                            unsigned size)
75949ab747fSPaolo Bonzini {
76049ab747fSPaolo Bonzini     uint32_t value;
76149ab747fSPaolo Bonzini     int channel = addr >> DBDMA_CHANNEL_SHIFT;
76249ab747fSPaolo Bonzini     DBDMAState *s = opaque;
76349ab747fSPaolo Bonzini     DBDMA_channel *ch = &s->channels[channel];
76449ab747fSPaolo Bonzini     int reg = (addr - (channel << DBDMA_CHANNEL_SHIFT)) >> 2;
76549ab747fSPaolo Bonzini 
76649ab747fSPaolo Bonzini     value = ch->regs[reg];
76749ab747fSPaolo Bonzini 
76849ab747fSPaolo Bonzini     DBDMA_DPRINTF("readl 0x" TARGET_FMT_plx " => 0x%08x\n", addr, value);
76949ab747fSPaolo Bonzini     DBDMA_DPRINTF("channel 0x%x reg 0x%x\n",
77049ab747fSPaolo Bonzini                   (uint32_t)addr >> DBDMA_CHANNEL_SHIFT, reg);
77149ab747fSPaolo Bonzini 
77249ab747fSPaolo Bonzini     switch(reg) {
77349ab747fSPaolo Bonzini     case DBDMA_CONTROL:
77449ab747fSPaolo Bonzini         value = 0;
77549ab747fSPaolo Bonzini         break;
77649ab747fSPaolo Bonzini     case DBDMA_STATUS:
77749ab747fSPaolo Bonzini     case DBDMA_CMDPTR_LO:
77849ab747fSPaolo Bonzini     case DBDMA_INTR_SEL:
77949ab747fSPaolo Bonzini     case DBDMA_BRANCH_SEL:
78049ab747fSPaolo Bonzini     case DBDMA_WAIT_SEL:
78149ab747fSPaolo Bonzini         /* nothing to do */
78249ab747fSPaolo Bonzini         break;
78349ab747fSPaolo Bonzini     case DBDMA_XFER_MODE:
78449ab747fSPaolo Bonzini     case DBDMA_CMDPTR_HI:
78549ab747fSPaolo Bonzini     case DBDMA_DATA2PTR_HI:
78649ab747fSPaolo Bonzini     case DBDMA_DATA2PTR_LO:
78749ab747fSPaolo Bonzini     case DBDMA_ADDRESS_HI:
78849ab747fSPaolo Bonzini     case DBDMA_BRANCH_ADDR_HI:
78949ab747fSPaolo Bonzini         /* unused */
79049ab747fSPaolo Bonzini         value = 0;
79149ab747fSPaolo Bonzini         break;
79249ab747fSPaolo Bonzini     case DBDMA_RES1:
79349ab747fSPaolo Bonzini     case DBDMA_RES2:
79449ab747fSPaolo Bonzini     case DBDMA_RES3:
79549ab747fSPaolo Bonzini     case DBDMA_RES4:
79649ab747fSPaolo Bonzini         /* reserved */
79749ab747fSPaolo Bonzini         break;
79849ab747fSPaolo Bonzini     }
79949ab747fSPaolo Bonzini 
80049ab747fSPaolo Bonzini     return value;
80149ab747fSPaolo Bonzini }
80249ab747fSPaolo Bonzini 
80349ab747fSPaolo Bonzini static const MemoryRegionOps dbdma_ops = {
80449ab747fSPaolo Bonzini     .read = dbdma_read,
80549ab747fSPaolo Bonzini     .write = dbdma_write,
80649ab747fSPaolo Bonzini     .endianness = DEVICE_LITTLE_ENDIAN,
80749ab747fSPaolo Bonzini     .valid = {
80849ab747fSPaolo Bonzini         .min_access_size = 4,
80949ab747fSPaolo Bonzini         .max_access_size = 4,
81049ab747fSPaolo Bonzini     },
81149ab747fSPaolo Bonzini };
81249ab747fSPaolo Bonzini 
81349ab747fSPaolo Bonzini static const VMStateDescription vmstate_dbdma_channel = {
81449ab747fSPaolo Bonzini     .name = "dbdma_channel",
81549ab747fSPaolo Bonzini     .version_id = 0,
81649ab747fSPaolo Bonzini     .minimum_version_id = 0,
81749ab747fSPaolo Bonzini     .minimum_version_id_old = 0,
81849ab747fSPaolo Bonzini     .fields      = (VMStateField[]) {
81949ab747fSPaolo Bonzini         VMSTATE_UINT32_ARRAY(regs, struct DBDMA_channel, DBDMA_REGS),
82049ab747fSPaolo Bonzini         VMSTATE_END_OF_LIST()
82149ab747fSPaolo Bonzini     }
82249ab747fSPaolo Bonzini };
82349ab747fSPaolo Bonzini 
82449ab747fSPaolo Bonzini static const VMStateDescription vmstate_dbdma = {
82549ab747fSPaolo Bonzini     .name = "dbdma",
82649ab747fSPaolo Bonzini     .version_id = 2,
82749ab747fSPaolo Bonzini     .minimum_version_id = 2,
82849ab747fSPaolo Bonzini     .minimum_version_id_old = 2,
82949ab747fSPaolo Bonzini     .fields      = (VMStateField[]) {
83049ab747fSPaolo Bonzini         VMSTATE_STRUCT_ARRAY(channels, DBDMAState, DBDMA_CHANNELS, 1,
83149ab747fSPaolo Bonzini                              vmstate_dbdma_channel, DBDMA_channel),
83249ab747fSPaolo Bonzini         VMSTATE_END_OF_LIST()
83349ab747fSPaolo Bonzini     }
83449ab747fSPaolo Bonzini };
83549ab747fSPaolo Bonzini 
83649ab747fSPaolo Bonzini static void dbdma_reset(void *opaque)
83749ab747fSPaolo Bonzini {
83849ab747fSPaolo Bonzini     DBDMAState *s = opaque;
83949ab747fSPaolo Bonzini     int i;
84049ab747fSPaolo Bonzini 
84149ab747fSPaolo Bonzini     for (i = 0; i < DBDMA_CHANNELS; i++)
84249ab747fSPaolo Bonzini         memset(s->channels[i].regs, 0, DBDMA_SIZE);
84349ab747fSPaolo Bonzini }
84449ab747fSPaolo Bonzini 
84549ab747fSPaolo Bonzini void* DBDMA_init (MemoryRegion **dbdma_mem)
84649ab747fSPaolo Bonzini {
84749ab747fSPaolo Bonzini     DBDMAState *s;
84849ab747fSPaolo Bonzini 
84949ab747fSPaolo Bonzini     s = g_malloc0(sizeof(DBDMAState));
85049ab747fSPaolo Bonzini 
851*2c9b15caSPaolo Bonzini     memory_region_init_io(&s->mem, NULL, &dbdma_ops, s, "dbdma", 0x1000);
85249ab747fSPaolo Bonzini     *dbdma_mem = &s->mem;
85349ab747fSPaolo Bonzini     vmstate_register(NULL, -1, &vmstate_dbdma, s);
85449ab747fSPaolo Bonzini     qemu_register_reset(dbdma_reset, s);
85549ab747fSPaolo Bonzini 
85649ab747fSPaolo Bonzini     dbdma_bh = qemu_bh_new(DBDMA_run_bh, s);
85749ab747fSPaolo Bonzini 
85849ab747fSPaolo Bonzini     return s;
85949ab747fSPaolo Bonzini }
860