xref: /openbmc/qemu/hw/misc/macio/mac_dbdma.c (revision 7eaba824b6bc14ee724f8593891f2165d2faa4ab)
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 
22733ce36bbSAlexander Graf     DBDMA_DPRINTF("%s\n", __func__);
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);
23633ce36bbSAlexander Graf         DBDMA_DPRINTF("%s: raise\n", __func__);
23749ab747fSPaolo Bonzini         return;
23849ab747fSPaolo Bonzini     }
23949ab747fSPaolo Bonzini 
24049ab747fSPaolo Bonzini     status = ch->regs[DBDMA_STATUS] & DEVSTAT;
24149ab747fSPaolo Bonzini 
24249ab747fSPaolo Bonzini     sel_mask = (ch->regs[DBDMA_INTR_SEL] >> 16) & 0x0f;
24349ab747fSPaolo Bonzini     sel_value = ch->regs[DBDMA_INTR_SEL] & 0x0f;
24449ab747fSPaolo Bonzini 
24549ab747fSPaolo Bonzini     cond = (status & sel_mask) == (sel_value & sel_mask);
24649ab747fSPaolo Bonzini 
24749ab747fSPaolo Bonzini     switch(intr) {
24849ab747fSPaolo Bonzini     case INTR_IFSET:  /* intr if condition bit is 1 */
24933ce36bbSAlexander Graf         if (cond) {
25049ab747fSPaolo Bonzini             qemu_irq_raise(ch->irq);
25133ce36bbSAlexander Graf             DBDMA_DPRINTF("%s: raise\n", __func__);
25233ce36bbSAlexander Graf         }
25349ab747fSPaolo Bonzini         return;
25449ab747fSPaolo Bonzini     case INTR_IFCLR:  /* intr if condition bit is 0 */
25533ce36bbSAlexander Graf         if (!cond) {
25649ab747fSPaolo Bonzini             qemu_irq_raise(ch->irq);
25733ce36bbSAlexander Graf             DBDMA_DPRINTF("%s: raise\n", __func__);
25833ce36bbSAlexander Graf         }
25949ab747fSPaolo Bonzini         return;
26049ab747fSPaolo Bonzini     }
26149ab747fSPaolo Bonzini }
26249ab747fSPaolo Bonzini 
26349ab747fSPaolo Bonzini static int conditional_wait(DBDMA_channel *ch)
26449ab747fSPaolo Bonzini {
26549ab747fSPaolo Bonzini     dbdma_cmd *current = &ch->current;
26649ab747fSPaolo Bonzini     uint16_t wait;
26749ab747fSPaolo Bonzini     uint16_t sel_mask, sel_value;
26849ab747fSPaolo Bonzini     uint32_t status;
26949ab747fSPaolo Bonzini     int cond;
27049ab747fSPaolo Bonzini 
27149ab747fSPaolo Bonzini     DBDMA_DPRINTF("conditional_wait\n");
27249ab747fSPaolo Bonzini 
27349ab747fSPaolo Bonzini     wait = le16_to_cpu(current->command) & WAIT_MASK;
27449ab747fSPaolo Bonzini 
27549ab747fSPaolo Bonzini     switch(wait) {
27649ab747fSPaolo Bonzini     case WAIT_NEVER:  /* don't wait */
27749ab747fSPaolo Bonzini         return 0;
27849ab747fSPaolo Bonzini     case WAIT_ALWAYS: /* always wait */
27949ab747fSPaolo Bonzini         return 1;
28049ab747fSPaolo Bonzini     }
28149ab747fSPaolo Bonzini 
28249ab747fSPaolo Bonzini     status = ch->regs[DBDMA_STATUS] & DEVSTAT;
28349ab747fSPaolo Bonzini 
28449ab747fSPaolo Bonzini     sel_mask = (ch->regs[DBDMA_WAIT_SEL] >> 16) & 0x0f;
28549ab747fSPaolo Bonzini     sel_value = ch->regs[DBDMA_WAIT_SEL] & 0x0f;
28649ab747fSPaolo Bonzini 
28749ab747fSPaolo Bonzini     cond = (status & sel_mask) == (sel_value & sel_mask);
28849ab747fSPaolo Bonzini 
28949ab747fSPaolo Bonzini     switch(wait) {
29049ab747fSPaolo Bonzini     case WAIT_IFSET:  /* wait if condition bit is 1 */
29149ab747fSPaolo Bonzini         if (cond)
29249ab747fSPaolo Bonzini             return 1;
29349ab747fSPaolo Bonzini         return 0;
29449ab747fSPaolo Bonzini     case WAIT_IFCLR:  /* wait if condition bit is 0 */
29549ab747fSPaolo Bonzini         if (!cond)
29649ab747fSPaolo Bonzini             return 1;
29749ab747fSPaolo Bonzini         return 0;
29849ab747fSPaolo Bonzini     }
29949ab747fSPaolo Bonzini     return 0;
30049ab747fSPaolo Bonzini }
30149ab747fSPaolo Bonzini 
30249ab747fSPaolo Bonzini static void next(DBDMA_channel *ch)
30349ab747fSPaolo Bonzini {
30449ab747fSPaolo Bonzini     uint32_t cp;
30549ab747fSPaolo Bonzini 
30649ab747fSPaolo Bonzini     ch->regs[DBDMA_STATUS] &= ~BT;
30749ab747fSPaolo Bonzini 
30849ab747fSPaolo Bonzini     cp = ch->regs[DBDMA_CMDPTR_LO];
30949ab747fSPaolo Bonzini     ch->regs[DBDMA_CMDPTR_LO] = cp + sizeof(dbdma_cmd);
31049ab747fSPaolo Bonzini     dbdma_cmdptr_load(ch);
31149ab747fSPaolo Bonzini }
31249ab747fSPaolo Bonzini 
31349ab747fSPaolo Bonzini static void branch(DBDMA_channel *ch)
31449ab747fSPaolo Bonzini {
31549ab747fSPaolo Bonzini     dbdma_cmd *current = &ch->current;
31649ab747fSPaolo Bonzini 
31749ab747fSPaolo Bonzini     ch->regs[DBDMA_CMDPTR_LO] = current->cmd_dep;
31849ab747fSPaolo Bonzini     ch->regs[DBDMA_STATUS] |= BT;
31949ab747fSPaolo Bonzini     dbdma_cmdptr_load(ch);
32049ab747fSPaolo Bonzini }
32149ab747fSPaolo Bonzini 
32249ab747fSPaolo Bonzini static void conditional_branch(DBDMA_channel *ch)
32349ab747fSPaolo Bonzini {
32449ab747fSPaolo Bonzini     dbdma_cmd *current = &ch->current;
32549ab747fSPaolo Bonzini     uint16_t br;
32649ab747fSPaolo Bonzini     uint16_t sel_mask, sel_value;
32749ab747fSPaolo Bonzini     uint32_t status;
32849ab747fSPaolo Bonzini     int cond;
32949ab747fSPaolo Bonzini 
33049ab747fSPaolo Bonzini     DBDMA_DPRINTF("conditional_branch\n");
33149ab747fSPaolo Bonzini 
33249ab747fSPaolo Bonzini     /* check if we must branch */
33349ab747fSPaolo Bonzini 
33449ab747fSPaolo Bonzini     br = le16_to_cpu(current->command) & BR_MASK;
33549ab747fSPaolo Bonzini 
33649ab747fSPaolo Bonzini     switch(br) {
33749ab747fSPaolo Bonzini     case BR_NEVER:  /* don't branch */
33849ab747fSPaolo Bonzini         next(ch);
33949ab747fSPaolo Bonzini         return;
34049ab747fSPaolo Bonzini     case BR_ALWAYS: /* always branch */
34149ab747fSPaolo Bonzini         branch(ch);
34249ab747fSPaolo Bonzini         return;
34349ab747fSPaolo Bonzini     }
34449ab747fSPaolo Bonzini 
34549ab747fSPaolo Bonzini     status = ch->regs[DBDMA_STATUS] & DEVSTAT;
34649ab747fSPaolo Bonzini 
34749ab747fSPaolo Bonzini     sel_mask = (ch->regs[DBDMA_BRANCH_SEL] >> 16) & 0x0f;
34849ab747fSPaolo Bonzini     sel_value = ch->regs[DBDMA_BRANCH_SEL] & 0x0f;
34949ab747fSPaolo Bonzini 
35049ab747fSPaolo Bonzini     cond = (status & sel_mask) == (sel_value & sel_mask);
35149ab747fSPaolo Bonzini 
35249ab747fSPaolo Bonzini     switch(br) {
35349ab747fSPaolo Bonzini     case BR_IFSET:  /* branch if condition bit is 1 */
35449ab747fSPaolo Bonzini         if (cond)
35549ab747fSPaolo Bonzini             branch(ch);
35649ab747fSPaolo Bonzini         else
35749ab747fSPaolo Bonzini             next(ch);
35849ab747fSPaolo Bonzini         return;
35949ab747fSPaolo Bonzini     case BR_IFCLR:  /* branch if condition bit is 0 */
36049ab747fSPaolo Bonzini         if (!cond)
36149ab747fSPaolo Bonzini             branch(ch);
36249ab747fSPaolo Bonzini         else
36349ab747fSPaolo Bonzini             next(ch);
36449ab747fSPaolo Bonzini         return;
36549ab747fSPaolo Bonzini     }
36649ab747fSPaolo Bonzini }
36749ab747fSPaolo Bonzini 
36849ab747fSPaolo Bonzini static QEMUBH *dbdma_bh;
36949ab747fSPaolo Bonzini static void channel_run(DBDMA_channel *ch);
37049ab747fSPaolo Bonzini 
37149ab747fSPaolo Bonzini static void dbdma_end(DBDMA_io *io)
37249ab747fSPaolo Bonzini {
37349ab747fSPaolo Bonzini     DBDMA_channel *ch = io->channel;
37449ab747fSPaolo Bonzini     dbdma_cmd *current = &ch->current;
37549ab747fSPaolo Bonzini 
37633ce36bbSAlexander Graf     DBDMA_DPRINTF("%s\n", __func__);
37733ce36bbSAlexander Graf 
37849ab747fSPaolo Bonzini     if (conditional_wait(ch))
37949ab747fSPaolo Bonzini         goto wait;
38049ab747fSPaolo Bonzini 
38149ab747fSPaolo Bonzini     current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]);
38249ab747fSPaolo Bonzini     current->res_count = cpu_to_le16(io->len);
38349ab747fSPaolo Bonzini     dbdma_cmdptr_save(ch);
38449ab747fSPaolo Bonzini     if (io->is_last)
38549ab747fSPaolo Bonzini         ch->regs[DBDMA_STATUS] &= ~FLUSH;
38649ab747fSPaolo Bonzini 
38749ab747fSPaolo Bonzini     conditional_interrupt(ch);
38849ab747fSPaolo Bonzini     conditional_branch(ch);
38949ab747fSPaolo Bonzini 
39049ab747fSPaolo Bonzini wait:
39149ab747fSPaolo Bonzini     ch->processing = 0;
39249ab747fSPaolo Bonzini     if ((ch->regs[DBDMA_STATUS] & RUN) &&
39349ab747fSPaolo Bonzini         (ch->regs[DBDMA_STATUS] & ACTIVE))
39449ab747fSPaolo Bonzini         channel_run(ch);
39549ab747fSPaolo Bonzini }
39649ab747fSPaolo Bonzini 
39749ab747fSPaolo Bonzini static void start_output(DBDMA_channel *ch, int key, uint32_t addr,
39849ab747fSPaolo Bonzini                         uint16_t req_count, int is_last)
39949ab747fSPaolo Bonzini {
40049ab747fSPaolo Bonzini     DBDMA_DPRINTF("start_output\n");
40149ab747fSPaolo Bonzini 
40249ab747fSPaolo Bonzini     /* KEY_REGS, KEY_DEVICE and KEY_STREAM
40349ab747fSPaolo Bonzini      * are not implemented in the mac-io chip
40449ab747fSPaolo Bonzini      */
40549ab747fSPaolo Bonzini 
40649ab747fSPaolo Bonzini     DBDMA_DPRINTF("addr 0x%x key 0x%x\n", addr, key);
40749ab747fSPaolo Bonzini     if (!addr || key > KEY_STREAM3) {
40849ab747fSPaolo Bonzini         kill_channel(ch);
40949ab747fSPaolo Bonzini         return;
41049ab747fSPaolo Bonzini     }
41149ab747fSPaolo Bonzini 
41249ab747fSPaolo Bonzini     ch->io.addr = addr;
41349ab747fSPaolo Bonzini     ch->io.len = req_count;
41449ab747fSPaolo Bonzini     ch->io.is_last = is_last;
41549ab747fSPaolo Bonzini     ch->io.dma_end = dbdma_end;
41649ab747fSPaolo Bonzini     ch->io.is_dma_out = 1;
41749ab747fSPaolo Bonzini     ch->processing = 1;
41849ab747fSPaolo Bonzini     if (ch->rw) {
41949ab747fSPaolo Bonzini         ch->rw(&ch->io);
42049ab747fSPaolo Bonzini     }
42149ab747fSPaolo Bonzini }
42249ab747fSPaolo Bonzini 
42349ab747fSPaolo Bonzini static void start_input(DBDMA_channel *ch, int key, uint32_t addr,
42449ab747fSPaolo Bonzini                        uint16_t req_count, int is_last)
42549ab747fSPaolo Bonzini {
42649ab747fSPaolo Bonzini     DBDMA_DPRINTF("start_input\n");
42749ab747fSPaolo Bonzini 
42849ab747fSPaolo Bonzini     /* KEY_REGS, KEY_DEVICE and KEY_STREAM
42949ab747fSPaolo Bonzini      * are not implemented in the mac-io chip
43049ab747fSPaolo Bonzini      */
43149ab747fSPaolo Bonzini 
43233ce36bbSAlexander Graf     DBDMA_DPRINTF("addr 0x%x key 0x%x\n", addr, key);
43349ab747fSPaolo Bonzini     if (!addr || key > KEY_STREAM3) {
43449ab747fSPaolo Bonzini         kill_channel(ch);
43549ab747fSPaolo Bonzini         return;
43649ab747fSPaolo Bonzini     }
43749ab747fSPaolo Bonzini 
43849ab747fSPaolo Bonzini     ch->io.addr = addr;
43949ab747fSPaolo Bonzini     ch->io.len = req_count;
44049ab747fSPaolo Bonzini     ch->io.is_last = is_last;
44149ab747fSPaolo Bonzini     ch->io.dma_end = dbdma_end;
44249ab747fSPaolo Bonzini     ch->io.is_dma_out = 0;
44349ab747fSPaolo Bonzini     ch->processing = 1;
44449ab747fSPaolo Bonzini     if (ch->rw) {
44549ab747fSPaolo Bonzini         ch->rw(&ch->io);
44649ab747fSPaolo Bonzini     }
44749ab747fSPaolo Bonzini }
44849ab747fSPaolo Bonzini 
44949ab747fSPaolo Bonzini static void load_word(DBDMA_channel *ch, int key, uint32_t addr,
45049ab747fSPaolo Bonzini                      uint16_t len)
45149ab747fSPaolo Bonzini {
45249ab747fSPaolo Bonzini     dbdma_cmd *current = &ch->current;
45349ab747fSPaolo Bonzini     uint32_t val;
45449ab747fSPaolo Bonzini 
45549ab747fSPaolo Bonzini     DBDMA_DPRINTF("load_word\n");
45649ab747fSPaolo Bonzini 
45749ab747fSPaolo Bonzini     /* only implements KEY_SYSTEM */
45849ab747fSPaolo Bonzini 
45949ab747fSPaolo Bonzini     if (key != KEY_SYSTEM) {
46049ab747fSPaolo Bonzini         printf("DBDMA: LOAD_WORD, unimplemented key %x\n", key);
46149ab747fSPaolo Bonzini         kill_channel(ch);
46249ab747fSPaolo Bonzini         return;
46349ab747fSPaolo Bonzini     }
46449ab747fSPaolo Bonzini 
465e1fe50dcSStefan Weil     cpu_physical_memory_read(addr, &val, len);
46649ab747fSPaolo Bonzini 
46749ab747fSPaolo Bonzini     if (len == 2)
46849ab747fSPaolo Bonzini         val = (val << 16) | (current->cmd_dep & 0x0000ffff);
46949ab747fSPaolo Bonzini     else if (len == 1)
47049ab747fSPaolo Bonzini         val = (val << 24) | (current->cmd_dep & 0x00ffffff);
47149ab747fSPaolo Bonzini 
47249ab747fSPaolo Bonzini     current->cmd_dep = val;
47349ab747fSPaolo Bonzini 
47449ab747fSPaolo Bonzini     if (conditional_wait(ch))
47549ab747fSPaolo Bonzini         goto wait;
47649ab747fSPaolo Bonzini 
47749ab747fSPaolo Bonzini     current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]);
47849ab747fSPaolo Bonzini     dbdma_cmdptr_save(ch);
47949ab747fSPaolo Bonzini     ch->regs[DBDMA_STATUS] &= ~FLUSH;
48049ab747fSPaolo Bonzini 
48149ab747fSPaolo Bonzini     conditional_interrupt(ch);
48249ab747fSPaolo Bonzini     next(ch);
48349ab747fSPaolo Bonzini 
48449ab747fSPaolo Bonzini wait:
48549ab747fSPaolo Bonzini     qemu_bh_schedule(dbdma_bh);
48649ab747fSPaolo Bonzini }
48749ab747fSPaolo Bonzini 
48849ab747fSPaolo Bonzini static void store_word(DBDMA_channel *ch, int key, uint32_t addr,
48949ab747fSPaolo Bonzini                       uint16_t len)
49049ab747fSPaolo Bonzini {
49149ab747fSPaolo Bonzini     dbdma_cmd *current = &ch->current;
49249ab747fSPaolo Bonzini     uint32_t val;
49349ab747fSPaolo Bonzini 
49449ab747fSPaolo Bonzini     DBDMA_DPRINTF("store_word\n");
49549ab747fSPaolo Bonzini 
49649ab747fSPaolo Bonzini     /* only implements KEY_SYSTEM */
49749ab747fSPaolo Bonzini 
49849ab747fSPaolo Bonzini     if (key != KEY_SYSTEM) {
49949ab747fSPaolo Bonzini         printf("DBDMA: STORE_WORD, unimplemented key %x\n", key);
50049ab747fSPaolo Bonzini         kill_channel(ch);
50149ab747fSPaolo Bonzini         return;
50249ab747fSPaolo Bonzini     }
50349ab747fSPaolo Bonzini 
50449ab747fSPaolo Bonzini     val = current->cmd_dep;
50549ab747fSPaolo Bonzini     if (len == 2)
50649ab747fSPaolo Bonzini         val >>= 16;
50749ab747fSPaolo Bonzini     else if (len == 1)
50849ab747fSPaolo Bonzini         val >>= 24;
50949ab747fSPaolo Bonzini 
510e1fe50dcSStefan Weil     cpu_physical_memory_write(addr, &val, len);
51149ab747fSPaolo Bonzini 
51249ab747fSPaolo Bonzini     if (conditional_wait(ch))
51349ab747fSPaolo Bonzini         goto wait;
51449ab747fSPaolo Bonzini 
51549ab747fSPaolo Bonzini     current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]);
51649ab747fSPaolo Bonzini     dbdma_cmdptr_save(ch);
51749ab747fSPaolo Bonzini     ch->regs[DBDMA_STATUS] &= ~FLUSH;
51849ab747fSPaolo Bonzini 
51949ab747fSPaolo Bonzini     conditional_interrupt(ch);
52049ab747fSPaolo Bonzini     next(ch);
52149ab747fSPaolo Bonzini 
52249ab747fSPaolo Bonzini wait:
52349ab747fSPaolo Bonzini     qemu_bh_schedule(dbdma_bh);
52449ab747fSPaolo Bonzini }
52549ab747fSPaolo Bonzini 
52649ab747fSPaolo Bonzini static void nop(DBDMA_channel *ch)
52749ab747fSPaolo Bonzini {
52849ab747fSPaolo Bonzini     dbdma_cmd *current = &ch->current;
52949ab747fSPaolo Bonzini 
53049ab747fSPaolo Bonzini     if (conditional_wait(ch))
53149ab747fSPaolo Bonzini         goto wait;
53249ab747fSPaolo Bonzini 
53349ab747fSPaolo Bonzini     current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]);
53449ab747fSPaolo Bonzini     dbdma_cmdptr_save(ch);
53549ab747fSPaolo Bonzini 
53649ab747fSPaolo Bonzini     conditional_interrupt(ch);
53749ab747fSPaolo Bonzini     conditional_branch(ch);
53849ab747fSPaolo Bonzini 
53949ab747fSPaolo Bonzini wait:
54049ab747fSPaolo Bonzini     qemu_bh_schedule(dbdma_bh);
54149ab747fSPaolo Bonzini }
54249ab747fSPaolo Bonzini 
54349ab747fSPaolo Bonzini static void stop(DBDMA_channel *ch)
54449ab747fSPaolo Bonzini {
54549ab747fSPaolo Bonzini     ch->regs[DBDMA_STATUS] &= ~(ACTIVE|DEAD|FLUSH);
54649ab747fSPaolo Bonzini 
54749ab747fSPaolo Bonzini     /* the stop command does not increment command pointer */
54849ab747fSPaolo Bonzini }
54949ab747fSPaolo Bonzini 
55049ab747fSPaolo Bonzini static void channel_run(DBDMA_channel *ch)
55149ab747fSPaolo Bonzini {
55249ab747fSPaolo Bonzini     dbdma_cmd *current = &ch->current;
55349ab747fSPaolo Bonzini     uint16_t cmd, key;
55449ab747fSPaolo Bonzini     uint16_t req_count;
55549ab747fSPaolo Bonzini     uint32_t phy_addr;
55649ab747fSPaolo Bonzini 
55749ab747fSPaolo Bonzini     DBDMA_DPRINTF("channel_run\n");
55849ab747fSPaolo Bonzini     dump_dbdma_cmd(current);
55949ab747fSPaolo Bonzini 
56049ab747fSPaolo Bonzini     /* clear WAKE flag at command fetch */
56149ab747fSPaolo Bonzini 
56249ab747fSPaolo Bonzini     ch->regs[DBDMA_STATUS] &= ~WAKE;
56349ab747fSPaolo Bonzini 
56449ab747fSPaolo Bonzini     cmd = le16_to_cpu(current->command) & COMMAND_MASK;
56549ab747fSPaolo Bonzini 
56649ab747fSPaolo Bonzini     switch (cmd) {
56749ab747fSPaolo Bonzini     case DBDMA_NOP:
56849ab747fSPaolo Bonzini         nop(ch);
56949ab747fSPaolo Bonzini         return;
57049ab747fSPaolo Bonzini 
57149ab747fSPaolo Bonzini     case DBDMA_STOP:
57249ab747fSPaolo Bonzini         stop(ch);
57349ab747fSPaolo Bonzini         return;
57449ab747fSPaolo Bonzini     }
57549ab747fSPaolo Bonzini 
57649ab747fSPaolo Bonzini     key = le16_to_cpu(current->command) & 0x0700;
57749ab747fSPaolo Bonzini     req_count = le16_to_cpu(current->req_count);
57849ab747fSPaolo Bonzini     phy_addr = le32_to_cpu(current->phy_addr);
57949ab747fSPaolo Bonzini 
58049ab747fSPaolo Bonzini     if (key == KEY_STREAM4) {
58149ab747fSPaolo Bonzini         printf("command %x, invalid key 4\n", cmd);
58249ab747fSPaolo Bonzini         kill_channel(ch);
58349ab747fSPaolo Bonzini         return;
58449ab747fSPaolo Bonzini     }
58549ab747fSPaolo Bonzini 
58649ab747fSPaolo Bonzini     switch (cmd) {
58749ab747fSPaolo Bonzini     case OUTPUT_MORE:
58849ab747fSPaolo Bonzini         start_output(ch, key, phy_addr, req_count, 0);
58949ab747fSPaolo Bonzini         return;
59049ab747fSPaolo Bonzini 
59149ab747fSPaolo Bonzini     case OUTPUT_LAST:
59249ab747fSPaolo Bonzini         start_output(ch, key, phy_addr, req_count, 1);
59349ab747fSPaolo Bonzini         return;
59449ab747fSPaolo Bonzini 
59549ab747fSPaolo Bonzini     case INPUT_MORE:
59649ab747fSPaolo Bonzini         start_input(ch, key, phy_addr, req_count, 0);
59749ab747fSPaolo Bonzini         return;
59849ab747fSPaolo Bonzini 
59949ab747fSPaolo Bonzini     case INPUT_LAST:
60049ab747fSPaolo Bonzini         start_input(ch, key, phy_addr, req_count, 1);
60149ab747fSPaolo Bonzini         return;
60249ab747fSPaolo Bonzini     }
60349ab747fSPaolo Bonzini 
60449ab747fSPaolo Bonzini     if (key < KEY_REGS) {
60549ab747fSPaolo Bonzini         printf("command %x, invalid key %x\n", cmd, key);
60649ab747fSPaolo Bonzini         key = KEY_SYSTEM;
60749ab747fSPaolo Bonzini     }
60849ab747fSPaolo Bonzini 
60949ab747fSPaolo Bonzini     /* for LOAD_WORD and STORE_WORD, req_count is on 3 bits
61049ab747fSPaolo Bonzini      * and BRANCH is invalid
61149ab747fSPaolo Bonzini      */
61249ab747fSPaolo Bonzini 
61349ab747fSPaolo Bonzini     req_count = req_count & 0x0007;
61449ab747fSPaolo Bonzini     if (req_count & 0x4) {
61549ab747fSPaolo Bonzini         req_count = 4;
61649ab747fSPaolo Bonzini         phy_addr &= ~3;
61749ab747fSPaolo Bonzini     } else if (req_count & 0x2) {
61849ab747fSPaolo Bonzini         req_count = 2;
61949ab747fSPaolo Bonzini         phy_addr &= ~1;
62049ab747fSPaolo Bonzini     } else
62149ab747fSPaolo Bonzini         req_count = 1;
62249ab747fSPaolo Bonzini 
62349ab747fSPaolo Bonzini     switch (cmd) {
62449ab747fSPaolo Bonzini     case LOAD_WORD:
62549ab747fSPaolo Bonzini         load_word(ch, key, phy_addr, req_count);
62649ab747fSPaolo Bonzini         return;
62749ab747fSPaolo Bonzini 
62849ab747fSPaolo Bonzini     case STORE_WORD:
62949ab747fSPaolo Bonzini         store_word(ch, key, phy_addr, req_count);
63049ab747fSPaolo Bonzini         return;
63149ab747fSPaolo Bonzini     }
63249ab747fSPaolo Bonzini }
63349ab747fSPaolo Bonzini 
63449ab747fSPaolo Bonzini static void DBDMA_run(DBDMAState *s)
63549ab747fSPaolo Bonzini {
63649ab747fSPaolo Bonzini     int channel;
63749ab747fSPaolo Bonzini 
63849ab747fSPaolo Bonzini     for (channel = 0; channel < DBDMA_CHANNELS; channel++) {
63949ab747fSPaolo Bonzini         DBDMA_channel *ch = &s->channels[channel];
64049ab747fSPaolo Bonzini         uint32_t status = ch->regs[DBDMA_STATUS];
64149ab747fSPaolo Bonzini         if (!ch->processing && (status & RUN) && (status & ACTIVE)) {
64249ab747fSPaolo Bonzini             channel_run(ch);
64349ab747fSPaolo Bonzini         }
64449ab747fSPaolo Bonzini     }
64549ab747fSPaolo Bonzini }
64649ab747fSPaolo Bonzini 
64749ab747fSPaolo Bonzini static void DBDMA_run_bh(void *opaque)
64849ab747fSPaolo Bonzini {
64949ab747fSPaolo Bonzini     DBDMAState *s = opaque;
65049ab747fSPaolo Bonzini 
65149ab747fSPaolo Bonzini     DBDMA_DPRINTF("DBDMA_run_bh\n");
65249ab747fSPaolo Bonzini 
65349ab747fSPaolo Bonzini     DBDMA_run(s);
65449ab747fSPaolo Bonzini }
65549ab747fSPaolo Bonzini 
65649ab747fSPaolo Bonzini void DBDMA_register_channel(void *dbdma, int nchan, qemu_irq irq,
65749ab747fSPaolo Bonzini                             DBDMA_rw rw, DBDMA_flush flush,
65849ab747fSPaolo Bonzini                             void *opaque)
65949ab747fSPaolo Bonzini {
66049ab747fSPaolo Bonzini     DBDMAState *s = dbdma;
66149ab747fSPaolo Bonzini     DBDMA_channel *ch = &s->channels[nchan];
66249ab747fSPaolo Bonzini 
66349ab747fSPaolo Bonzini     DBDMA_DPRINTF("DBDMA_register_channel 0x%x\n", nchan);
66449ab747fSPaolo Bonzini 
66549ab747fSPaolo Bonzini     ch->irq = irq;
66649ab747fSPaolo Bonzini     ch->channel = nchan;
66749ab747fSPaolo Bonzini     ch->rw = rw;
66849ab747fSPaolo Bonzini     ch->flush = flush;
66949ab747fSPaolo Bonzini     ch->io.opaque = opaque;
67049ab747fSPaolo Bonzini     ch->io.channel = ch;
67149ab747fSPaolo Bonzini }
67249ab747fSPaolo Bonzini 
67349ab747fSPaolo Bonzini static void
67449ab747fSPaolo Bonzini dbdma_control_write(DBDMA_channel *ch)
67549ab747fSPaolo Bonzini {
67649ab747fSPaolo Bonzini     uint16_t mask, value;
67749ab747fSPaolo Bonzini     uint32_t status;
67849ab747fSPaolo Bonzini 
67949ab747fSPaolo Bonzini     mask = (ch->regs[DBDMA_CONTROL] >> 16) & 0xffff;
68049ab747fSPaolo Bonzini     value = ch->regs[DBDMA_CONTROL] & 0xffff;
68149ab747fSPaolo Bonzini 
68249ab747fSPaolo Bonzini     value &= (RUN | PAUSE | FLUSH | WAKE | DEVSTAT);
68349ab747fSPaolo Bonzini 
68449ab747fSPaolo Bonzini     status = ch->regs[DBDMA_STATUS];
68549ab747fSPaolo Bonzini 
68649ab747fSPaolo Bonzini     status = (value & mask) | (status & ~mask);
68749ab747fSPaolo Bonzini 
68849ab747fSPaolo Bonzini     if (status & WAKE)
68949ab747fSPaolo Bonzini         status |= ACTIVE;
69049ab747fSPaolo Bonzini     if (status & RUN) {
69149ab747fSPaolo Bonzini         status |= ACTIVE;
69249ab747fSPaolo Bonzini         status &= ~DEAD;
69349ab747fSPaolo Bonzini     }
69449ab747fSPaolo Bonzini     if (status & PAUSE)
69549ab747fSPaolo Bonzini         status &= ~ACTIVE;
69649ab747fSPaolo Bonzini     if ((ch->regs[DBDMA_STATUS] & RUN) && !(status & RUN)) {
69749ab747fSPaolo Bonzini         /* RUN is cleared */
69849ab747fSPaolo Bonzini         status &= ~(ACTIVE|DEAD);
69949ab747fSPaolo Bonzini         if ((status & FLUSH) && ch->flush) {
70049ab747fSPaolo Bonzini             ch->flush(&ch->io);
70149ab747fSPaolo Bonzini             status &= ~FLUSH;
70249ab747fSPaolo Bonzini         }
70349ab747fSPaolo Bonzini     }
70449ab747fSPaolo Bonzini 
70549ab747fSPaolo Bonzini     DBDMA_DPRINTF("    status 0x%08x\n", status);
70649ab747fSPaolo Bonzini 
70749ab747fSPaolo Bonzini     ch->regs[DBDMA_STATUS] = status;
70849ab747fSPaolo Bonzini 
70949ab747fSPaolo Bonzini     if (status & ACTIVE)
71049ab747fSPaolo Bonzini         qemu_bh_schedule(dbdma_bh);
71149ab747fSPaolo Bonzini     if ((status & FLUSH) && ch->flush)
71249ab747fSPaolo Bonzini         ch->flush(&ch->io);
71349ab747fSPaolo Bonzini }
71449ab747fSPaolo Bonzini 
71549ab747fSPaolo Bonzini static void dbdma_write(void *opaque, hwaddr addr,
71649ab747fSPaolo Bonzini                         uint64_t value, unsigned size)
71749ab747fSPaolo Bonzini {
71849ab747fSPaolo Bonzini     int channel = addr >> DBDMA_CHANNEL_SHIFT;
71949ab747fSPaolo Bonzini     DBDMAState *s = opaque;
72049ab747fSPaolo Bonzini     DBDMA_channel *ch = &s->channels[channel];
72149ab747fSPaolo Bonzini     int reg = (addr - (channel << DBDMA_CHANNEL_SHIFT)) >> 2;
72249ab747fSPaolo Bonzini 
72358c0c311SAlexander Graf     DBDMA_DPRINTF("writel 0x" TARGET_FMT_plx " <= 0x%08"PRIx64"\n",
72458c0c311SAlexander Graf                   addr, value);
72549ab747fSPaolo Bonzini     DBDMA_DPRINTF("channel 0x%x reg 0x%x\n",
72649ab747fSPaolo Bonzini                   (uint32_t)addr >> DBDMA_CHANNEL_SHIFT, reg);
72749ab747fSPaolo Bonzini 
728*7eaba824SAlexander Graf     /* cmdptr cannot be modified if channel is ACTIVE */
72949ab747fSPaolo Bonzini 
730*7eaba824SAlexander Graf     if (reg == DBDMA_CMDPTR_LO && (ch->regs[DBDMA_STATUS] & ACTIVE)) {
73149ab747fSPaolo Bonzini         return;
732*7eaba824SAlexander Graf     }
73349ab747fSPaolo Bonzini 
73449ab747fSPaolo Bonzini     ch->regs[reg] = value;
73549ab747fSPaolo Bonzini 
73649ab747fSPaolo Bonzini     switch(reg) {
73749ab747fSPaolo Bonzini     case DBDMA_CONTROL:
73849ab747fSPaolo Bonzini         dbdma_control_write(ch);
73949ab747fSPaolo Bonzini         break;
74049ab747fSPaolo Bonzini     case DBDMA_CMDPTR_LO:
74149ab747fSPaolo Bonzini         /* 16-byte aligned */
74249ab747fSPaolo Bonzini         ch->regs[DBDMA_CMDPTR_LO] &= ~0xf;
74349ab747fSPaolo Bonzini         dbdma_cmdptr_load(ch);
74449ab747fSPaolo Bonzini         break;
74549ab747fSPaolo Bonzini     case DBDMA_STATUS:
74649ab747fSPaolo Bonzini     case DBDMA_INTR_SEL:
74749ab747fSPaolo Bonzini     case DBDMA_BRANCH_SEL:
74849ab747fSPaolo Bonzini     case DBDMA_WAIT_SEL:
74949ab747fSPaolo Bonzini         /* nothing to do */
75049ab747fSPaolo Bonzini         break;
75149ab747fSPaolo Bonzini     case DBDMA_XFER_MODE:
75249ab747fSPaolo Bonzini     case DBDMA_CMDPTR_HI:
75349ab747fSPaolo Bonzini     case DBDMA_DATA2PTR_HI:
75449ab747fSPaolo Bonzini     case DBDMA_DATA2PTR_LO:
75549ab747fSPaolo Bonzini     case DBDMA_ADDRESS_HI:
75649ab747fSPaolo Bonzini     case DBDMA_BRANCH_ADDR_HI:
75749ab747fSPaolo Bonzini     case DBDMA_RES1:
75849ab747fSPaolo Bonzini     case DBDMA_RES2:
75949ab747fSPaolo Bonzini     case DBDMA_RES3:
76049ab747fSPaolo Bonzini     case DBDMA_RES4:
76149ab747fSPaolo Bonzini         /* unused */
76249ab747fSPaolo Bonzini         break;
76349ab747fSPaolo Bonzini     }
76449ab747fSPaolo Bonzini }
76549ab747fSPaolo Bonzini 
76649ab747fSPaolo Bonzini static uint64_t dbdma_read(void *opaque, hwaddr addr,
76749ab747fSPaolo Bonzini                            unsigned size)
76849ab747fSPaolo Bonzini {
76949ab747fSPaolo Bonzini     uint32_t value;
77049ab747fSPaolo Bonzini     int channel = addr >> DBDMA_CHANNEL_SHIFT;
77149ab747fSPaolo Bonzini     DBDMAState *s = opaque;
77249ab747fSPaolo Bonzini     DBDMA_channel *ch = &s->channels[channel];
77349ab747fSPaolo Bonzini     int reg = (addr - (channel << DBDMA_CHANNEL_SHIFT)) >> 2;
77449ab747fSPaolo Bonzini 
77549ab747fSPaolo Bonzini     value = ch->regs[reg];
77649ab747fSPaolo Bonzini 
77749ab747fSPaolo Bonzini     DBDMA_DPRINTF("readl 0x" TARGET_FMT_plx " => 0x%08x\n", addr, value);
77849ab747fSPaolo Bonzini     DBDMA_DPRINTF("channel 0x%x reg 0x%x\n",
77949ab747fSPaolo Bonzini                   (uint32_t)addr >> DBDMA_CHANNEL_SHIFT, reg);
78049ab747fSPaolo Bonzini 
78149ab747fSPaolo Bonzini     switch(reg) {
78249ab747fSPaolo Bonzini     case DBDMA_CONTROL:
78349ab747fSPaolo Bonzini         value = 0;
78449ab747fSPaolo Bonzini         break;
78549ab747fSPaolo Bonzini     case DBDMA_STATUS:
78649ab747fSPaolo Bonzini     case DBDMA_CMDPTR_LO:
78749ab747fSPaolo Bonzini     case DBDMA_INTR_SEL:
78849ab747fSPaolo Bonzini     case DBDMA_BRANCH_SEL:
78949ab747fSPaolo Bonzini     case DBDMA_WAIT_SEL:
79049ab747fSPaolo Bonzini         /* nothing to do */
79149ab747fSPaolo Bonzini         break;
79249ab747fSPaolo Bonzini     case DBDMA_XFER_MODE:
79349ab747fSPaolo Bonzini     case DBDMA_CMDPTR_HI:
79449ab747fSPaolo Bonzini     case DBDMA_DATA2PTR_HI:
79549ab747fSPaolo Bonzini     case DBDMA_DATA2PTR_LO:
79649ab747fSPaolo Bonzini     case DBDMA_ADDRESS_HI:
79749ab747fSPaolo Bonzini     case DBDMA_BRANCH_ADDR_HI:
79849ab747fSPaolo Bonzini         /* unused */
79949ab747fSPaolo Bonzini         value = 0;
80049ab747fSPaolo Bonzini         break;
80149ab747fSPaolo Bonzini     case DBDMA_RES1:
80249ab747fSPaolo Bonzini     case DBDMA_RES2:
80349ab747fSPaolo Bonzini     case DBDMA_RES3:
80449ab747fSPaolo Bonzini     case DBDMA_RES4:
80549ab747fSPaolo Bonzini         /* reserved */
80649ab747fSPaolo Bonzini         break;
80749ab747fSPaolo Bonzini     }
80849ab747fSPaolo Bonzini 
80949ab747fSPaolo Bonzini     return value;
81049ab747fSPaolo Bonzini }
81149ab747fSPaolo Bonzini 
81249ab747fSPaolo Bonzini static const MemoryRegionOps dbdma_ops = {
81349ab747fSPaolo Bonzini     .read = dbdma_read,
81449ab747fSPaolo Bonzini     .write = dbdma_write,
81549ab747fSPaolo Bonzini     .endianness = DEVICE_LITTLE_ENDIAN,
81649ab747fSPaolo Bonzini     .valid = {
81749ab747fSPaolo Bonzini         .min_access_size = 4,
81849ab747fSPaolo Bonzini         .max_access_size = 4,
81949ab747fSPaolo Bonzini     },
82049ab747fSPaolo Bonzini };
82149ab747fSPaolo Bonzini 
82249ab747fSPaolo Bonzini static const VMStateDescription vmstate_dbdma_channel = {
82349ab747fSPaolo Bonzini     .name = "dbdma_channel",
82449ab747fSPaolo Bonzini     .version_id = 0,
82549ab747fSPaolo Bonzini     .minimum_version_id = 0,
82649ab747fSPaolo Bonzini     .minimum_version_id_old = 0,
82749ab747fSPaolo Bonzini     .fields      = (VMStateField[]) {
82849ab747fSPaolo Bonzini         VMSTATE_UINT32_ARRAY(regs, struct DBDMA_channel, DBDMA_REGS),
82949ab747fSPaolo Bonzini         VMSTATE_END_OF_LIST()
83049ab747fSPaolo Bonzini     }
83149ab747fSPaolo Bonzini };
83249ab747fSPaolo Bonzini 
83349ab747fSPaolo Bonzini static const VMStateDescription vmstate_dbdma = {
83449ab747fSPaolo Bonzini     .name = "dbdma",
83549ab747fSPaolo Bonzini     .version_id = 2,
83649ab747fSPaolo Bonzini     .minimum_version_id = 2,
83749ab747fSPaolo Bonzini     .minimum_version_id_old = 2,
83849ab747fSPaolo Bonzini     .fields      = (VMStateField[]) {
83949ab747fSPaolo Bonzini         VMSTATE_STRUCT_ARRAY(channels, DBDMAState, DBDMA_CHANNELS, 1,
84049ab747fSPaolo Bonzini                              vmstate_dbdma_channel, DBDMA_channel),
84149ab747fSPaolo Bonzini         VMSTATE_END_OF_LIST()
84249ab747fSPaolo Bonzini     }
84349ab747fSPaolo Bonzini };
84449ab747fSPaolo Bonzini 
84549ab747fSPaolo Bonzini static void dbdma_reset(void *opaque)
84649ab747fSPaolo Bonzini {
84749ab747fSPaolo Bonzini     DBDMAState *s = opaque;
84849ab747fSPaolo Bonzini     int i;
84949ab747fSPaolo Bonzini 
85049ab747fSPaolo Bonzini     for (i = 0; i < DBDMA_CHANNELS; i++)
85149ab747fSPaolo Bonzini         memset(s->channels[i].regs, 0, DBDMA_SIZE);
85249ab747fSPaolo Bonzini }
85349ab747fSPaolo Bonzini 
85449ab747fSPaolo Bonzini void* DBDMA_init (MemoryRegion **dbdma_mem)
85549ab747fSPaolo Bonzini {
85649ab747fSPaolo Bonzini     DBDMAState *s;
85749ab747fSPaolo Bonzini 
85849ab747fSPaolo Bonzini     s = g_malloc0(sizeof(DBDMAState));
85949ab747fSPaolo Bonzini 
8602c9b15caSPaolo Bonzini     memory_region_init_io(&s->mem, NULL, &dbdma_ops, s, "dbdma", 0x1000);
86149ab747fSPaolo Bonzini     *dbdma_mem = &s->mem;
86249ab747fSPaolo Bonzini     vmstate_register(NULL, -1, &vmstate_dbdma, s);
86349ab747fSPaolo Bonzini     qemu_register_reset(dbdma_reset, s);
86449ab747fSPaolo Bonzini 
86549ab747fSPaolo Bonzini     dbdma_bh = qemu_bh_new(DBDMA_run_bh, s);
86649ab747fSPaolo Bonzini 
86749ab747fSPaolo Bonzini     return s;
86849ab747fSPaolo Bonzini }
869