xref: /qemu/hw/misc/macio/mac_dbdma.c (revision d6454270575da1f16a8923c7cb240e46ef243f72)
13cbee15bSj_mayer /*
23cbee15bSj_mayer  * PowerMac descriptor-based DMA emulation
33cbee15bSj_mayer  *
43cbee15bSj_mayer  * Copyright (c) 2005-2007 Fabrice Bellard
53cbee15bSj_mayer  * Copyright (c) 2007 Jocelyn Mayer
628ce5ce6Saurel32  * Copyright (c) 2009 Laurent Vivier
728ce5ce6Saurel32  *
828ce5ce6Saurel32  * some parts from linux-2.6.28, arch/powerpc/include/asm/dbdma.h
928ce5ce6Saurel32  *
1028ce5ce6Saurel32  *   Definitions for using the Apple Descriptor-Based DMA controller
1128ce5ce6Saurel32  *   in Power Macintosh computers.
1228ce5ce6Saurel32  *
1328ce5ce6Saurel32  *   Copyright (C) 1996 Paul Mackerras.
1428ce5ce6Saurel32  *
1528ce5ce6Saurel32  * some parts from mol 0.9.71
1628ce5ce6Saurel32  *
1728ce5ce6Saurel32  *   Descriptor based DMA emulation
1828ce5ce6Saurel32  *
1928ce5ce6Saurel32  *   Copyright (C) 1998-2004 Samuel Rydh (samuel@ibrium.se)
203cbee15bSj_mayer  *
213cbee15bSj_mayer  * Permission is hereby granted, free of charge, to any person obtaining a copy
223cbee15bSj_mayer  * of this software and associated documentation files (the "Software"), to deal
233cbee15bSj_mayer  * in the Software without restriction, including without limitation the rights
243cbee15bSj_mayer  * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
253cbee15bSj_mayer  * copies of the Software, and to permit persons to whom the Software is
263cbee15bSj_mayer  * furnished to do so, subject to the following conditions:
273cbee15bSj_mayer  *
283cbee15bSj_mayer  * The above copyright notice and this permission notice shall be included in
293cbee15bSj_mayer  * all copies or substantial portions of the Software.
303cbee15bSj_mayer  *
313cbee15bSj_mayer  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
323cbee15bSj_mayer  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
333cbee15bSj_mayer  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
343cbee15bSj_mayer  * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
353cbee15bSj_mayer  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
363cbee15bSj_mayer  * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
373cbee15bSj_mayer  * THE SOFTWARE.
383cbee15bSj_mayer  */
390b8fa32fSMarkus Armbruster 
400d75590dSPeter Maydell #include "qemu/osdep.h"
4183c9f4caSPaolo Bonzini #include "hw/hw.h"
4264552b6bSMarkus Armbruster #include "hw/irq.h"
430d09e41aSPaolo Bonzini #include "hw/ppc/mac_dbdma.h"
44*d6454270SMarkus Armbruster #include "migration/vmstate.h"
451de7afc9SPaolo Bonzini #include "qemu/main-loop.h"
460b8fa32fSMarkus Armbruster #include "qemu/module.h"
4703dd024fSPaolo Bonzini #include "qemu/log.h"
4888655881SMark Cave-Ayland #include "sysemu/dma.h"
493cbee15bSj_mayer 
50ea026b2fSblueswir1 /* debug DBDMA */
51ba0b17ddSMark Cave-Ayland #define DEBUG_DBDMA 0
523e49c439SMark Cave-Ayland #define DEBUG_DBDMA_CHANMASK ((1ull << DBDMA_CHANNELS) - 1)
53ea026b2fSblueswir1 
54ba0b17ddSMark Cave-Ayland #define DBDMA_DPRINTF(fmt, ...) do { \
55ba0b17ddSMark Cave-Ayland     if (DEBUG_DBDMA) { \
56ba0b17ddSMark Cave-Ayland         printf("DBDMA: " fmt , ## __VA_ARGS__); \
57ba0b17ddSMark Cave-Ayland     } \
582562755eSEric Blake } while (0)
59ea026b2fSblueswir1 
603e49c439SMark Cave-Ayland #define DBDMA_DPRINTFCH(ch, fmt, ...) do { \
613e49c439SMark Cave-Ayland     if (DEBUG_DBDMA) { \
623e49c439SMark Cave-Ayland         if ((1ul << (ch)->channel) & DEBUG_DBDMA_CHANMASK) { \
633e49c439SMark Cave-Ayland             printf("DBDMA[%02x]: " fmt , (ch)->channel, ## __VA_ARGS__); \
643e49c439SMark Cave-Ayland         } \
653e49c439SMark Cave-Ayland     } \
662562755eSEric Blake } while (0)
673e49c439SMark Cave-Ayland 
6828ce5ce6Saurel32 /*
6928ce5ce6Saurel32  */
703cbee15bSj_mayer 
71d2f0ce21SAlexander Graf static DBDMAState *dbdma_from_ch(DBDMA_channel *ch)
72d2f0ce21SAlexander Graf {
73d2f0ce21SAlexander Graf     return container_of(ch, DBDMAState, channels[ch->channel]);
74d2f0ce21SAlexander Graf }
75d2f0ce21SAlexander Graf 
76ba0b17ddSMark Cave-Ayland #if DEBUG_DBDMA
77b7d67813SMark Cave-Ayland static void dump_dbdma_cmd(DBDMA_channel *ch, dbdma_cmd *cmd)
783cbee15bSj_mayer {
79b7d67813SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "dbdma_cmd %p\n", cmd);
80b7d67813SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "    req_count 0x%04x\n", le16_to_cpu(cmd->req_count));
81b7d67813SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "    command 0x%04x\n", le16_to_cpu(cmd->command));
82b7d67813SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "    phy_addr 0x%08x\n", le32_to_cpu(cmd->phy_addr));
83b7d67813SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "    cmd_dep 0x%08x\n", le32_to_cpu(cmd->cmd_dep));
84b7d67813SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "    res_count 0x%04x\n", le16_to_cpu(cmd->res_count));
85b7d67813SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "    xfer_status 0x%04x\n",
86b7d67813SMark Cave-Ayland                     le16_to_cpu(cmd->xfer_status));
8728ce5ce6Saurel32 }
8828ce5ce6Saurel32 #else
89b7d67813SMark Cave-Ayland static void dump_dbdma_cmd(DBDMA_channel *ch, dbdma_cmd *cmd)
9028ce5ce6Saurel32 {
9128ce5ce6Saurel32 }
9228ce5ce6Saurel32 #endif
9328ce5ce6Saurel32 static void dbdma_cmdptr_load(DBDMA_channel *ch)
9428ce5ce6Saurel32 {
953e49c439SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "dbdma_cmdptr_load 0x%08x\n",
96ad674e53SAurelien Jarno                     ch->regs[DBDMA_CMDPTR_LO]);
9788655881SMark Cave-Ayland     dma_memory_read(&address_space_memory, ch->regs[DBDMA_CMDPTR_LO],
98e1fe50dcSStefan Weil                     &ch->current, sizeof(dbdma_cmd));
993cbee15bSj_mayer }
1003cbee15bSj_mayer 
10128ce5ce6Saurel32 static void dbdma_cmdptr_save(DBDMA_channel *ch)
1023cbee15bSj_mayer {
10377453882SBenjamin Herrenschmidt     DBDMA_DPRINTFCH(ch, "-> update 0x%08x stat=0x%08x, res=0x%04x\n",
10477453882SBenjamin Herrenschmidt                     ch->regs[DBDMA_CMDPTR_LO],
10528ce5ce6Saurel32                     le16_to_cpu(ch->current.xfer_status),
10628ce5ce6Saurel32                     le16_to_cpu(ch->current.res_count));
10788655881SMark Cave-Ayland     dma_memory_write(&address_space_memory, ch->regs[DBDMA_CMDPTR_LO],
108e1fe50dcSStefan Weil                      &ch->current, sizeof(dbdma_cmd));
10928ce5ce6Saurel32 }
11028ce5ce6Saurel32 
11128ce5ce6Saurel32 static void kill_channel(DBDMA_channel *ch)
11228ce5ce6Saurel32 {
1133e49c439SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "kill_channel\n");
11428ce5ce6Saurel32 
115ad674e53SAurelien Jarno     ch->regs[DBDMA_STATUS] |= DEAD;
116ad674e53SAurelien Jarno     ch->regs[DBDMA_STATUS] &= ~ACTIVE;
11728ce5ce6Saurel32 
11828ce5ce6Saurel32     qemu_irq_raise(ch->irq);
11928ce5ce6Saurel32 }
12028ce5ce6Saurel32 
12128ce5ce6Saurel32 static void conditional_interrupt(DBDMA_channel *ch)
12228ce5ce6Saurel32 {
12328ce5ce6Saurel32     dbdma_cmd *current = &ch->current;
12428ce5ce6Saurel32     uint16_t intr;
12528ce5ce6Saurel32     uint16_t sel_mask, sel_value;
12628ce5ce6Saurel32     uint32_t status;
12728ce5ce6Saurel32     int cond;
12828ce5ce6Saurel32 
1293e49c439SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "%s\n", __func__);
13028ce5ce6Saurel32 
131b42ec42dSaurel32     intr = le16_to_cpu(current->command) & INTR_MASK;
13228ce5ce6Saurel32 
13328ce5ce6Saurel32     switch(intr) {
13428ce5ce6Saurel32     case INTR_NEVER:  /* don't interrupt */
13528ce5ce6Saurel32         return;
13628ce5ce6Saurel32     case INTR_ALWAYS: /* always interrupt */
13728ce5ce6Saurel32         qemu_irq_raise(ch->irq);
1383e49c439SMark Cave-Ayland         DBDMA_DPRINTFCH(ch, "%s: raise\n", __func__);
13928ce5ce6Saurel32         return;
14028ce5ce6Saurel32     }
14128ce5ce6Saurel32 
142ad674e53SAurelien Jarno     status = ch->regs[DBDMA_STATUS] & DEVSTAT;
14328ce5ce6Saurel32 
144ad674e53SAurelien Jarno     sel_mask = (ch->regs[DBDMA_INTR_SEL] >> 16) & 0x0f;
145ad674e53SAurelien Jarno     sel_value = ch->regs[DBDMA_INTR_SEL] & 0x0f;
14628ce5ce6Saurel32 
14728ce5ce6Saurel32     cond = (status & sel_mask) == (sel_value & sel_mask);
14828ce5ce6Saurel32 
14928ce5ce6Saurel32     switch(intr) {
15028ce5ce6Saurel32     case INTR_IFSET:  /* intr if condition bit is 1 */
15133ce36bbSAlexander Graf         if (cond) {
15228ce5ce6Saurel32             qemu_irq_raise(ch->irq);
1533e49c439SMark Cave-Ayland             DBDMA_DPRINTFCH(ch, "%s: raise\n", __func__);
15433ce36bbSAlexander Graf         }
15528ce5ce6Saurel32         return;
15628ce5ce6Saurel32     case INTR_IFCLR:  /* intr if condition bit is 0 */
15733ce36bbSAlexander Graf         if (!cond) {
15828ce5ce6Saurel32             qemu_irq_raise(ch->irq);
1593e49c439SMark Cave-Ayland             DBDMA_DPRINTFCH(ch, "%s: raise\n", __func__);
16033ce36bbSAlexander Graf         }
16128ce5ce6Saurel32         return;
16228ce5ce6Saurel32     }
16328ce5ce6Saurel32 }
16428ce5ce6Saurel32 
16528ce5ce6Saurel32 static int conditional_wait(DBDMA_channel *ch)
16628ce5ce6Saurel32 {
16728ce5ce6Saurel32     dbdma_cmd *current = &ch->current;
16828ce5ce6Saurel32     uint16_t wait;
16928ce5ce6Saurel32     uint16_t sel_mask, sel_value;
17028ce5ce6Saurel32     uint32_t status;
17128ce5ce6Saurel32     int cond;
17277453882SBenjamin Herrenschmidt     int res = 0;
17328ce5ce6Saurel32 
174b42ec42dSaurel32     wait = le16_to_cpu(current->command) & WAIT_MASK;
17528ce5ce6Saurel32     switch(wait) {
17628ce5ce6Saurel32     case WAIT_NEVER:  /* don't wait */
17728ce5ce6Saurel32         return 0;
17828ce5ce6Saurel32     case WAIT_ALWAYS: /* always wait */
17977453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, "  [WAIT_ALWAYS]\n");
18028ce5ce6Saurel32         return 1;
18128ce5ce6Saurel32     }
18228ce5ce6Saurel32 
183ad674e53SAurelien Jarno     status = ch->regs[DBDMA_STATUS] & DEVSTAT;
18428ce5ce6Saurel32 
185ad674e53SAurelien Jarno     sel_mask = (ch->regs[DBDMA_WAIT_SEL] >> 16) & 0x0f;
186ad674e53SAurelien Jarno     sel_value = ch->regs[DBDMA_WAIT_SEL] & 0x0f;
18728ce5ce6Saurel32 
18828ce5ce6Saurel32     cond = (status & sel_mask) == (sel_value & sel_mask);
18928ce5ce6Saurel32 
19028ce5ce6Saurel32     switch(wait) {
19128ce5ce6Saurel32     case WAIT_IFSET:  /* wait if condition bit is 1 */
19277453882SBenjamin Herrenschmidt         if (cond) {
19377453882SBenjamin Herrenschmidt             res = 1;
19428ce5ce6Saurel32         }
19577453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, "  [WAIT_IFSET=%d]\n", res);
19677453882SBenjamin Herrenschmidt         break;
19777453882SBenjamin Herrenschmidt     case WAIT_IFCLR:  /* wait if condition bit is 0 */
19877453882SBenjamin Herrenschmidt         if (!cond) {
19977453882SBenjamin Herrenschmidt             res = 1;
20077453882SBenjamin Herrenschmidt         }
20177453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, "  [WAIT_IFCLR=%d]\n", res);
20277453882SBenjamin Herrenschmidt         break;
20377453882SBenjamin Herrenschmidt     }
20477453882SBenjamin Herrenschmidt     return res;
20528ce5ce6Saurel32 }
20628ce5ce6Saurel32 
20728ce5ce6Saurel32 static void next(DBDMA_channel *ch)
20828ce5ce6Saurel32 {
20928ce5ce6Saurel32     uint32_t cp;
21028ce5ce6Saurel32 
211ad674e53SAurelien Jarno     ch->regs[DBDMA_STATUS] &= ~BT;
21228ce5ce6Saurel32 
213ad674e53SAurelien Jarno     cp = ch->regs[DBDMA_CMDPTR_LO];
214ad674e53SAurelien Jarno     ch->regs[DBDMA_CMDPTR_LO] = cp + sizeof(dbdma_cmd);
21528ce5ce6Saurel32     dbdma_cmdptr_load(ch);
21628ce5ce6Saurel32 }
21728ce5ce6Saurel32 
21828ce5ce6Saurel32 static void branch(DBDMA_channel *ch)
21928ce5ce6Saurel32 {
22028ce5ce6Saurel32     dbdma_cmd *current = &ch->current;
22128ce5ce6Saurel32 
2223f0d4128SMark Cave-Ayland     ch->regs[DBDMA_CMDPTR_LO] = le32_to_cpu(current->cmd_dep);
223ad674e53SAurelien Jarno     ch->regs[DBDMA_STATUS] |= BT;
22428ce5ce6Saurel32     dbdma_cmdptr_load(ch);
22528ce5ce6Saurel32 }
22628ce5ce6Saurel32 
22728ce5ce6Saurel32 static void conditional_branch(DBDMA_channel *ch)
22828ce5ce6Saurel32 {
22928ce5ce6Saurel32     dbdma_cmd *current = &ch->current;
23028ce5ce6Saurel32     uint16_t br;
23128ce5ce6Saurel32     uint16_t sel_mask, sel_value;
23228ce5ce6Saurel32     uint32_t status;
23328ce5ce6Saurel32     int cond;
23428ce5ce6Saurel32 
23528ce5ce6Saurel32     /* check if we must branch */
23628ce5ce6Saurel32 
237b42ec42dSaurel32     br = le16_to_cpu(current->command) & BR_MASK;
23828ce5ce6Saurel32 
23928ce5ce6Saurel32     switch(br) {
24028ce5ce6Saurel32     case BR_NEVER:  /* don't branch */
24128ce5ce6Saurel32         next(ch);
24228ce5ce6Saurel32         return;
24328ce5ce6Saurel32     case BR_ALWAYS: /* always branch */
24477453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, "  [BR_ALWAYS]\n");
24528ce5ce6Saurel32         branch(ch);
24628ce5ce6Saurel32         return;
24728ce5ce6Saurel32     }
24828ce5ce6Saurel32 
249ad674e53SAurelien Jarno     status = ch->regs[DBDMA_STATUS] & DEVSTAT;
25028ce5ce6Saurel32 
251ad674e53SAurelien Jarno     sel_mask = (ch->regs[DBDMA_BRANCH_SEL] >> 16) & 0x0f;
252ad674e53SAurelien Jarno     sel_value = ch->regs[DBDMA_BRANCH_SEL] & 0x0f;
25328ce5ce6Saurel32 
25428ce5ce6Saurel32     cond = (status & sel_mask) == (sel_value & sel_mask);
25528ce5ce6Saurel32 
25628ce5ce6Saurel32     switch(br) {
25728ce5ce6Saurel32     case BR_IFSET:  /* branch if condition bit is 1 */
25877453882SBenjamin Herrenschmidt         if (cond) {
25977453882SBenjamin Herrenschmidt             DBDMA_DPRINTFCH(ch, "  [BR_IFSET = 1]\n");
26028ce5ce6Saurel32             branch(ch);
26177453882SBenjamin Herrenschmidt         } else {
26277453882SBenjamin Herrenschmidt             DBDMA_DPRINTFCH(ch, "  [BR_IFSET = 0]\n");
26328ce5ce6Saurel32             next(ch);
26477453882SBenjamin Herrenschmidt         }
26528ce5ce6Saurel32         return;
26628ce5ce6Saurel32     case BR_IFCLR:  /* branch if condition bit is 0 */
26777453882SBenjamin Herrenschmidt         if (!cond) {
26877453882SBenjamin Herrenschmidt             DBDMA_DPRINTFCH(ch, "  [BR_IFCLR = 1]\n");
26928ce5ce6Saurel32             branch(ch);
27077453882SBenjamin Herrenschmidt         } else {
27177453882SBenjamin Herrenschmidt             DBDMA_DPRINTFCH(ch, "  [BR_IFCLR = 0]\n");
27228ce5ce6Saurel32             next(ch);
27377453882SBenjamin Herrenschmidt         }
27428ce5ce6Saurel32         return;
27528ce5ce6Saurel32     }
27628ce5ce6Saurel32 }
27728ce5ce6Saurel32 
278b42ec42dSaurel32 static void channel_run(DBDMA_channel *ch);
279b42ec42dSaurel32 
280b42ec42dSaurel32 static void dbdma_end(DBDMA_io *io)
28128ce5ce6Saurel32 {
28228ce5ce6Saurel32     DBDMA_channel *ch = io->channel;
28328ce5ce6Saurel32     dbdma_cmd *current = &ch->current;
28428ce5ce6Saurel32 
2853e49c439SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "%s\n", __func__);
28633ce36bbSAlexander Graf 
287b42ec42dSaurel32     if (conditional_wait(ch))
288b42ec42dSaurel32         goto wait;
28928ce5ce6Saurel32 
290ad674e53SAurelien Jarno     current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]);
291ad674e53SAurelien Jarno     current->res_count = cpu_to_le16(io->len);
292b42ec42dSaurel32     dbdma_cmdptr_save(ch);
293862c9280Saurel32     if (io->is_last)
294ad674e53SAurelien Jarno         ch->regs[DBDMA_STATUS] &= ~FLUSH;
29528ce5ce6Saurel32 
296b42ec42dSaurel32     conditional_interrupt(ch);
297b42ec42dSaurel32     conditional_branch(ch);
298b42ec42dSaurel32 
299b42ec42dSaurel32 wait:
30003ee3b1eSAlexander Graf     /* Indicate that we're ready for a new DMA round */
30103ee3b1eSAlexander Graf     ch->io.processing = false;
30203ee3b1eSAlexander Graf 
303ad674e53SAurelien Jarno     if ((ch->regs[DBDMA_STATUS] & RUN) &&
304ad674e53SAurelien Jarno         (ch->regs[DBDMA_STATUS] & ACTIVE))
305b42ec42dSaurel32         channel_run(ch);
30628ce5ce6Saurel32 }
30728ce5ce6Saurel32 
308b42ec42dSaurel32 static void start_output(DBDMA_channel *ch, int key, uint32_t addr,
30928ce5ce6Saurel32                         uint16_t req_count, int is_last)
31028ce5ce6Saurel32 {
3113e49c439SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "start_output\n");
31228ce5ce6Saurel32 
31328ce5ce6Saurel32     /* KEY_REGS, KEY_DEVICE and KEY_STREAM
31428ce5ce6Saurel32      * are not implemented in the mac-io chip
31528ce5ce6Saurel32      */
31628ce5ce6Saurel32 
3173e49c439SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "addr 0x%x key 0x%x\n", addr, key);
31828ce5ce6Saurel32     if (!addr || key > KEY_STREAM3) {
31928ce5ce6Saurel32         kill_channel(ch);
320b42ec42dSaurel32         return;
32128ce5ce6Saurel32     }
32228ce5ce6Saurel32 
323b42ec42dSaurel32     ch->io.addr = addr;
32428ce5ce6Saurel32     ch->io.len = req_count;
32528ce5ce6Saurel32     ch->io.is_last = is_last;
326b42ec42dSaurel32     ch->io.dma_end = dbdma_end;
327b42ec42dSaurel32     ch->io.is_dma_out = 1;
32803ee3b1eSAlexander Graf     ch->io.processing = true;
329a9ceb76dSAlexander Graf     if (ch->rw) {
330b42ec42dSaurel32         ch->rw(&ch->io);
33128ce5ce6Saurel32     }
332a9ceb76dSAlexander Graf }
33328ce5ce6Saurel32 
334b42ec42dSaurel32 static void start_input(DBDMA_channel *ch, int key, uint32_t addr,
33528ce5ce6Saurel32                        uint16_t req_count, int is_last)
33628ce5ce6Saurel32 {
3373e49c439SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "start_input\n");
33828ce5ce6Saurel32 
33928ce5ce6Saurel32     /* KEY_REGS, KEY_DEVICE and KEY_STREAM
34028ce5ce6Saurel32      * are not implemented in the mac-io chip
34128ce5ce6Saurel32      */
34228ce5ce6Saurel32 
3433e49c439SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "addr 0x%x key 0x%x\n", addr, key);
34428ce5ce6Saurel32     if (!addr || key > KEY_STREAM3) {
34528ce5ce6Saurel32         kill_channel(ch);
346b42ec42dSaurel32         return;
34728ce5ce6Saurel32     }
34828ce5ce6Saurel32 
349b42ec42dSaurel32     ch->io.addr = addr;
35028ce5ce6Saurel32     ch->io.len = req_count;
35128ce5ce6Saurel32     ch->io.is_last = is_last;
352b42ec42dSaurel32     ch->io.dma_end = dbdma_end;
353b42ec42dSaurel32     ch->io.is_dma_out = 0;
35403ee3b1eSAlexander Graf     ch->io.processing = true;
355a9ceb76dSAlexander Graf     if (ch->rw) {
356b42ec42dSaurel32         ch->rw(&ch->io);
35728ce5ce6Saurel32     }
358a9ceb76dSAlexander Graf }
35928ce5ce6Saurel32 
360b42ec42dSaurel32 static void load_word(DBDMA_channel *ch, int key, uint32_t addr,
36128ce5ce6Saurel32                      uint16_t len)
36228ce5ce6Saurel32 {
36328ce5ce6Saurel32     dbdma_cmd *current = &ch->current;
36428ce5ce6Saurel32 
365e12f50b9SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "load_word %d bytes, addr=%08x\n", len, addr);
36628ce5ce6Saurel32 
36728ce5ce6Saurel32     /* only implements KEY_SYSTEM */
36828ce5ce6Saurel32 
36928ce5ce6Saurel32     if (key != KEY_SYSTEM) {
37028ce5ce6Saurel32         printf("DBDMA: LOAD_WORD, unimplemented key %x\n", key);
37128ce5ce6Saurel32         kill_channel(ch);
372b42ec42dSaurel32         return;
37328ce5ce6Saurel32     }
37428ce5ce6Saurel32 
375e12f50b9SMark Cave-Ayland     dma_memory_read(&address_space_memory, addr, &current->cmd_dep, len);
37628ce5ce6Saurel32 
37728ce5ce6Saurel32     if (conditional_wait(ch))
378b42ec42dSaurel32         goto wait;
37928ce5ce6Saurel32 
380ad674e53SAurelien Jarno     current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]);
38128ce5ce6Saurel32     dbdma_cmdptr_save(ch);
382ad674e53SAurelien Jarno     ch->regs[DBDMA_STATUS] &= ~FLUSH;
38328ce5ce6Saurel32 
38428ce5ce6Saurel32     conditional_interrupt(ch);
38528ce5ce6Saurel32     next(ch);
38628ce5ce6Saurel32 
387b42ec42dSaurel32 wait:
388d2f0ce21SAlexander Graf     DBDMA_kick(dbdma_from_ch(ch));
38928ce5ce6Saurel32 }
39028ce5ce6Saurel32 
391b42ec42dSaurel32 static void store_word(DBDMA_channel *ch, int key, uint32_t addr,
39228ce5ce6Saurel32                       uint16_t len)
39328ce5ce6Saurel32 {
39428ce5ce6Saurel32     dbdma_cmd *current = &ch->current;
39528ce5ce6Saurel32 
396e12f50b9SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "store_word %d bytes, addr=%08x pa=%x\n",
397e12f50b9SMark Cave-Ayland                     len, addr, le32_to_cpu(current->cmd_dep));
39828ce5ce6Saurel32 
39928ce5ce6Saurel32     /* only implements KEY_SYSTEM */
40028ce5ce6Saurel32 
40128ce5ce6Saurel32     if (key != KEY_SYSTEM) {
40228ce5ce6Saurel32         printf("DBDMA: STORE_WORD, unimplemented key %x\n", key);
40328ce5ce6Saurel32         kill_channel(ch);
404b42ec42dSaurel32         return;
40528ce5ce6Saurel32     }
40628ce5ce6Saurel32 
407e12f50b9SMark Cave-Ayland     dma_memory_write(&address_space_memory, addr, &current->cmd_dep, len);
40828ce5ce6Saurel32 
40928ce5ce6Saurel32     if (conditional_wait(ch))
410b42ec42dSaurel32         goto wait;
41128ce5ce6Saurel32 
412ad674e53SAurelien Jarno     current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]);
41328ce5ce6Saurel32     dbdma_cmdptr_save(ch);
414ad674e53SAurelien Jarno     ch->regs[DBDMA_STATUS] &= ~FLUSH;
41528ce5ce6Saurel32 
41628ce5ce6Saurel32     conditional_interrupt(ch);
41728ce5ce6Saurel32     next(ch);
41828ce5ce6Saurel32 
419b42ec42dSaurel32 wait:
420d2f0ce21SAlexander Graf     DBDMA_kick(dbdma_from_ch(ch));
42128ce5ce6Saurel32 }
42228ce5ce6Saurel32 
423b42ec42dSaurel32 static void nop(DBDMA_channel *ch)
42428ce5ce6Saurel32 {
42528ce5ce6Saurel32     dbdma_cmd *current = &ch->current;
42628ce5ce6Saurel32 
42728ce5ce6Saurel32     if (conditional_wait(ch))
428b42ec42dSaurel32         goto wait;
42928ce5ce6Saurel32 
430ad674e53SAurelien Jarno     current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]);
43128ce5ce6Saurel32     dbdma_cmdptr_save(ch);
43228ce5ce6Saurel32 
43328ce5ce6Saurel32     conditional_interrupt(ch);
43428ce5ce6Saurel32     conditional_branch(ch);
43528ce5ce6Saurel32 
436b42ec42dSaurel32 wait:
437d2f0ce21SAlexander Graf     DBDMA_kick(dbdma_from_ch(ch));
43828ce5ce6Saurel32 }
43928ce5ce6Saurel32 
440b42ec42dSaurel32 static void stop(DBDMA_channel *ch)
44128ce5ce6Saurel32 {
44277453882SBenjamin Herrenschmidt     ch->regs[DBDMA_STATUS] &= ~(ACTIVE);
44328ce5ce6Saurel32 
44428ce5ce6Saurel32     /* the stop command does not increment command pointer */
44528ce5ce6Saurel32 }
44628ce5ce6Saurel32 
447b42ec42dSaurel32 static void channel_run(DBDMA_channel *ch)
44828ce5ce6Saurel32 {
44928ce5ce6Saurel32     dbdma_cmd *current = &ch->current;
45028ce5ce6Saurel32     uint16_t cmd, key;
45128ce5ce6Saurel32     uint16_t req_count;
45228ce5ce6Saurel32     uint32_t phy_addr;
45328ce5ce6Saurel32 
4543e49c439SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "channel_run\n");
455b7d67813SMark Cave-Ayland     dump_dbdma_cmd(ch, current);
45628ce5ce6Saurel32 
45728ce5ce6Saurel32     /* clear WAKE flag at command fetch */
45828ce5ce6Saurel32 
459ad674e53SAurelien Jarno     ch->regs[DBDMA_STATUS] &= ~WAKE;
46028ce5ce6Saurel32 
46128ce5ce6Saurel32     cmd = le16_to_cpu(current->command) & COMMAND_MASK;
46228ce5ce6Saurel32 
46328ce5ce6Saurel32     switch (cmd) {
46428ce5ce6Saurel32     case DBDMA_NOP:
465b42ec42dSaurel32         nop(ch);
466b42ec42dSaurel32         return;
46728ce5ce6Saurel32 
46828ce5ce6Saurel32     case DBDMA_STOP:
469b42ec42dSaurel32         stop(ch);
470b42ec42dSaurel32         return;
47128ce5ce6Saurel32     }
47228ce5ce6Saurel32 
47328ce5ce6Saurel32     key = le16_to_cpu(current->command) & 0x0700;
47428ce5ce6Saurel32     req_count = le16_to_cpu(current->req_count);
47528ce5ce6Saurel32     phy_addr = le32_to_cpu(current->phy_addr);
47628ce5ce6Saurel32 
47728ce5ce6Saurel32     if (key == KEY_STREAM4) {
47828ce5ce6Saurel32         printf("command %x, invalid key 4\n", cmd);
47928ce5ce6Saurel32         kill_channel(ch);
480b42ec42dSaurel32         return;
48128ce5ce6Saurel32     }
48228ce5ce6Saurel32 
48328ce5ce6Saurel32     switch (cmd) {
48428ce5ce6Saurel32     case OUTPUT_MORE:
48577453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, "* OUTPUT_MORE *\n");
486b42ec42dSaurel32         start_output(ch, key, phy_addr, req_count, 0);
487b42ec42dSaurel32         return;
48828ce5ce6Saurel32 
48928ce5ce6Saurel32     case OUTPUT_LAST:
49077453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, "* OUTPUT_LAST *\n");
491b42ec42dSaurel32         start_output(ch, key, phy_addr, req_count, 1);
492b42ec42dSaurel32         return;
49328ce5ce6Saurel32 
49428ce5ce6Saurel32     case INPUT_MORE:
49577453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, "* INPUT_MORE *\n");
496b42ec42dSaurel32         start_input(ch, key, phy_addr, req_count, 0);
497b42ec42dSaurel32         return;
49828ce5ce6Saurel32 
49928ce5ce6Saurel32     case INPUT_LAST:
50077453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, "* INPUT_LAST *\n");
501b42ec42dSaurel32         start_input(ch, key, phy_addr, req_count, 1);
502b42ec42dSaurel32         return;
50328ce5ce6Saurel32     }
50428ce5ce6Saurel32 
50528ce5ce6Saurel32     if (key < KEY_REGS) {
50628ce5ce6Saurel32         printf("command %x, invalid key %x\n", cmd, key);
50728ce5ce6Saurel32         key = KEY_SYSTEM;
50828ce5ce6Saurel32     }
50928ce5ce6Saurel32 
51028ce5ce6Saurel32     /* for LOAD_WORD and STORE_WORD, req_count is on 3 bits
51128ce5ce6Saurel32      * and BRANCH is invalid
51228ce5ce6Saurel32      */
51328ce5ce6Saurel32 
51428ce5ce6Saurel32     req_count = req_count & 0x0007;
51528ce5ce6Saurel32     if (req_count & 0x4) {
51628ce5ce6Saurel32         req_count = 4;
51728ce5ce6Saurel32         phy_addr &= ~3;
51828ce5ce6Saurel32     } else if (req_count & 0x2) {
51928ce5ce6Saurel32         req_count = 2;
52028ce5ce6Saurel32         phy_addr &= ~1;
52128ce5ce6Saurel32     } else
52228ce5ce6Saurel32         req_count = 1;
52328ce5ce6Saurel32 
52428ce5ce6Saurel32     switch (cmd) {
52528ce5ce6Saurel32     case LOAD_WORD:
52677453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, "* LOAD_WORD *\n");
527b42ec42dSaurel32         load_word(ch, key, phy_addr, req_count);
528b42ec42dSaurel32         return;
52928ce5ce6Saurel32 
53028ce5ce6Saurel32     case STORE_WORD:
53177453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, "* STORE_WORD *\n");
532b42ec42dSaurel32         store_word(ch, key, phy_addr, req_count);
533b42ec42dSaurel32         return;
53428ce5ce6Saurel32     }
53528ce5ce6Saurel32 }
53628ce5ce6Saurel32 
537c20df14bSJuan Quintela static void DBDMA_run(DBDMAState *s)
53828ce5ce6Saurel32 {
53928ce5ce6Saurel32     int channel;
54028ce5ce6Saurel32 
541c20df14bSJuan Quintela     for (channel = 0; channel < DBDMA_CHANNELS; channel++) {
542c20df14bSJuan Quintela         DBDMA_channel *ch = &s->channels[channel];
543ad674e53SAurelien Jarno         uint32_t status = ch->regs[DBDMA_STATUS];
54403ee3b1eSAlexander Graf         if (!ch->io.processing && (status & RUN) && (status & ACTIVE)) {
545b42ec42dSaurel32             channel_run(ch);
54628ce5ce6Saurel32         }
54728ce5ce6Saurel32     }
548c20df14bSJuan Quintela }
54928ce5ce6Saurel32 
55028ce5ce6Saurel32 static void DBDMA_run_bh(void *opaque)
55128ce5ce6Saurel32 {
552c20df14bSJuan Quintela     DBDMAState *s = opaque;
55328ce5ce6Saurel32 
5543e49c439SMark Cave-Ayland     DBDMA_DPRINTF("-> DBDMA_run_bh\n");
555c20df14bSJuan Quintela     DBDMA_run(s);
5563e49c439SMark Cave-Ayland     DBDMA_DPRINTF("<- DBDMA_run_bh\n");
55728ce5ce6Saurel32 }
55828ce5ce6Saurel32 
559d1e562deSAlexander Graf void DBDMA_kick(DBDMAState *dbdma)
560d1e562deSAlexander Graf {
561d2f0ce21SAlexander Graf     qemu_bh_schedule(dbdma->bh);
562d1e562deSAlexander Graf }
563d1e562deSAlexander Graf 
56428ce5ce6Saurel32 void DBDMA_register_channel(void *dbdma, int nchan, qemu_irq irq,
565862c9280Saurel32                             DBDMA_rw rw, DBDMA_flush flush,
56628ce5ce6Saurel32                             void *opaque)
56728ce5ce6Saurel32 {
568c20df14bSJuan Quintela     DBDMAState *s = dbdma;
569c20df14bSJuan Quintela     DBDMA_channel *ch = &s->channels[nchan];
57028ce5ce6Saurel32 
5713e49c439SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "DBDMA_register_channel 0x%x\n", nchan);
57228ce5ce6Saurel32 
5732d7d06d8SHervé Poussineau     assert(rw);
5742d7d06d8SHervé Poussineau     assert(flush);
5752d7d06d8SHervé Poussineau 
57628ce5ce6Saurel32     ch->irq = irq;
577b42ec42dSaurel32     ch->rw = rw;
578862c9280Saurel32     ch->flush = flush;
57928ce5ce6Saurel32     ch->io.opaque = opaque;
58028ce5ce6Saurel32 }
58128ce5ce6Saurel32 
58277453882SBenjamin Herrenschmidt static void dbdma_control_write(DBDMA_channel *ch)
58328ce5ce6Saurel32 {
58428ce5ce6Saurel32     uint16_t mask, value;
58528ce5ce6Saurel32     uint32_t status;
58677453882SBenjamin Herrenschmidt     bool do_flush = false;
58728ce5ce6Saurel32 
588ad674e53SAurelien Jarno     mask = (ch->regs[DBDMA_CONTROL] >> 16) & 0xffff;
589ad674e53SAurelien Jarno     value = ch->regs[DBDMA_CONTROL] & 0xffff;
59028ce5ce6Saurel32 
59177453882SBenjamin Herrenschmidt     /* This is the status register which we'll update
59277453882SBenjamin Herrenschmidt      * appropriately and store back
59377453882SBenjamin Herrenschmidt      */
594ad674e53SAurelien Jarno     status = ch->regs[DBDMA_STATUS];
59528ce5ce6Saurel32 
59677453882SBenjamin Herrenschmidt     /* RUN and PAUSE are bits under SW control only
59777453882SBenjamin Herrenschmidt      * FLUSH and WAKE are set by SW and cleared by HW
59877453882SBenjamin Herrenschmidt      * DEAD, ACTIVE and BT are only under HW control
59977453882SBenjamin Herrenschmidt      *
60077453882SBenjamin Herrenschmidt      * We handle ACTIVE separately at the end of the
60177453882SBenjamin Herrenschmidt      * logic to ensure all cases are covered.
60277453882SBenjamin Herrenschmidt      */
60328ce5ce6Saurel32 
60477453882SBenjamin Herrenschmidt     /* Setting RUN will tentatively activate the channel
60577453882SBenjamin Herrenschmidt      */
60677453882SBenjamin Herrenschmidt     if ((mask & RUN) && (value & RUN)) {
60777453882SBenjamin Herrenschmidt         status |= RUN;
60877453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, " Setting RUN !\n");
60928ce5ce6Saurel32     }
61077453882SBenjamin Herrenschmidt 
61177453882SBenjamin Herrenschmidt     /* Clearing RUN 1->0 will stop the channel */
61277453882SBenjamin Herrenschmidt     if ((mask & RUN) && !(value & RUN)) {
61377453882SBenjamin Herrenschmidt         /* This has the side effect of clearing the DEAD bit */
61477453882SBenjamin Herrenschmidt         status &= ~(DEAD | RUN);
61577453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, " Clearing RUN !\n");
61677453882SBenjamin Herrenschmidt     }
61777453882SBenjamin Herrenschmidt 
61877453882SBenjamin Herrenschmidt     /* Setting WAKE wakes up an idle channel if it's running
61977453882SBenjamin Herrenschmidt      *
62077453882SBenjamin Herrenschmidt      * Note: The doc doesn't say so but assume that only works
62177453882SBenjamin Herrenschmidt      * on a channel whose RUN bit is set.
62277453882SBenjamin Herrenschmidt      *
62377453882SBenjamin Herrenschmidt      * We set WAKE in status, it's not terribly useful as it will
62477453882SBenjamin Herrenschmidt      * be cleared on the next command fetch but it seems to mimmic
62577453882SBenjamin Herrenschmidt      * the HW behaviour and is useful for the way we handle
62677453882SBenjamin Herrenschmidt      * ACTIVE further down.
62777453882SBenjamin Herrenschmidt      */
62877453882SBenjamin Herrenschmidt     if ((mask & WAKE) && (value & WAKE) && (status & RUN)) {
62977453882SBenjamin Herrenschmidt         status |= WAKE;
63077453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, " Setting WAKE !\n");
63177453882SBenjamin Herrenschmidt     }
63277453882SBenjamin Herrenschmidt 
63377453882SBenjamin Herrenschmidt     /* PAUSE being set will deactivate (or prevent activation)
63477453882SBenjamin Herrenschmidt      * of the channel. We just copy it over for now, ACTIVE will
63577453882SBenjamin Herrenschmidt      * be re-evaluated later.
63677453882SBenjamin Herrenschmidt      */
63777453882SBenjamin Herrenschmidt     if (mask & PAUSE) {
63877453882SBenjamin Herrenschmidt         status = (status & ~PAUSE) | (value & PAUSE);
63977453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, " %sing PAUSE !\n",
64077453882SBenjamin Herrenschmidt                         (value & PAUSE) ? "sett" : "clear");
64177453882SBenjamin Herrenschmidt     }
64277453882SBenjamin Herrenschmidt 
64377453882SBenjamin Herrenschmidt     /* FLUSH is its own thing */
64477453882SBenjamin Herrenschmidt     if ((mask & FLUSH) && (value & FLUSH))  {
64577453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, " Setting FLUSH !\n");
64677453882SBenjamin Herrenschmidt         /* We set flush directly in the status register, we do *NOT*
64777453882SBenjamin Herrenschmidt          * set it in "status" so that it gets naturally cleared when
64877453882SBenjamin Herrenschmidt          * we update the status register further down. That way it
64977453882SBenjamin Herrenschmidt          * will be set only during the HW flush operation so it is
65077453882SBenjamin Herrenschmidt          * visible to any completions happening during that time.
65177453882SBenjamin Herrenschmidt          */
65277453882SBenjamin Herrenschmidt         ch->regs[DBDMA_STATUS] |= FLUSH;
65377453882SBenjamin Herrenschmidt         do_flush = true;
65477453882SBenjamin Herrenschmidt     }
65577453882SBenjamin Herrenschmidt 
65677453882SBenjamin Herrenschmidt     /* If either RUN or PAUSE is clear, so should ACTIVE be,
65777453882SBenjamin Herrenschmidt      * otherwise, ACTIVE will be set if we modified RUN, PAUSE or
65877453882SBenjamin Herrenschmidt      * set WAKE. That means that PAUSE was just cleared, RUN was
65977453882SBenjamin Herrenschmidt      * just set or WAKE was just set.
66077453882SBenjamin Herrenschmidt      */
66177453882SBenjamin Herrenschmidt     if ((status & PAUSE) || !(status & RUN)) {
66228ce5ce6Saurel32         status &= ~ACTIVE;
66377453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, "  -> ACTIVE down !\n");
66477453882SBenjamin Herrenschmidt 
66577453882SBenjamin Herrenschmidt         /* We stopped processing, we want the underlying HW command
66677453882SBenjamin Herrenschmidt          * to complete *before* we clear the ACTIVE bit. Otherwise
66777453882SBenjamin Herrenschmidt          * we can get into a situation where the command status will
66877453882SBenjamin Herrenschmidt          * have RUN or ACTIVE not set which is going to confuse the
66977453882SBenjamin Herrenschmidt          * MacOS driver.
67077453882SBenjamin Herrenschmidt          */
67177453882SBenjamin Herrenschmidt         do_flush = true;
67277453882SBenjamin Herrenschmidt     } else if (mask & (RUN | PAUSE)) {
67377453882SBenjamin Herrenschmidt         status |= ACTIVE;
67477453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, " -> ACTIVE up !\n");
67577453882SBenjamin Herrenschmidt     } else if ((mask & WAKE) && (value & WAKE)) {
67677453882SBenjamin Herrenschmidt         status |= ACTIVE;
67777453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, " -> ACTIVE up !\n");
6781cde732dSMark Cave-Ayland     }
6791cde732dSMark Cave-Ayland 
68077453882SBenjamin Herrenschmidt     DBDMA_DPRINTFCH(ch, " new status=0x%08x\n", status);
68177453882SBenjamin Herrenschmidt 
68277453882SBenjamin Herrenschmidt     /* If we need to flush the underlying HW, do it now, this happens
68377453882SBenjamin Herrenschmidt      * both on FLUSH commands and when stopping the channel for safety.
68477453882SBenjamin Herrenschmidt      */
68577453882SBenjamin Herrenschmidt     if (do_flush && ch->flush) {
686987422bcSAmadeusz Sławiński         ch->flush(&ch->io);
687987422bcSAmadeusz Sławiński     }
68828ce5ce6Saurel32 
68977453882SBenjamin Herrenschmidt     /* Finally update the status register image */
690ad674e53SAurelien Jarno     ch->regs[DBDMA_STATUS] = status;
69128ce5ce6Saurel32 
69277453882SBenjamin Herrenschmidt     /* If active, make sure the BH gets to run */
693d2f0ce21SAlexander Graf     if (status & ACTIVE) {
694d2f0ce21SAlexander Graf         DBDMA_kick(dbdma_from_ch(ch));
695d2f0ce21SAlexander Graf     }
696d2f0ce21SAlexander Graf }
6973cbee15bSj_mayer 
698a8170e5eSAvi Kivity static void dbdma_write(void *opaque, hwaddr addr,
69923c5e4caSAvi Kivity                         uint64_t value, unsigned size)
7003cbee15bSj_mayer {
70128ce5ce6Saurel32     int channel = addr >> DBDMA_CHANNEL_SHIFT;
702c20df14bSJuan Quintela     DBDMAState *s = opaque;
703c20df14bSJuan Quintela     DBDMA_channel *ch = &s->channels[channel];
70428ce5ce6Saurel32     int reg = (addr - (channel << DBDMA_CHANNEL_SHIFT)) >> 2;
70528ce5ce6Saurel32 
7063e49c439SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "writel 0x" TARGET_FMT_plx " <= 0x%08"PRIx64"\n",
70758c0c311SAlexander Graf                     addr, value);
7083e49c439SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "channel 0x%x reg 0x%x\n",
70928ce5ce6Saurel32                     (uint32_t)addr >> DBDMA_CHANNEL_SHIFT, reg);
71028ce5ce6Saurel32 
7117eaba824SAlexander Graf     /* cmdptr cannot be modified if channel is ACTIVE */
71228ce5ce6Saurel32 
7137eaba824SAlexander Graf     if (reg == DBDMA_CMDPTR_LO && (ch->regs[DBDMA_STATUS] & ACTIVE)) {
71428ce5ce6Saurel32         return;
7157eaba824SAlexander Graf     }
71628ce5ce6Saurel32 
71728ce5ce6Saurel32     ch->regs[reg] = value;
71828ce5ce6Saurel32 
71928ce5ce6Saurel32     switch(reg) {
72028ce5ce6Saurel32     case DBDMA_CONTROL:
72128ce5ce6Saurel32         dbdma_control_write(ch);
72228ce5ce6Saurel32         break;
72328ce5ce6Saurel32     case DBDMA_CMDPTR_LO:
72428ce5ce6Saurel32         /* 16-byte aligned */
725ad674e53SAurelien Jarno         ch->regs[DBDMA_CMDPTR_LO] &= ~0xf;
72628ce5ce6Saurel32         dbdma_cmdptr_load(ch);
72728ce5ce6Saurel32         break;
72828ce5ce6Saurel32     case DBDMA_STATUS:
72928ce5ce6Saurel32     case DBDMA_INTR_SEL:
73028ce5ce6Saurel32     case DBDMA_BRANCH_SEL:
73128ce5ce6Saurel32     case DBDMA_WAIT_SEL:
73228ce5ce6Saurel32         /* nothing to do */
73328ce5ce6Saurel32         break;
73428ce5ce6Saurel32     case DBDMA_XFER_MODE:
73528ce5ce6Saurel32     case DBDMA_CMDPTR_HI:
73628ce5ce6Saurel32     case DBDMA_DATA2PTR_HI:
73728ce5ce6Saurel32     case DBDMA_DATA2PTR_LO:
73828ce5ce6Saurel32     case DBDMA_ADDRESS_HI:
73928ce5ce6Saurel32     case DBDMA_BRANCH_ADDR_HI:
74028ce5ce6Saurel32     case DBDMA_RES1:
74128ce5ce6Saurel32     case DBDMA_RES2:
74228ce5ce6Saurel32     case DBDMA_RES3:
74328ce5ce6Saurel32     case DBDMA_RES4:
74428ce5ce6Saurel32         /* unused */
74528ce5ce6Saurel32         break;
7463cbee15bSj_mayer     }
7473cbee15bSj_mayer }
7483cbee15bSj_mayer 
749a8170e5eSAvi Kivity static uint64_t dbdma_read(void *opaque, hwaddr addr,
75023c5e4caSAvi Kivity                            unsigned size)
7513cbee15bSj_mayer {
75228ce5ce6Saurel32     uint32_t value;
75328ce5ce6Saurel32     int channel = addr >> DBDMA_CHANNEL_SHIFT;
754c20df14bSJuan Quintela     DBDMAState *s = opaque;
755c20df14bSJuan Quintela     DBDMA_channel *ch = &s->channels[channel];
75628ce5ce6Saurel32     int reg = (addr - (channel << DBDMA_CHANNEL_SHIFT)) >> 2;
757ea026b2fSblueswir1 
75828ce5ce6Saurel32     value = ch->regs[reg];
75928ce5ce6Saurel32 
76028ce5ce6Saurel32     switch(reg) {
76128ce5ce6Saurel32     case DBDMA_CONTROL:
76277453882SBenjamin Herrenschmidt         value = ch->regs[DBDMA_STATUS];
76328ce5ce6Saurel32         break;
76428ce5ce6Saurel32     case DBDMA_STATUS:
76528ce5ce6Saurel32     case DBDMA_CMDPTR_LO:
76628ce5ce6Saurel32     case DBDMA_INTR_SEL:
76728ce5ce6Saurel32     case DBDMA_BRANCH_SEL:
76828ce5ce6Saurel32     case DBDMA_WAIT_SEL:
76928ce5ce6Saurel32         /* nothing to do */
77028ce5ce6Saurel32         break;
77128ce5ce6Saurel32     case DBDMA_XFER_MODE:
77228ce5ce6Saurel32     case DBDMA_CMDPTR_HI:
77328ce5ce6Saurel32     case DBDMA_DATA2PTR_HI:
77428ce5ce6Saurel32     case DBDMA_DATA2PTR_LO:
77528ce5ce6Saurel32     case DBDMA_ADDRESS_HI:
77628ce5ce6Saurel32     case DBDMA_BRANCH_ADDR_HI:
77728ce5ce6Saurel32         /* unused */
77828ce5ce6Saurel32         value = 0;
77928ce5ce6Saurel32         break;
78028ce5ce6Saurel32     case DBDMA_RES1:
78128ce5ce6Saurel32     case DBDMA_RES2:
78228ce5ce6Saurel32     case DBDMA_RES3:
78328ce5ce6Saurel32     case DBDMA_RES4:
78428ce5ce6Saurel32         /* reserved */
78528ce5ce6Saurel32         break;
78628ce5ce6Saurel32     }
78728ce5ce6Saurel32 
78877453882SBenjamin Herrenschmidt     DBDMA_DPRINTFCH(ch, "readl 0x" TARGET_FMT_plx " => 0x%08x\n", addr, value);
78977453882SBenjamin Herrenschmidt     DBDMA_DPRINTFCH(ch, "channel 0x%x reg 0x%x\n",
79077453882SBenjamin Herrenschmidt                     (uint32_t)addr >> DBDMA_CHANNEL_SHIFT, reg);
79177453882SBenjamin Herrenschmidt 
79228ce5ce6Saurel32     return value;
7933cbee15bSj_mayer }
7943cbee15bSj_mayer 
79523c5e4caSAvi Kivity static const MemoryRegionOps dbdma_ops = {
79623c5e4caSAvi Kivity     .read = dbdma_read,
79723c5e4caSAvi Kivity     .write = dbdma_write,
79823c5e4caSAvi Kivity     .endianness = DEVICE_LITTLE_ENDIAN,
79923c5e4caSAvi Kivity     .valid = {
80023c5e4caSAvi Kivity         .min_access_size = 4,
80123c5e4caSAvi Kivity         .max_access_size = 4,
80223c5e4caSAvi Kivity     },
8033cbee15bSj_mayer };
8043cbee15bSj_mayer 
805627be2f2SMark Cave-Ayland static const VMStateDescription vmstate_dbdma_io = {
806627be2f2SMark Cave-Ayland     .name = "dbdma_io",
807da26fdc3SJuan Quintela     .version_id = 0,
808da26fdc3SJuan Quintela     .minimum_version_id = 0,
809da26fdc3SJuan Quintela     .fields = (VMStateField[]) {
810627be2f2SMark Cave-Ayland         VMSTATE_UINT64(addr, struct DBDMA_io),
811627be2f2SMark Cave-Ayland         VMSTATE_INT32(len, struct DBDMA_io),
812627be2f2SMark Cave-Ayland         VMSTATE_INT32(is_last, struct DBDMA_io),
813627be2f2SMark Cave-Ayland         VMSTATE_INT32(is_dma_out, struct DBDMA_io),
814627be2f2SMark Cave-Ayland         VMSTATE_BOOL(processing, struct DBDMA_io),
815627be2f2SMark Cave-Ayland         VMSTATE_END_OF_LIST()
816627be2f2SMark Cave-Ayland     }
817627be2f2SMark Cave-Ayland };
818627be2f2SMark Cave-Ayland 
819627be2f2SMark Cave-Ayland static const VMStateDescription vmstate_dbdma_cmd = {
820627be2f2SMark Cave-Ayland     .name = "dbdma_cmd",
821627be2f2SMark Cave-Ayland     .version_id = 0,
822627be2f2SMark Cave-Ayland     .minimum_version_id = 0,
823627be2f2SMark Cave-Ayland     .fields = (VMStateField[]) {
824627be2f2SMark Cave-Ayland         VMSTATE_UINT16(req_count, dbdma_cmd),
825627be2f2SMark Cave-Ayland         VMSTATE_UINT16(command, dbdma_cmd),
826627be2f2SMark Cave-Ayland         VMSTATE_UINT32(phy_addr, dbdma_cmd),
827627be2f2SMark Cave-Ayland         VMSTATE_UINT32(cmd_dep, dbdma_cmd),
828627be2f2SMark Cave-Ayland         VMSTATE_UINT16(res_count, dbdma_cmd),
829627be2f2SMark Cave-Ayland         VMSTATE_UINT16(xfer_status, dbdma_cmd),
830627be2f2SMark Cave-Ayland         VMSTATE_END_OF_LIST()
831627be2f2SMark Cave-Ayland     }
832627be2f2SMark Cave-Ayland };
833627be2f2SMark Cave-Ayland 
834627be2f2SMark Cave-Ayland static const VMStateDescription vmstate_dbdma_channel = {
835627be2f2SMark Cave-Ayland     .name = "dbdma_channel",
836627be2f2SMark Cave-Ayland     .version_id = 1,
837627be2f2SMark Cave-Ayland     .minimum_version_id = 1,
838627be2f2SMark Cave-Ayland     .fields = (VMStateField[]) {
839da26fdc3SJuan Quintela         VMSTATE_UINT32_ARRAY(regs, struct DBDMA_channel, DBDMA_REGS),
840627be2f2SMark Cave-Ayland         VMSTATE_STRUCT(io, struct DBDMA_channel, 0, vmstate_dbdma_io, DBDMA_io),
841627be2f2SMark Cave-Ayland         VMSTATE_STRUCT(current, struct DBDMA_channel, 0, vmstate_dbdma_cmd,
842627be2f2SMark Cave-Ayland                        dbdma_cmd),
843da26fdc3SJuan Quintela         VMSTATE_END_OF_LIST()
8449b64997fSblueswir1     }
845da26fdc3SJuan Quintela };
8469b64997fSblueswir1 
847da26fdc3SJuan Quintela static const VMStateDescription vmstate_dbdma = {
848da26fdc3SJuan Quintela     .name = "dbdma",
849627be2f2SMark Cave-Ayland     .version_id = 3,
850627be2f2SMark Cave-Ayland     .minimum_version_id = 3,
851da26fdc3SJuan Quintela     .fields = (VMStateField[]) {
852da26fdc3SJuan Quintela         VMSTATE_STRUCT_ARRAY(channels, DBDMAState, DBDMA_CHANNELS, 1,
853da26fdc3SJuan Quintela                              vmstate_dbdma_channel, DBDMA_channel),
854da26fdc3SJuan Quintela         VMSTATE_END_OF_LIST()
8559b64997fSblueswir1     }
856da26fdc3SJuan Quintela };
8579b64997fSblueswir1 
8581d27f351SMark Cave-Ayland static void mac_dbdma_reset(DeviceState *d)
8596e6b7363Sblueswir1 {
8601d27f351SMark Cave-Ayland     DBDMAState *s = MAC_DBDMA(d);
86128ce5ce6Saurel32     int i;
86228ce5ce6Saurel32 
8631d27f351SMark Cave-Ayland     for (i = 0; i < DBDMA_CHANNELS; i++) {
864c20df14bSJuan Quintela         memset(s->channels[i].regs, 0, DBDMA_SIZE);
8656e6b7363Sblueswir1     }
8661d27f351SMark Cave-Ayland }
8676e6b7363Sblueswir1 
8682d7d06d8SHervé Poussineau static void dbdma_unassigned_rw(DBDMA_io *io)
8692d7d06d8SHervé Poussineau {
8702d7d06d8SHervé Poussineau     DBDMA_channel *ch = io->channel;
87177453882SBenjamin Herrenschmidt     dbdma_cmd *current = &ch->current;
87277453882SBenjamin Herrenschmidt     uint16_t cmd;
8732d7d06d8SHervé Poussineau     qemu_log_mask(LOG_GUEST_ERROR, "%s: use of unassigned channel %d\n",
8742d7d06d8SHervé Poussineau                   __func__, ch->channel);
8752df77896SMark Cave-Ayland     ch->io.processing = false;
87677453882SBenjamin Herrenschmidt 
87777453882SBenjamin Herrenschmidt     cmd = le16_to_cpu(current->command) & COMMAND_MASK;
87877453882SBenjamin Herrenschmidt     if (cmd == OUTPUT_MORE || cmd == OUTPUT_LAST ||
87977453882SBenjamin Herrenschmidt         cmd == INPUT_MORE || cmd == INPUT_LAST) {
88077453882SBenjamin Herrenschmidt         current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]);
88177453882SBenjamin Herrenschmidt         current->res_count = cpu_to_le16(io->len);
88277453882SBenjamin Herrenschmidt         dbdma_cmdptr_save(ch);
88377453882SBenjamin Herrenschmidt     }
8842d7d06d8SHervé Poussineau }
8852d7d06d8SHervé Poussineau 
8862d7d06d8SHervé Poussineau static void dbdma_unassigned_flush(DBDMA_io *io)
8872d7d06d8SHervé Poussineau {
8882d7d06d8SHervé Poussineau     DBDMA_channel *ch = io->channel;
8892d7d06d8SHervé Poussineau     qemu_log_mask(LOG_GUEST_ERROR, "%s: use of unassigned channel %d\n",
8902d7d06d8SHervé Poussineau                   __func__, ch->channel);
8912d7d06d8SHervé Poussineau }
8922d7d06d8SHervé Poussineau 
8931d27f351SMark Cave-Ayland static void mac_dbdma_init(Object *obj)
8941d27f351SMark Cave-Ayland {
8951d27f351SMark Cave-Ayland     SysBusDevice *sbd = SYS_BUS_DEVICE(obj);
8961d27f351SMark Cave-Ayland     DBDMAState *s = MAC_DBDMA(obj);
8971d27f351SMark Cave-Ayland     int i;
89828ce5ce6Saurel32 
8993e300fa6SAlexander Graf     for (i = 0; i < DBDMA_CHANNELS; i++) {
9002d7d06d8SHervé Poussineau         DBDMA_channel *ch = &s->channels[i];
9012d7d06d8SHervé Poussineau 
9022d7d06d8SHervé Poussineau         ch->rw = dbdma_unassigned_rw;
9032d7d06d8SHervé Poussineau         ch->flush = dbdma_unassigned_flush;
9042d7d06d8SHervé Poussineau         ch->channel = i;
9052d7d06d8SHervé Poussineau         ch->io.channel = ch;
9063e300fa6SAlexander Graf     }
9073e300fa6SAlexander Graf 
9081d27f351SMark Cave-Ayland     memory_region_init_io(&s->mem, obj, &dbdma_ops, s, "dbdma", 0x1000);
9091d27f351SMark Cave-Ayland     sysbus_init_mmio(sbd, &s->mem);
9101d27f351SMark Cave-Ayland }
9111d27f351SMark Cave-Ayland 
9121d27f351SMark Cave-Ayland static void mac_dbdma_realize(DeviceState *dev, Error **errp)
9131d27f351SMark Cave-Ayland {
9141d27f351SMark Cave-Ayland     DBDMAState *s = MAC_DBDMA(dev);
91528ce5ce6Saurel32 
916d2f0ce21SAlexander Graf     s->bh = qemu_bh_new(DBDMA_run_bh, s);
9173cbee15bSj_mayer }
9181d27f351SMark Cave-Ayland 
9191d27f351SMark Cave-Ayland static void mac_dbdma_class_init(ObjectClass *oc, void *data)
9201d27f351SMark Cave-Ayland {
9211d27f351SMark Cave-Ayland     DeviceClass *dc = DEVICE_CLASS(oc);
9221d27f351SMark Cave-Ayland 
9231d27f351SMark Cave-Ayland     dc->realize = mac_dbdma_realize;
9241d27f351SMark Cave-Ayland     dc->reset = mac_dbdma_reset;
9251d27f351SMark Cave-Ayland     dc->vmsd = &vmstate_dbdma;
9261d27f351SMark Cave-Ayland }
9271d27f351SMark Cave-Ayland 
9281d27f351SMark Cave-Ayland static const TypeInfo mac_dbdma_type_info = {
9291d27f351SMark Cave-Ayland     .name = TYPE_MAC_DBDMA,
9301d27f351SMark Cave-Ayland     .parent = TYPE_SYS_BUS_DEVICE,
9311d27f351SMark Cave-Ayland     .instance_size = sizeof(DBDMAState),
9321d27f351SMark Cave-Ayland     .instance_init = mac_dbdma_init,
9331d27f351SMark Cave-Ayland     .class_init = mac_dbdma_class_init
9341d27f351SMark Cave-Ayland };
9351d27f351SMark Cave-Ayland 
9361d27f351SMark Cave-Ayland static void mac_dbdma_register_types(void)
9371d27f351SMark Cave-Ayland {
9381d27f351SMark Cave-Ayland     type_register_static(&mac_dbdma_type_info);
9391d27f351SMark Cave-Ayland }
9401d27f351SMark Cave-Ayland 
9411d27f351SMark Cave-Ayland type_init(mac_dbdma_register_types)
942