xref: /openbmc/qemu/hw/misc/macio/mac_dbdma.c (revision ba0b17dd8f00bdc4d55d67046e4300d95ad5f3f2)
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  */
390d75590dSPeter Maydell #include "qemu/osdep.h"
4049ab747fSPaolo Bonzini #include "hw/hw.h"
4149ab747fSPaolo Bonzini #include "hw/isa/isa.h"
4249ab747fSPaolo Bonzini #include "hw/ppc/mac_dbdma.h"
4349ab747fSPaolo Bonzini #include "qemu/main-loop.h"
4403dd024fSPaolo Bonzini #include "qemu/log.h"
4588655881SMark Cave-Ayland #include "sysemu/dma.h"
4649ab747fSPaolo Bonzini 
4749ab747fSPaolo Bonzini /* debug DBDMA */
48*ba0b17ddSMark Cave-Ayland #define DEBUG_DBDMA 0
4949ab747fSPaolo Bonzini 
50*ba0b17ddSMark Cave-Ayland #define DBDMA_DPRINTF(fmt, ...) do { \
51*ba0b17ddSMark Cave-Ayland     if (DEBUG_DBDMA) { \
52*ba0b17ddSMark Cave-Ayland         printf("DBDMA: " fmt , ## __VA_ARGS__); \
53*ba0b17ddSMark Cave-Ayland     } \
54*ba0b17ddSMark Cave-Ayland } while (0);
5549ab747fSPaolo Bonzini 
5649ab747fSPaolo Bonzini /*
5749ab747fSPaolo Bonzini  */
5849ab747fSPaolo Bonzini 
59d2f0ce21SAlexander Graf static DBDMAState *dbdma_from_ch(DBDMA_channel *ch)
60d2f0ce21SAlexander Graf {
61d2f0ce21SAlexander Graf     return container_of(ch, DBDMAState, channels[ch->channel]);
62d2f0ce21SAlexander Graf }
63d2f0ce21SAlexander Graf 
64*ba0b17ddSMark Cave-Ayland #if DEBUG_DBDMA
6549ab747fSPaolo Bonzini static void dump_dbdma_cmd(dbdma_cmd *cmd)
6649ab747fSPaolo Bonzini {
6749ab747fSPaolo Bonzini     printf("dbdma_cmd %p\n", cmd);
6849ab747fSPaolo Bonzini     printf("    req_count 0x%04x\n", le16_to_cpu(cmd->req_count));
6949ab747fSPaolo Bonzini     printf("    command 0x%04x\n", le16_to_cpu(cmd->command));
7049ab747fSPaolo Bonzini     printf("    phy_addr 0x%08x\n", le32_to_cpu(cmd->phy_addr));
7149ab747fSPaolo Bonzini     printf("    cmd_dep 0x%08x\n", le32_to_cpu(cmd->cmd_dep));
7249ab747fSPaolo Bonzini     printf("    res_count 0x%04x\n", le16_to_cpu(cmd->res_count));
7349ab747fSPaolo Bonzini     printf("    xfer_status 0x%04x\n", le16_to_cpu(cmd->xfer_status));
7449ab747fSPaolo Bonzini }
7549ab747fSPaolo Bonzini #else
7649ab747fSPaolo Bonzini static void dump_dbdma_cmd(dbdma_cmd *cmd)
7749ab747fSPaolo Bonzini {
7849ab747fSPaolo Bonzini }
7949ab747fSPaolo Bonzini #endif
8049ab747fSPaolo Bonzini static void dbdma_cmdptr_load(DBDMA_channel *ch)
8149ab747fSPaolo Bonzini {
8249ab747fSPaolo Bonzini     DBDMA_DPRINTF("dbdma_cmdptr_load 0x%08x\n",
8349ab747fSPaolo Bonzini                   ch->regs[DBDMA_CMDPTR_LO]);
8488655881SMark Cave-Ayland     dma_memory_read(&address_space_memory, ch->regs[DBDMA_CMDPTR_LO],
85e1fe50dcSStefan Weil                     &ch->current, sizeof(dbdma_cmd));
8649ab747fSPaolo Bonzini }
8749ab747fSPaolo Bonzini 
8849ab747fSPaolo Bonzini static void dbdma_cmdptr_save(DBDMA_channel *ch)
8949ab747fSPaolo Bonzini {
9049ab747fSPaolo Bonzini     DBDMA_DPRINTF("dbdma_cmdptr_save 0x%08x\n",
9149ab747fSPaolo Bonzini                   ch->regs[DBDMA_CMDPTR_LO]);
9249ab747fSPaolo Bonzini     DBDMA_DPRINTF("xfer_status 0x%08x res_count 0x%04x\n",
9349ab747fSPaolo Bonzini                   le16_to_cpu(ch->current.xfer_status),
9449ab747fSPaolo Bonzini                   le16_to_cpu(ch->current.res_count));
9588655881SMark Cave-Ayland     dma_memory_write(&address_space_memory, ch->regs[DBDMA_CMDPTR_LO],
96e1fe50dcSStefan Weil                      &ch->current, sizeof(dbdma_cmd));
9749ab747fSPaolo Bonzini }
9849ab747fSPaolo Bonzini 
9949ab747fSPaolo Bonzini static void kill_channel(DBDMA_channel *ch)
10049ab747fSPaolo Bonzini {
10149ab747fSPaolo Bonzini     DBDMA_DPRINTF("kill_channel\n");
10249ab747fSPaolo Bonzini 
10349ab747fSPaolo Bonzini     ch->regs[DBDMA_STATUS] |= DEAD;
10449ab747fSPaolo Bonzini     ch->regs[DBDMA_STATUS] &= ~ACTIVE;
10549ab747fSPaolo Bonzini 
10649ab747fSPaolo Bonzini     qemu_irq_raise(ch->irq);
10749ab747fSPaolo Bonzini }
10849ab747fSPaolo Bonzini 
10949ab747fSPaolo Bonzini static void conditional_interrupt(DBDMA_channel *ch)
11049ab747fSPaolo Bonzini {
11149ab747fSPaolo Bonzini     dbdma_cmd *current = &ch->current;
11249ab747fSPaolo Bonzini     uint16_t intr;
11349ab747fSPaolo Bonzini     uint16_t sel_mask, sel_value;
11449ab747fSPaolo Bonzini     uint32_t status;
11549ab747fSPaolo Bonzini     int cond;
11649ab747fSPaolo Bonzini 
11733ce36bbSAlexander Graf     DBDMA_DPRINTF("%s\n", __func__);
11849ab747fSPaolo Bonzini 
11949ab747fSPaolo Bonzini     intr = le16_to_cpu(current->command) & INTR_MASK;
12049ab747fSPaolo Bonzini 
12149ab747fSPaolo Bonzini     switch(intr) {
12249ab747fSPaolo Bonzini     case INTR_NEVER:  /* don't interrupt */
12349ab747fSPaolo Bonzini         return;
12449ab747fSPaolo Bonzini     case INTR_ALWAYS: /* always interrupt */
12549ab747fSPaolo Bonzini         qemu_irq_raise(ch->irq);
12633ce36bbSAlexander Graf         DBDMA_DPRINTF("%s: raise\n", __func__);
12749ab747fSPaolo Bonzini         return;
12849ab747fSPaolo Bonzini     }
12949ab747fSPaolo Bonzini 
13049ab747fSPaolo Bonzini     status = ch->regs[DBDMA_STATUS] & DEVSTAT;
13149ab747fSPaolo Bonzini 
13249ab747fSPaolo Bonzini     sel_mask = (ch->regs[DBDMA_INTR_SEL] >> 16) & 0x0f;
13349ab747fSPaolo Bonzini     sel_value = ch->regs[DBDMA_INTR_SEL] & 0x0f;
13449ab747fSPaolo Bonzini 
13549ab747fSPaolo Bonzini     cond = (status & sel_mask) == (sel_value & sel_mask);
13649ab747fSPaolo Bonzini 
13749ab747fSPaolo Bonzini     switch(intr) {
13849ab747fSPaolo Bonzini     case INTR_IFSET:  /* intr if condition bit is 1 */
13933ce36bbSAlexander Graf         if (cond) {
14049ab747fSPaolo Bonzini             qemu_irq_raise(ch->irq);
14133ce36bbSAlexander Graf             DBDMA_DPRINTF("%s: raise\n", __func__);
14233ce36bbSAlexander Graf         }
14349ab747fSPaolo Bonzini         return;
14449ab747fSPaolo Bonzini     case INTR_IFCLR:  /* intr if condition bit is 0 */
14533ce36bbSAlexander Graf         if (!cond) {
14649ab747fSPaolo Bonzini             qemu_irq_raise(ch->irq);
14733ce36bbSAlexander Graf             DBDMA_DPRINTF("%s: raise\n", __func__);
14833ce36bbSAlexander Graf         }
14949ab747fSPaolo Bonzini         return;
15049ab747fSPaolo Bonzini     }
15149ab747fSPaolo Bonzini }
15249ab747fSPaolo Bonzini 
15349ab747fSPaolo Bonzini static int conditional_wait(DBDMA_channel *ch)
15449ab747fSPaolo Bonzini {
15549ab747fSPaolo Bonzini     dbdma_cmd *current = &ch->current;
15649ab747fSPaolo Bonzini     uint16_t wait;
15749ab747fSPaolo Bonzini     uint16_t sel_mask, sel_value;
15849ab747fSPaolo Bonzini     uint32_t status;
15949ab747fSPaolo Bonzini     int cond;
16049ab747fSPaolo Bonzini 
16149ab747fSPaolo Bonzini     DBDMA_DPRINTF("conditional_wait\n");
16249ab747fSPaolo Bonzini 
16349ab747fSPaolo Bonzini     wait = le16_to_cpu(current->command) & WAIT_MASK;
16449ab747fSPaolo Bonzini 
16549ab747fSPaolo Bonzini     switch(wait) {
16649ab747fSPaolo Bonzini     case WAIT_NEVER:  /* don't wait */
16749ab747fSPaolo Bonzini         return 0;
16849ab747fSPaolo Bonzini     case WAIT_ALWAYS: /* always wait */
16949ab747fSPaolo Bonzini         return 1;
17049ab747fSPaolo Bonzini     }
17149ab747fSPaolo Bonzini 
17249ab747fSPaolo Bonzini     status = ch->regs[DBDMA_STATUS] & DEVSTAT;
17349ab747fSPaolo Bonzini 
17449ab747fSPaolo Bonzini     sel_mask = (ch->regs[DBDMA_WAIT_SEL] >> 16) & 0x0f;
17549ab747fSPaolo Bonzini     sel_value = ch->regs[DBDMA_WAIT_SEL] & 0x0f;
17649ab747fSPaolo Bonzini 
17749ab747fSPaolo Bonzini     cond = (status & sel_mask) == (sel_value & sel_mask);
17849ab747fSPaolo Bonzini 
17949ab747fSPaolo Bonzini     switch(wait) {
18049ab747fSPaolo Bonzini     case WAIT_IFSET:  /* wait if condition bit is 1 */
18149ab747fSPaolo Bonzini         if (cond)
18249ab747fSPaolo Bonzini             return 1;
18349ab747fSPaolo Bonzini         return 0;
18449ab747fSPaolo Bonzini     case WAIT_IFCLR:  /* wait if condition bit is 0 */
18549ab747fSPaolo Bonzini         if (!cond)
18649ab747fSPaolo Bonzini             return 1;
18749ab747fSPaolo Bonzini         return 0;
18849ab747fSPaolo Bonzini     }
18949ab747fSPaolo Bonzini     return 0;
19049ab747fSPaolo Bonzini }
19149ab747fSPaolo Bonzini 
19249ab747fSPaolo Bonzini static void next(DBDMA_channel *ch)
19349ab747fSPaolo Bonzini {
19449ab747fSPaolo Bonzini     uint32_t cp;
19549ab747fSPaolo Bonzini 
19649ab747fSPaolo Bonzini     ch->regs[DBDMA_STATUS] &= ~BT;
19749ab747fSPaolo Bonzini 
19849ab747fSPaolo Bonzini     cp = ch->regs[DBDMA_CMDPTR_LO];
19949ab747fSPaolo Bonzini     ch->regs[DBDMA_CMDPTR_LO] = cp + sizeof(dbdma_cmd);
20049ab747fSPaolo Bonzini     dbdma_cmdptr_load(ch);
20149ab747fSPaolo Bonzini }
20249ab747fSPaolo Bonzini 
20349ab747fSPaolo Bonzini static void branch(DBDMA_channel *ch)
20449ab747fSPaolo Bonzini {
20549ab747fSPaolo Bonzini     dbdma_cmd *current = &ch->current;
20649ab747fSPaolo Bonzini 
20749ab747fSPaolo Bonzini     ch->regs[DBDMA_CMDPTR_LO] = current->cmd_dep;
20849ab747fSPaolo Bonzini     ch->regs[DBDMA_STATUS] |= BT;
20949ab747fSPaolo Bonzini     dbdma_cmdptr_load(ch);
21049ab747fSPaolo Bonzini }
21149ab747fSPaolo Bonzini 
21249ab747fSPaolo Bonzini static void conditional_branch(DBDMA_channel *ch)
21349ab747fSPaolo Bonzini {
21449ab747fSPaolo Bonzini     dbdma_cmd *current = &ch->current;
21549ab747fSPaolo Bonzini     uint16_t br;
21649ab747fSPaolo Bonzini     uint16_t sel_mask, sel_value;
21749ab747fSPaolo Bonzini     uint32_t status;
21849ab747fSPaolo Bonzini     int cond;
21949ab747fSPaolo Bonzini 
22049ab747fSPaolo Bonzini     DBDMA_DPRINTF("conditional_branch\n");
22149ab747fSPaolo Bonzini 
22249ab747fSPaolo Bonzini     /* check if we must branch */
22349ab747fSPaolo Bonzini 
22449ab747fSPaolo Bonzini     br = le16_to_cpu(current->command) & BR_MASK;
22549ab747fSPaolo Bonzini 
22649ab747fSPaolo Bonzini     switch(br) {
22749ab747fSPaolo Bonzini     case BR_NEVER:  /* don't branch */
22849ab747fSPaolo Bonzini         next(ch);
22949ab747fSPaolo Bonzini         return;
23049ab747fSPaolo Bonzini     case BR_ALWAYS: /* always branch */
23149ab747fSPaolo Bonzini         branch(ch);
23249ab747fSPaolo Bonzini         return;
23349ab747fSPaolo Bonzini     }
23449ab747fSPaolo Bonzini 
23549ab747fSPaolo Bonzini     status = ch->regs[DBDMA_STATUS] & DEVSTAT;
23649ab747fSPaolo Bonzini 
23749ab747fSPaolo Bonzini     sel_mask = (ch->regs[DBDMA_BRANCH_SEL] >> 16) & 0x0f;
23849ab747fSPaolo Bonzini     sel_value = ch->regs[DBDMA_BRANCH_SEL] & 0x0f;
23949ab747fSPaolo Bonzini 
24049ab747fSPaolo Bonzini     cond = (status & sel_mask) == (sel_value & sel_mask);
24149ab747fSPaolo Bonzini 
24249ab747fSPaolo Bonzini     switch(br) {
24349ab747fSPaolo Bonzini     case BR_IFSET:  /* branch if condition bit is 1 */
24449ab747fSPaolo Bonzini         if (cond)
24549ab747fSPaolo Bonzini             branch(ch);
24649ab747fSPaolo Bonzini         else
24749ab747fSPaolo Bonzini             next(ch);
24849ab747fSPaolo Bonzini         return;
24949ab747fSPaolo Bonzini     case BR_IFCLR:  /* branch if condition bit is 0 */
25049ab747fSPaolo Bonzini         if (!cond)
25149ab747fSPaolo Bonzini             branch(ch);
25249ab747fSPaolo Bonzini         else
25349ab747fSPaolo Bonzini             next(ch);
25449ab747fSPaolo Bonzini         return;
25549ab747fSPaolo Bonzini     }
25649ab747fSPaolo Bonzini }
25749ab747fSPaolo Bonzini 
25849ab747fSPaolo Bonzini static void channel_run(DBDMA_channel *ch);
25949ab747fSPaolo Bonzini 
26049ab747fSPaolo Bonzini static void dbdma_end(DBDMA_io *io)
26149ab747fSPaolo Bonzini {
26249ab747fSPaolo Bonzini     DBDMA_channel *ch = io->channel;
26349ab747fSPaolo Bonzini     dbdma_cmd *current = &ch->current;
26449ab747fSPaolo Bonzini 
26533ce36bbSAlexander Graf     DBDMA_DPRINTF("%s\n", __func__);
26633ce36bbSAlexander Graf 
26749ab747fSPaolo Bonzini     if (conditional_wait(ch))
26849ab747fSPaolo Bonzini         goto wait;
26949ab747fSPaolo Bonzini 
27049ab747fSPaolo Bonzini     current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]);
27149ab747fSPaolo Bonzini     current->res_count = cpu_to_le16(io->len);
27249ab747fSPaolo Bonzini     dbdma_cmdptr_save(ch);
27349ab747fSPaolo Bonzini     if (io->is_last)
27449ab747fSPaolo Bonzini         ch->regs[DBDMA_STATUS] &= ~FLUSH;
27549ab747fSPaolo Bonzini 
27649ab747fSPaolo Bonzini     conditional_interrupt(ch);
27749ab747fSPaolo Bonzini     conditional_branch(ch);
27849ab747fSPaolo Bonzini 
27949ab747fSPaolo Bonzini wait:
28003ee3b1eSAlexander Graf     /* Indicate that we're ready for a new DMA round */
28103ee3b1eSAlexander Graf     ch->io.processing = false;
28203ee3b1eSAlexander Graf 
28349ab747fSPaolo Bonzini     if ((ch->regs[DBDMA_STATUS] & RUN) &&
28449ab747fSPaolo Bonzini         (ch->regs[DBDMA_STATUS] & ACTIVE))
28549ab747fSPaolo Bonzini         channel_run(ch);
28649ab747fSPaolo Bonzini }
28749ab747fSPaolo Bonzini 
28849ab747fSPaolo Bonzini static void start_output(DBDMA_channel *ch, int key, uint32_t addr,
28949ab747fSPaolo Bonzini                         uint16_t req_count, int is_last)
29049ab747fSPaolo Bonzini {
29149ab747fSPaolo Bonzini     DBDMA_DPRINTF("start_output\n");
29249ab747fSPaolo Bonzini 
29349ab747fSPaolo Bonzini     /* KEY_REGS, KEY_DEVICE and KEY_STREAM
29449ab747fSPaolo Bonzini      * are not implemented in the mac-io chip
29549ab747fSPaolo Bonzini      */
29649ab747fSPaolo Bonzini 
29749ab747fSPaolo Bonzini     DBDMA_DPRINTF("addr 0x%x key 0x%x\n", addr, key);
29849ab747fSPaolo Bonzini     if (!addr || key > KEY_STREAM3) {
29949ab747fSPaolo Bonzini         kill_channel(ch);
30049ab747fSPaolo Bonzini         return;
30149ab747fSPaolo Bonzini     }
30249ab747fSPaolo Bonzini 
30349ab747fSPaolo Bonzini     ch->io.addr = addr;
30449ab747fSPaolo Bonzini     ch->io.len = req_count;
30549ab747fSPaolo Bonzini     ch->io.is_last = is_last;
30649ab747fSPaolo Bonzini     ch->io.dma_end = dbdma_end;
30749ab747fSPaolo Bonzini     ch->io.is_dma_out = 1;
30803ee3b1eSAlexander Graf     ch->io.processing = true;
30949ab747fSPaolo Bonzini     if (ch->rw) {
31049ab747fSPaolo Bonzini         ch->rw(&ch->io);
31149ab747fSPaolo Bonzini     }
31249ab747fSPaolo Bonzini }
31349ab747fSPaolo Bonzini 
31449ab747fSPaolo Bonzini static void start_input(DBDMA_channel *ch, int key, uint32_t addr,
31549ab747fSPaolo Bonzini                        uint16_t req_count, int is_last)
31649ab747fSPaolo Bonzini {
31749ab747fSPaolo Bonzini     DBDMA_DPRINTF("start_input\n");
31849ab747fSPaolo Bonzini 
31949ab747fSPaolo Bonzini     /* KEY_REGS, KEY_DEVICE and KEY_STREAM
32049ab747fSPaolo Bonzini      * are not implemented in the mac-io chip
32149ab747fSPaolo Bonzini      */
32249ab747fSPaolo Bonzini 
32333ce36bbSAlexander Graf     DBDMA_DPRINTF("addr 0x%x key 0x%x\n", addr, key);
32449ab747fSPaolo Bonzini     if (!addr || key > KEY_STREAM3) {
32549ab747fSPaolo Bonzini         kill_channel(ch);
32649ab747fSPaolo Bonzini         return;
32749ab747fSPaolo Bonzini     }
32849ab747fSPaolo Bonzini 
32949ab747fSPaolo Bonzini     ch->io.addr = addr;
33049ab747fSPaolo Bonzini     ch->io.len = req_count;
33149ab747fSPaolo Bonzini     ch->io.is_last = is_last;
33249ab747fSPaolo Bonzini     ch->io.dma_end = dbdma_end;
33349ab747fSPaolo Bonzini     ch->io.is_dma_out = 0;
33403ee3b1eSAlexander Graf     ch->io.processing = true;
33549ab747fSPaolo Bonzini     if (ch->rw) {
33649ab747fSPaolo Bonzini         ch->rw(&ch->io);
33749ab747fSPaolo Bonzini     }
33849ab747fSPaolo Bonzini }
33949ab747fSPaolo Bonzini 
34049ab747fSPaolo Bonzini static void load_word(DBDMA_channel *ch, int key, uint32_t addr,
34149ab747fSPaolo Bonzini                      uint16_t len)
34249ab747fSPaolo Bonzini {
34349ab747fSPaolo Bonzini     dbdma_cmd *current = &ch->current;
34449ab747fSPaolo Bonzini     uint32_t val;
34549ab747fSPaolo Bonzini 
34649ab747fSPaolo Bonzini     DBDMA_DPRINTF("load_word\n");
34749ab747fSPaolo Bonzini 
34849ab747fSPaolo Bonzini     /* only implements KEY_SYSTEM */
34949ab747fSPaolo Bonzini 
35049ab747fSPaolo Bonzini     if (key != KEY_SYSTEM) {
35149ab747fSPaolo Bonzini         printf("DBDMA: LOAD_WORD, unimplemented key %x\n", key);
35249ab747fSPaolo Bonzini         kill_channel(ch);
35349ab747fSPaolo Bonzini         return;
35449ab747fSPaolo Bonzini     }
35549ab747fSPaolo Bonzini 
35688655881SMark Cave-Ayland     dma_memory_read(&address_space_memory, addr, &val, len);
35749ab747fSPaolo Bonzini 
35849ab747fSPaolo Bonzini     if (len == 2)
35949ab747fSPaolo Bonzini         val = (val << 16) | (current->cmd_dep & 0x0000ffff);
36049ab747fSPaolo Bonzini     else if (len == 1)
36149ab747fSPaolo Bonzini         val = (val << 24) | (current->cmd_dep & 0x00ffffff);
36249ab747fSPaolo Bonzini 
36349ab747fSPaolo Bonzini     current->cmd_dep = val;
36449ab747fSPaolo Bonzini 
36549ab747fSPaolo Bonzini     if (conditional_wait(ch))
36649ab747fSPaolo Bonzini         goto wait;
36749ab747fSPaolo Bonzini 
36849ab747fSPaolo Bonzini     current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]);
36949ab747fSPaolo Bonzini     dbdma_cmdptr_save(ch);
37049ab747fSPaolo Bonzini     ch->regs[DBDMA_STATUS] &= ~FLUSH;
37149ab747fSPaolo Bonzini 
37249ab747fSPaolo Bonzini     conditional_interrupt(ch);
37349ab747fSPaolo Bonzini     next(ch);
37449ab747fSPaolo Bonzini 
37549ab747fSPaolo Bonzini wait:
376d2f0ce21SAlexander Graf     DBDMA_kick(dbdma_from_ch(ch));
37749ab747fSPaolo Bonzini }
37849ab747fSPaolo Bonzini 
37949ab747fSPaolo Bonzini static void store_word(DBDMA_channel *ch, int key, uint32_t addr,
38049ab747fSPaolo Bonzini                       uint16_t len)
38149ab747fSPaolo Bonzini {
38249ab747fSPaolo Bonzini     dbdma_cmd *current = &ch->current;
38349ab747fSPaolo Bonzini     uint32_t val;
38449ab747fSPaolo Bonzini 
38549ab747fSPaolo Bonzini     DBDMA_DPRINTF("store_word\n");
38649ab747fSPaolo Bonzini 
38749ab747fSPaolo Bonzini     /* only implements KEY_SYSTEM */
38849ab747fSPaolo Bonzini 
38949ab747fSPaolo Bonzini     if (key != KEY_SYSTEM) {
39049ab747fSPaolo Bonzini         printf("DBDMA: STORE_WORD, unimplemented key %x\n", key);
39149ab747fSPaolo Bonzini         kill_channel(ch);
39249ab747fSPaolo Bonzini         return;
39349ab747fSPaolo Bonzini     }
39449ab747fSPaolo Bonzini 
39549ab747fSPaolo Bonzini     val = current->cmd_dep;
39649ab747fSPaolo Bonzini     if (len == 2)
39749ab747fSPaolo Bonzini         val >>= 16;
39849ab747fSPaolo Bonzini     else if (len == 1)
39949ab747fSPaolo Bonzini         val >>= 24;
40049ab747fSPaolo Bonzini 
40188655881SMark Cave-Ayland     dma_memory_write(&address_space_memory, addr, &val, len);
40249ab747fSPaolo Bonzini 
40349ab747fSPaolo Bonzini     if (conditional_wait(ch))
40449ab747fSPaolo Bonzini         goto wait;
40549ab747fSPaolo Bonzini 
40649ab747fSPaolo Bonzini     current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]);
40749ab747fSPaolo Bonzini     dbdma_cmdptr_save(ch);
40849ab747fSPaolo Bonzini     ch->regs[DBDMA_STATUS] &= ~FLUSH;
40949ab747fSPaolo Bonzini 
41049ab747fSPaolo Bonzini     conditional_interrupt(ch);
41149ab747fSPaolo Bonzini     next(ch);
41249ab747fSPaolo Bonzini 
41349ab747fSPaolo Bonzini wait:
414d2f0ce21SAlexander Graf     DBDMA_kick(dbdma_from_ch(ch));
41549ab747fSPaolo Bonzini }
41649ab747fSPaolo Bonzini 
41749ab747fSPaolo Bonzini static void nop(DBDMA_channel *ch)
41849ab747fSPaolo Bonzini {
41949ab747fSPaolo Bonzini     dbdma_cmd *current = &ch->current;
42049ab747fSPaolo Bonzini 
42149ab747fSPaolo Bonzini     if (conditional_wait(ch))
42249ab747fSPaolo Bonzini         goto wait;
42349ab747fSPaolo Bonzini 
42449ab747fSPaolo Bonzini     current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]);
42549ab747fSPaolo Bonzini     dbdma_cmdptr_save(ch);
42649ab747fSPaolo Bonzini 
42749ab747fSPaolo Bonzini     conditional_interrupt(ch);
42849ab747fSPaolo Bonzini     conditional_branch(ch);
42949ab747fSPaolo Bonzini 
43049ab747fSPaolo Bonzini wait:
431d2f0ce21SAlexander Graf     DBDMA_kick(dbdma_from_ch(ch));
43249ab747fSPaolo Bonzini }
43349ab747fSPaolo Bonzini 
43449ab747fSPaolo Bonzini static void stop(DBDMA_channel *ch)
43549ab747fSPaolo Bonzini {
43649ab747fSPaolo Bonzini     ch->regs[DBDMA_STATUS] &= ~(ACTIVE|DEAD|FLUSH);
43749ab747fSPaolo Bonzini 
43849ab747fSPaolo Bonzini     /* the stop command does not increment command pointer */
43949ab747fSPaolo Bonzini }
44049ab747fSPaolo Bonzini 
44149ab747fSPaolo Bonzini static void channel_run(DBDMA_channel *ch)
44249ab747fSPaolo Bonzini {
44349ab747fSPaolo Bonzini     dbdma_cmd *current = &ch->current;
44449ab747fSPaolo Bonzini     uint16_t cmd, key;
44549ab747fSPaolo Bonzini     uint16_t req_count;
44649ab747fSPaolo Bonzini     uint32_t phy_addr;
44749ab747fSPaolo Bonzini 
44849ab747fSPaolo Bonzini     DBDMA_DPRINTF("channel_run\n");
44949ab747fSPaolo Bonzini     dump_dbdma_cmd(current);
45049ab747fSPaolo Bonzini 
45149ab747fSPaolo Bonzini     /* clear WAKE flag at command fetch */
45249ab747fSPaolo Bonzini 
45349ab747fSPaolo Bonzini     ch->regs[DBDMA_STATUS] &= ~WAKE;
45449ab747fSPaolo Bonzini 
45549ab747fSPaolo Bonzini     cmd = le16_to_cpu(current->command) & COMMAND_MASK;
45649ab747fSPaolo Bonzini 
45749ab747fSPaolo Bonzini     switch (cmd) {
45849ab747fSPaolo Bonzini     case DBDMA_NOP:
45949ab747fSPaolo Bonzini         nop(ch);
46049ab747fSPaolo Bonzini         return;
46149ab747fSPaolo Bonzini 
46249ab747fSPaolo Bonzini     case DBDMA_STOP:
46349ab747fSPaolo Bonzini         stop(ch);
46449ab747fSPaolo Bonzini         return;
46549ab747fSPaolo Bonzini     }
46649ab747fSPaolo Bonzini 
46749ab747fSPaolo Bonzini     key = le16_to_cpu(current->command) & 0x0700;
46849ab747fSPaolo Bonzini     req_count = le16_to_cpu(current->req_count);
46949ab747fSPaolo Bonzini     phy_addr = le32_to_cpu(current->phy_addr);
47049ab747fSPaolo Bonzini 
47149ab747fSPaolo Bonzini     if (key == KEY_STREAM4) {
47249ab747fSPaolo Bonzini         printf("command %x, invalid key 4\n", cmd);
47349ab747fSPaolo Bonzini         kill_channel(ch);
47449ab747fSPaolo Bonzini         return;
47549ab747fSPaolo Bonzini     }
47649ab747fSPaolo Bonzini 
47749ab747fSPaolo Bonzini     switch (cmd) {
47849ab747fSPaolo Bonzini     case OUTPUT_MORE:
47949ab747fSPaolo Bonzini         start_output(ch, key, phy_addr, req_count, 0);
48049ab747fSPaolo Bonzini         return;
48149ab747fSPaolo Bonzini 
48249ab747fSPaolo Bonzini     case OUTPUT_LAST:
48349ab747fSPaolo Bonzini         start_output(ch, key, phy_addr, req_count, 1);
48449ab747fSPaolo Bonzini         return;
48549ab747fSPaolo Bonzini 
48649ab747fSPaolo Bonzini     case INPUT_MORE:
48749ab747fSPaolo Bonzini         start_input(ch, key, phy_addr, req_count, 0);
48849ab747fSPaolo Bonzini         return;
48949ab747fSPaolo Bonzini 
49049ab747fSPaolo Bonzini     case INPUT_LAST:
49149ab747fSPaolo Bonzini         start_input(ch, key, phy_addr, req_count, 1);
49249ab747fSPaolo Bonzini         return;
49349ab747fSPaolo Bonzini     }
49449ab747fSPaolo Bonzini 
49549ab747fSPaolo Bonzini     if (key < KEY_REGS) {
49649ab747fSPaolo Bonzini         printf("command %x, invalid key %x\n", cmd, key);
49749ab747fSPaolo Bonzini         key = KEY_SYSTEM;
49849ab747fSPaolo Bonzini     }
49949ab747fSPaolo Bonzini 
50049ab747fSPaolo Bonzini     /* for LOAD_WORD and STORE_WORD, req_count is on 3 bits
50149ab747fSPaolo Bonzini      * and BRANCH is invalid
50249ab747fSPaolo Bonzini      */
50349ab747fSPaolo Bonzini 
50449ab747fSPaolo Bonzini     req_count = req_count & 0x0007;
50549ab747fSPaolo Bonzini     if (req_count & 0x4) {
50649ab747fSPaolo Bonzini         req_count = 4;
50749ab747fSPaolo Bonzini         phy_addr &= ~3;
50849ab747fSPaolo Bonzini     } else if (req_count & 0x2) {
50949ab747fSPaolo Bonzini         req_count = 2;
51049ab747fSPaolo Bonzini         phy_addr &= ~1;
51149ab747fSPaolo Bonzini     } else
51249ab747fSPaolo Bonzini         req_count = 1;
51349ab747fSPaolo Bonzini 
51449ab747fSPaolo Bonzini     switch (cmd) {
51549ab747fSPaolo Bonzini     case LOAD_WORD:
51649ab747fSPaolo Bonzini         load_word(ch, key, phy_addr, req_count);
51749ab747fSPaolo Bonzini         return;
51849ab747fSPaolo Bonzini 
51949ab747fSPaolo Bonzini     case STORE_WORD:
52049ab747fSPaolo Bonzini         store_word(ch, key, phy_addr, req_count);
52149ab747fSPaolo Bonzini         return;
52249ab747fSPaolo Bonzini     }
52349ab747fSPaolo Bonzini }
52449ab747fSPaolo Bonzini 
52549ab747fSPaolo Bonzini static void DBDMA_run(DBDMAState *s)
52649ab747fSPaolo Bonzini {
52749ab747fSPaolo Bonzini     int channel;
52849ab747fSPaolo Bonzini 
52949ab747fSPaolo Bonzini     for (channel = 0; channel < DBDMA_CHANNELS; channel++) {
53049ab747fSPaolo Bonzini         DBDMA_channel *ch = &s->channels[channel];
53149ab747fSPaolo Bonzini         uint32_t status = ch->regs[DBDMA_STATUS];
53203ee3b1eSAlexander Graf         if (!ch->io.processing && (status & RUN) && (status & ACTIVE)) {
53349ab747fSPaolo Bonzini             channel_run(ch);
53449ab747fSPaolo Bonzini         }
53549ab747fSPaolo Bonzini     }
53649ab747fSPaolo Bonzini }
53749ab747fSPaolo Bonzini 
53849ab747fSPaolo Bonzini static void DBDMA_run_bh(void *opaque)
53949ab747fSPaolo Bonzini {
54049ab747fSPaolo Bonzini     DBDMAState *s = opaque;
54149ab747fSPaolo Bonzini 
54249ab747fSPaolo Bonzini     DBDMA_DPRINTF("DBDMA_run_bh\n");
54349ab747fSPaolo Bonzini 
54449ab747fSPaolo Bonzini     DBDMA_run(s);
54549ab747fSPaolo Bonzini }
54649ab747fSPaolo Bonzini 
547d1e562deSAlexander Graf void DBDMA_kick(DBDMAState *dbdma)
548d1e562deSAlexander Graf {
549d2f0ce21SAlexander Graf     qemu_bh_schedule(dbdma->bh);
550d1e562deSAlexander Graf }
551d1e562deSAlexander Graf 
55249ab747fSPaolo Bonzini void DBDMA_register_channel(void *dbdma, int nchan, qemu_irq irq,
55349ab747fSPaolo Bonzini                             DBDMA_rw rw, DBDMA_flush flush,
55449ab747fSPaolo Bonzini                             void *opaque)
55549ab747fSPaolo Bonzini {
55649ab747fSPaolo Bonzini     DBDMAState *s = dbdma;
55749ab747fSPaolo Bonzini     DBDMA_channel *ch = &s->channels[nchan];
55849ab747fSPaolo Bonzini 
55949ab747fSPaolo Bonzini     DBDMA_DPRINTF("DBDMA_register_channel 0x%x\n", nchan);
56049ab747fSPaolo Bonzini 
5612d7d06d8SHervé Poussineau     assert(rw);
5622d7d06d8SHervé Poussineau     assert(flush);
5632d7d06d8SHervé Poussineau 
56449ab747fSPaolo Bonzini     ch->irq = irq;
56549ab747fSPaolo Bonzini     ch->rw = rw;
56649ab747fSPaolo Bonzini     ch->flush = flush;
56749ab747fSPaolo Bonzini     ch->io.opaque = opaque;
56849ab747fSPaolo Bonzini }
56949ab747fSPaolo Bonzini 
57049ab747fSPaolo Bonzini static void
57149ab747fSPaolo Bonzini dbdma_control_write(DBDMA_channel *ch)
57249ab747fSPaolo Bonzini {
57349ab747fSPaolo Bonzini     uint16_t mask, value;
57449ab747fSPaolo Bonzini     uint32_t status;
57549ab747fSPaolo Bonzini 
57649ab747fSPaolo Bonzini     mask = (ch->regs[DBDMA_CONTROL] >> 16) & 0xffff;
57749ab747fSPaolo Bonzini     value = ch->regs[DBDMA_CONTROL] & 0xffff;
57849ab747fSPaolo Bonzini 
57949ab747fSPaolo Bonzini     value &= (RUN | PAUSE | FLUSH | WAKE | DEVSTAT);
58049ab747fSPaolo Bonzini 
58149ab747fSPaolo Bonzini     status = ch->regs[DBDMA_STATUS];
58249ab747fSPaolo Bonzini 
58349ab747fSPaolo Bonzini     status = (value & mask) | (status & ~mask);
58449ab747fSPaolo Bonzini 
58549ab747fSPaolo Bonzini     if (status & WAKE)
58649ab747fSPaolo Bonzini         status |= ACTIVE;
58749ab747fSPaolo Bonzini     if (status & RUN) {
58849ab747fSPaolo Bonzini         status |= ACTIVE;
58949ab747fSPaolo Bonzini         status &= ~DEAD;
59049ab747fSPaolo Bonzini     }
59149ab747fSPaolo Bonzini     if (status & PAUSE)
59249ab747fSPaolo Bonzini         status &= ~ACTIVE;
59349ab747fSPaolo Bonzini     if ((ch->regs[DBDMA_STATUS] & RUN) && !(status & RUN)) {
59449ab747fSPaolo Bonzini         /* RUN is cleared */
59549ab747fSPaolo Bonzini         status &= ~(ACTIVE|DEAD);
5961cde732dSMark Cave-Ayland     }
5971cde732dSMark Cave-Ayland 
59849ab747fSPaolo Bonzini     if ((status & FLUSH) && ch->flush) {
59949ab747fSPaolo Bonzini         ch->flush(&ch->io);
60049ab747fSPaolo Bonzini         status &= ~FLUSH;
60149ab747fSPaolo Bonzini     }
60249ab747fSPaolo Bonzini 
60349ab747fSPaolo Bonzini     DBDMA_DPRINTF("    status 0x%08x\n", status);
60449ab747fSPaolo Bonzini 
60549ab747fSPaolo Bonzini     ch->regs[DBDMA_STATUS] = status;
60649ab747fSPaolo Bonzini 
607d2f0ce21SAlexander Graf     if (status & ACTIVE) {
608d2f0ce21SAlexander Graf         DBDMA_kick(dbdma_from_ch(ch));
609d2f0ce21SAlexander Graf     }
610d2f0ce21SAlexander Graf }
61149ab747fSPaolo Bonzini 
61249ab747fSPaolo Bonzini static void dbdma_write(void *opaque, hwaddr addr,
61349ab747fSPaolo Bonzini                         uint64_t value, unsigned size)
61449ab747fSPaolo Bonzini {
61549ab747fSPaolo Bonzini     int channel = addr >> DBDMA_CHANNEL_SHIFT;
61649ab747fSPaolo Bonzini     DBDMAState *s = opaque;
61749ab747fSPaolo Bonzini     DBDMA_channel *ch = &s->channels[channel];
61849ab747fSPaolo Bonzini     int reg = (addr - (channel << DBDMA_CHANNEL_SHIFT)) >> 2;
61949ab747fSPaolo Bonzini 
62058c0c311SAlexander Graf     DBDMA_DPRINTF("writel 0x" TARGET_FMT_plx " <= 0x%08"PRIx64"\n",
62158c0c311SAlexander Graf                   addr, value);
62249ab747fSPaolo Bonzini     DBDMA_DPRINTF("channel 0x%x reg 0x%x\n",
62349ab747fSPaolo Bonzini                   (uint32_t)addr >> DBDMA_CHANNEL_SHIFT, reg);
62449ab747fSPaolo Bonzini 
6257eaba824SAlexander Graf     /* cmdptr cannot be modified if channel is ACTIVE */
62649ab747fSPaolo Bonzini 
6277eaba824SAlexander Graf     if (reg == DBDMA_CMDPTR_LO && (ch->regs[DBDMA_STATUS] & ACTIVE)) {
62849ab747fSPaolo Bonzini         return;
6297eaba824SAlexander Graf     }
63049ab747fSPaolo Bonzini 
63149ab747fSPaolo Bonzini     ch->regs[reg] = value;
63249ab747fSPaolo Bonzini 
63349ab747fSPaolo Bonzini     switch(reg) {
63449ab747fSPaolo Bonzini     case DBDMA_CONTROL:
63549ab747fSPaolo Bonzini         dbdma_control_write(ch);
63649ab747fSPaolo Bonzini         break;
63749ab747fSPaolo Bonzini     case DBDMA_CMDPTR_LO:
63849ab747fSPaolo Bonzini         /* 16-byte aligned */
63949ab747fSPaolo Bonzini         ch->regs[DBDMA_CMDPTR_LO] &= ~0xf;
64049ab747fSPaolo Bonzini         dbdma_cmdptr_load(ch);
64149ab747fSPaolo Bonzini         break;
64249ab747fSPaolo Bonzini     case DBDMA_STATUS:
64349ab747fSPaolo Bonzini     case DBDMA_INTR_SEL:
64449ab747fSPaolo Bonzini     case DBDMA_BRANCH_SEL:
64549ab747fSPaolo Bonzini     case DBDMA_WAIT_SEL:
64649ab747fSPaolo Bonzini         /* nothing to do */
64749ab747fSPaolo Bonzini         break;
64849ab747fSPaolo Bonzini     case DBDMA_XFER_MODE:
64949ab747fSPaolo Bonzini     case DBDMA_CMDPTR_HI:
65049ab747fSPaolo Bonzini     case DBDMA_DATA2PTR_HI:
65149ab747fSPaolo Bonzini     case DBDMA_DATA2PTR_LO:
65249ab747fSPaolo Bonzini     case DBDMA_ADDRESS_HI:
65349ab747fSPaolo Bonzini     case DBDMA_BRANCH_ADDR_HI:
65449ab747fSPaolo Bonzini     case DBDMA_RES1:
65549ab747fSPaolo Bonzini     case DBDMA_RES2:
65649ab747fSPaolo Bonzini     case DBDMA_RES3:
65749ab747fSPaolo Bonzini     case DBDMA_RES4:
65849ab747fSPaolo Bonzini         /* unused */
65949ab747fSPaolo Bonzini         break;
66049ab747fSPaolo Bonzini     }
66149ab747fSPaolo Bonzini }
66249ab747fSPaolo Bonzini 
66349ab747fSPaolo Bonzini static uint64_t dbdma_read(void *opaque, hwaddr addr,
66449ab747fSPaolo Bonzini                            unsigned size)
66549ab747fSPaolo Bonzini {
66649ab747fSPaolo Bonzini     uint32_t value;
66749ab747fSPaolo Bonzini     int channel = addr >> DBDMA_CHANNEL_SHIFT;
66849ab747fSPaolo Bonzini     DBDMAState *s = opaque;
66949ab747fSPaolo Bonzini     DBDMA_channel *ch = &s->channels[channel];
67049ab747fSPaolo Bonzini     int reg = (addr - (channel << DBDMA_CHANNEL_SHIFT)) >> 2;
67149ab747fSPaolo Bonzini 
67249ab747fSPaolo Bonzini     value = ch->regs[reg];
67349ab747fSPaolo Bonzini 
67449ab747fSPaolo Bonzini     DBDMA_DPRINTF("readl 0x" TARGET_FMT_plx " => 0x%08x\n", addr, value);
67549ab747fSPaolo Bonzini     DBDMA_DPRINTF("channel 0x%x reg 0x%x\n",
67649ab747fSPaolo Bonzini                   (uint32_t)addr >> DBDMA_CHANNEL_SHIFT, reg);
67749ab747fSPaolo Bonzini 
67849ab747fSPaolo Bonzini     switch(reg) {
67949ab747fSPaolo Bonzini     case DBDMA_CONTROL:
68049ab747fSPaolo Bonzini         value = 0;
68149ab747fSPaolo Bonzini         break;
68249ab747fSPaolo Bonzini     case DBDMA_STATUS:
68349ab747fSPaolo Bonzini     case DBDMA_CMDPTR_LO:
68449ab747fSPaolo Bonzini     case DBDMA_INTR_SEL:
68549ab747fSPaolo Bonzini     case DBDMA_BRANCH_SEL:
68649ab747fSPaolo Bonzini     case DBDMA_WAIT_SEL:
68749ab747fSPaolo Bonzini         /* nothing to do */
68849ab747fSPaolo Bonzini         break;
68949ab747fSPaolo Bonzini     case DBDMA_XFER_MODE:
69049ab747fSPaolo Bonzini     case DBDMA_CMDPTR_HI:
69149ab747fSPaolo Bonzini     case DBDMA_DATA2PTR_HI:
69249ab747fSPaolo Bonzini     case DBDMA_DATA2PTR_LO:
69349ab747fSPaolo Bonzini     case DBDMA_ADDRESS_HI:
69449ab747fSPaolo Bonzini     case DBDMA_BRANCH_ADDR_HI:
69549ab747fSPaolo Bonzini         /* unused */
69649ab747fSPaolo Bonzini         value = 0;
69749ab747fSPaolo Bonzini         break;
69849ab747fSPaolo Bonzini     case DBDMA_RES1:
69949ab747fSPaolo Bonzini     case DBDMA_RES2:
70049ab747fSPaolo Bonzini     case DBDMA_RES3:
70149ab747fSPaolo Bonzini     case DBDMA_RES4:
70249ab747fSPaolo Bonzini         /* reserved */
70349ab747fSPaolo Bonzini         break;
70449ab747fSPaolo Bonzini     }
70549ab747fSPaolo Bonzini 
70649ab747fSPaolo Bonzini     return value;
70749ab747fSPaolo Bonzini }
70849ab747fSPaolo Bonzini 
70949ab747fSPaolo Bonzini static const MemoryRegionOps dbdma_ops = {
71049ab747fSPaolo Bonzini     .read = dbdma_read,
71149ab747fSPaolo Bonzini     .write = dbdma_write,
71249ab747fSPaolo Bonzini     .endianness = DEVICE_LITTLE_ENDIAN,
71349ab747fSPaolo Bonzini     .valid = {
71449ab747fSPaolo Bonzini         .min_access_size = 4,
71549ab747fSPaolo Bonzini         .max_access_size = 4,
71649ab747fSPaolo Bonzini     },
71749ab747fSPaolo Bonzini };
71849ab747fSPaolo Bonzini 
719627be2f2SMark Cave-Ayland static const VMStateDescription vmstate_dbdma_io = {
720627be2f2SMark Cave-Ayland     .name = "dbdma_io",
72149ab747fSPaolo Bonzini     .version_id = 0,
72249ab747fSPaolo Bonzini     .minimum_version_id = 0,
72349ab747fSPaolo Bonzini     .fields = (VMStateField[]) {
724627be2f2SMark Cave-Ayland         VMSTATE_UINT64(addr, struct DBDMA_io),
725627be2f2SMark Cave-Ayland         VMSTATE_INT32(len, struct DBDMA_io),
726627be2f2SMark Cave-Ayland         VMSTATE_INT32(is_last, struct DBDMA_io),
727627be2f2SMark Cave-Ayland         VMSTATE_INT32(is_dma_out, struct DBDMA_io),
728627be2f2SMark Cave-Ayland         VMSTATE_BOOL(processing, struct DBDMA_io),
729627be2f2SMark Cave-Ayland         VMSTATE_END_OF_LIST()
730627be2f2SMark Cave-Ayland     }
731627be2f2SMark Cave-Ayland };
732627be2f2SMark Cave-Ayland 
733627be2f2SMark Cave-Ayland static const VMStateDescription vmstate_dbdma_cmd = {
734627be2f2SMark Cave-Ayland     .name = "dbdma_cmd",
735627be2f2SMark Cave-Ayland     .version_id = 0,
736627be2f2SMark Cave-Ayland     .minimum_version_id = 0,
737627be2f2SMark Cave-Ayland     .fields = (VMStateField[]) {
738627be2f2SMark Cave-Ayland         VMSTATE_UINT16(req_count, dbdma_cmd),
739627be2f2SMark Cave-Ayland         VMSTATE_UINT16(command, dbdma_cmd),
740627be2f2SMark Cave-Ayland         VMSTATE_UINT32(phy_addr, dbdma_cmd),
741627be2f2SMark Cave-Ayland         VMSTATE_UINT32(cmd_dep, dbdma_cmd),
742627be2f2SMark Cave-Ayland         VMSTATE_UINT16(res_count, dbdma_cmd),
743627be2f2SMark Cave-Ayland         VMSTATE_UINT16(xfer_status, dbdma_cmd),
744627be2f2SMark Cave-Ayland         VMSTATE_END_OF_LIST()
745627be2f2SMark Cave-Ayland     }
746627be2f2SMark Cave-Ayland };
747627be2f2SMark Cave-Ayland 
748627be2f2SMark Cave-Ayland static const VMStateDescription vmstate_dbdma_channel = {
749627be2f2SMark Cave-Ayland     .name = "dbdma_channel",
750627be2f2SMark Cave-Ayland     .version_id = 1,
751627be2f2SMark Cave-Ayland     .minimum_version_id = 1,
752627be2f2SMark Cave-Ayland     .fields = (VMStateField[]) {
75349ab747fSPaolo Bonzini         VMSTATE_UINT32_ARRAY(regs, struct DBDMA_channel, DBDMA_REGS),
754627be2f2SMark Cave-Ayland         VMSTATE_STRUCT(io, struct DBDMA_channel, 0, vmstate_dbdma_io, DBDMA_io),
755627be2f2SMark Cave-Ayland         VMSTATE_STRUCT(current, struct DBDMA_channel, 0, vmstate_dbdma_cmd,
756627be2f2SMark Cave-Ayland                        dbdma_cmd),
75749ab747fSPaolo Bonzini         VMSTATE_END_OF_LIST()
75849ab747fSPaolo Bonzini     }
75949ab747fSPaolo Bonzini };
76049ab747fSPaolo Bonzini 
76149ab747fSPaolo Bonzini static const VMStateDescription vmstate_dbdma = {
76249ab747fSPaolo Bonzini     .name = "dbdma",
763627be2f2SMark Cave-Ayland     .version_id = 3,
764627be2f2SMark Cave-Ayland     .minimum_version_id = 3,
76549ab747fSPaolo Bonzini     .fields = (VMStateField[]) {
76649ab747fSPaolo Bonzini         VMSTATE_STRUCT_ARRAY(channels, DBDMAState, DBDMA_CHANNELS, 1,
76749ab747fSPaolo Bonzini                              vmstate_dbdma_channel, DBDMA_channel),
76849ab747fSPaolo Bonzini         VMSTATE_END_OF_LIST()
76949ab747fSPaolo Bonzini     }
77049ab747fSPaolo Bonzini };
77149ab747fSPaolo Bonzini 
77249ab747fSPaolo Bonzini static void dbdma_reset(void *opaque)
77349ab747fSPaolo Bonzini {
77449ab747fSPaolo Bonzini     DBDMAState *s = opaque;
77549ab747fSPaolo Bonzini     int i;
77649ab747fSPaolo Bonzini 
77749ab747fSPaolo Bonzini     for (i = 0; i < DBDMA_CHANNELS; i++)
77849ab747fSPaolo Bonzini         memset(s->channels[i].regs, 0, DBDMA_SIZE);
77949ab747fSPaolo Bonzini }
78049ab747fSPaolo Bonzini 
7812d7d06d8SHervé Poussineau static void dbdma_unassigned_rw(DBDMA_io *io)
7822d7d06d8SHervé Poussineau {
7832d7d06d8SHervé Poussineau     DBDMA_channel *ch = io->channel;
7842d7d06d8SHervé Poussineau     qemu_log_mask(LOG_GUEST_ERROR, "%s: use of unassigned channel %d\n",
7852d7d06d8SHervé Poussineau                   __func__, ch->channel);
7862d7d06d8SHervé Poussineau }
7872d7d06d8SHervé Poussineau 
7882d7d06d8SHervé Poussineau static void dbdma_unassigned_flush(DBDMA_io *io)
7892d7d06d8SHervé Poussineau {
7902d7d06d8SHervé Poussineau     DBDMA_channel *ch = io->channel;
7912d7d06d8SHervé Poussineau     qemu_log_mask(LOG_GUEST_ERROR, "%s: use of unassigned channel %d\n",
7922d7d06d8SHervé Poussineau                   __func__, ch->channel);
7932d7d06d8SHervé Poussineau }
7942d7d06d8SHervé Poussineau 
79549ab747fSPaolo Bonzini void* DBDMA_init (MemoryRegion **dbdma_mem)
79649ab747fSPaolo Bonzini {
79749ab747fSPaolo Bonzini     DBDMAState *s;
7983e300fa6SAlexander Graf     int i;
79949ab747fSPaolo Bonzini 
80049ab747fSPaolo Bonzini     s = g_malloc0(sizeof(DBDMAState));
80149ab747fSPaolo Bonzini 
8023e300fa6SAlexander Graf     for (i = 0; i < DBDMA_CHANNELS; i++) {
8033e300fa6SAlexander Graf         DBDMA_io *io = &s->channels[i].io;
8042d7d06d8SHervé Poussineau         DBDMA_channel *ch = &s->channels[i];
8053e300fa6SAlexander Graf         qemu_iovec_init(&io->iov, 1);
8062d7d06d8SHervé Poussineau 
8072d7d06d8SHervé Poussineau         ch->rw = dbdma_unassigned_rw;
8082d7d06d8SHervé Poussineau         ch->flush = dbdma_unassigned_flush;
8092d7d06d8SHervé Poussineau         ch->channel = i;
8102d7d06d8SHervé Poussineau         ch->io.channel = ch;
8113e300fa6SAlexander Graf     }
8123e300fa6SAlexander Graf 
8132c9b15caSPaolo Bonzini     memory_region_init_io(&s->mem, NULL, &dbdma_ops, s, "dbdma", 0x1000);
81449ab747fSPaolo Bonzini     *dbdma_mem = &s->mem;
81549ab747fSPaolo Bonzini     vmstate_register(NULL, -1, &vmstate_dbdma, s);
81649ab747fSPaolo Bonzini     qemu_register_reset(dbdma_reset, s);
81749ab747fSPaolo Bonzini 
818d2f0ce21SAlexander Graf     s->bh = qemu_bh_new(DBDMA_run_bh, s);
81949ab747fSPaolo Bonzini 
82049ab747fSPaolo Bonzini     return s;
82149ab747fSPaolo Bonzini }
822