xref: /qemu/hw/misc/macio/mac_dbdma.c (revision b7d678135f0294489e0458ef97088e848d08dfb5)
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  */
390d75590dSPeter Maydell #include "qemu/osdep.h"
4083c9f4caSPaolo Bonzini #include "hw/hw.h"
410d09e41aSPaolo Bonzini #include "hw/isa/isa.h"
420d09e41aSPaolo Bonzini #include "hw/ppc/mac_dbdma.h"
431de7afc9SPaolo Bonzini #include "qemu/main-loop.h"
4403dd024fSPaolo Bonzini #include "qemu/log.h"
4588655881SMark Cave-Ayland #include "sysemu/dma.h"
463cbee15bSj_mayer 
47ea026b2fSblueswir1 /* debug DBDMA */
48ba0b17ddSMark Cave-Ayland #define DEBUG_DBDMA 0
493e49c439SMark Cave-Ayland #define DEBUG_DBDMA_CHANMASK ((1ull << DBDMA_CHANNELS) - 1)
50ea026b2fSblueswir1 
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     } \
552562755eSEric Blake } while (0)
56ea026b2fSblueswir1 
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     } \
632562755eSEric Blake } while (0)
643e49c439SMark Cave-Ayland 
6528ce5ce6Saurel32 /*
6628ce5ce6Saurel32  */
673cbee15bSj_mayer 
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
74*b7d67813SMark Cave-Ayland static void dump_dbdma_cmd(DBDMA_channel *ch, dbdma_cmd *cmd)
753cbee15bSj_mayer {
76*b7d67813SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "dbdma_cmd %p\n", cmd);
77*b7d67813SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "    req_count 0x%04x\n", le16_to_cpu(cmd->req_count));
78*b7d67813SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "    command 0x%04x\n", le16_to_cpu(cmd->command));
79*b7d67813SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "    phy_addr 0x%08x\n", le32_to_cpu(cmd->phy_addr));
80*b7d67813SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "    cmd_dep 0x%08x\n", le32_to_cpu(cmd->cmd_dep));
81*b7d67813SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "    res_count 0x%04x\n", le16_to_cpu(cmd->res_count));
82*b7d67813SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "    xfer_status 0x%04x\n",
83*b7d67813SMark Cave-Ayland                     le16_to_cpu(cmd->xfer_status));
8428ce5ce6Saurel32 }
8528ce5ce6Saurel32 #else
86*b7d67813SMark Cave-Ayland static void dump_dbdma_cmd(DBDMA_channel *ch, dbdma_cmd *cmd)
8728ce5ce6Saurel32 {
8828ce5ce6Saurel32 }
8928ce5ce6Saurel32 #endif
9028ce5ce6Saurel32 static void dbdma_cmdptr_load(DBDMA_channel *ch)
9128ce5ce6Saurel32 {
923e49c439SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "dbdma_cmdptr_load 0x%08x\n",
93ad674e53SAurelien Jarno                     ch->regs[DBDMA_CMDPTR_LO]);
9488655881SMark Cave-Ayland     dma_memory_read(&address_space_memory, ch->regs[DBDMA_CMDPTR_LO],
95e1fe50dcSStefan Weil                     &ch->current, sizeof(dbdma_cmd));
963cbee15bSj_mayer }
973cbee15bSj_mayer 
9828ce5ce6Saurel32 static void dbdma_cmdptr_save(DBDMA_channel *ch)
993cbee15bSj_mayer {
10077453882SBenjamin Herrenschmidt     DBDMA_DPRINTFCH(ch, "-> update 0x%08x stat=0x%08x, res=0x%04x\n",
10177453882SBenjamin Herrenschmidt                     ch->regs[DBDMA_CMDPTR_LO],
10228ce5ce6Saurel32                     le16_to_cpu(ch->current.xfer_status),
10328ce5ce6Saurel32                     le16_to_cpu(ch->current.res_count));
10488655881SMark Cave-Ayland     dma_memory_write(&address_space_memory, ch->regs[DBDMA_CMDPTR_LO],
105e1fe50dcSStefan Weil                      &ch->current, sizeof(dbdma_cmd));
10628ce5ce6Saurel32 }
10728ce5ce6Saurel32 
10828ce5ce6Saurel32 static void kill_channel(DBDMA_channel *ch)
10928ce5ce6Saurel32 {
1103e49c439SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "kill_channel\n");
11128ce5ce6Saurel32 
112ad674e53SAurelien Jarno     ch->regs[DBDMA_STATUS] |= DEAD;
113ad674e53SAurelien Jarno     ch->regs[DBDMA_STATUS] &= ~ACTIVE;
11428ce5ce6Saurel32 
11528ce5ce6Saurel32     qemu_irq_raise(ch->irq);
11628ce5ce6Saurel32 }
11728ce5ce6Saurel32 
11828ce5ce6Saurel32 static void conditional_interrupt(DBDMA_channel *ch)
11928ce5ce6Saurel32 {
12028ce5ce6Saurel32     dbdma_cmd *current = &ch->current;
12128ce5ce6Saurel32     uint16_t intr;
12228ce5ce6Saurel32     uint16_t sel_mask, sel_value;
12328ce5ce6Saurel32     uint32_t status;
12428ce5ce6Saurel32     int cond;
12528ce5ce6Saurel32 
1263e49c439SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "%s\n", __func__);
12728ce5ce6Saurel32 
128b42ec42dSaurel32     intr = le16_to_cpu(current->command) & INTR_MASK;
12928ce5ce6Saurel32 
13028ce5ce6Saurel32     switch(intr) {
13128ce5ce6Saurel32     case INTR_NEVER:  /* don't interrupt */
13228ce5ce6Saurel32         return;
13328ce5ce6Saurel32     case INTR_ALWAYS: /* always interrupt */
13428ce5ce6Saurel32         qemu_irq_raise(ch->irq);
1353e49c439SMark Cave-Ayland         DBDMA_DPRINTFCH(ch, "%s: raise\n", __func__);
13628ce5ce6Saurel32         return;
13728ce5ce6Saurel32     }
13828ce5ce6Saurel32 
139ad674e53SAurelien Jarno     status = ch->regs[DBDMA_STATUS] & DEVSTAT;
14028ce5ce6Saurel32 
141ad674e53SAurelien Jarno     sel_mask = (ch->regs[DBDMA_INTR_SEL] >> 16) & 0x0f;
142ad674e53SAurelien Jarno     sel_value = ch->regs[DBDMA_INTR_SEL] & 0x0f;
14328ce5ce6Saurel32 
14428ce5ce6Saurel32     cond = (status & sel_mask) == (sel_value & sel_mask);
14528ce5ce6Saurel32 
14628ce5ce6Saurel32     switch(intr) {
14728ce5ce6Saurel32     case INTR_IFSET:  /* intr if condition bit is 1 */
14833ce36bbSAlexander Graf         if (cond) {
14928ce5ce6Saurel32             qemu_irq_raise(ch->irq);
1503e49c439SMark Cave-Ayland             DBDMA_DPRINTFCH(ch, "%s: raise\n", __func__);
15133ce36bbSAlexander Graf         }
15228ce5ce6Saurel32         return;
15328ce5ce6Saurel32     case INTR_IFCLR:  /* intr if condition bit is 0 */
15433ce36bbSAlexander Graf         if (!cond) {
15528ce5ce6Saurel32             qemu_irq_raise(ch->irq);
1563e49c439SMark Cave-Ayland             DBDMA_DPRINTFCH(ch, "%s: raise\n", __func__);
15733ce36bbSAlexander Graf         }
15828ce5ce6Saurel32         return;
15928ce5ce6Saurel32     }
16028ce5ce6Saurel32 }
16128ce5ce6Saurel32 
16228ce5ce6Saurel32 static int conditional_wait(DBDMA_channel *ch)
16328ce5ce6Saurel32 {
16428ce5ce6Saurel32     dbdma_cmd *current = &ch->current;
16528ce5ce6Saurel32     uint16_t wait;
16628ce5ce6Saurel32     uint16_t sel_mask, sel_value;
16728ce5ce6Saurel32     uint32_t status;
16828ce5ce6Saurel32     int cond;
16977453882SBenjamin Herrenschmidt     int res = 0;
17028ce5ce6Saurel32 
171b42ec42dSaurel32     wait = le16_to_cpu(current->command) & WAIT_MASK;
17228ce5ce6Saurel32     switch(wait) {
17328ce5ce6Saurel32     case WAIT_NEVER:  /* don't wait */
17428ce5ce6Saurel32         return 0;
17528ce5ce6Saurel32     case WAIT_ALWAYS: /* always wait */
17677453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, "  [WAIT_ALWAYS]\n");
17728ce5ce6Saurel32         return 1;
17828ce5ce6Saurel32     }
17928ce5ce6Saurel32 
180ad674e53SAurelien Jarno     status = ch->regs[DBDMA_STATUS] & DEVSTAT;
18128ce5ce6Saurel32 
182ad674e53SAurelien Jarno     sel_mask = (ch->regs[DBDMA_WAIT_SEL] >> 16) & 0x0f;
183ad674e53SAurelien Jarno     sel_value = ch->regs[DBDMA_WAIT_SEL] & 0x0f;
18428ce5ce6Saurel32 
18528ce5ce6Saurel32     cond = (status & sel_mask) == (sel_value & sel_mask);
18628ce5ce6Saurel32 
18728ce5ce6Saurel32     switch(wait) {
18828ce5ce6Saurel32     case WAIT_IFSET:  /* wait if condition bit is 1 */
18977453882SBenjamin Herrenschmidt         if (cond) {
19077453882SBenjamin Herrenschmidt             res = 1;
19128ce5ce6Saurel32         }
19277453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, "  [WAIT_IFSET=%d]\n", res);
19377453882SBenjamin Herrenschmidt         break;
19477453882SBenjamin Herrenschmidt     case WAIT_IFCLR:  /* wait if condition bit is 0 */
19577453882SBenjamin Herrenschmidt         if (!cond) {
19677453882SBenjamin Herrenschmidt             res = 1;
19777453882SBenjamin Herrenschmidt         }
19877453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, "  [WAIT_IFCLR=%d]\n", res);
19977453882SBenjamin Herrenschmidt         break;
20077453882SBenjamin Herrenschmidt     }
20177453882SBenjamin Herrenschmidt     return res;
20228ce5ce6Saurel32 }
20328ce5ce6Saurel32 
20428ce5ce6Saurel32 static void next(DBDMA_channel *ch)
20528ce5ce6Saurel32 {
20628ce5ce6Saurel32     uint32_t cp;
20728ce5ce6Saurel32 
208ad674e53SAurelien Jarno     ch->regs[DBDMA_STATUS] &= ~BT;
20928ce5ce6Saurel32 
210ad674e53SAurelien Jarno     cp = ch->regs[DBDMA_CMDPTR_LO];
211ad674e53SAurelien Jarno     ch->regs[DBDMA_CMDPTR_LO] = cp + sizeof(dbdma_cmd);
21228ce5ce6Saurel32     dbdma_cmdptr_load(ch);
21328ce5ce6Saurel32 }
21428ce5ce6Saurel32 
21528ce5ce6Saurel32 static void branch(DBDMA_channel *ch)
21628ce5ce6Saurel32 {
21728ce5ce6Saurel32     dbdma_cmd *current = &ch->current;
21828ce5ce6Saurel32 
2193f0d4128SMark Cave-Ayland     ch->regs[DBDMA_CMDPTR_LO] = le32_to_cpu(current->cmd_dep);
220ad674e53SAurelien Jarno     ch->regs[DBDMA_STATUS] |= BT;
22128ce5ce6Saurel32     dbdma_cmdptr_load(ch);
22228ce5ce6Saurel32 }
22328ce5ce6Saurel32 
22428ce5ce6Saurel32 static void conditional_branch(DBDMA_channel *ch)
22528ce5ce6Saurel32 {
22628ce5ce6Saurel32     dbdma_cmd *current = &ch->current;
22728ce5ce6Saurel32     uint16_t br;
22828ce5ce6Saurel32     uint16_t sel_mask, sel_value;
22928ce5ce6Saurel32     uint32_t status;
23028ce5ce6Saurel32     int cond;
23128ce5ce6Saurel32 
23228ce5ce6Saurel32     /* check if we must branch */
23328ce5ce6Saurel32 
234b42ec42dSaurel32     br = le16_to_cpu(current->command) & BR_MASK;
23528ce5ce6Saurel32 
23628ce5ce6Saurel32     switch(br) {
23728ce5ce6Saurel32     case BR_NEVER:  /* don't branch */
23828ce5ce6Saurel32         next(ch);
23928ce5ce6Saurel32         return;
24028ce5ce6Saurel32     case BR_ALWAYS: /* always branch */
24177453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, "  [BR_ALWAYS]\n");
24228ce5ce6Saurel32         branch(ch);
24328ce5ce6Saurel32         return;
24428ce5ce6Saurel32     }
24528ce5ce6Saurel32 
246ad674e53SAurelien Jarno     status = ch->regs[DBDMA_STATUS] & DEVSTAT;
24728ce5ce6Saurel32 
248ad674e53SAurelien Jarno     sel_mask = (ch->regs[DBDMA_BRANCH_SEL] >> 16) & 0x0f;
249ad674e53SAurelien Jarno     sel_value = ch->regs[DBDMA_BRANCH_SEL] & 0x0f;
25028ce5ce6Saurel32 
25128ce5ce6Saurel32     cond = (status & sel_mask) == (sel_value & sel_mask);
25228ce5ce6Saurel32 
25328ce5ce6Saurel32     switch(br) {
25428ce5ce6Saurel32     case BR_IFSET:  /* branch if condition bit is 1 */
25577453882SBenjamin Herrenschmidt         if (cond) {
25677453882SBenjamin Herrenschmidt             DBDMA_DPRINTFCH(ch, "  [BR_IFSET = 1]\n");
25728ce5ce6Saurel32             branch(ch);
25877453882SBenjamin Herrenschmidt         } else {
25977453882SBenjamin Herrenschmidt             DBDMA_DPRINTFCH(ch, "  [BR_IFSET = 0]\n");
26028ce5ce6Saurel32             next(ch);
26177453882SBenjamin Herrenschmidt         }
26228ce5ce6Saurel32         return;
26328ce5ce6Saurel32     case BR_IFCLR:  /* branch if condition bit is 0 */
26477453882SBenjamin Herrenschmidt         if (!cond) {
26577453882SBenjamin Herrenschmidt             DBDMA_DPRINTFCH(ch, "  [BR_IFCLR = 1]\n");
26628ce5ce6Saurel32             branch(ch);
26777453882SBenjamin Herrenschmidt         } else {
26877453882SBenjamin Herrenschmidt             DBDMA_DPRINTFCH(ch, "  [BR_IFCLR = 0]\n");
26928ce5ce6Saurel32             next(ch);
27077453882SBenjamin Herrenschmidt         }
27128ce5ce6Saurel32         return;
27228ce5ce6Saurel32     }
27328ce5ce6Saurel32 }
27428ce5ce6Saurel32 
275b42ec42dSaurel32 static void channel_run(DBDMA_channel *ch);
276b42ec42dSaurel32 
277b42ec42dSaurel32 static void dbdma_end(DBDMA_io *io)
27828ce5ce6Saurel32 {
27928ce5ce6Saurel32     DBDMA_channel *ch = io->channel;
28028ce5ce6Saurel32     dbdma_cmd *current = &ch->current;
28128ce5ce6Saurel32 
2823e49c439SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "%s\n", __func__);
28333ce36bbSAlexander Graf 
284b42ec42dSaurel32     if (conditional_wait(ch))
285b42ec42dSaurel32         goto wait;
28628ce5ce6Saurel32 
287ad674e53SAurelien Jarno     current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]);
288ad674e53SAurelien Jarno     current->res_count = cpu_to_le16(io->len);
289b42ec42dSaurel32     dbdma_cmdptr_save(ch);
290862c9280Saurel32     if (io->is_last)
291ad674e53SAurelien Jarno         ch->regs[DBDMA_STATUS] &= ~FLUSH;
29228ce5ce6Saurel32 
293b42ec42dSaurel32     conditional_interrupt(ch);
294b42ec42dSaurel32     conditional_branch(ch);
295b42ec42dSaurel32 
296b42ec42dSaurel32 wait:
29703ee3b1eSAlexander Graf     /* Indicate that we're ready for a new DMA round */
29803ee3b1eSAlexander Graf     ch->io.processing = false;
29903ee3b1eSAlexander Graf 
300ad674e53SAurelien Jarno     if ((ch->regs[DBDMA_STATUS] & RUN) &&
301ad674e53SAurelien Jarno         (ch->regs[DBDMA_STATUS] & ACTIVE))
302b42ec42dSaurel32         channel_run(ch);
30328ce5ce6Saurel32 }
30428ce5ce6Saurel32 
305b42ec42dSaurel32 static void start_output(DBDMA_channel *ch, int key, uint32_t addr,
30628ce5ce6Saurel32                         uint16_t req_count, int is_last)
30728ce5ce6Saurel32 {
3083e49c439SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "start_output\n");
30928ce5ce6Saurel32 
31028ce5ce6Saurel32     /* KEY_REGS, KEY_DEVICE and KEY_STREAM
31128ce5ce6Saurel32      * are not implemented in the mac-io chip
31228ce5ce6Saurel32      */
31328ce5ce6Saurel32 
3143e49c439SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "addr 0x%x key 0x%x\n", addr, key);
31528ce5ce6Saurel32     if (!addr || key > KEY_STREAM3) {
31628ce5ce6Saurel32         kill_channel(ch);
317b42ec42dSaurel32         return;
31828ce5ce6Saurel32     }
31928ce5ce6Saurel32 
320b42ec42dSaurel32     ch->io.addr = addr;
32128ce5ce6Saurel32     ch->io.len = req_count;
32228ce5ce6Saurel32     ch->io.is_last = is_last;
323b42ec42dSaurel32     ch->io.dma_end = dbdma_end;
324b42ec42dSaurel32     ch->io.is_dma_out = 1;
32503ee3b1eSAlexander Graf     ch->io.processing = true;
326a9ceb76dSAlexander Graf     if (ch->rw) {
327b42ec42dSaurel32         ch->rw(&ch->io);
32828ce5ce6Saurel32     }
329a9ceb76dSAlexander Graf }
33028ce5ce6Saurel32 
331b42ec42dSaurel32 static void start_input(DBDMA_channel *ch, int key, uint32_t addr,
33228ce5ce6Saurel32                        uint16_t req_count, int is_last)
33328ce5ce6Saurel32 {
3343e49c439SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "start_input\n");
33528ce5ce6Saurel32 
33628ce5ce6Saurel32     /* KEY_REGS, KEY_DEVICE and KEY_STREAM
33728ce5ce6Saurel32      * are not implemented in the mac-io chip
33828ce5ce6Saurel32      */
33928ce5ce6Saurel32 
3403e49c439SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "addr 0x%x key 0x%x\n", addr, key);
34128ce5ce6Saurel32     if (!addr || key > KEY_STREAM3) {
34228ce5ce6Saurel32         kill_channel(ch);
343b42ec42dSaurel32         return;
34428ce5ce6Saurel32     }
34528ce5ce6Saurel32 
346b42ec42dSaurel32     ch->io.addr = addr;
34728ce5ce6Saurel32     ch->io.len = req_count;
34828ce5ce6Saurel32     ch->io.is_last = is_last;
349b42ec42dSaurel32     ch->io.dma_end = dbdma_end;
350b42ec42dSaurel32     ch->io.is_dma_out = 0;
35103ee3b1eSAlexander Graf     ch->io.processing = true;
352a9ceb76dSAlexander Graf     if (ch->rw) {
353b42ec42dSaurel32         ch->rw(&ch->io);
35428ce5ce6Saurel32     }
355a9ceb76dSAlexander Graf }
35628ce5ce6Saurel32 
357b42ec42dSaurel32 static void load_word(DBDMA_channel *ch, int key, uint32_t addr,
35828ce5ce6Saurel32                      uint16_t len)
35928ce5ce6Saurel32 {
36028ce5ce6Saurel32     dbdma_cmd *current = &ch->current;
36128ce5ce6Saurel32 
362e12f50b9SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "load_word %d bytes, addr=%08x\n", len, addr);
36328ce5ce6Saurel32 
36428ce5ce6Saurel32     /* only implements KEY_SYSTEM */
36528ce5ce6Saurel32 
36628ce5ce6Saurel32     if (key != KEY_SYSTEM) {
36728ce5ce6Saurel32         printf("DBDMA: LOAD_WORD, unimplemented key %x\n", key);
36828ce5ce6Saurel32         kill_channel(ch);
369b42ec42dSaurel32         return;
37028ce5ce6Saurel32     }
37128ce5ce6Saurel32 
372e12f50b9SMark Cave-Ayland     dma_memory_read(&address_space_memory, addr, &current->cmd_dep, len);
37328ce5ce6Saurel32 
37428ce5ce6Saurel32     if (conditional_wait(ch))
375b42ec42dSaurel32         goto wait;
37628ce5ce6Saurel32 
377ad674e53SAurelien Jarno     current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]);
37828ce5ce6Saurel32     dbdma_cmdptr_save(ch);
379ad674e53SAurelien Jarno     ch->regs[DBDMA_STATUS] &= ~FLUSH;
38028ce5ce6Saurel32 
38128ce5ce6Saurel32     conditional_interrupt(ch);
38228ce5ce6Saurel32     next(ch);
38328ce5ce6Saurel32 
384b42ec42dSaurel32 wait:
385d2f0ce21SAlexander Graf     DBDMA_kick(dbdma_from_ch(ch));
38628ce5ce6Saurel32 }
38728ce5ce6Saurel32 
388b42ec42dSaurel32 static void store_word(DBDMA_channel *ch, int key, uint32_t addr,
38928ce5ce6Saurel32                       uint16_t len)
39028ce5ce6Saurel32 {
39128ce5ce6Saurel32     dbdma_cmd *current = &ch->current;
39228ce5ce6Saurel32 
393e12f50b9SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "store_word %d bytes, addr=%08x pa=%x\n",
394e12f50b9SMark Cave-Ayland                     len, addr, le32_to_cpu(current->cmd_dep));
39528ce5ce6Saurel32 
39628ce5ce6Saurel32     /* only implements KEY_SYSTEM */
39728ce5ce6Saurel32 
39828ce5ce6Saurel32     if (key != KEY_SYSTEM) {
39928ce5ce6Saurel32         printf("DBDMA: STORE_WORD, unimplemented key %x\n", key);
40028ce5ce6Saurel32         kill_channel(ch);
401b42ec42dSaurel32         return;
40228ce5ce6Saurel32     }
40328ce5ce6Saurel32 
404e12f50b9SMark Cave-Ayland     dma_memory_write(&address_space_memory, addr, &current->cmd_dep, len);
40528ce5ce6Saurel32 
40628ce5ce6Saurel32     if (conditional_wait(ch))
407b42ec42dSaurel32         goto wait;
40828ce5ce6Saurel32 
409ad674e53SAurelien Jarno     current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]);
41028ce5ce6Saurel32     dbdma_cmdptr_save(ch);
411ad674e53SAurelien Jarno     ch->regs[DBDMA_STATUS] &= ~FLUSH;
41228ce5ce6Saurel32 
41328ce5ce6Saurel32     conditional_interrupt(ch);
41428ce5ce6Saurel32     next(ch);
41528ce5ce6Saurel32 
416b42ec42dSaurel32 wait:
417d2f0ce21SAlexander Graf     DBDMA_kick(dbdma_from_ch(ch));
41828ce5ce6Saurel32 }
41928ce5ce6Saurel32 
420b42ec42dSaurel32 static void nop(DBDMA_channel *ch)
42128ce5ce6Saurel32 {
42228ce5ce6Saurel32     dbdma_cmd *current = &ch->current;
42328ce5ce6Saurel32 
42428ce5ce6Saurel32     if (conditional_wait(ch))
425b42ec42dSaurel32         goto wait;
42628ce5ce6Saurel32 
427ad674e53SAurelien Jarno     current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]);
42828ce5ce6Saurel32     dbdma_cmdptr_save(ch);
42928ce5ce6Saurel32 
43028ce5ce6Saurel32     conditional_interrupt(ch);
43128ce5ce6Saurel32     conditional_branch(ch);
43228ce5ce6Saurel32 
433b42ec42dSaurel32 wait:
434d2f0ce21SAlexander Graf     DBDMA_kick(dbdma_from_ch(ch));
43528ce5ce6Saurel32 }
43628ce5ce6Saurel32 
437b42ec42dSaurel32 static void stop(DBDMA_channel *ch)
43828ce5ce6Saurel32 {
43977453882SBenjamin Herrenschmidt     ch->regs[DBDMA_STATUS] &= ~(ACTIVE);
44028ce5ce6Saurel32 
44128ce5ce6Saurel32     /* the stop command does not increment command pointer */
44228ce5ce6Saurel32 }
44328ce5ce6Saurel32 
444b42ec42dSaurel32 static void channel_run(DBDMA_channel *ch)
44528ce5ce6Saurel32 {
44628ce5ce6Saurel32     dbdma_cmd *current = &ch->current;
44728ce5ce6Saurel32     uint16_t cmd, key;
44828ce5ce6Saurel32     uint16_t req_count;
44928ce5ce6Saurel32     uint32_t phy_addr;
45028ce5ce6Saurel32 
4513e49c439SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "channel_run\n");
452*b7d67813SMark Cave-Ayland     dump_dbdma_cmd(ch, current);
45328ce5ce6Saurel32 
45428ce5ce6Saurel32     /* clear WAKE flag at command fetch */
45528ce5ce6Saurel32 
456ad674e53SAurelien Jarno     ch->regs[DBDMA_STATUS] &= ~WAKE;
45728ce5ce6Saurel32 
45828ce5ce6Saurel32     cmd = le16_to_cpu(current->command) & COMMAND_MASK;
45928ce5ce6Saurel32 
46028ce5ce6Saurel32     switch (cmd) {
46128ce5ce6Saurel32     case DBDMA_NOP:
462b42ec42dSaurel32         nop(ch);
463b42ec42dSaurel32         return;
46428ce5ce6Saurel32 
46528ce5ce6Saurel32     case DBDMA_STOP:
466b42ec42dSaurel32         stop(ch);
467b42ec42dSaurel32         return;
46828ce5ce6Saurel32     }
46928ce5ce6Saurel32 
47028ce5ce6Saurel32     key = le16_to_cpu(current->command) & 0x0700;
47128ce5ce6Saurel32     req_count = le16_to_cpu(current->req_count);
47228ce5ce6Saurel32     phy_addr = le32_to_cpu(current->phy_addr);
47328ce5ce6Saurel32 
47428ce5ce6Saurel32     if (key == KEY_STREAM4) {
47528ce5ce6Saurel32         printf("command %x, invalid key 4\n", cmd);
47628ce5ce6Saurel32         kill_channel(ch);
477b42ec42dSaurel32         return;
47828ce5ce6Saurel32     }
47928ce5ce6Saurel32 
48028ce5ce6Saurel32     switch (cmd) {
48128ce5ce6Saurel32     case OUTPUT_MORE:
48277453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, "* OUTPUT_MORE *\n");
483b42ec42dSaurel32         start_output(ch, key, phy_addr, req_count, 0);
484b42ec42dSaurel32         return;
48528ce5ce6Saurel32 
48628ce5ce6Saurel32     case OUTPUT_LAST:
48777453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, "* OUTPUT_LAST *\n");
488b42ec42dSaurel32         start_output(ch, key, phy_addr, req_count, 1);
489b42ec42dSaurel32         return;
49028ce5ce6Saurel32 
49128ce5ce6Saurel32     case INPUT_MORE:
49277453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, "* INPUT_MORE *\n");
493b42ec42dSaurel32         start_input(ch, key, phy_addr, req_count, 0);
494b42ec42dSaurel32         return;
49528ce5ce6Saurel32 
49628ce5ce6Saurel32     case INPUT_LAST:
49777453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, "* INPUT_LAST *\n");
498b42ec42dSaurel32         start_input(ch, key, phy_addr, req_count, 1);
499b42ec42dSaurel32         return;
50028ce5ce6Saurel32     }
50128ce5ce6Saurel32 
50228ce5ce6Saurel32     if (key < KEY_REGS) {
50328ce5ce6Saurel32         printf("command %x, invalid key %x\n", cmd, key);
50428ce5ce6Saurel32         key = KEY_SYSTEM;
50528ce5ce6Saurel32     }
50628ce5ce6Saurel32 
50728ce5ce6Saurel32     /* for LOAD_WORD and STORE_WORD, req_count is on 3 bits
50828ce5ce6Saurel32      * and BRANCH is invalid
50928ce5ce6Saurel32      */
51028ce5ce6Saurel32 
51128ce5ce6Saurel32     req_count = req_count & 0x0007;
51228ce5ce6Saurel32     if (req_count & 0x4) {
51328ce5ce6Saurel32         req_count = 4;
51428ce5ce6Saurel32         phy_addr &= ~3;
51528ce5ce6Saurel32     } else if (req_count & 0x2) {
51628ce5ce6Saurel32         req_count = 2;
51728ce5ce6Saurel32         phy_addr &= ~1;
51828ce5ce6Saurel32     } else
51928ce5ce6Saurel32         req_count = 1;
52028ce5ce6Saurel32 
52128ce5ce6Saurel32     switch (cmd) {
52228ce5ce6Saurel32     case LOAD_WORD:
52377453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, "* LOAD_WORD *\n");
524b42ec42dSaurel32         load_word(ch, key, phy_addr, req_count);
525b42ec42dSaurel32         return;
52628ce5ce6Saurel32 
52728ce5ce6Saurel32     case STORE_WORD:
52877453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, "* STORE_WORD *\n");
529b42ec42dSaurel32         store_word(ch, key, phy_addr, req_count);
530b42ec42dSaurel32         return;
53128ce5ce6Saurel32     }
53228ce5ce6Saurel32 }
53328ce5ce6Saurel32 
534c20df14bSJuan Quintela static void DBDMA_run(DBDMAState *s)
53528ce5ce6Saurel32 {
53628ce5ce6Saurel32     int channel;
53728ce5ce6Saurel32 
538c20df14bSJuan Quintela     for (channel = 0; channel < DBDMA_CHANNELS; channel++) {
539c20df14bSJuan Quintela         DBDMA_channel *ch = &s->channels[channel];
540ad674e53SAurelien Jarno         uint32_t status = ch->regs[DBDMA_STATUS];
54103ee3b1eSAlexander Graf         if (!ch->io.processing && (status & RUN) && (status & ACTIVE)) {
542b42ec42dSaurel32             channel_run(ch);
54328ce5ce6Saurel32         }
54428ce5ce6Saurel32     }
545c20df14bSJuan Quintela }
54628ce5ce6Saurel32 
54728ce5ce6Saurel32 static void DBDMA_run_bh(void *opaque)
54828ce5ce6Saurel32 {
549c20df14bSJuan Quintela     DBDMAState *s = opaque;
55028ce5ce6Saurel32 
5513e49c439SMark Cave-Ayland     DBDMA_DPRINTF("-> DBDMA_run_bh\n");
552c20df14bSJuan Quintela     DBDMA_run(s);
5533e49c439SMark Cave-Ayland     DBDMA_DPRINTF("<- DBDMA_run_bh\n");
55428ce5ce6Saurel32 }
55528ce5ce6Saurel32 
556d1e562deSAlexander Graf void DBDMA_kick(DBDMAState *dbdma)
557d1e562deSAlexander Graf {
558d2f0ce21SAlexander Graf     qemu_bh_schedule(dbdma->bh);
559d1e562deSAlexander Graf }
560d1e562deSAlexander Graf 
56128ce5ce6Saurel32 void DBDMA_register_channel(void *dbdma, int nchan, qemu_irq irq,
562862c9280Saurel32                             DBDMA_rw rw, DBDMA_flush flush,
56328ce5ce6Saurel32                             void *opaque)
56428ce5ce6Saurel32 {
565c20df14bSJuan Quintela     DBDMAState *s = dbdma;
566c20df14bSJuan Quintela     DBDMA_channel *ch = &s->channels[nchan];
56728ce5ce6Saurel32 
5683e49c439SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "DBDMA_register_channel 0x%x\n", nchan);
56928ce5ce6Saurel32 
5702d7d06d8SHervé Poussineau     assert(rw);
5712d7d06d8SHervé Poussineau     assert(flush);
5722d7d06d8SHervé Poussineau 
57328ce5ce6Saurel32     ch->irq = irq;
574b42ec42dSaurel32     ch->rw = rw;
575862c9280Saurel32     ch->flush = flush;
57628ce5ce6Saurel32     ch->io.opaque = opaque;
57728ce5ce6Saurel32 }
57828ce5ce6Saurel32 
57977453882SBenjamin Herrenschmidt static void dbdma_control_write(DBDMA_channel *ch)
58028ce5ce6Saurel32 {
58128ce5ce6Saurel32     uint16_t mask, value;
58228ce5ce6Saurel32     uint32_t status;
58377453882SBenjamin Herrenschmidt     bool do_flush = false;
58428ce5ce6Saurel32 
585ad674e53SAurelien Jarno     mask = (ch->regs[DBDMA_CONTROL] >> 16) & 0xffff;
586ad674e53SAurelien Jarno     value = ch->regs[DBDMA_CONTROL] & 0xffff;
58728ce5ce6Saurel32 
58877453882SBenjamin Herrenschmidt     /* This is the status register which we'll update
58977453882SBenjamin Herrenschmidt      * appropriately and store back
59077453882SBenjamin Herrenschmidt      */
591ad674e53SAurelien Jarno     status = ch->regs[DBDMA_STATUS];
59228ce5ce6Saurel32 
59377453882SBenjamin Herrenschmidt     /* RUN and PAUSE are bits under SW control only
59477453882SBenjamin Herrenschmidt      * FLUSH and WAKE are set by SW and cleared by HW
59577453882SBenjamin Herrenschmidt      * DEAD, ACTIVE and BT are only under HW control
59677453882SBenjamin Herrenschmidt      *
59777453882SBenjamin Herrenschmidt      * We handle ACTIVE separately at the end of the
59877453882SBenjamin Herrenschmidt      * logic to ensure all cases are covered.
59977453882SBenjamin Herrenschmidt      */
60028ce5ce6Saurel32 
60177453882SBenjamin Herrenschmidt     /* Setting RUN will tentatively activate the channel
60277453882SBenjamin Herrenschmidt      */
60377453882SBenjamin Herrenschmidt     if ((mask & RUN) && (value & RUN)) {
60477453882SBenjamin Herrenschmidt         status |= RUN;
60577453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, " Setting RUN !\n");
60628ce5ce6Saurel32     }
60777453882SBenjamin Herrenschmidt 
60877453882SBenjamin Herrenschmidt     /* Clearing RUN 1->0 will stop the channel */
60977453882SBenjamin Herrenschmidt     if ((mask & RUN) && !(value & RUN)) {
61077453882SBenjamin Herrenschmidt         /* This has the side effect of clearing the DEAD bit */
61177453882SBenjamin Herrenschmidt         status &= ~(DEAD | RUN);
61277453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, " Clearing RUN !\n");
61377453882SBenjamin Herrenschmidt     }
61477453882SBenjamin Herrenschmidt 
61577453882SBenjamin Herrenschmidt     /* Setting WAKE wakes up an idle channel if it's running
61677453882SBenjamin Herrenschmidt      *
61777453882SBenjamin Herrenschmidt      * Note: The doc doesn't say so but assume that only works
61877453882SBenjamin Herrenschmidt      * on a channel whose RUN bit is set.
61977453882SBenjamin Herrenschmidt      *
62077453882SBenjamin Herrenschmidt      * We set WAKE in status, it's not terribly useful as it will
62177453882SBenjamin Herrenschmidt      * be cleared on the next command fetch but it seems to mimmic
62277453882SBenjamin Herrenschmidt      * the HW behaviour and is useful for the way we handle
62377453882SBenjamin Herrenschmidt      * ACTIVE further down.
62477453882SBenjamin Herrenschmidt      */
62577453882SBenjamin Herrenschmidt     if ((mask & WAKE) && (value & WAKE) && (status & RUN)) {
62677453882SBenjamin Herrenschmidt         status |= WAKE;
62777453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, " Setting WAKE !\n");
62877453882SBenjamin Herrenschmidt     }
62977453882SBenjamin Herrenschmidt 
63077453882SBenjamin Herrenschmidt     /* PAUSE being set will deactivate (or prevent activation)
63177453882SBenjamin Herrenschmidt      * of the channel. We just copy it over for now, ACTIVE will
63277453882SBenjamin Herrenschmidt      * be re-evaluated later.
63377453882SBenjamin Herrenschmidt      */
63477453882SBenjamin Herrenschmidt     if (mask & PAUSE) {
63577453882SBenjamin Herrenschmidt         status = (status & ~PAUSE) | (value & PAUSE);
63677453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, " %sing PAUSE !\n",
63777453882SBenjamin Herrenschmidt                         (value & PAUSE) ? "sett" : "clear");
63877453882SBenjamin Herrenschmidt     }
63977453882SBenjamin Herrenschmidt 
64077453882SBenjamin Herrenschmidt     /* FLUSH is its own thing */
64177453882SBenjamin Herrenschmidt     if ((mask & FLUSH) && (value & FLUSH))  {
64277453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, " Setting FLUSH !\n");
64377453882SBenjamin Herrenschmidt         /* We set flush directly in the status register, we do *NOT*
64477453882SBenjamin Herrenschmidt          * set it in "status" so that it gets naturally cleared when
64577453882SBenjamin Herrenschmidt          * we update the status register further down. That way it
64677453882SBenjamin Herrenschmidt          * will be set only during the HW flush operation so it is
64777453882SBenjamin Herrenschmidt          * visible to any completions happening during that time.
64877453882SBenjamin Herrenschmidt          */
64977453882SBenjamin Herrenschmidt         ch->regs[DBDMA_STATUS] |= FLUSH;
65077453882SBenjamin Herrenschmidt         do_flush = true;
65177453882SBenjamin Herrenschmidt     }
65277453882SBenjamin Herrenschmidt 
65377453882SBenjamin Herrenschmidt     /* If either RUN or PAUSE is clear, so should ACTIVE be,
65477453882SBenjamin Herrenschmidt      * otherwise, ACTIVE will be set if we modified RUN, PAUSE or
65577453882SBenjamin Herrenschmidt      * set WAKE. That means that PAUSE was just cleared, RUN was
65677453882SBenjamin Herrenschmidt      * just set or WAKE was just set.
65777453882SBenjamin Herrenschmidt      */
65877453882SBenjamin Herrenschmidt     if ((status & PAUSE) || !(status & RUN)) {
65928ce5ce6Saurel32         status &= ~ACTIVE;
66077453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, "  -> ACTIVE down !\n");
66177453882SBenjamin Herrenschmidt 
66277453882SBenjamin Herrenschmidt         /* We stopped processing, we want the underlying HW command
66377453882SBenjamin Herrenschmidt          * to complete *before* we clear the ACTIVE bit. Otherwise
66477453882SBenjamin Herrenschmidt          * we can get into a situation where the command status will
66577453882SBenjamin Herrenschmidt          * have RUN or ACTIVE not set which is going to confuse the
66677453882SBenjamin Herrenschmidt          * MacOS driver.
66777453882SBenjamin Herrenschmidt          */
66877453882SBenjamin Herrenschmidt         do_flush = true;
66977453882SBenjamin Herrenschmidt     } else if (mask & (RUN | PAUSE)) {
67077453882SBenjamin Herrenschmidt         status |= ACTIVE;
67177453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, " -> ACTIVE up !\n");
67277453882SBenjamin Herrenschmidt     } else if ((mask & WAKE) && (value & WAKE)) {
67377453882SBenjamin Herrenschmidt         status |= ACTIVE;
67477453882SBenjamin Herrenschmidt         DBDMA_DPRINTFCH(ch, " -> ACTIVE up !\n");
6751cde732dSMark Cave-Ayland     }
6761cde732dSMark Cave-Ayland 
67777453882SBenjamin Herrenschmidt     DBDMA_DPRINTFCH(ch, " new status=0x%08x\n", status);
67877453882SBenjamin Herrenschmidt 
67977453882SBenjamin Herrenschmidt     /* If we need to flush the underlying HW, do it now, this happens
68077453882SBenjamin Herrenschmidt      * both on FLUSH commands and when stopping the channel for safety.
68177453882SBenjamin Herrenschmidt      */
68277453882SBenjamin Herrenschmidt     if (do_flush && ch->flush) {
683987422bcSAmadeusz Sławiński         ch->flush(&ch->io);
684987422bcSAmadeusz Sławiński     }
68528ce5ce6Saurel32 
68677453882SBenjamin Herrenschmidt     /* Finally update the status register image */
687ad674e53SAurelien Jarno     ch->regs[DBDMA_STATUS] = status;
68828ce5ce6Saurel32 
68977453882SBenjamin Herrenschmidt     /* If active, make sure the BH gets to run */
690d2f0ce21SAlexander Graf     if (status & ACTIVE) {
691d2f0ce21SAlexander Graf         DBDMA_kick(dbdma_from_ch(ch));
692d2f0ce21SAlexander Graf     }
693d2f0ce21SAlexander Graf }
6943cbee15bSj_mayer 
695a8170e5eSAvi Kivity static void dbdma_write(void *opaque, hwaddr addr,
69623c5e4caSAvi Kivity                         uint64_t value, unsigned size)
6973cbee15bSj_mayer {
69828ce5ce6Saurel32     int channel = addr >> DBDMA_CHANNEL_SHIFT;
699c20df14bSJuan Quintela     DBDMAState *s = opaque;
700c20df14bSJuan Quintela     DBDMA_channel *ch = &s->channels[channel];
70128ce5ce6Saurel32     int reg = (addr - (channel << DBDMA_CHANNEL_SHIFT)) >> 2;
70228ce5ce6Saurel32 
7033e49c439SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "writel 0x" TARGET_FMT_plx " <= 0x%08"PRIx64"\n",
70458c0c311SAlexander Graf                     addr, value);
7053e49c439SMark Cave-Ayland     DBDMA_DPRINTFCH(ch, "channel 0x%x reg 0x%x\n",
70628ce5ce6Saurel32                     (uint32_t)addr >> DBDMA_CHANNEL_SHIFT, reg);
70728ce5ce6Saurel32 
7087eaba824SAlexander Graf     /* cmdptr cannot be modified if channel is ACTIVE */
70928ce5ce6Saurel32 
7107eaba824SAlexander Graf     if (reg == DBDMA_CMDPTR_LO && (ch->regs[DBDMA_STATUS] & ACTIVE)) {
71128ce5ce6Saurel32         return;
7127eaba824SAlexander Graf     }
71328ce5ce6Saurel32 
71428ce5ce6Saurel32     ch->regs[reg] = value;
71528ce5ce6Saurel32 
71628ce5ce6Saurel32     switch(reg) {
71728ce5ce6Saurel32     case DBDMA_CONTROL:
71828ce5ce6Saurel32         dbdma_control_write(ch);
71928ce5ce6Saurel32         break;
72028ce5ce6Saurel32     case DBDMA_CMDPTR_LO:
72128ce5ce6Saurel32         /* 16-byte aligned */
722ad674e53SAurelien Jarno         ch->regs[DBDMA_CMDPTR_LO] &= ~0xf;
72328ce5ce6Saurel32         dbdma_cmdptr_load(ch);
72428ce5ce6Saurel32         break;
72528ce5ce6Saurel32     case DBDMA_STATUS:
72628ce5ce6Saurel32     case DBDMA_INTR_SEL:
72728ce5ce6Saurel32     case DBDMA_BRANCH_SEL:
72828ce5ce6Saurel32     case DBDMA_WAIT_SEL:
72928ce5ce6Saurel32         /* nothing to do */
73028ce5ce6Saurel32         break;
73128ce5ce6Saurel32     case DBDMA_XFER_MODE:
73228ce5ce6Saurel32     case DBDMA_CMDPTR_HI:
73328ce5ce6Saurel32     case DBDMA_DATA2PTR_HI:
73428ce5ce6Saurel32     case DBDMA_DATA2PTR_LO:
73528ce5ce6Saurel32     case DBDMA_ADDRESS_HI:
73628ce5ce6Saurel32     case DBDMA_BRANCH_ADDR_HI:
73728ce5ce6Saurel32     case DBDMA_RES1:
73828ce5ce6Saurel32     case DBDMA_RES2:
73928ce5ce6Saurel32     case DBDMA_RES3:
74028ce5ce6Saurel32     case DBDMA_RES4:
74128ce5ce6Saurel32         /* unused */
74228ce5ce6Saurel32         break;
7433cbee15bSj_mayer     }
7443cbee15bSj_mayer }
7453cbee15bSj_mayer 
746a8170e5eSAvi Kivity static uint64_t dbdma_read(void *opaque, hwaddr addr,
74723c5e4caSAvi Kivity                            unsigned size)
7483cbee15bSj_mayer {
74928ce5ce6Saurel32     uint32_t value;
75028ce5ce6Saurel32     int channel = addr >> DBDMA_CHANNEL_SHIFT;
751c20df14bSJuan Quintela     DBDMAState *s = opaque;
752c20df14bSJuan Quintela     DBDMA_channel *ch = &s->channels[channel];
75328ce5ce6Saurel32     int reg = (addr - (channel << DBDMA_CHANNEL_SHIFT)) >> 2;
754ea026b2fSblueswir1 
75528ce5ce6Saurel32     value = ch->regs[reg];
75628ce5ce6Saurel32 
75728ce5ce6Saurel32     switch(reg) {
75828ce5ce6Saurel32     case DBDMA_CONTROL:
75977453882SBenjamin Herrenschmidt         value = ch->regs[DBDMA_STATUS];
76028ce5ce6Saurel32         break;
76128ce5ce6Saurel32     case DBDMA_STATUS:
76228ce5ce6Saurel32     case DBDMA_CMDPTR_LO:
76328ce5ce6Saurel32     case DBDMA_INTR_SEL:
76428ce5ce6Saurel32     case DBDMA_BRANCH_SEL:
76528ce5ce6Saurel32     case DBDMA_WAIT_SEL:
76628ce5ce6Saurel32         /* nothing to do */
76728ce5ce6Saurel32         break;
76828ce5ce6Saurel32     case DBDMA_XFER_MODE:
76928ce5ce6Saurel32     case DBDMA_CMDPTR_HI:
77028ce5ce6Saurel32     case DBDMA_DATA2PTR_HI:
77128ce5ce6Saurel32     case DBDMA_DATA2PTR_LO:
77228ce5ce6Saurel32     case DBDMA_ADDRESS_HI:
77328ce5ce6Saurel32     case DBDMA_BRANCH_ADDR_HI:
77428ce5ce6Saurel32         /* unused */
77528ce5ce6Saurel32         value = 0;
77628ce5ce6Saurel32         break;
77728ce5ce6Saurel32     case DBDMA_RES1:
77828ce5ce6Saurel32     case DBDMA_RES2:
77928ce5ce6Saurel32     case DBDMA_RES3:
78028ce5ce6Saurel32     case DBDMA_RES4:
78128ce5ce6Saurel32         /* reserved */
78228ce5ce6Saurel32         break;
78328ce5ce6Saurel32     }
78428ce5ce6Saurel32 
78577453882SBenjamin Herrenschmidt     DBDMA_DPRINTFCH(ch, "readl 0x" TARGET_FMT_plx " => 0x%08x\n", addr, value);
78677453882SBenjamin Herrenschmidt     DBDMA_DPRINTFCH(ch, "channel 0x%x reg 0x%x\n",
78777453882SBenjamin Herrenschmidt                     (uint32_t)addr >> DBDMA_CHANNEL_SHIFT, reg);
78877453882SBenjamin Herrenschmidt 
78928ce5ce6Saurel32     return value;
7903cbee15bSj_mayer }
7913cbee15bSj_mayer 
79223c5e4caSAvi Kivity static const MemoryRegionOps dbdma_ops = {
79323c5e4caSAvi Kivity     .read = dbdma_read,
79423c5e4caSAvi Kivity     .write = dbdma_write,
79523c5e4caSAvi Kivity     .endianness = DEVICE_LITTLE_ENDIAN,
79623c5e4caSAvi Kivity     .valid = {
79723c5e4caSAvi Kivity         .min_access_size = 4,
79823c5e4caSAvi Kivity         .max_access_size = 4,
79923c5e4caSAvi Kivity     },
8003cbee15bSj_mayer };
8013cbee15bSj_mayer 
802627be2f2SMark Cave-Ayland static const VMStateDescription vmstate_dbdma_io = {
803627be2f2SMark Cave-Ayland     .name = "dbdma_io",
804da26fdc3SJuan Quintela     .version_id = 0,
805da26fdc3SJuan Quintela     .minimum_version_id = 0,
806da26fdc3SJuan Quintela     .fields = (VMStateField[]) {
807627be2f2SMark Cave-Ayland         VMSTATE_UINT64(addr, struct DBDMA_io),
808627be2f2SMark Cave-Ayland         VMSTATE_INT32(len, struct DBDMA_io),
809627be2f2SMark Cave-Ayland         VMSTATE_INT32(is_last, struct DBDMA_io),
810627be2f2SMark Cave-Ayland         VMSTATE_INT32(is_dma_out, struct DBDMA_io),
811627be2f2SMark Cave-Ayland         VMSTATE_BOOL(processing, struct DBDMA_io),
812627be2f2SMark Cave-Ayland         VMSTATE_END_OF_LIST()
813627be2f2SMark Cave-Ayland     }
814627be2f2SMark Cave-Ayland };
815627be2f2SMark Cave-Ayland 
816627be2f2SMark Cave-Ayland static const VMStateDescription vmstate_dbdma_cmd = {
817627be2f2SMark Cave-Ayland     .name = "dbdma_cmd",
818627be2f2SMark Cave-Ayland     .version_id = 0,
819627be2f2SMark Cave-Ayland     .minimum_version_id = 0,
820627be2f2SMark Cave-Ayland     .fields = (VMStateField[]) {
821627be2f2SMark Cave-Ayland         VMSTATE_UINT16(req_count, dbdma_cmd),
822627be2f2SMark Cave-Ayland         VMSTATE_UINT16(command, dbdma_cmd),
823627be2f2SMark Cave-Ayland         VMSTATE_UINT32(phy_addr, dbdma_cmd),
824627be2f2SMark Cave-Ayland         VMSTATE_UINT32(cmd_dep, dbdma_cmd),
825627be2f2SMark Cave-Ayland         VMSTATE_UINT16(res_count, dbdma_cmd),
826627be2f2SMark Cave-Ayland         VMSTATE_UINT16(xfer_status, dbdma_cmd),
827627be2f2SMark Cave-Ayland         VMSTATE_END_OF_LIST()
828627be2f2SMark Cave-Ayland     }
829627be2f2SMark Cave-Ayland };
830627be2f2SMark Cave-Ayland 
831627be2f2SMark Cave-Ayland static const VMStateDescription vmstate_dbdma_channel = {
832627be2f2SMark Cave-Ayland     .name = "dbdma_channel",
833627be2f2SMark Cave-Ayland     .version_id = 1,
834627be2f2SMark Cave-Ayland     .minimum_version_id = 1,
835627be2f2SMark Cave-Ayland     .fields = (VMStateField[]) {
836da26fdc3SJuan Quintela         VMSTATE_UINT32_ARRAY(regs, struct DBDMA_channel, DBDMA_REGS),
837627be2f2SMark Cave-Ayland         VMSTATE_STRUCT(io, struct DBDMA_channel, 0, vmstate_dbdma_io, DBDMA_io),
838627be2f2SMark Cave-Ayland         VMSTATE_STRUCT(current, struct DBDMA_channel, 0, vmstate_dbdma_cmd,
839627be2f2SMark Cave-Ayland                        dbdma_cmd),
840da26fdc3SJuan Quintela         VMSTATE_END_OF_LIST()
8419b64997fSblueswir1     }
842da26fdc3SJuan Quintela };
8439b64997fSblueswir1 
844da26fdc3SJuan Quintela static const VMStateDescription vmstate_dbdma = {
845da26fdc3SJuan Quintela     .name = "dbdma",
846627be2f2SMark Cave-Ayland     .version_id = 3,
847627be2f2SMark Cave-Ayland     .minimum_version_id = 3,
848da26fdc3SJuan Quintela     .fields = (VMStateField[]) {
849da26fdc3SJuan Quintela         VMSTATE_STRUCT_ARRAY(channels, DBDMAState, DBDMA_CHANNELS, 1,
850da26fdc3SJuan Quintela                              vmstate_dbdma_channel, DBDMA_channel),
851da26fdc3SJuan Quintela         VMSTATE_END_OF_LIST()
8529b64997fSblueswir1     }
853da26fdc3SJuan Quintela };
8549b64997fSblueswir1 
8551d27f351SMark Cave-Ayland static void mac_dbdma_reset(DeviceState *d)
8566e6b7363Sblueswir1 {
8571d27f351SMark Cave-Ayland     DBDMAState *s = MAC_DBDMA(d);
85828ce5ce6Saurel32     int i;
85928ce5ce6Saurel32 
8601d27f351SMark Cave-Ayland     for (i = 0; i < DBDMA_CHANNELS; i++) {
861c20df14bSJuan Quintela         memset(s->channels[i].regs, 0, DBDMA_SIZE);
8626e6b7363Sblueswir1     }
8631d27f351SMark Cave-Ayland }
8646e6b7363Sblueswir1 
8652d7d06d8SHervé Poussineau static void dbdma_unassigned_rw(DBDMA_io *io)
8662d7d06d8SHervé Poussineau {
8672d7d06d8SHervé Poussineau     DBDMA_channel *ch = io->channel;
86877453882SBenjamin Herrenschmidt     dbdma_cmd *current = &ch->current;
86977453882SBenjamin Herrenschmidt     uint16_t cmd;
8702d7d06d8SHervé Poussineau     qemu_log_mask(LOG_GUEST_ERROR, "%s: use of unassigned channel %d\n",
8712d7d06d8SHervé Poussineau                   __func__, ch->channel);
8722df77896SMark Cave-Ayland     ch->io.processing = false;
87377453882SBenjamin Herrenschmidt 
87477453882SBenjamin Herrenschmidt     cmd = le16_to_cpu(current->command) & COMMAND_MASK;
87577453882SBenjamin Herrenschmidt     if (cmd == OUTPUT_MORE || cmd == OUTPUT_LAST ||
87677453882SBenjamin Herrenschmidt         cmd == INPUT_MORE || cmd == INPUT_LAST) {
87777453882SBenjamin Herrenschmidt         current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]);
87877453882SBenjamin Herrenschmidt         current->res_count = cpu_to_le16(io->len);
87977453882SBenjamin Herrenschmidt         dbdma_cmdptr_save(ch);
88077453882SBenjamin Herrenschmidt     }
8812d7d06d8SHervé Poussineau }
8822d7d06d8SHervé Poussineau 
8832d7d06d8SHervé Poussineau static void dbdma_unassigned_flush(DBDMA_io *io)
8842d7d06d8SHervé Poussineau {
8852d7d06d8SHervé Poussineau     DBDMA_channel *ch = io->channel;
8862d7d06d8SHervé Poussineau     qemu_log_mask(LOG_GUEST_ERROR, "%s: use of unassigned channel %d\n",
8872d7d06d8SHervé Poussineau                   __func__, ch->channel);
8882d7d06d8SHervé Poussineau }
8892d7d06d8SHervé Poussineau 
8901d27f351SMark Cave-Ayland static void mac_dbdma_init(Object *obj)
8911d27f351SMark Cave-Ayland {
8921d27f351SMark Cave-Ayland     SysBusDevice *sbd = SYS_BUS_DEVICE(obj);
8931d27f351SMark Cave-Ayland     DBDMAState *s = MAC_DBDMA(obj);
8941d27f351SMark Cave-Ayland     int i;
89528ce5ce6Saurel32 
8963e300fa6SAlexander Graf     for (i = 0; i < DBDMA_CHANNELS; i++) {
8972d7d06d8SHervé Poussineau         DBDMA_channel *ch = &s->channels[i];
8982d7d06d8SHervé Poussineau 
8992d7d06d8SHervé Poussineau         ch->rw = dbdma_unassigned_rw;
9002d7d06d8SHervé Poussineau         ch->flush = dbdma_unassigned_flush;
9012d7d06d8SHervé Poussineau         ch->channel = i;
9022d7d06d8SHervé Poussineau         ch->io.channel = ch;
9033e300fa6SAlexander Graf     }
9043e300fa6SAlexander Graf 
9051d27f351SMark Cave-Ayland     memory_region_init_io(&s->mem, obj, &dbdma_ops, s, "dbdma", 0x1000);
9061d27f351SMark Cave-Ayland     sysbus_init_mmio(sbd, &s->mem);
9071d27f351SMark Cave-Ayland }
9081d27f351SMark Cave-Ayland 
9091d27f351SMark Cave-Ayland static void mac_dbdma_realize(DeviceState *dev, Error **errp)
9101d27f351SMark Cave-Ayland {
9111d27f351SMark Cave-Ayland     DBDMAState *s = MAC_DBDMA(dev);
91228ce5ce6Saurel32 
913d2f0ce21SAlexander Graf     s->bh = qemu_bh_new(DBDMA_run_bh, s);
9143cbee15bSj_mayer }
9151d27f351SMark Cave-Ayland 
9161d27f351SMark Cave-Ayland static void mac_dbdma_class_init(ObjectClass *oc, void *data)
9171d27f351SMark Cave-Ayland {
9181d27f351SMark Cave-Ayland     DeviceClass *dc = DEVICE_CLASS(oc);
9191d27f351SMark Cave-Ayland 
9201d27f351SMark Cave-Ayland     dc->realize = mac_dbdma_realize;
9211d27f351SMark Cave-Ayland     dc->reset = mac_dbdma_reset;
9221d27f351SMark Cave-Ayland     dc->vmsd = &vmstate_dbdma;
9231d27f351SMark Cave-Ayland }
9241d27f351SMark Cave-Ayland 
9251d27f351SMark Cave-Ayland static const TypeInfo mac_dbdma_type_info = {
9261d27f351SMark Cave-Ayland     .name = TYPE_MAC_DBDMA,
9271d27f351SMark Cave-Ayland     .parent = TYPE_SYS_BUS_DEVICE,
9281d27f351SMark Cave-Ayland     .instance_size = sizeof(DBDMAState),
9291d27f351SMark Cave-Ayland     .instance_init = mac_dbdma_init,
9301d27f351SMark Cave-Ayland     .class_init = mac_dbdma_class_init
9311d27f351SMark Cave-Ayland };
9321d27f351SMark Cave-Ayland 
9331d27f351SMark Cave-Ayland static void mac_dbdma_register_types(void)
9341d27f351SMark Cave-Ayland {
9351d27f351SMark Cave-Ayland     type_register_static(&mac_dbdma_type_info);
9361d27f351SMark Cave-Ayland }
9371d27f351SMark Cave-Ayland 
9381d27f351SMark Cave-Ayland type_init(mac_dbdma_register_types)
939