xref: /openbmc/qemu/hw/misc/macio/mac_dbdma.c (revision 77453882495b321404e874aa97bca1214160229d)
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 */
48ba0b17ddSMark Cave-Ayland #define DEBUG_DBDMA 0
493e49c439SMark Cave-Ayland #define DEBUG_DBDMA_CHANMASK ((1ull << DBDMA_CHANNELS) - 1)
5049ab747fSPaolo Bonzini 
51ba0b17ddSMark Cave-Ayland #define DBDMA_DPRINTF(fmt, ...) do { \
52ba0b17ddSMark Cave-Ayland     if (DEBUG_DBDMA) { \
53ba0b17ddSMark Cave-Ayland         printf("DBDMA: " fmt , ## __VA_ARGS__); \
54ba0b17ddSMark Cave-Ayland     } \
55ba0b17ddSMark Cave-Ayland } while (0);
5649ab747fSPaolo Bonzini 
573e49c439SMark Cave-Ayland #define DBDMA_DPRINTFCH(ch, fmt, ...) do { \
583e49c439SMark Cave-Ayland     if (DEBUG_DBDMA) { \
593e49c439SMark Cave-Ayland         if ((1ul << (ch)->channel) & DEBUG_DBDMA_CHANMASK) { \
603e49c439SMark Cave-Ayland             printf("DBDMA[%02x]: " fmt , (ch)->channel, ## __VA_ARGS__); \
613e49c439SMark Cave-Ayland         } \
623e49c439SMark Cave-Ayland     } \
633e49c439SMark Cave-Ayland } while (0);
643e49c439SMark Cave-Ayland 
6549ab747fSPaolo Bonzini /*
6649ab747fSPaolo Bonzini  */
6749ab747fSPaolo Bonzini 
68d2f0ce21SAlexander Graf static DBDMAState *dbdma_from_ch(DBDMA_channel *ch)
69d2f0ce21SAlexander Graf {
70d2f0ce21SAlexander Graf     return container_of(ch, DBDMAState, channels[ch->channel]);
71d2f0ce21SAlexander Graf }
72d2f0ce21SAlexander Graf 
73ba0b17ddSMark Cave-Ayland #if DEBUG_DBDMA
7449ab747fSPaolo Bonzini static void dump_dbdma_cmd(dbdma_cmd *cmd)
7549ab747fSPaolo Bonzini {
7649ab747fSPaolo Bonzini     printf("dbdma_cmd %p\n", cmd);
7749ab747fSPaolo Bonzini     printf("    req_count 0x%04x\n", le16_to_cpu(cmd->req_count));
7849ab747fSPaolo Bonzini     printf("    command 0x%04x\n", le16_to_cpu(cmd->command));
7949ab747fSPaolo Bonzini     printf("    phy_addr 0x%08x\n", le32_to_cpu(cmd->phy_addr));
8049ab747fSPaolo Bonzini     printf("    cmd_dep 0x%08x\n", le32_to_cpu(cmd->cmd_dep));
8149ab747fSPaolo Bonzini     printf("    res_count 0x%04x\n", le16_to_cpu(cmd->res_count));
8249ab747fSPaolo Bonzini     printf("    xfer_status 0x%04x\n", le16_to_cpu(cmd->xfer_status));
8349ab747fSPaolo Bonzini }
8449ab747fSPaolo Bonzini #else
8549ab747fSPaolo Bonzini static void dump_dbdma_cmd(dbdma_cmd *cmd)
8649ab747fSPaolo Bonzini {
8749ab747fSPaolo Bonzini }
8849ab747fSPaolo Bonzini #endif
8949ab747fSPaolo Bonzini static void dbdma_cmdptr_load(DBDMA_channel *ch)
9049ab747fSPaolo Bonzini {
913e49c439SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "dbdma_cmdptr_load 0x%08x\n",
9249ab747fSPaolo Bonzini                     ch->regs[DBDMA_CMDPTR_LO]);
9388655881SMark Cave-Ayland     dma_memory_read(&address_space_memory, ch->regs[DBDMA_CMDPTR_LO],
94e1fe50dcSStefan Weil                     &ch->current, sizeof(dbdma_cmd));
9549ab747fSPaolo Bonzini }
9649ab747fSPaolo Bonzini 
9749ab747fSPaolo Bonzini static void dbdma_cmdptr_save(DBDMA_channel *ch)
9849ab747fSPaolo Bonzini {
99*77453882SBenjamin Herrenschmidt     DBDMA_DPRINTFCH(ch, "-> update 0x%08x stat=0x%08x, res=0x%04x\n",
100*77453882SBenjamin Herrenschmidt                     ch->regs[DBDMA_CMDPTR_LO],
10149ab747fSPaolo Bonzini                     le16_to_cpu(ch->current.xfer_status),
10249ab747fSPaolo Bonzini                     le16_to_cpu(ch->current.res_count));
10388655881SMark Cave-Ayland     dma_memory_write(&address_space_memory, ch->regs[DBDMA_CMDPTR_LO],
104e1fe50dcSStefan Weil                      &ch->current, sizeof(dbdma_cmd));
10549ab747fSPaolo Bonzini }
10649ab747fSPaolo Bonzini 
10749ab747fSPaolo Bonzini static void kill_channel(DBDMA_channel *ch)
10849ab747fSPaolo Bonzini {
1093e49c439SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "kill_channel\n");
11049ab747fSPaolo Bonzini 
11149ab747fSPaolo Bonzini     ch->regs[DBDMA_STATUS] |= DEAD;
11249ab747fSPaolo Bonzini     ch->regs[DBDMA_STATUS] &= ~ACTIVE;
11349ab747fSPaolo Bonzini 
11449ab747fSPaolo Bonzini     qemu_irq_raise(ch->irq);
11549ab747fSPaolo Bonzini }
11649ab747fSPaolo Bonzini 
11749ab747fSPaolo Bonzini static void conditional_interrupt(DBDMA_channel *ch)
11849ab747fSPaolo Bonzini {
11949ab747fSPaolo Bonzini     dbdma_cmd *current = &ch->current;
12049ab747fSPaolo Bonzini     uint16_t intr;
12149ab747fSPaolo Bonzini     uint16_t sel_mask, sel_value;
12249ab747fSPaolo Bonzini     uint32_t status;
12349ab747fSPaolo Bonzini     int cond;
12449ab747fSPaolo Bonzini 
1253e49c439SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "%s\n", __func__);
12649ab747fSPaolo Bonzini 
12749ab747fSPaolo Bonzini     intr = le16_to_cpu(current->command) & INTR_MASK;
12849ab747fSPaolo Bonzini 
12949ab747fSPaolo Bonzini     switch(intr) {
13049ab747fSPaolo Bonzini     case INTR_NEVER:  /* don't interrupt */
13149ab747fSPaolo Bonzini         return;
13249ab747fSPaolo Bonzini     case INTR_ALWAYS: /* always interrupt */
13349ab747fSPaolo Bonzini         qemu_irq_raise(ch->irq);
1343e49c439SMark Cave-Ayland         DBDMA_DPRINTFCH(ch, "%s: raise\n", __func__);
13549ab747fSPaolo Bonzini         return;
13649ab747fSPaolo Bonzini     }
13749ab747fSPaolo Bonzini 
13849ab747fSPaolo Bonzini     status = ch->regs[DBDMA_STATUS] & DEVSTAT;
13949ab747fSPaolo Bonzini 
14049ab747fSPaolo Bonzini     sel_mask = (ch->regs[DBDMA_INTR_SEL] >> 16) & 0x0f;
14149ab747fSPaolo Bonzini     sel_value = ch->regs[DBDMA_INTR_SEL] & 0x0f;
14249ab747fSPaolo Bonzini 
14349ab747fSPaolo Bonzini     cond = (status & sel_mask) == (sel_value & sel_mask);
14449ab747fSPaolo Bonzini 
14549ab747fSPaolo Bonzini     switch(intr) {
14649ab747fSPaolo Bonzini     case INTR_IFSET:  /* intr if condition bit is 1 */
14733ce36bbSAlexander Graf         if (cond) {
14849ab747fSPaolo Bonzini             qemu_irq_raise(ch->irq);
1493e49c439SMark Cave-Ayland             DBDMA_DPRINTFCH(ch, "%s: raise\n", __func__);
15033ce36bbSAlexander Graf         }
15149ab747fSPaolo Bonzini         return;
15249ab747fSPaolo Bonzini     case INTR_IFCLR:  /* intr if condition bit is 0 */
15333ce36bbSAlexander Graf         if (!cond) {
15449ab747fSPaolo Bonzini             qemu_irq_raise(ch->irq);
1553e49c439SMark Cave-Ayland             DBDMA_DPRINTFCH(ch, "%s: raise\n", __func__);
15633ce36bbSAlexander Graf         }
15749ab747fSPaolo Bonzini         return;
15849ab747fSPaolo Bonzini     }
15949ab747fSPaolo Bonzini }
16049ab747fSPaolo Bonzini 
16149ab747fSPaolo Bonzini static int conditional_wait(DBDMA_channel *ch)
16249ab747fSPaolo Bonzini {
16349ab747fSPaolo Bonzini     dbdma_cmd *current = &ch->current;
16449ab747fSPaolo Bonzini     uint16_t wait;
16549ab747fSPaolo Bonzini     uint16_t sel_mask, sel_value;
16649ab747fSPaolo Bonzini     uint32_t status;
16749ab747fSPaolo Bonzini     int cond;
168*77453882SBenjamin Herrenschmidt     int res = 0;
16949ab747fSPaolo Bonzini 
17049ab747fSPaolo Bonzini     wait = le16_to_cpu(current->command) & WAIT_MASK;
17149ab747fSPaolo Bonzini     switch(wait) {
17249ab747fSPaolo Bonzini     case WAIT_NEVER:  /* don't wait */
17349ab747fSPaolo Bonzini         return 0;
17449ab747fSPaolo Bonzini     case WAIT_ALWAYS: /* always wait */
175*77453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, "  [WAIT_ALWAYS]\n");
17649ab747fSPaolo Bonzini         return 1;
17749ab747fSPaolo Bonzini     }
17849ab747fSPaolo Bonzini 
17949ab747fSPaolo Bonzini     status = ch->regs[DBDMA_STATUS] & DEVSTAT;
18049ab747fSPaolo Bonzini 
18149ab747fSPaolo Bonzini     sel_mask = (ch->regs[DBDMA_WAIT_SEL] >> 16) & 0x0f;
18249ab747fSPaolo Bonzini     sel_value = ch->regs[DBDMA_WAIT_SEL] & 0x0f;
18349ab747fSPaolo Bonzini 
18449ab747fSPaolo Bonzini     cond = (status & sel_mask) == (sel_value & sel_mask);
18549ab747fSPaolo Bonzini 
18649ab747fSPaolo Bonzini     switch(wait) {
18749ab747fSPaolo Bonzini     case WAIT_IFSET:  /* wait if condition bit is 1 */
188*77453882SBenjamin Herrenschmidt         if (cond) {
189*77453882SBenjamin Herrenschmidt             res = 1;
19049ab747fSPaolo Bonzini         }
191*77453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, "  [WAIT_IFSET=%d]\n", res);
192*77453882SBenjamin Herrenschmidt         break;
193*77453882SBenjamin Herrenschmidt     case WAIT_IFCLR:  /* wait if condition bit is 0 */
194*77453882SBenjamin Herrenschmidt         if (!cond) {
195*77453882SBenjamin Herrenschmidt             res = 1;
196*77453882SBenjamin Herrenschmidt         }
197*77453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, "  [WAIT_IFCLR=%d]\n", res);
198*77453882SBenjamin Herrenschmidt         break;
199*77453882SBenjamin Herrenschmidt     }
200*77453882SBenjamin Herrenschmidt     return res;
20149ab747fSPaolo Bonzini }
20249ab747fSPaolo Bonzini 
20349ab747fSPaolo Bonzini static void next(DBDMA_channel *ch)
20449ab747fSPaolo Bonzini {
20549ab747fSPaolo Bonzini     uint32_t cp;
20649ab747fSPaolo Bonzini 
20749ab747fSPaolo Bonzini     ch->regs[DBDMA_STATUS] &= ~BT;
20849ab747fSPaolo Bonzini 
20949ab747fSPaolo Bonzini     cp = ch->regs[DBDMA_CMDPTR_LO];
21049ab747fSPaolo Bonzini     ch->regs[DBDMA_CMDPTR_LO] = cp + sizeof(dbdma_cmd);
21149ab747fSPaolo Bonzini     dbdma_cmdptr_load(ch);
21249ab747fSPaolo Bonzini }
21349ab747fSPaolo Bonzini 
21449ab747fSPaolo Bonzini static void branch(DBDMA_channel *ch)
21549ab747fSPaolo Bonzini {
21649ab747fSPaolo Bonzini     dbdma_cmd *current = &ch->current;
21749ab747fSPaolo Bonzini 
2183f0d4128SMark Cave-Ayland     ch->regs[DBDMA_CMDPTR_LO] = le32_to_cpu(current->cmd_dep);
21949ab747fSPaolo Bonzini     ch->regs[DBDMA_STATUS] |= BT;
22049ab747fSPaolo Bonzini     dbdma_cmdptr_load(ch);
22149ab747fSPaolo Bonzini }
22249ab747fSPaolo Bonzini 
22349ab747fSPaolo Bonzini static void conditional_branch(DBDMA_channel *ch)
22449ab747fSPaolo Bonzini {
22549ab747fSPaolo Bonzini     dbdma_cmd *current = &ch->current;
22649ab747fSPaolo Bonzini     uint16_t br;
22749ab747fSPaolo Bonzini     uint16_t sel_mask, sel_value;
22849ab747fSPaolo Bonzini     uint32_t status;
22949ab747fSPaolo Bonzini     int cond;
23049ab747fSPaolo Bonzini 
23149ab747fSPaolo Bonzini     /* check if we must branch */
23249ab747fSPaolo Bonzini 
23349ab747fSPaolo Bonzini     br = le16_to_cpu(current->command) & BR_MASK;
23449ab747fSPaolo Bonzini 
23549ab747fSPaolo Bonzini     switch(br) {
23649ab747fSPaolo Bonzini     case BR_NEVER:  /* don't branch */
23749ab747fSPaolo Bonzini         next(ch);
23849ab747fSPaolo Bonzini         return;
23949ab747fSPaolo Bonzini     case BR_ALWAYS: /* always branch */
240*77453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, "  [BR_ALWAYS]\n");
24149ab747fSPaolo Bonzini         branch(ch);
24249ab747fSPaolo Bonzini         return;
24349ab747fSPaolo Bonzini     }
24449ab747fSPaolo Bonzini 
24549ab747fSPaolo Bonzini     status = ch->regs[DBDMA_STATUS] & DEVSTAT;
24649ab747fSPaolo Bonzini 
24749ab747fSPaolo Bonzini     sel_mask = (ch->regs[DBDMA_BRANCH_SEL] >> 16) & 0x0f;
24849ab747fSPaolo Bonzini     sel_value = ch->regs[DBDMA_BRANCH_SEL] & 0x0f;
24949ab747fSPaolo Bonzini 
25049ab747fSPaolo Bonzini     cond = (status & sel_mask) == (sel_value & sel_mask);
25149ab747fSPaolo Bonzini 
25249ab747fSPaolo Bonzini     switch(br) {
25349ab747fSPaolo Bonzini     case BR_IFSET:  /* branch if condition bit is 1 */
254*77453882SBenjamin Herrenschmidt         if (cond) {
255*77453882SBenjamin Herrenschmidt             DBDMA_DPRINTFCH(ch, "  [BR_IFSET = 1]\n");
25649ab747fSPaolo Bonzini             branch(ch);
257*77453882SBenjamin Herrenschmidt         } else {
258*77453882SBenjamin Herrenschmidt             DBDMA_DPRINTFCH(ch, "  [BR_IFSET = 0]\n");
25949ab747fSPaolo Bonzini             next(ch);
260*77453882SBenjamin Herrenschmidt         }
26149ab747fSPaolo Bonzini         return;
26249ab747fSPaolo Bonzini     case BR_IFCLR:  /* branch if condition bit is 0 */
263*77453882SBenjamin Herrenschmidt         if (!cond) {
264*77453882SBenjamin Herrenschmidt             DBDMA_DPRINTFCH(ch, "  [BR_IFCLR = 1]\n");
26549ab747fSPaolo Bonzini             branch(ch);
266*77453882SBenjamin Herrenschmidt         } else {
267*77453882SBenjamin Herrenschmidt             DBDMA_DPRINTFCH(ch, "  [BR_IFCLR = 0]\n");
26849ab747fSPaolo Bonzini             next(ch);
269*77453882SBenjamin Herrenschmidt         }
27049ab747fSPaolo Bonzini         return;
27149ab747fSPaolo Bonzini     }
27249ab747fSPaolo Bonzini }
27349ab747fSPaolo Bonzini 
27449ab747fSPaolo Bonzini static void channel_run(DBDMA_channel *ch);
27549ab747fSPaolo Bonzini 
27649ab747fSPaolo Bonzini static void dbdma_end(DBDMA_io *io)
27749ab747fSPaolo Bonzini {
27849ab747fSPaolo Bonzini     DBDMA_channel *ch = io->channel;
27949ab747fSPaolo Bonzini     dbdma_cmd *current = &ch->current;
28049ab747fSPaolo Bonzini 
2813e49c439SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "%s\n", __func__);
28233ce36bbSAlexander Graf 
28349ab747fSPaolo Bonzini     if (conditional_wait(ch))
28449ab747fSPaolo Bonzini         goto wait;
28549ab747fSPaolo Bonzini 
28649ab747fSPaolo Bonzini     current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]);
28749ab747fSPaolo Bonzini     current->res_count = cpu_to_le16(io->len);
28849ab747fSPaolo Bonzini     dbdma_cmdptr_save(ch);
28949ab747fSPaolo Bonzini     if (io->is_last)
29049ab747fSPaolo Bonzini         ch->regs[DBDMA_STATUS] &= ~FLUSH;
29149ab747fSPaolo Bonzini 
29249ab747fSPaolo Bonzini     conditional_interrupt(ch);
29349ab747fSPaolo Bonzini     conditional_branch(ch);
29449ab747fSPaolo Bonzini 
29549ab747fSPaolo Bonzini wait:
29603ee3b1eSAlexander Graf     /* Indicate that we're ready for a new DMA round */
29703ee3b1eSAlexander Graf     ch->io.processing = false;
29803ee3b1eSAlexander Graf 
29949ab747fSPaolo Bonzini     if ((ch->regs[DBDMA_STATUS] & RUN) &&
30049ab747fSPaolo Bonzini         (ch->regs[DBDMA_STATUS] & ACTIVE))
30149ab747fSPaolo Bonzini         channel_run(ch);
30249ab747fSPaolo Bonzini }
30349ab747fSPaolo Bonzini 
30449ab747fSPaolo Bonzini static void start_output(DBDMA_channel *ch, int key, uint32_t addr,
30549ab747fSPaolo Bonzini                         uint16_t req_count, int is_last)
30649ab747fSPaolo Bonzini {
3073e49c439SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "start_output\n");
30849ab747fSPaolo Bonzini 
30949ab747fSPaolo Bonzini     /* KEY_REGS, KEY_DEVICE and KEY_STREAM
31049ab747fSPaolo Bonzini      * are not implemented in the mac-io chip
31149ab747fSPaolo Bonzini      */
31249ab747fSPaolo Bonzini 
3133e49c439SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "addr 0x%x key 0x%x\n", addr, key);
31449ab747fSPaolo Bonzini     if (!addr || key > KEY_STREAM3) {
31549ab747fSPaolo Bonzini         kill_channel(ch);
31649ab747fSPaolo Bonzini         return;
31749ab747fSPaolo Bonzini     }
31849ab747fSPaolo Bonzini 
31949ab747fSPaolo Bonzini     ch->io.addr = addr;
32049ab747fSPaolo Bonzini     ch->io.len = req_count;
32149ab747fSPaolo Bonzini     ch->io.is_last = is_last;
32249ab747fSPaolo Bonzini     ch->io.dma_end = dbdma_end;
32349ab747fSPaolo Bonzini     ch->io.is_dma_out = 1;
32403ee3b1eSAlexander Graf     ch->io.processing = true;
32549ab747fSPaolo Bonzini     if (ch->rw) {
32649ab747fSPaolo Bonzini         ch->rw(&ch->io);
32749ab747fSPaolo Bonzini     }
32849ab747fSPaolo Bonzini }
32949ab747fSPaolo Bonzini 
33049ab747fSPaolo Bonzini static void start_input(DBDMA_channel *ch, int key, uint32_t addr,
33149ab747fSPaolo Bonzini                        uint16_t req_count, int is_last)
33249ab747fSPaolo Bonzini {
3333e49c439SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "start_input\n");
33449ab747fSPaolo Bonzini 
33549ab747fSPaolo Bonzini     /* KEY_REGS, KEY_DEVICE and KEY_STREAM
33649ab747fSPaolo Bonzini      * are not implemented in the mac-io chip
33749ab747fSPaolo Bonzini      */
33849ab747fSPaolo Bonzini 
3393e49c439SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "addr 0x%x key 0x%x\n", addr, key);
34049ab747fSPaolo Bonzini     if (!addr || key > KEY_STREAM3) {
34149ab747fSPaolo Bonzini         kill_channel(ch);
34249ab747fSPaolo Bonzini         return;
34349ab747fSPaolo Bonzini     }
34449ab747fSPaolo Bonzini 
34549ab747fSPaolo Bonzini     ch->io.addr = addr;
34649ab747fSPaolo Bonzini     ch->io.len = req_count;
34749ab747fSPaolo Bonzini     ch->io.is_last = is_last;
34849ab747fSPaolo Bonzini     ch->io.dma_end = dbdma_end;
34949ab747fSPaolo Bonzini     ch->io.is_dma_out = 0;
35003ee3b1eSAlexander Graf     ch->io.processing = true;
35149ab747fSPaolo Bonzini     if (ch->rw) {
35249ab747fSPaolo Bonzini         ch->rw(&ch->io);
35349ab747fSPaolo Bonzini     }
35449ab747fSPaolo Bonzini }
35549ab747fSPaolo Bonzini 
35649ab747fSPaolo Bonzini static void load_word(DBDMA_channel *ch, int key, uint32_t addr,
35749ab747fSPaolo Bonzini                      uint16_t len)
35849ab747fSPaolo Bonzini {
35949ab747fSPaolo Bonzini     dbdma_cmd *current = &ch->current;
36049ab747fSPaolo Bonzini 
361e12f50b9SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "load_word %d bytes, addr=%08x\n", len, addr);
36249ab747fSPaolo Bonzini 
36349ab747fSPaolo Bonzini     /* only implements KEY_SYSTEM */
36449ab747fSPaolo Bonzini 
36549ab747fSPaolo Bonzini     if (key != KEY_SYSTEM) {
36649ab747fSPaolo Bonzini         printf("DBDMA: LOAD_WORD, unimplemented key %x\n", key);
36749ab747fSPaolo Bonzini         kill_channel(ch);
36849ab747fSPaolo Bonzini         return;
36949ab747fSPaolo Bonzini     }
37049ab747fSPaolo Bonzini 
371e12f50b9SMark Cave-Ayland     dma_memory_read(&address_space_memory, addr, &current->cmd_dep, len);
37249ab747fSPaolo Bonzini 
37349ab747fSPaolo Bonzini     if (conditional_wait(ch))
37449ab747fSPaolo Bonzini         goto wait;
37549ab747fSPaolo Bonzini 
37649ab747fSPaolo Bonzini     current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]);
37749ab747fSPaolo Bonzini     dbdma_cmdptr_save(ch);
37849ab747fSPaolo Bonzini     ch->regs[DBDMA_STATUS] &= ~FLUSH;
37949ab747fSPaolo Bonzini 
38049ab747fSPaolo Bonzini     conditional_interrupt(ch);
38149ab747fSPaolo Bonzini     next(ch);
38249ab747fSPaolo Bonzini 
38349ab747fSPaolo Bonzini wait:
384d2f0ce21SAlexander Graf     DBDMA_kick(dbdma_from_ch(ch));
38549ab747fSPaolo Bonzini }
38649ab747fSPaolo Bonzini 
38749ab747fSPaolo Bonzini static void store_word(DBDMA_channel *ch, int key, uint32_t addr,
38849ab747fSPaolo Bonzini                       uint16_t len)
38949ab747fSPaolo Bonzini {
39049ab747fSPaolo Bonzini     dbdma_cmd *current = &ch->current;
39149ab747fSPaolo Bonzini 
392e12f50b9SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "store_word %d bytes, addr=%08x pa=%x\n",
393e12f50b9SMark Cave-Ayland                     len, addr, le32_to_cpu(current->cmd_dep));
39449ab747fSPaolo Bonzini 
39549ab747fSPaolo Bonzini     /* only implements KEY_SYSTEM */
39649ab747fSPaolo Bonzini 
39749ab747fSPaolo Bonzini     if (key != KEY_SYSTEM) {
39849ab747fSPaolo Bonzini         printf("DBDMA: STORE_WORD, unimplemented key %x\n", key);
39949ab747fSPaolo Bonzini         kill_channel(ch);
40049ab747fSPaolo Bonzini         return;
40149ab747fSPaolo Bonzini     }
40249ab747fSPaolo Bonzini 
403e12f50b9SMark Cave-Ayland     dma_memory_write(&address_space_memory, addr, &current->cmd_dep, len);
40449ab747fSPaolo Bonzini 
40549ab747fSPaolo Bonzini     if (conditional_wait(ch))
40649ab747fSPaolo Bonzini         goto wait;
40749ab747fSPaolo Bonzini 
40849ab747fSPaolo Bonzini     current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]);
40949ab747fSPaolo Bonzini     dbdma_cmdptr_save(ch);
41049ab747fSPaolo Bonzini     ch->regs[DBDMA_STATUS] &= ~FLUSH;
41149ab747fSPaolo Bonzini 
41249ab747fSPaolo Bonzini     conditional_interrupt(ch);
41349ab747fSPaolo Bonzini     next(ch);
41449ab747fSPaolo Bonzini 
41549ab747fSPaolo Bonzini wait:
416d2f0ce21SAlexander Graf     DBDMA_kick(dbdma_from_ch(ch));
41749ab747fSPaolo Bonzini }
41849ab747fSPaolo Bonzini 
41949ab747fSPaolo Bonzini static void nop(DBDMA_channel *ch)
42049ab747fSPaolo Bonzini {
42149ab747fSPaolo Bonzini     dbdma_cmd *current = &ch->current;
42249ab747fSPaolo Bonzini 
42349ab747fSPaolo Bonzini     if (conditional_wait(ch))
42449ab747fSPaolo Bonzini         goto wait;
42549ab747fSPaolo Bonzini 
42649ab747fSPaolo Bonzini     current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]);
42749ab747fSPaolo Bonzini     dbdma_cmdptr_save(ch);
42849ab747fSPaolo Bonzini 
42949ab747fSPaolo Bonzini     conditional_interrupt(ch);
43049ab747fSPaolo Bonzini     conditional_branch(ch);
43149ab747fSPaolo Bonzini 
43249ab747fSPaolo Bonzini wait:
433d2f0ce21SAlexander Graf     DBDMA_kick(dbdma_from_ch(ch));
43449ab747fSPaolo Bonzini }
43549ab747fSPaolo Bonzini 
43649ab747fSPaolo Bonzini static void stop(DBDMA_channel *ch)
43749ab747fSPaolo Bonzini {
438*77453882SBenjamin Herrenschmidt     ch->regs[DBDMA_STATUS] &= ~(ACTIVE);
43949ab747fSPaolo Bonzini 
44049ab747fSPaolo Bonzini     /* the stop command does not increment command pointer */
44149ab747fSPaolo Bonzini }
44249ab747fSPaolo Bonzini 
44349ab747fSPaolo Bonzini static void channel_run(DBDMA_channel *ch)
44449ab747fSPaolo Bonzini {
44549ab747fSPaolo Bonzini     dbdma_cmd *current = &ch->current;
44649ab747fSPaolo Bonzini     uint16_t cmd, key;
44749ab747fSPaolo Bonzini     uint16_t req_count;
44849ab747fSPaolo Bonzini     uint32_t phy_addr;
44949ab747fSPaolo Bonzini 
4503e49c439SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "channel_run\n");
45149ab747fSPaolo Bonzini     dump_dbdma_cmd(current);
45249ab747fSPaolo Bonzini 
45349ab747fSPaolo Bonzini     /* clear WAKE flag at command fetch */
45449ab747fSPaolo Bonzini 
45549ab747fSPaolo Bonzini     ch->regs[DBDMA_STATUS] &= ~WAKE;
45649ab747fSPaolo Bonzini 
45749ab747fSPaolo Bonzini     cmd = le16_to_cpu(current->command) & COMMAND_MASK;
45849ab747fSPaolo Bonzini 
45949ab747fSPaolo Bonzini     switch (cmd) {
46049ab747fSPaolo Bonzini     case DBDMA_NOP:
46149ab747fSPaolo Bonzini         nop(ch);
46249ab747fSPaolo Bonzini         return;
46349ab747fSPaolo Bonzini 
46449ab747fSPaolo Bonzini     case DBDMA_STOP:
46549ab747fSPaolo Bonzini         stop(ch);
46649ab747fSPaolo Bonzini         return;
46749ab747fSPaolo Bonzini     }
46849ab747fSPaolo Bonzini 
46949ab747fSPaolo Bonzini     key = le16_to_cpu(current->command) & 0x0700;
47049ab747fSPaolo Bonzini     req_count = le16_to_cpu(current->req_count);
47149ab747fSPaolo Bonzini     phy_addr = le32_to_cpu(current->phy_addr);
47249ab747fSPaolo Bonzini 
47349ab747fSPaolo Bonzini     if (key == KEY_STREAM4) {
47449ab747fSPaolo Bonzini         printf("command %x, invalid key 4\n", cmd);
47549ab747fSPaolo Bonzini         kill_channel(ch);
47649ab747fSPaolo Bonzini         return;
47749ab747fSPaolo Bonzini     }
47849ab747fSPaolo Bonzini 
47949ab747fSPaolo Bonzini     switch (cmd) {
48049ab747fSPaolo Bonzini     case OUTPUT_MORE:
481*77453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, "* OUTPUT_MORE *\n");
48249ab747fSPaolo Bonzini         start_output(ch, key, phy_addr, req_count, 0);
48349ab747fSPaolo Bonzini         return;
48449ab747fSPaolo Bonzini 
48549ab747fSPaolo Bonzini     case OUTPUT_LAST:
486*77453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, "* OUTPUT_LAST *\n");
48749ab747fSPaolo Bonzini         start_output(ch, key, phy_addr, req_count, 1);
48849ab747fSPaolo Bonzini         return;
48949ab747fSPaolo Bonzini 
49049ab747fSPaolo Bonzini     case INPUT_MORE:
491*77453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, "* INPUT_MORE *\n");
49249ab747fSPaolo Bonzini         start_input(ch, key, phy_addr, req_count, 0);
49349ab747fSPaolo Bonzini         return;
49449ab747fSPaolo Bonzini 
49549ab747fSPaolo Bonzini     case INPUT_LAST:
496*77453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, "* INPUT_LAST *\n");
49749ab747fSPaolo Bonzini         start_input(ch, key, phy_addr, req_count, 1);
49849ab747fSPaolo Bonzini         return;
49949ab747fSPaolo Bonzini     }
50049ab747fSPaolo Bonzini 
50149ab747fSPaolo Bonzini     if (key < KEY_REGS) {
50249ab747fSPaolo Bonzini         printf("command %x, invalid key %x\n", cmd, key);
50349ab747fSPaolo Bonzini         key = KEY_SYSTEM;
50449ab747fSPaolo Bonzini     }
50549ab747fSPaolo Bonzini 
50649ab747fSPaolo Bonzini     /* for LOAD_WORD and STORE_WORD, req_count is on 3 bits
50749ab747fSPaolo Bonzini      * and BRANCH is invalid
50849ab747fSPaolo Bonzini      */
50949ab747fSPaolo Bonzini 
51049ab747fSPaolo Bonzini     req_count = req_count & 0x0007;
51149ab747fSPaolo Bonzini     if (req_count & 0x4) {
51249ab747fSPaolo Bonzini         req_count = 4;
51349ab747fSPaolo Bonzini         phy_addr &= ~3;
51449ab747fSPaolo Bonzini     } else if (req_count & 0x2) {
51549ab747fSPaolo Bonzini         req_count = 2;
51649ab747fSPaolo Bonzini         phy_addr &= ~1;
51749ab747fSPaolo Bonzini     } else
51849ab747fSPaolo Bonzini         req_count = 1;
51949ab747fSPaolo Bonzini 
52049ab747fSPaolo Bonzini     switch (cmd) {
52149ab747fSPaolo Bonzini     case LOAD_WORD:
522*77453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, "* LOAD_WORD *\n");
52349ab747fSPaolo Bonzini         load_word(ch, key, phy_addr, req_count);
52449ab747fSPaolo Bonzini         return;
52549ab747fSPaolo Bonzini 
52649ab747fSPaolo Bonzini     case STORE_WORD:
527*77453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, "* STORE_WORD *\n");
52849ab747fSPaolo Bonzini         store_word(ch, key, phy_addr, req_count);
52949ab747fSPaolo Bonzini         return;
53049ab747fSPaolo Bonzini     }
53149ab747fSPaolo Bonzini }
53249ab747fSPaolo Bonzini 
53349ab747fSPaolo Bonzini static void DBDMA_run(DBDMAState *s)
53449ab747fSPaolo Bonzini {
53549ab747fSPaolo Bonzini     int channel;
53649ab747fSPaolo Bonzini 
53749ab747fSPaolo Bonzini     for (channel = 0; channel < DBDMA_CHANNELS; channel++) {
53849ab747fSPaolo Bonzini         DBDMA_channel *ch = &s->channels[channel];
53949ab747fSPaolo Bonzini         uint32_t status = ch->regs[DBDMA_STATUS];
54003ee3b1eSAlexander Graf         if (!ch->io.processing && (status & RUN) && (status & ACTIVE)) {
54149ab747fSPaolo Bonzini             channel_run(ch);
54249ab747fSPaolo Bonzini         }
54349ab747fSPaolo Bonzini     }
54449ab747fSPaolo Bonzini }
54549ab747fSPaolo Bonzini 
54649ab747fSPaolo Bonzini static void DBDMA_run_bh(void *opaque)
54749ab747fSPaolo Bonzini {
54849ab747fSPaolo Bonzini     DBDMAState *s = opaque;
54949ab747fSPaolo Bonzini 
5503e49c439SMark Cave-Ayland     DBDMA_DPRINTF("-> DBDMA_run_bh\n");
55149ab747fSPaolo Bonzini     DBDMA_run(s);
5523e49c439SMark Cave-Ayland     DBDMA_DPRINTF("<- DBDMA_run_bh\n");
55349ab747fSPaolo Bonzini }
55449ab747fSPaolo Bonzini 
555d1e562deSAlexander Graf void DBDMA_kick(DBDMAState *dbdma)
556d1e562deSAlexander Graf {
557d2f0ce21SAlexander Graf     qemu_bh_schedule(dbdma->bh);
558d1e562deSAlexander Graf }
559d1e562deSAlexander Graf 
56049ab747fSPaolo Bonzini void DBDMA_register_channel(void *dbdma, int nchan, qemu_irq irq,
56149ab747fSPaolo Bonzini                             DBDMA_rw rw, DBDMA_flush flush,
56249ab747fSPaolo Bonzini                             void *opaque)
56349ab747fSPaolo Bonzini {
56449ab747fSPaolo Bonzini     DBDMAState *s = dbdma;
56549ab747fSPaolo Bonzini     DBDMA_channel *ch = &s->channels[nchan];
56649ab747fSPaolo Bonzini 
5673e49c439SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "DBDMA_register_channel 0x%x\n", nchan);
56849ab747fSPaolo Bonzini 
5692d7d06d8SHervé Poussineau     assert(rw);
5702d7d06d8SHervé Poussineau     assert(flush);
5712d7d06d8SHervé Poussineau 
57249ab747fSPaolo Bonzini     ch->irq = irq;
57349ab747fSPaolo Bonzini     ch->rw = rw;
57449ab747fSPaolo Bonzini     ch->flush = flush;
57549ab747fSPaolo Bonzini     ch->io.opaque = opaque;
57649ab747fSPaolo Bonzini }
57749ab747fSPaolo Bonzini 
578*77453882SBenjamin Herrenschmidt static void dbdma_control_write(DBDMA_channel *ch)
57949ab747fSPaolo Bonzini {
58049ab747fSPaolo Bonzini     uint16_t mask, value;
58149ab747fSPaolo Bonzini     uint32_t status;
582*77453882SBenjamin Herrenschmidt     bool do_flush = false;
58349ab747fSPaolo Bonzini 
58449ab747fSPaolo Bonzini     mask = (ch->regs[DBDMA_CONTROL] >> 16) & 0xffff;
58549ab747fSPaolo Bonzini     value = ch->regs[DBDMA_CONTROL] & 0xffff;
58649ab747fSPaolo Bonzini 
587*77453882SBenjamin Herrenschmidt     /* This is the status register which we'll update
588*77453882SBenjamin Herrenschmidt      * appropriately and store back
589*77453882SBenjamin Herrenschmidt      */
59049ab747fSPaolo Bonzini     status = ch->regs[DBDMA_STATUS];
59149ab747fSPaolo Bonzini 
592*77453882SBenjamin Herrenschmidt     /* RUN and PAUSE are bits under SW control only
593*77453882SBenjamin Herrenschmidt      * FLUSH and WAKE are set by SW and cleared by HW
594*77453882SBenjamin Herrenschmidt      * DEAD, ACTIVE and BT are only under HW control
595*77453882SBenjamin Herrenschmidt      *
596*77453882SBenjamin Herrenschmidt      * We handle ACTIVE separately at the end of the
597*77453882SBenjamin Herrenschmidt      * logic to ensure all cases are covered.
598*77453882SBenjamin Herrenschmidt      */
59949ab747fSPaolo Bonzini 
600*77453882SBenjamin Herrenschmidt     /* Setting RUN will tentatively activate the channel
601*77453882SBenjamin Herrenschmidt      */
602*77453882SBenjamin Herrenschmidt     if ((mask & RUN) && (value & RUN)) {
603*77453882SBenjamin Herrenschmidt         status |= RUN;
604*77453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, " Setting RUN !\n");
60549ab747fSPaolo Bonzini     }
606*77453882SBenjamin Herrenschmidt 
607*77453882SBenjamin Herrenschmidt     /* Clearing RUN 1->0 will stop the channel */
608*77453882SBenjamin Herrenschmidt     if ((mask & RUN) && !(value & RUN)) {
609*77453882SBenjamin Herrenschmidt         /* This has the side effect of clearing the DEAD bit */
610*77453882SBenjamin Herrenschmidt         status &= ~(DEAD | RUN);
611*77453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, " Clearing RUN !\n");
612*77453882SBenjamin Herrenschmidt     }
613*77453882SBenjamin Herrenschmidt 
614*77453882SBenjamin Herrenschmidt     /* Setting WAKE wakes up an idle channel if it's running
615*77453882SBenjamin Herrenschmidt      *
616*77453882SBenjamin Herrenschmidt      * Note: The doc doesn't say so but assume that only works
617*77453882SBenjamin Herrenschmidt      * on a channel whose RUN bit is set.
618*77453882SBenjamin Herrenschmidt      *
619*77453882SBenjamin Herrenschmidt      * We set WAKE in status, it's not terribly useful as it will
620*77453882SBenjamin Herrenschmidt      * be cleared on the next command fetch but it seems to mimmic
621*77453882SBenjamin Herrenschmidt      * the HW behaviour and is useful for the way we handle
622*77453882SBenjamin Herrenschmidt      * ACTIVE further down.
623*77453882SBenjamin Herrenschmidt      */
624*77453882SBenjamin Herrenschmidt     if ((mask & WAKE) && (value & WAKE) && (status & RUN)) {
625*77453882SBenjamin Herrenschmidt         status |= WAKE;
626*77453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, " Setting WAKE !\n");
627*77453882SBenjamin Herrenschmidt     }
628*77453882SBenjamin Herrenschmidt 
629*77453882SBenjamin Herrenschmidt     /* PAUSE being set will deactivate (or prevent activation)
630*77453882SBenjamin Herrenschmidt      * of the channel. We just copy it over for now, ACTIVE will
631*77453882SBenjamin Herrenschmidt      * be re-evaluated later.
632*77453882SBenjamin Herrenschmidt      */
633*77453882SBenjamin Herrenschmidt     if (mask & PAUSE) {
634*77453882SBenjamin Herrenschmidt         status = (status & ~PAUSE) | (value & PAUSE);
635*77453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, " %sing PAUSE !\n",
636*77453882SBenjamin Herrenschmidt                         (value & PAUSE) ? "sett" : "clear");
637*77453882SBenjamin Herrenschmidt     }
638*77453882SBenjamin Herrenschmidt 
639*77453882SBenjamin Herrenschmidt     /* FLUSH is its own thing */
640*77453882SBenjamin Herrenschmidt     if ((mask & FLUSH) && (value & FLUSH))  {
641*77453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, " Setting FLUSH !\n");
642*77453882SBenjamin Herrenschmidt         /* We set flush directly in the status register, we do *NOT*
643*77453882SBenjamin Herrenschmidt          * set it in "status" so that it gets naturally cleared when
644*77453882SBenjamin Herrenschmidt          * we update the status register further down. That way it
645*77453882SBenjamin Herrenschmidt          * will be set only during the HW flush operation so it is
646*77453882SBenjamin Herrenschmidt          * visible to any completions happening during that time.
647*77453882SBenjamin Herrenschmidt          */
648*77453882SBenjamin Herrenschmidt         ch->regs[DBDMA_STATUS] |= FLUSH;
649*77453882SBenjamin Herrenschmidt         do_flush = true;
650*77453882SBenjamin Herrenschmidt     }
651*77453882SBenjamin Herrenschmidt 
652*77453882SBenjamin Herrenschmidt     /* If either RUN or PAUSE is clear, so should ACTIVE be,
653*77453882SBenjamin Herrenschmidt      * otherwise, ACTIVE will be set if we modified RUN, PAUSE or
654*77453882SBenjamin Herrenschmidt      * set WAKE. That means that PAUSE was just cleared, RUN was
655*77453882SBenjamin Herrenschmidt      * just set or WAKE was just set.
656*77453882SBenjamin Herrenschmidt      */
657*77453882SBenjamin Herrenschmidt     if ((status & PAUSE) || !(status & RUN)) {
65849ab747fSPaolo Bonzini         status &= ~ACTIVE;
659*77453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, "  -> ACTIVE down !\n");
660*77453882SBenjamin Herrenschmidt 
661*77453882SBenjamin Herrenschmidt         /* We stopped processing, we want the underlying HW command
662*77453882SBenjamin Herrenschmidt          * to complete *before* we clear the ACTIVE bit. Otherwise
663*77453882SBenjamin Herrenschmidt          * we can get into a situation where the command status will
664*77453882SBenjamin Herrenschmidt          * have RUN or ACTIVE not set which is going to confuse the
665*77453882SBenjamin Herrenschmidt          * MacOS driver.
666*77453882SBenjamin Herrenschmidt          */
667*77453882SBenjamin Herrenschmidt         do_flush = true;
668*77453882SBenjamin Herrenschmidt     } else if (mask & (RUN | PAUSE)) {
669*77453882SBenjamin Herrenschmidt         status |= ACTIVE;
670*77453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, " -> ACTIVE up !\n");
671*77453882SBenjamin Herrenschmidt     } else if ((mask & WAKE) && (value & WAKE)) {
672*77453882SBenjamin Herrenschmidt         status |= ACTIVE;
673*77453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, " -> ACTIVE up !\n");
6741cde732dSMark Cave-Ayland     }
6751cde732dSMark Cave-Ayland 
676*77453882SBenjamin Herrenschmidt     DBDMA_DPRINTFCH(ch, " new status=0x%08x\n", status);
677*77453882SBenjamin Herrenschmidt 
678*77453882SBenjamin Herrenschmidt     /* If we need to flush the underlying HW, do it now, this happens
679*77453882SBenjamin Herrenschmidt      * both on FLUSH commands and when stopping the channel for safety.
680*77453882SBenjamin Herrenschmidt      */
681*77453882SBenjamin Herrenschmidt     if (do_flush && ch->flush) {
68249ab747fSPaolo Bonzini         ch->flush(&ch->io);
68349ab747fSPaolo Bonzini     }
68449ab747fSPaolo Bonzini 
685*77453882SBenjamin Herrenschmidt     /* Finally update the status register image */
68649ab747fSPaolo Bonzini     ch->regs[DBDMA_STATUS] = status;
68749ab747fSPaolo Bonzini 
688*77453882SBenjamin Herrenschmidt     /* If active, make sure the BH gets to run */
689d2f0ce21SAlexander Graf     if (status & ACTIVE) {
690d2f0ce21SAlexander Graf         DBDMA_kick(dbdma_from_ch(ch));
691d2f0ce21SAlexander Graf     }
692d2f0ce21SAlexander Graf }
69349ab747fSPaolo Bonzini 
69449ab747fSPaolo Bonzini static void dbdma_write(void *opaque, hwaddr addr,
69549ab747fSPaolo Bonzini                         uint64_t value, unsigned size)
69649ab747fSPaolo Bonzini {
69749ab747fSPaolo Bonzini     int channel = addr >> DBDMA_CHANNEL_SHIFT;
69849ab747fSPaolo Bonzini     DBDMAState *s = opaque;
69949ab747fSPaolo Bonzini     DBDMA_channel *ch = &s->channels[channel];
70049ab747fSPaolo Bonzini     int reg = (addr - (channel << DBDMA_CHANNEL_SHIFT)) >> 2;
70149ab747fSPaolo Bonzini 
7023e49c439SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "writel 0x" TARGET_FMT_plx " <= 0x%08"PRIx64"\n",
70358c0c311SAlexander Graf                     addr, value);
7043e49c439SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "channel 0x%x reg 0x%x\n",
70549ab747fSPaolo Bonzini                     (uint32_t)addr >> DBDMA_CHANNEL_SHIFT, reg);
70649ab747fSPaolo Bonzini 
7077eaba824SAlexander Graf     /* cmdptr cannot be modified if channel is ACTIVE */
70849ab747fSPaolo Bonzini 
7097eaba824SAlexander Graf     if (reg == DBDMA_CMDPTR_LO && (ch->regs[DBDMA_STATUS] & ACTIVE)) {
71049ab747fSPaolo Bonzini         return;
7117eaba824SAlexander Graf     }
71249ab747fSPaolo Bonzini 
71349ab747fSPaolo Bonzini     ch->regs[reg] = value;
71449ab747fSPaolo Bonzini 
71549ab747fSPaolo Bonzini     switch(reg) {
71649ab747fSPaolo Bonzini     case DBDMA_CONTROL:
71749ab747fSPaolo Bonzini         dbdma_control_write(ch);
71849ab747fSPaolo Bonzini         break;
71949ab747fSPaolo Bonzini     case DBDMA_CMDPTR_LO:
72049ab747fSPaolo Bonzini         /* 16-byte aligned */
72149ab747fSPaolo Bonzini         ch->regs[DBDMA_CMDPTR_LO] &= ~0xf;
72249ab747fSPaolo Bonzini         dbdma_cmdptr_load(ch);
72349ab747fSPaolo Bonzini         break;
72449ab747fSPaolo Bonzini     case DBDMA_STATUS:
72549ab747fSPaolo Bonzini     case DBDMA_INTR_SEL:
72649ab747fSPaolo Bonzini     case DBDMA_BRANCH_SEL:
72749ab747fSPaolo Bonzini     case DBDMA_WAIT_SEL:
72849ab747fSPaolo Bonzini         /* nothing to do */
72949ab747fSPaolo Bonzini         break;
73049ab747fSPaolo Bonzini     case DBDMA_XFER_MODE:
73149ab747fSPaolo Bonzini     case DBDMA_CMDPTR_HI:
73249ab747fSPaolo Bonzini     case DBDMA_DATA2PTR_HI:
73349ab747fSPaolo Bonzini     case DBDMA_DATA2PTR_LO:
73449ab747fSPaolo Bonzini     case DBDMA_ADDRESS_HI:
73549ab747fSPaolo Bonzini     case DBDMA_BRANCH_ADDR_HI:
73649ab747fSPaolo Bonzini     case DBDMA_RES1:
73749ab747fSPaolo Bonzini     case DBDMA_RES2:
73849ab747fSPaolo Bonzini     case DBDMA_RES3:
73949ab747fSPaolo Bonzini     case DBDMA_RES4:
74049ab747fSPaolo Bonzini         /* unused */
74149ab747fSPaolo Bonzini         break;
74249ab747fSPaolo Bonzini     }
74349ab747fSPaolo Bonzini }
74449ab747fSPaolo Bonzini 
74549ab747fSPaolo Bonzini static uint64_t dbdma_read(void *opaque, hwaddr addr,
74649ab747fSPaolo Bonzini                            unsigned size)
74749ab747fSPaolo Bonzini {
74849ab747fSPaolo Bonzini     uint32_t value;
74949ab747fSPaolo Bonzini     int channel = addr >> DBDMA_CHANNEL_SHIFT;
75049ab747fSPaolo Bonzini     DBDMAState *s = opaque;
75149ab747fSPaolo Bonzini     DBDMA_channel *ch = &s->channels[channel];
75249ab747fSPaolo Bonzini     int reg = (addr - (channel << DBDMA_CHANNEL_SHIFT)) >> 2;
75349ab747fSPaolo Bonzini 
75449ab747fSPaolo Bonzini     value = ch->regs[reg];
75549ab747fSPaolo Bonzini 
75649ab747fSPaolo Bonzini     switch(reg) {
75749ab747fSPaolo Bonzini     case DBDMA_CONTROL:
758*77453882SBenjamin Herrenschmidt         value = ch->regs[DBDMA_STATUS];
75949ab747fSPaolo Bonzini         break;
76049ab747fSPaolo Bonzini     case DBDMA_STATUS:
76149ab747fSPaolo Bonzini     case DBDMA_CMDPTR_LO:
76249ab747fSPaolo Bonzini     case DBDMA_INTR_SEL:
76349ab747fSPaolo Bonzini     case DBDMA_BRANCH_SEL:
76449ab747fSPaolo Bonzini     case DBDMA_WAIT_SEL:
76549ab747fSPaolo Bonzini         /* nothing to do */
76649ab747fSPaolo Bonzini         break;
76749ab747fSPaolo Bonzini     case DBDMA_XFER_MODE:
76849ab747fSPaolo Bonzini     case DBDMA_CMDPTR_HI:
76949ab747fSPaolo Bonzini     case DBDMA_DATA2PTR_HI:
77049ab747fSPaolo Bonzini     case DBDMA_DATA2PTR_LO:
77149ab747fSPaolo Bonzini     case DBDMA_ADDRESS_HI:
77249ab747fSPaolo Bonzini     case DBDMA_BRANCH_ADDR_HI:
77349ab747fSPaolo Bonzini         /* unused */
77449ab747fSPaolo Bonzini         value = 0;
77549ab747fSPaolo Bonzini         break;
77649ab747fSPaolo Bonzini     case DBDMA_RES1:
77749ab747fSPaolo Bonzini     case DBDMA_RES2:
77849ab747fSPaolo Bonzini     case DBDMA_RES3:
77949ab747fSPaolo Bonzini     case DBDMA_RES4:
78049ab747fSPaolo Bonzini         /* reserved */
78149ab747fSPaolo Bonzini         break;
78249ab747fSPaolo Bonzini     }
78349ab747fSPaolo Bonzini 
784*77453882SBenjamin Herrenschmidt     DBDMA_DPRINTFCH(ch, "readl 0x" TARGET_FMT_plx " => 0x%08x\n", addr, value);
785*77453882SBenjamin Herrenschmidt     DBDMA_DPRINTFCH(ch, "channel 0x%x reg 0x%x\n",
786*77453882SBenjamin Herrenschmidt                     (uint32_t)addr >> DBDMA_CHANNEL_SHIFT, reg);
787*77453882SBenjamin Herrenschmidt 
78849ab747fSPaolo Bonzini     return value;
78949ab747fSPaolo Bonzini }
79049ab747fSPaolo Bonzini 
79149ab747fSPaolo Bonzini static const MemoryRegionOps dbdma_ops = {
79249ab747fSPaolo Bonzini     .read = dbdma_read,
79349ab747fSPaolo Bonzini     .write = dbdma_write,
79449ab747fSPaolo Bonzini     .endianness = DEVICE_LITTLE_ENDIAN,
79549ab747fSPaolo Bonzini     .valid = {
79649ab747fSPaolo Bonzini         .min_access_size = 4,
79749ab747fSPaolo Bonzini         .max_access_size = 4,
79849ab747fSPaolo Bonzini     },
79949ab747fSPaolo Bonzini };
80049ab747fSPaolo Bonzini 
801627be2f2SMark Cave-Ayland static const VMStateDescription vmstate_dbdma_io = {
802627be2f2SMark Cave-Ayland     .name = "dbdma_io",
80349ab747fSPaolo Bonzini     .version_id = 0,
80449ab747fSPaolo Bonzini     .minimum_version_id = 0,
80549ab747fSPaolo Bonzini     .fields = (VMStateField[]) {
806627be2f2SMark Cave-Ayland         VMSTATE_UINT64(addr, struct DBDMA_io),
807627be2f2SMark Cave-Ayland         VMSTATE_INT32(len, struct DBDMA_io),
808627be2f2SMark Cave-Ayland         VMSTATE_INT32(is_last, struct DBDMA_io),
809627be2f2SMark Cave-Ayland         VMSTATE_INT32(is_dma_out, struct DBDMA_io),
810627be2f2SMark Cave-Ayland         VMSTATE_BOOL(processing, struct DBDMA_io),
811627be2f2SMark Cave-Ayland         VMSTATE_END_OF_LIST()
812627be2f2SMark Cave-Ayland     }
813627be2f2SMark Cave-Ayland };
814627be2f2SMark Cave-Ayland 
815627be2f2SMark Cave-Ayland static const VMStateDescription vmstate_dbdma_cmd = {
816627be2f2SMark Cave-Ayland     .name = "dbdma_cmd",
817627be2f2SMark Cave-Ayland     .version_id = 0,
818627be2f2SMark Cave-Ayland     .minimum_version_id = 0,
819627be2f2SMark Cave-Ayland     .fields = (VMStateField[]) {
820627be2f2SMark Cave-Ayland         VMSTATE_UINT16(req_count, dbdma_cmd),
821627be2f2SMark Cave-Ayland         VMSTATE_UINT16(command, dbdma_cmd),
822627be2f2SMark Cave-Ayland         VMSTATE_UINT32(phy_addr, dbdma_cmd),
823627be2f2SMark Cave-Ayland         VMSTATE_UINT32(cmd_dep, dbdma_cmd),
824627be2f2SMark Cave-Ayland         VMSTATE_UINT16(res_count, dbdma_cmd),
825627be2f2SMark Cave-Ayland         VMSTATE_UINT16(xfer_status, dbdma_cmd),
826627be2f2SMark Cave-Ayland         VMSTATE_END_OF_LIST()
827627be2f2SMark Cave-Ayland     }
828627be2f2SMark Cave-Ayland };
829627be2f2SMark Cave-Ayland 
830627be2f2SMark Cave-Ayland static const VMStateDescription vmstate_dbdma_channel = {
831627be2f2SMark Cave-Ayland     .name = "dbdma_channel",
832627be2f2SMark Cave-Ayland     .version_id = 1,
833627be2f2SMark Cave-Ayland     .minimum_version_id = 1,
834627be2f2SMark Cave-Ayland     .fields = (VMStateField[]) {
83549ab747fSPaolo Bonzini         VMSTATE_UINT32_ARRAY(regs, struct DBDMA_channel, DBDMA_REGS),
836627be2f2SMark Cave-Ayland         VMSTATE_STRUCT(io, struct DBDMA_channel, 0, vmstate_dbdma_io, DBDMA_io),
837627be2f2SMark Cave-Ayland         VMSTATE_STRUCT(current, struct DBDMA_channel, 0, vmstate_dbdma_cmd,
838627be2f2SMark Cave-Ayland                        dbdma_cmd),
83949ab747fSPaolo Bonzini         VMSTATE_END_OF_LIST()
84049ab747fSPaolo Bonzini     }
84149ab747fSPaolo Bonzini };
84249ab747fSPaolo Bonzini 
84349ab747fSPaolo Bonzini static const VMStateDescription vmstate_dbdma = {
84449ab747fSPaolo Bonzini     .name = "dbdma",
845627be2f2SMark Cave-Ayland     .version_id = 3,
846627be2f2SMark Cave-Ayland     .minimum_version_id = 3,
84749ab747fSPaolo Bonzini     .fields = (VMStateField[]) {
84849ab747fSPaolo Bonzini         VMSTATE_STRUCT_ARRAY(channels, DBDMAState, DBDMA_CHANNELS, 1,
84949ab747fSPaolo Bonzini                              vmstate_dbdma_channel, DBDMA_channel),
85049ab747fSPaolo Bonzini         VMSTATE_END_OF_LIST()
85149ab747fSPaolo Bonzini     }
85249ab747fSPaolo Bonzini };
85349ab747fSPaolo Bonzini 
85449ab747fSPaolo Bonzini static void dbdma_reset(void *opaque)
85549ab747fSPaolo Bonzini {
85649ab747fSPaolo Bonzini     DBDMAState *s = opaque;
85749ab747fSPaolo Bonzini     int i;
85849ab747fSPaolo Bonzini 
85949ab747fSPaolo Bonzini     for (i = 0; i < DBDMA_CHANNELS; i++)
86049ab747fSPaolo Bonzini         memset(s->channels[i].regs, 0, DBDMA_SIZE);
86149ab747fSPaolo Bonzini }
86249ab747fSPaolo Bonzini 
8632d7d06d8SHervé Poussineau static void dbdma_unassigned_rw(DBDMA_io *io)
8642d7d06d8SHervé Poussineau {
8652d7d06d8SHervé Poussineau     DBDMA_channel *ch = io->channel;
866*77453882SBenjamin Herrenschmidt     dbdma_cmd *current = &ch->current;
867*77453882SBenjamin Herrenschmidt     uint16_t cmd;
8682d7d06d8SHervé Poussineau     qemu_log_mask(LOG_GUEST_ERROR, "%s: use of unassigned channel %d\n",
8692d7d06d8SHervé Poussineau                   __func__, ch->channel);
8702df77896SMark Cave-Ayland     ch->io.processing = false;
871*77453882SBenjamin Herrenschmidt 
872*77453882SBenjamin Herrenschmidt     cmd = le16_to_cpu(current->command) & COMMAND_MASK;
873*77453882SBenjamin Herrenschmidt     if (cmd == OUTPUT_MORE || cmd == OUTPUT_LAST ||
874*77453882SBenjamin Herrenschmidt         cmd == INPUT_MORE || cmd == INPUT_LAST) {
875*77453882SBenjamin Herrenschmidt         current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]);
876*77453882SBenjamin Herrenschmidt         current->res_count = cpu_to_le16(io->len);
877*77453882SBenjamin Herrenschmidt         dbdma_cmdptr_save(ch);
878*77453882SBenjamin Herrenschmidt     }
8792d7d06d8SHervé Poussineau }
8802d7d06d8SHervé Poussineau 
8812d7d06d8SHervé Poussineau static void dbdma_unassigned_flush(DBDMA_io *io)
8822d7d06d8SHervé Poussineau {
8832d7d06d8SHervé Poussineau     DBDMA_channel *ch = io->channel;
8842d7d06d8SHervé Poussineau     qemu_log_mask(LOG_GUEST_ERROR, "%s: use of unassigned channel %d\n",
8852d7d06d8SHervé Poussineau                   __func__, ch->channel);
8862d7d06d8SHervé Poussineau }
8872d7d06d8SHervé Poussineau 
88849ab747fSPaolo Bonzini void* DBDMA_init (MemoryRegion **dbdma_mem)
88949ab747fSPaolo Bonzini {
89049ab747fSPaolo Bonzini     DBDMAState *s;
8913e300fa6SAlexander Graf     int i;
89249ab747fSPaolo Bonzini 
89349ab747fSPaolo Bonzini     s = g_malloc0(sizeof(DBDMAState));
89449ab747fSPaolo Bonzini 
8953e300fa6SAlexander Graf     for (i = 0; i < DBDMA_CHANNELS; i++) {
8963e300fa6SAlexander Graf         DBDMA_io *io = &s->channels[i].io;
8972d7d06d8SHervé Poussineau         DBDMA_channel *ch = &s->channels[i];
8983e300fa6SAlexander Graf         qemu_iovec_init(&io->iov, 1);
8992d7d06d8SHervé Poussineau 
9002d7d06d8SHervé Poussineau         ch->rw = dbdma_unassigned_rw;
9012d7d06d8SHervé Poussineau         ch->flush = dbdma_unassigned_flush;
9022d7d06d8SHervé Poussineau         ch->channel = i;
9032d7d06d8SHervé Poussineau         ch->io.channel = ch;
9043e300fa6SAlexander Graf     }
9053e300fa6SAlexander Graf 
9062c9b15caSPaolo Bonzini     memory_region_init_io(&s->mem, NULL, &dbdma_ops, s, "dbdma", 0x1000);
90749ab747fSPaolo Bonzini     *dbdma_mem = &s->mem;
90849ab747fSPaolo Bonzini     vmstate_register(NULL, -1, &vmstate_dbdma, s);
90949ab747fSPaolo Bonzini     qemu_register_reset(dbdma_reset, s);
91049ab747fSPaolo Bonzini 
911d2f0ce21SAlexander Graf     s->bh = qemu_bh_new(DBDMA_run_bh, s);
91249ab747fSPaolo Bonzini 
91349ab747fSPaolo Bonzini     return s;
91449ab747fSPaolo Bonzini }
915