xref: /qemu/hw/misc/macio/mac_dbdma.c (revision 03dd024ff57733a55cd2e455f361d053c81b1b29)
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"
44*03dd024fSPaolo Bonzini #include "qemu/log.h"
453cbee15bSj_mayer 
46ea026b2fSblueswir1 /* debug DBDMA */
47ea026b2fSblueswir1 //#define DEBUG_DBDMA
48ea026b2fSblueswir1 
49ea026b2fSblueswir1 #ifdef DEBUG_DBDMA
50001faf32SBlue Swirl #define DBDMA_DPRINTF(fmt, ...)                                 \
51001faf32SBlue Swirl     do { printf("DBDMA: " fmt , ## __VA_ARGS__); } while (0)
52ea026b2fSblueswir1 #else
53001faf32SBlue Swirl #define DBDMA_DPRINTF(fmt, ...)
54ea026b2fSblueswir1 #endif
55ea026b2fSblueswir1 
5628ce5ce6Saurel32 /*
5728ce5ce6Saurel32  */
583cbee15bSj_mayer 
59d2f0ce21SAlexander Graf static DBDMAState *dbdma_from_ch(DBDMA_channel *ch)
60d2f0ce21SAlexander Graf {
61d2f0ce21SAlexander Graf     return container_of(ch, DBDMAState, channels[ch->channel]);
62d2f0ce21SAlexander Graf }
63d2f0ce21SAlexander Graf 
6428ce5ce6Saurel32 #ifdef DEBUG_DBDMA
6528ce5ce6Saurel32 static void dump_dbdma_cmd(dbdma_cmd *cmd)
663cbee15bSj_mayer {
6728ce5ce6Saurel32     printf("dbdma_cmd %p\n", cmd);
6828ce5ce6Saurel32     printf("    req_count 0x%04x\n", le16_to_cpu(cmd->req_count));
6928ce5ce6Saurel32     printf("    command 0x%04x\n", le16_to_cpu(cmd->command));
7028ce5ce6Saurel32     printf("    phy_addr 0x%08x\n", le32_to_cpu(cmd->phy_addr));
7128ce5ce6Saurel32     printf("    cmd_dep 0x%08x\n", le32_to_cpu(cmd->cmd_dep));
7228ce5ce6Saurel32     printf("    res_count 0x%04x\n", le16_to_cpu(cmd->res_count));
7328ce5ce6Saurel32     printf("    xfer_status 0x%04x\n", le16_to_cpu(cmd->xfer_status));
7428ce5ce6Saurel32 }
7528ce5ce6Saurel32 #else
7628ce5ce6Saurel32 static void dump_dbdma_cmd(dbdma_cmd *cmd)
7728ce5ce6Saurel32 {
7828ce5ce6Saurel32 }
7928ce5ce6Saurel32 #endif
8028ce5ce6Saurel32 static void dbdma_cmdptr_load(DBDMA_channel *ch)
8128ce5ce6Saurel32 {
8228ce5ce6Saurel32     DBDMA_DPRINTF("dbdma_cmdptr_load 0x%08x\n",
83ad674e53SAurelien Jarno                   ch->regs[DBDMA_CMDPTR_LO]);
84ad674e53SAurelien Jarno     cpu_physical_memory_read(ch->regs[DBDMA_CMDPTR_LO],
85e1fe50dcSStefan Weil                              &ch->current, sizeof(dbdma_cmd));
863cbee15bSj_mayer }
873cbee15bSj_mayer 
8828ce5ce6Saurel32 static void dbdma_cmdptr_save(DBDMA_channel *ch)
893cbee15bSj_mayer {
9028ce5ce6Saurel32     DBDMA_DPRINTF("dbdma_cmdptr_save 0x%08x\n",
91ad674e53SAurelien Jarno                   ch->regs[DBDMA_CMDPTR_LO]);
9228ce5ce6Saurel32     DBDMA_DPRINTF("xfer_status 0x%08x res_count 0x%04x\n",
9328ce5ce6Saurel32                   le16_to_cpu(ch->current.xfer_status),
9428ce5ce6Saurel32                   le16_to_cpu(ch->current.res_count));
95ad674e53SAurelien Jarno     cpu_physical_memory_write(ch->regs[DBDMA_CMDPTR_LO],
96e1fe50dcSStefan Weil                               &ch->current, sizeof(dbdma_cmd));
9728ce5ce6Saurel32 }
9828ce5ce6Saurel32 
9928ce5ce6Saurel32 static void kill_channel(DBDMA_channel *ch)
10028ce5ce6Saurel32 {
10128ce5ce6Saurel32     DBDMA_DPRINTF("kill_channel\n");
10228ce5ce6Saurel32 
103ad674e53SAurelien Jarno     ch->regs[DBDMA_STATUS] |= DEAD;
104ad674e53SAurelien Jarno     ch->regs[DBDMA_STATUS] &= ~ACTIVE;
10528ce5ce6Saurel32 
10628ce5ce6Saurel32     qemu_irq_raise(ch->irq);
10728ce5ce6Saurel32 }
10828ce5ce6Saurel32 
10928ce5ce6Saurel32 static void conditional_interrupt(DBDMA_channel *ch)
11028ce5ce6Saurel32 {
11128ce5ce6Saurel32     dbdma_cmd *current = &ch->current;
11228ce5ce6Saurel32     uint16_t intr;
11328ce5ce6Saurel32     uint16_t sel_mask, sel_value;
11428ce5ce6Saurel32     uint32_t status;
11528ce5ce6Saurel32     int cond;
11628ce5ce6Saurel32 
11733ce36bbSAlexander Graf     DBDMA_DPRINTF("%s\n", __func__);
11828ce5ce6Saurel32 
119b42ec42dSaurel32     intr = le16_to_cpu(current->command) & INTR_MASK;
12028ce5ce6Saurel32 
12128ce5ce6Saurel32     switch(intr) {
12228ce5ce6Saurel32     case INTR_NEVER:  /* don't interrupt */
12328ce5ce6Saurel32         return;
12428ce5ce6Saurel32     case INTR_ALWAYS: /* always interrupt */
12528ce5ce6Saurel32         qemu_irq_raise(ch->irq);
12633ce36bbSAlexander Graf         DBDMA_DPRINTF("%s: raise\n", __func__);
12728ce5ce6Saurel32         return;
12828ce5ce6Saurel32     }
12928ce5ce6Saurel32 
130ad674e53SAurelien Jarno     status = ch->regs[DBDMA_STATUS] & DEVSTAT;
13128ce5ce6Saurel32 
132ad674e53SAurelien Jarno     sel_mask = (ch->regs[DBDMA_INTR_SEL] >> 16) & 0x0f;
133ad674e53SAurelien Jarno     sel_value = ch->regs[DBDMA_INTR_SEL] & 0x0f;
13428ce5ce6Saurel32 
13528ce5ce6Saurel32     cond = (status & sel_mask) == (sel_value & sel_mask);
13628ce5ce6Saurel32 
13728ce5ce6Saurel32     switch(intr) {
13828ce5ce6Saurel32     case INTR_IFSET:  /* intr if condition bit is 1 */
13933ce36bbSAlexander Graf         if (cond) {
14028ce5ce6Saurel32             qemu_irq_raise(ch->irq);
14133ce36bbSAlexander Graf             DBDMA_DPRINTF("%s: raise\n", __func__);
14233ce36bbSAlexander Graf         }
14328ce5ce6Saurel32         return;
14428ce5ce6Saurel32     case INTR_IFCLR:  /* intr if condition bit is 0 */
14533ce36bbSAlexander Graf         if (!cond) {
14628ce5ce6Saurel32             qemu_irq_raise(ch->irq);
14733ce36bbSAlexander Graf             DBDMA_DPRINTF("%s: raise\n", __func__);
14833ce36bbSAlexander Graf         }
14928ce5ce6Saurel32         return;
15028ce5ce6Saurel32     }
15128ce5ce6Saurel32 }
15228ce5ce6Saurel32 
15328ce5ce6Saurel32 static int conditional_wait(DBDMA_channel *ch)
15428ce5ce6Saurel32 {
15528ce5ce6Saurel32     dbdma_cmd *current = &ch->current;
15628ce5ce6Saurel32     uint16_t wait;
15728ce5ce6Saurel32     uint16_t sel_mask, sel_value;
15828ce5ce6Saurel32     uint32_t status;
15928ce5ce6Saurel32     int cond;
16028ce5ce6Saurel32 
16128ce5ce6Saurel32     DBDMA_DPRINTF("conditional_wait\n");
16228ce5ce6Saurel32 
163b42ec42dSaurel32     wait = le16_to_cpu(current->command) & WAIT_MASK;
16428ce5ce6Saurel32 
16528ce5ce6Saurel32     switch(wait) {
16628ce5ce6Saurel32     case WAIT_NEVER:  /* don't wait */
16728ce5ce6Saurel32         return 0;
16828ce5ce6Saurel32     case WAIT_ALWAYS: /* always wait */
16928ce5ce6Saurel32         return 1;
17028ce5ce6Saurel32     }
17128ce5ce6Saurel32 
172ad674e53SAurelien Jarno     status = ch->regs[DBDMA_STATUS] & DEVSTAT;
17328ce5ce6Saurel32 
174ad674e53SAurelien Jarno     sel_mask = (ch->regs[DBDMA_WAIT_SEL] >> 16) & 0x0f;
175ad674e53SAurelien Jarno     sel_value = ch->regs[DBDMA_WAIT_SEL] & 0x0f;
17628ce5ce6Saurel32 
17728ce5ce6Saurel32     cond = (status & sel_mask) == (sel_value & sel_mask);
17828ce5ce6Saurel32 
17928ce5ce6Saurel32     switch(wait) {
18028ce5ce6Saurel32     case WAIT_IFSET:  /* wait if condition bit is 1 */
18128ce5ce6Saurel32         if (cond)
18228ce5ce6Saurel32             return 1;
18328ce5ce6Saurel32         return 0;
18428ce5ce6Saurel32     case WAIT_IFCLR:  /* wait if condition bit is 0 */
18528ce5ce6Saurel32         if (!cond)
18628ce5ce6Saurel32             return 1;
18728ce5ce6Saurel32         return 0;
18828ce5ce6Saurel32     }
18928ce5ce6Saurel32     return 0;
19028ce5ce6Saurel32 }
19128ce5ce6Saurel32 
19228ce5ce6Saurel32 static void next(DBDMA_channel *ch)
19328ce5ce6Saurel32 {
19428ce5ce6Saurel32     uint32_t cp;
19528ce5ce6Saurel32 
196ad674e53SAurelien Jarno     ch->regs[DBDMA_STATUS] &= ~BT;
19728ce5ce6Saurel32 
198ad674e53SAurelien Jarno     cp = ch->regs[DBDMA_CMDPTR_LO];
199ad674e53SAurelien Jarno     ch->regs[DBDMA_CMDPTR_LO] = cp + sizeof(dbdma_cmd);
20028ce5ce6Saurel32     dbdma_cmdptr_load(ch);
20128ce5ce6Saurel32 }
20228ce5ce6Saurel32 
20328ce5ce6Saurel32 static void branch(DBDMA_channel *ch)
20428ce5ce6Saurel32 {
20528ce5ce6Saurel32     dbdma_cmd *current = &ch->current;
20628ce5ce6Saurel32 
20728ce5ce6Saurel32     ch->regs[DBDMA_CMDPTR_LO] = current->cmd_dep;
208ad674e53SAurelien Jarno     ch->regs[DBDMA_STATUS] |= BT;
20928ce5ce6Saurel32     dbdma_cmdptr_load(ch);
21028ce5ce6Saurel32 }
21128ce5ce6Saurel32 
21228ce5ce6Saurel32 static void conditional_branch(DBDMA_channel *ch)
21328ce5ce6Saurel32 {
21428ce5ce6Saurel32     dbdma_cmd *current = &ch->current;
21528ce5ce6Saurel32     uint16_t br;
21628ce5ce6Saurel32     uint16_t sel_mask, sel_value;
21728ce5ce6Saurel32     uint32_t status;
21828ce5ce6Saurel32     int cond;
21928ce5ce6Saurel32 
22028ce5ce6Saurel32     DBDMA_DPRINTF("conditional_branch\n");
22128ce5ce6Saurel32 
22228ce5ce6Saurel32     /* check if we must branch */
22328ce5ce6Saurel32 
224b42ec42dSaurel32     br = le16_to_cpu(current->command) & BR_MASK;
22528ce5ce6Saurel32 
22628ce5ce6Saurel32     switch(br) {
22728ce5ce6Saurel32     case BR_NEVER:  /* don't branch */
22828ce5ce6Saurel32         next(ch);
22928ce5ce6Saurel32         return;
23028ce5ce6Saurel32     case BR_ALWAYS: /* always branch */
23128ce5ce6Saurel32         branch(ch);
23228ce5ce6Saurel32         return;
23328ce5ce6Saurel32     }
23428ce5ce6Saurel32 
235ad674e53SAurelien Jarno     status = ch->regs[DBDMA_STATUS] & DEVSTAT;
23628ce5ce6Saurel32 
237ad674e53SAurelien Jarno     sel_mask = (ch->regs[DBDMA_BRANCH_SEL] >> 16) & 0x0f;
238ad674e53SAurelien Jarno     sel_value = ch->regs[DBDMA_BRANCH_SEL] & 0x0f;
23928ce5ce6Saurel32 
24028ce5ce6Saurel32     cond = (status & sel_mask) == (sel_value & sel_mask);
24128ce5ce6Saurel32 
24228ce5ce6Saurel32     switch(br) {
24328ce5ce6Saurel32     case BR_IFSET:  /* branch if condition bit is 1 */
24428ce5ce6Saurel32         if (cond)
24528ce5ce6Saurel32             branch(ch);
24628ce5ce6Saurel32         else
24728ce5ce6Saurel32             next(ch);
24828ce5ce6Saurel32         return;
24928ce5ce6Saurel32     case BR_IFCLR:  /* branch if condition bit is 0 */
25028ce5ce6Saurel32         if (!cond)
25128ce5ce6Saurel32             branch(ch);
25228ce5ce6Saurel32         else
25328ce5ce6Saurel32             next(ch);
25428ce5ce6Saurel32         return;
25528ce5ce6Saurel32     }
25628ce5ce6Saurel32 }
25728ce5ce6Saurel32 
258b42ec42dSaurel32 static void channel_run(DBDMA_channel *ch);
259b42ec42dSaurel32 
260b42ec42dSaurel32 static void dbdma_end(DBDMA_io *io)
26128ce5ce6Saurel32 {
26228ce5ce6Saurel32     DBDMA_channel *ch = io->channel;
26328ce5ce6Saurel32     dbdma_cmd *current = &ch->current;
26428ce5ce6Saurel32 
26533ce36bbSAlexander Graf     DBDMA_DPRINTF("%s\n", __func__);
26633ce36bbSAlexander Graf 
267b42ec42dSaurel32     if (conditional_wait(ch))
268b42ec42dSaurel32         goto wait;
26928ce5ce6Saurel32 
270ad674e53SAurelien Jarno     current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]);
271ad674e53SAurelien Jarno     current->res_count = cpu_to_le16(io->len);
272b42ec42dSaurel32     dbdma_cmdptr_save(ch);
273862c9280Saurel32     if (io->is_last)
274ad674e53SAurelien Jarno         ch->regs[DBDMA_STATUS] &= ~FLUSH;
27528ce5ce6Saurel32 
276b42ec42dSaurel32     conditional_interrupt(ch);
277b42ec42dSaurel32     conditional_branch(ch);
278b42ec42dSaurel32 
279b42ec42dSaurel32 wait:
28003ee3b1eSAlexander Graf     /* Indicate that we're ready for a new DMA round */
28103ee3b1eSAlexander Graf     ch->io.processing = false;
28203ee3b1eSAlexander Graf 
283ad674e53SAurelien Jarno     if ((ch->regs[DBDMA_STATUS] & RUN) &&
284ad674e53SAurelien Jarno         (ch->regs[DBDMA_STATUS] & ACTIVE))
285b42ec42dSaurel32         channel_run(ch);
28628ce5ce6Saurel32 }
28728ce5ce6Saurel32 
288b42ec42dSaurel32 static void start_output(DBDMA_channel *ch, int key, uint32_t addr,
28928ce5ce6Saurel32                         uint16_t req_count, int is_last)
29028ce5ce6Saurel32 {
29128ce5ce6Saurel32     DBDMA_DPRINTF("start_output\n");
29228ce5ce6Saurel32 
29328ce5ce6Saurel32     /* KEY_REGS, KEY_DEVICE and KEY_STREAM
29428ce5ce6Saurel32      * are not implemented in the mac-io chip
29528ce5ce6Saurel32      */
29628ce5ce6Saurel32 
29728ce5ce6Saurel32     DBDMA_DPRINTF("addr 0x%x key 0x%x\n", addr, key);
29828ce5ce6Saurel32     if (!addr || key > KEY_STREAM3) {
29928ce5ce6Saurel32         kill_channel(ch);
300b42ec42dSaurel32         return;
30128ce5ce6Saurel32     }
30228ce5ce6Saurel32 
303b42ec42dSaurel32     ch->io.addr = addr;
30428ce5ce6Saurel32     ch->io.len = req_count;
30528ce5ce6Saurel32     ch->io.is_last = is_last;
306b42ec42dSaurel32     ch->io.dma_end = dbdma_end;
307b42ec42dSaurel32     ch->io.is_dma_out = 1;
30803ee3b1eSAlexander Graf     ch->io.processing = true;
309a9ceb76dSAlexander Graf     if (ch->rw) {
310b42ec42dSaurel32         ch->rw(&ch->io);
31128ce5ce6Saurel32     }
312a9ceb76dSAlexander Graf }
31328ce5ce6Saurel32 
314b42ec42dSaurel32 static void start_input(DBDMA_channel *ch, int key, uint32_t addr,
31528ce5ce6Saurel32                        uint16_t req_count, int is_last)
31628ce5ce6Saurel32 {
31728ce5ce6Saurel32     DBDMA_DPRINTF("start_input\n");
31828ce5ce6Saurel32 
31928ce5ce6Saurel32     /* KEY_REGS, KEY_DEVICE and KEY_STREAM
32028ce5ce6Saurel32      * are not implemented in the mac-io chip
32128ce5ce6Saurel32      */
32228ce5ce6Saurel32 
32333ce36bbSAlexander Graf     DBDMA_DPRINTF("addr 0x%x key 0x%x\n", addr, key);
32428ce5ce6Saurel32     if (!addr || key > KEY_STREAM3) {
32528ce5ce6Saurel32         kill_channel(ch);
326b42ec42dSaurel32         return;
32728ce5ce6Saurel32     }
32828ce5ce6Saurel32 
329b42ec42dSaurel32     ch->io.addr = addr;
33028ce5ce6Saurel32     ch->io.len = req_count;
33128ce5ce6Saurel32     ch->io.is_last = is_last;
332b42ec42dSaurel32     ch->io.dma_end = dbdma_end;
333b42ec42dSaurel32     ch->io.is_dma_out = 0;
33403ee3b1eSAlexander Graf     ch->io.processing = true;
335a9ceb76dSAlexander Graf     if (ch->rw) {
336b42ec42dSaurel32         ch->rw(&ch->io);
33728ce5ce6Saurel32     }
338a9ceb76dSAlexander Graf }
33928ce5ce6Saurel32 
340b42ec42dSaurel32 static void load_word(DBDMA_channel *ch, int key, uint32_t addr,
34128ce5ce6Saurel32                      uint16_t len)
34228ce5ce6Saurel32 {
34328ce5ce6Saurel32     dbdma_cmd *current = &ch->current;
34428ce5ce6Saurel32     uint32_t val;
34528ce5ce6Saurel32 
34628ce5ce6Saurel32     DBDMA_DPRINTF("load_word\n");
34728ce5ce6Saurel32 
34828ce5ce6Saurel32     /* only implements KEY_SYSTEM */
34928ce5ce6Saurel32 
35028ce5ce6Saurel32     if (key != KEY_SYSTEM) {
35128ce5ce6Saurel32         printf("DBDMA: LOAD_WORD, unimplemented key %x\n", key);
35228ce5ce6Saurel32         kill_channel(ch);
353b42ec42dSaurel32         return;
35428ce5ce6Saurel32     }
35528ce5ce6Saurel32 
356e1fe50dcSStefan Weil     cpu_physical_memory_read(addr, &val, len);
35728ce5ce6Saurel32 
35828ce5ce6Saurel32     if (len == 2)
35928ce5ce6Saurel32         val = (val << 16) | (current->cmd_dep & 0x0000ffff);
36028ce5ce6Saurel32     else if (len == 1)
36128ce5ce6Saurel32         val = (val << 24) | (current->cmd_dep & 0x00ffffff);
36228ce5ce6Saurel32 
36328ce5ce6Saurel32     current->cmd_dep = val;
36428ce5ce6Saurel32 
36528ce5ce6Saurel32     if (conditional_wait(ch))
366b42ec42dSaurel32         goto wait;
36728ce5ce6Saurel32 
368ad674e53SAurelien Jarno     current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]);
36928ce5ce6Saurel32     dbdma_cmdptr_save(ch);
370ad674e53SAurelien Jarno     ch->regs[DBDMA_STATUS] &= ~FLUSH;
37128ce5ce6Saurel32 
37228ce5ce6Saurel32     conditional_interrupt(ch);
37328ce5ce6Saurel32     next(ch);
37428ce5ce6Saurel32 
375b42ec42dSaurel32 wait:
376d2f0ce21SAlexander Graf     DBDMA_kick(dbdma_from_ch(ch));
37728ce5ce6Saurel32 }
37828ce5ce6Saurel32 
379b42ec42dSaurel32 static void store_word(DBDMA_channel *ch, int key, uint32_t addr,
38028ce5ce6Saurel32                       uint16_t len)
38128ce5ce6Saurel32 {
38228ce5ce6Saurel32     dbdma_cmd *current = &ch->current;
38328ce5ce6Saurel32     uint32_t val;
38428ce5ce6Saurel32 
38528ce5ce6Saurel32     DBDMA_DPRINTF("store_word\n");
38628ce5ce6Saurel32 
38728ce5ce6Saurel32     /* only implements KEY_SYSTEM */
38828ce5ce6Saurel32 
38928ce5ce6Saurel32     if (key != KEY_SYSTEM) {
39028ce5ce6Saurel32         printf("DBDMA: STORE_WORD, unimplemented key %x\n", key);
39128ce5ce6Saurel32         kill_channel(ch);
392b42ec42dSaurel32         return;
39328ce5ce6Saurel32     }
39428ce5ce6Saurel32 
39528ce5ce6Saurel32     val = current->cmd_dep;
39628ce5ce6Saurel32     if (len == 2)
39728ce5ce6Saurel32         val >>= 16;
39828ce5ce6Saurel32     else if (len == 1)
39928ce5ce6Saurel32         val >>= 24;
40028ce5ce6Saurel32 
401e1fe50dcSStefan Weil     cpu_physical_memory_write(addr, &val, len);
40228ce5ce6Saurel32 
40328ce5ce6Saurel32     if (conditional_wait(ch))
404b42ec42dSaurel32         goto wait;
40528ce5ce6Saurel32 
406ad674e53SAurelien Jarno     current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]);
40728ce5ce6Saurel32     dbdma_cmdptr_save(ch);
408ad674e53SAurelien Jarno     ch->regs[DBDMA_STATUS] &= ~FLUSH;
40928ce5ce6Saurel32 
41028ce5ce6Saurel32     conditional_interrupt(ch);
41128ce5ce6Saurel32     next(ch);
41228ce5ce6Saurel32 
413b42ec42dSaurel32 wait:
414d2f0ce21SAlexander Graf     DBDMA_kick(dbdma_from_ch(ch));
41528ce5ce6Saurel32 }
41628ce5ce6Saurel32 
417b42ec42dSaurel32 static void nop(DBDMA_channel *ch)
41828ce5ce6Saurel32 {
41928ce5ce6Saurel32     dbdma_cmd *current = &ch->current;
42028ce5ce6Saurel32 
42128ce5ce6Saurel32     if (conditional_wait(ch))
422b42ec42dSaurel32         goto wait;
42328ce5ce6Saurel32 
424ad674e53SAurelien Jarno     current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]);
42528ce5ce6Saurel32     dbdma_cmdptr_save(ch);
42628ce5ce6Saurel32 
42728ce5ce6Saurel32     conditional_interrupt(ch);
42828ce5ce6Saurel32     conditional_branch(ch);
42928ce5ce6Saurel32 
430b42ec42dSaurel32 wait:
431d2f0ce21SAlexander Graf     DBDMA_kick(dbdma_from_ch(ch));
43228ce5ce6Saurel32 }
43328ce5ce6Saurel32 
434b42ec42dSaurel32 static void stop(DBDMA_channel *ch)
43528ce5ce6Saurel32 {
436ad674e53SAurelien Jarno     ch->regs[DBDMA_STATUS] &= ~(ACTIVE|DEAD|FLUSH);
43728ce5ce6Saurel32 
43828ce5ce6Saurel32     /* the stop command does not increment command pointer */
43928ce5ce6Saurel32 }
44028ce5ce6Saurel32 
441b42ec42dSaurel32 static void channel_run(DBDMA_channel *ch)
44228ce5ce6Saurel32 {
44328ce5ce6Saurel32     dbdma_cmd *current = &ch->current;
44428ce5ce6Saurel32     uint16_t cmd, key;
44528ce5ce6Saurel32     uint16_t req_count;
44628ce5ce6Saurel32     uint32_t phy_addr;
44728ce5ce6Saurel32 
44828ce5ce6Saurel32     DBDMA_DPRINTF("channel_run\n");
44928ce5ce6Saurel32     dump_dbdma_cmd(current);
45028ce5ce6Saurel32 
45128ce5ce6Saurel32     /* clear WAKE flag at command fetch */
45228ce5ce6Saurel32 
453ad674e53SAurelien Jarno     ch->regs[DBDMA_STATUS] &= ~WAKE;
45428ce5ce6Saurel32 
45528ce5ce6Saurel32     cmd = le16_to_cpu(current->command) & COMMAND_MASK;
45628ce5ce6Saurel32 
45728ce5ce6Saurel32     switch (cmd) {
45828ce5ce6Saurel32     case DBDMA_NOP:
459b42ec42dSaurel32         nop(ch);
460b42ec42dSaurel32         return;
46128ce5ce6Saurel32 
46228ce5ce6Saurel32     case DBDMA_STOP:
463b42ec42dSaurel32         stop(ch);
464b42ec42dSaurel32         return;
46528ce5ce6Saurel32     }
46628ce5ce6Saurel32 
46728ce5ce6Saurel32     key = le16_to_cpu(current->command) & 0x0700;
46828ce5ce6Saurel32     req_count = le16_to_cpu(current->req_count);
46928ce5ce6Saurel32     phy_addr = le32_to_cpu(current->phy_addr);
47028ce5ce6Saurel32 
47128ce5ce6Saurel32     if (key == KEY_STREAM4) {
47228ce5ce6Saurel32         printf("command %x, invalid key 4\n", cmd);
47328ce5ce6Saurel32         kill_channel(ch);
474b42ec42dSaurel32         return;
47528ce5ce6Saurel32     }
47628ce5ce6Saurel32 
47728ce5ce6Saurel32     switch (cmd) {
47828ce5ce6Saurel32     case OUTPUT_MORE:
479b42ec42dSaurel32         start_output(ch, key, phy_addr, req_count, 0);
480b42ec42dSaurel32         return;
48128ce5ce6Saurel32 
48228ce5ce6Saurel32     case OUTPUT_LAST:
483b42ec42dSaurel32         start_output(ch, key, phy_addr, req_count, 1);
484b42ec42dSaurel32         return;
48528ce5ce6Saurel32 
48628ce5ce6Saurel32     case INPUT_MORE:
487b42ec42dSaurel32         start_input(ch, key, phy_addr, req_count, 0);
488b42ec42dSaurel32         return;
48928ce5ce6Saurel32 
49028ce5ce6Saurel32     case INPUT_LAST:
491b42ec42dSaurel32         start_input(ch, key, phy_addr, req_count, 1);
492b42ec42dSaurel32         return;
49328ce5ce6Saurel32     }
49428ce5ce6Saurel32 
49528ce5ce6Saurel32     if (key < KEY_REGS) {
49628ce5ce6Saurel32         printf("command %x, invalid key %x\n", cmd, key);
49728ce5ce6Saurel32         key = KEY_SYSTEM;
49828ce5ce6Saurel32     }
49928ce5ce6Saurel32 
50028ce5ce6Saurel32     /* for LOAD_WORD and STORE_WORD, req_count is on 3 bits
50128ce5ce6Saurel32      * and BRANCH is invalid
50228ce5ce6Saurel32      */
50328ce5ce6Saurel32 
50428ce5ce6Saurel32     req_count = req_count & 0x0007;
50528ce5ce6Saurel32     if (req_count & 0x4) {
50628ce5ce6Saurel32         req_count = 4;
50728ce5ce6Saurel32         phy_addr &= ~3;
50828ce5ce6Saurel32     } else if (req_count & 0x2) {
50928ce5ce6Saurel32         req_count = 2;
51028ce5ce6Saurel32         phy_addr &= ~1;
51128ce5ce6Saurel32     } else
51228ce5ce6Saurel32         req_count = 1;
51328ce5ce6Saurel32 
51428ce5ce6Saurel32     switch (cmd) {
51528ce5ce6Saurel32     case LOAD_WORD:
516b42ec42dSaurel32         load_word(ch, key, phy_addr, req_count);
517b42ec42dSaurel32         return;
51828ce5ce6Saurel32 
51928ce5ce6Saurel32     case STORE_WORD:
520b42ec42dSaurel32         store_word(ch, key, phy_addr, req_count);
521b42ec42dSaurel32         return;
52228ce5ce6Saurel32     }
52328ce5ce6Saurel32 }
52428ce5ce6Saurel32 
525c20df14bSJuan Quintela static void DBDMA_run(DBDMAState *s)
52628ce5ce6Saurel32 {
52728ce5ce6Saurel32     int channel;
52828ce5ce6Saurel32 
529c20df14bSJuan Quintela     for (channel = 0; channel < DBDMA_CHANNELS; channel++) {
530c20df14bSJuan Quintela         DBDMA_channel *ch = &s->channels[channel];
531ad674e53SAurelien Jarno         uint32_t status = ch->regs[DBDMA_STATUS];
53203ee3b1eSAlexander Graf         if (!ch->io.processing && (status & RUN) && (status & ACTIVE)) {
533b42ec42dSaurel32             channel_run(ch);
53428ce5ce6Saurel32         }
53528ce5ce6Saurel32     }
536c20df14bSJuan Quintela }
53728ce5ce6Saurel32 
53828ce5ce6Saurel32 static void DBDMA_run_bh(void *opaque)
53928ce5ce6Saurel32 {
540c20df14bSJuan Quintela     DBDMAState *s = opaque;
54128ce5ce6Saurel32 
54228ce5ce6Saurel32     DBDMA_DPRINTF("DBDMA_run_bh\n");
54328ce5ce6Saurel32 
544c20df14bSJuan Quintela     DBDMA_run(s);
54528ce5ce6Saurel32 }
54628ce5ce6Saurel32 
547d1e562deSAlexander Graf void DBDMA_kick(DBDMAState *dbdma)
548d1e562deSAlexander Graf {
549d2f0ce21SAlexander Graf     qemu_bh_schedule(dbdma->bh);
550d1e562deSAlexander Graf }
551d1e562deSAlexander Graf 
55228ce5ce6Saurel32 void DBDMA_register_channel(void *dbdma, int nchan, qemu_irq irq,
553862c9280Saurel32                             DBDMA_rw rw, DBDMA_flush flush,
55428ce5ce6Saurel32                             void *opaque)
55528ce5ce6Saurel32 {
556c20df14bSJuan Quintela     DBDMAState *s = dbdma;
557c20df14bSJuan Quintela     DBDMA_channel *ch = &s->channels[nchan];
55828ce5ce6Saurel32 
55928ce5ce6Saurel32     DBDMA_DPRINTF("DBDMA_register_channel 0x%x\n", nchan);
56028ce5ce6Saurel32 
5612d7d06d8SHervé Poussineau     assert(rw);
5622d7d06d8SHervé Poussineau     assert(flush);
5632d7d06d8SHervé Poussineau 
56428ce5ce6Saurel32     ch->irq = irq;
565b42ec42dSaurel32     ch->rw = rw;
566862c9280Saurel32     ch->flush = flush;
56728ce5ce6Saurel32     ch->io.opaque = opaque;
56828ce5ce6Saurel32 }
56928ce5ce6Saurel32 
57028ce5ce6Saurel32 static void
57128ce5ce6Saurel32 dbdma_control_write(DBDMA_channel *ch)
57228ce5ce6Saurel32 {
57328ce5ce6Saurel32     uint16_t mask, value;
57428ce5ce6Saurel32     uint32_t status;
57528ce5ce6Saurel32 
576ad674e53SAurelien Jarno     mask = (ch->regs[DBDMA_CONTROL] >> 16) & 0xffff;
577ad674e53SAurelien Jarno     value = ch->regs[DBDMA_CONTROL] & 0xffff;
57828ce5ce6Saurel32 
57928ce5ce6Saurel32     value &= (RUN | PAUSE | FLUSH | WAKE | DEVSTAT);
58028ce5ce6Saurel32 
581ad674e53SAurelien Jarno     status = ch->regs[DBDMA_STATUS];
58228ce5ce6Saurel32 
58328ce5ce6Saurel32     status = (value & mask) | (status & ~mask);
58428ce5ce6Saurel32 
58528ce5ce6Saurel32     if (status & WAKE)
58628ce5ce6Saurel32         status |= ACTIVE;
58728ce5ce6Saurel32     if (status & RUN) {
58828ce5ce6Saurel32         status |= ACTIVE;
58928ce5ce6Saurel32         status &= ~DEAD;
59028ce5ce6Saurel32     }
59128ce5ce6Saurel32     if (status & PAUSE)
59228ce5ce6Saurel32         status &= ~ACTIVE;
593ad674e53SAurelien Jarno     if ((ch->regs[DBDMA_STATUS] & RUN) && !(status & RUN)) {
59428ce5ce6Saurel32         /* RUN is cleared */
59528ce5ce6Saurel32         status &= ~(ACTIVE|DEAD);
5961cde732dSMark Cave-Ayland     }
5971cde732dSMark Cave-Ayland 
598987422bcSAmadeusz Sławiński     if ((status & FLUSH) && ch->flush) {
599987422bcSAmadeusz Sławiński         ch->flush(&ch->io);
600987422bcSAmadeusz Sławiński         status &= ~FLUSH;
601987422bcSAmadeusz Sławiński     }
60228ce5ce6Saurel32 
60328ce5ce6Saurel32     DBDMA_DPRINTF("    status 0x%08x\n", status);
60428ce5ce6Saurel32 
605ad674e53SAurelien Jarno     ch->regs[DBDMA_STATUS] = status;
60628ce5ce6Saurel32 
607d2f0ce21SAlexander Graf     if (status & ACTIVE) {
608d2f0ce21SAlexander Graf         DBDMA_kick(dbdma_from_ch(ch));
609d2f0ce21SAlexander Graf     }
610d2f0ce21SAlexander Graf }
6113cbee15bSj_mayer 
612a8170e5eSAvi Kivity static void dbdma_write(void *opaque, hwaddr addr,
61323c5e4caSAvi Kivity                         uint64_t value, unsigned size)
6143cbee15bSj_mayer {
61528ce5ce6Saurel32     int channel = addr >> DBDMA_CHANNEL_SHIFT;
616c20df14bSJuan Quintela     DBDMAState *s = opaque;
617c20df14bSJuan Quintela     DBDMA_channel *ch = &s->channels[channel];
61828ce5ce6Saurel32     int reg = (addr - (channel << DBDMA_CHANNEL_SHIFT)) >> 2;
61928ce5ce6Saurel32 
62058c0c311SAlexander Graf     DBDMA_DPRINTF("writel 0x" TARGET_FMT_plx " <= 0x%08"PRIx64"\n",
62158c0c311SAlexander Graf                   addr, value);
62228ce5ce6Saurel32     DBDMA_DPRINTF("channel 0x%x reg 0x%x\n",
62328ce5ce6Saurel32                   (uint32_t)addr >> DBDMA_CHANNEL_SHIFT, reg);
62428ce5ce6Saurel32 
6257eaba824SAlexander Graf     /* cmdptr cannot be modified if channel is ACTIVE */
62628ce5ce6Saurel32 
6277eaba824SAlexander Graf     if (reg == DBDMA_CMDPTR_LO && (ch->regs[DBDMA_STATUS] & ACTIVE)) {
62828ce5ce6Saurel32         return;
6297eaba824SAlexander Graf     }
63028ce5ce6Saurel32 
63128ce5ce6Saurel32     ch->regs[reg] = value;
63228ce5ce6Saurel32 
63328ce5ce6Saurel32     switch(reg) {
63428ce5ce6Saurel32     case DBDMA_CONTROL:
63528ce5ce6Saurel32         dbdma_control_write(ch);
63628ce5ce6Saurel32         break;
63728ce5ce6Saurel32     case DBDMA_CMDPTR_LO:
63828ce5ce6Saurel32         /* 16-byte aligned */
639ad674e53SAurelien Jarno         ch->regs[DBDMA_CMDPTR_LO] &= ~0xf;
64028ce5ce6Saurel32         dbdma_cmdptr_load(ch);
64128ce5ce6Saurel32         break;
64228ce5ce6Saurel32     case DBDMA_STATUS:
64328ce5ce6Saurel32     case DBDMA_INTR_SEL:
64428ce5ce6Saurel32     case DBDMA_BRANCH_SEL:
64528ce5ce6Saurel32     case DBDMA_WAIT_SEL:
64628ce5ce6Saurel32         /* nothing to do */
64728ce5ce6Saurel32         break;
64828ce5ce6Saurel32     case DBDMA_XFER_MODE:
64928ce5ce6Saurel32     case DBDMA_CMDPTR_HI:
65028ce5ce6Saurel32     case DBDMA_DATA2PTR_HI:
65128ce5ce6Saurel32     case DBDMA_DATA2PTR_LO:
65228ce5ce6Saurel32     case DBDMA_ADDRESS_HI:
65328ce5ce6Saurel32     case DBDMA_BRANCH_ADDR_HI:
65428ce5ce6Saurel32     case DBDMA_RES1:
65528ce5ce6Saurel32     case DBDMA_RES2:
65628ce5ce6Saurel32     case DBDMA_RES3:
65728ce5ce6Saurel32     case DBDMA_RES4:
65828ce5ce6Saurel32         /* unused */
65928ce5ce6Saurel32         break;
6603cbee15bSj_mayer     }
6613cbee15bSj_mayer }
6623cbee15bSj_mayer 
663a8170e5eSAvi Kivity static uint64_t dbdma_read(void *opaque, hwaddr addr,
66423c5e4caSAvi Kivity                            unsigned size)
6653cbee15bSj_mayer {
66628ce5ce6Saurel32     uint32_t value;
66728ce5ce6Saurel32     int channel = addr >> DBDMA_CHANNEL_SHIFT;
668c20df14bSJuan Quintela     DBDMAState *s = opaque;
669c20df14bSJuan Quintela     DBDMA_channel *ch = &s->channels[channel];
67028ce5ce6Saurel32     int reg = (addr - (channel << DBDMA_CHANNEL_SHIFT)) >> 2;
671ea026b2fSblueswir1 
67228ce5ce6Saurel32     value = ch->regs[reg];
67328ce5ce6Saurel32 
67428ce5ce6Saurel32     DBDMA_DPRINTF("readl 0x" TARGET_FMT_plx " => 0x%08x\n", addr, value);
67528ce5ce6Saurel32     DBDMA_DPRINTF("channel 0x%x reg 0x%x\n",
67628ce5ce6Saurel32                   (uint32_t)addr >> DBDMA_CHANNEL_SHIFT, reg);
67728ce5ce6Saurel32 
67828ce5ce6Saurel32     switch(reg) {
67928ce5ce6Saurel32     case DBDMA_CONTROL:
68028ce5ce6Saurel32         value = 0;
68128ce5ce6Saurel32         break;
68228ce5ce6Saurel32     case DBDMA_STATUS:
68328ce5ce6Saurel32     case DBDMA_CMDPTR_LO:
68428ce5ce6Saurel32     case DBDMA_INTR_SEL:
68528ce5ce6Saurel32     case DBDMA_BRANCH_SEL:
68628ce5ce6Saurel32     case DBDMA_WAIT_SEL:
68728ce5ce6Saurel32         /* nothing to do */
68828ce5ce6Saurel32         break;
68928ce5ce6Saurel32     case DBDMA_XFER_MODE:
69028ce5ce6Saurel32     case DBDMA_CMDPTR_HI:
69128ce5ce6Saurel32     case DBDMA_DATA2PTR_HI:
69228ce5ce6Saurel32     case DBDMA_DATA2PTR_LO:
69328ce5ce6Saurel32     case DBDMA_ADDRESS_HI:
69428ce5ce6Saurel32     case DBDMA_BRANCH_ADDR_HI:
69528ce5ce6Saurel32         /* unused */
69628ce5ce6Saurel32         value = 0;
69728ce5ce6Saurel32         break;
69828ce5ce6Saurel32     case DBDMA_RES1:
69928ce5ce6Saurel32     case DBDMA_RES2:
70028ce5ce6Saurel32     case DBDMA_RES3:
70128ce5ce6Saurel32     case DBDMA_RES4:
70228ce5ce6Saurel32         /* reserved */
70328ce5ce6Saurel32         break;
70428ce5ce6Saurel32     }
70528ce5ce6Saurel32 
70628ce5ce6Saurel32     return value;
7073cbee15bSj_mayer }
7083cbee15bSj_mayer 
70923c5e4caSAvi Kivity static const MemoryRegionOps dbdma_ops = {
71023c5e4caSAvi Kivity     .read = dbdma_read,
71123c5e4caSAvi Kivity     .write = dbdma_write,
71223c5e4caSAvi Kivity     .endianness = DEVICE_LITTLE_ENDIAN,
71323c5e4caSAvi Kivity     .valid = {
71423c5e4caSAvi Kivity         .min_access_size = 4,
71523c5e4caSAvi Kivity         .max_access_size = 4,
71623c5e4caSAvi Kivity     },
7173cbee15bSj_mayer };
7183cbee15bSj_mayer 
719627be2f2SMark Cave-Ayland static const VMStateDescription vmstate_dbdma_io = {
720627be2f2SMark Cave-Ayland     .name = "dbdma_io",
721da26fdc3SJuan Quintela     .version_id = 0,
722da26fdc3SJuan Quintela     .minimum_version_id = 0,
723da26fdc3SJuan Quintela     .fields = (VMStateField[]) {
724627be2f2SMark Cave-Ayland         VMSTATE_UINT64(addr, struct DBDMA_io),
725627be2f2SMark Cave-Ayland         VMSTATE_INT32(len, struct DBDMA_io),
726627be2f2SMark Cave-Ayland         VMSTATE_INT32(is_last, struct DBDMA_io),
727627be2f2SMark Cave-Ayland         VMSTATE_INT32(is_dma_out, struct DBDMA_io),
728627be2f2SMark Cave-Ayland         VMSTATE_BOOL(processing, struct DBDMA_io),
729627be2f2SMark Cave-Ayland         VMSTATE_END_OF_LIST()
730627be2f2SMark Cave-Ayland     }
731627be2f2SMark Cave-Ayland };
732627be2f2SMark Cave-Ayland 
733627be2f2SMark Cave-Ayland static const VMStateDescription vmstate_dbdma_cmd = {
734627be2f2SMark Cave-Ayland     .name = "dbdma_cmd",
735627be2f2SMark Cave-Ayland     .version_id = 0,
736627be2f2SMark Cave-Ayland     .minimum_version_id = 0,
737627be2f2SMark Cave-Ayland     .fields = (VMStateField[]) {
738627be2f2SMark Cave-Ayland         VMSTATE_UINT16(req_count, dbdma_cmd),
739627be2f2SMark Cave-Ayland         VMSTATE_UINT16(command, dbdma_cmd),
740627be2f2SMark Cave-Ayland         VMSTATE_UINT32(phy_addr, dbdma_cmd),
741627be2f2SMark Cave-Ayland         VMSTATE_UINT32(cmd_dep, dbdma_cmd),
742627be2f2SMark Cave-Ayland         VMSTATE_UINT16(res_count, dbdma_cmd),
743627be2f2SMark Cave-Ayland         VMSTATE_UINT16(xfer_status, dbdma_cmd),
744627be2f2SMark Cave-Ayland         VMSTATE_END_OF_LIST()
745627be2f2SMark Cave-Ayland     }
746627be2f2SMark Cave-Ayland };
747627be2f2SMark Cave-Ayland 
748627be2f2SMark Cave-Ayland static const VMStateDescription vmstate_dbdma_channel = {
749627be2f2SMark Cave-Ayland     .name = "dbdma_channel",
750627be2f2SMark Cave-Ayland     .version_id = 1,
751627be2f2SMark Cave-Ayland     .minimum_version_id = 1,
752627be2f2SMark Cave-Ayland     .fields = (VMStateField[]) {
753da26fdc3SJuan Quintela         VMSTATE_UINT32_ARRAY(regs, struct DBDMA_channel, DBDMA_REGS),
754627be2f2SMark Cave-Ayland         VMSTATE_STRUCT(io, struct DBDMA_channel, 0, vmstate_dbdma_io, DBDMA_io),
755627be2f2SMark Cave-Ayland         VMSTATE_STRUCT(current, struct DBDMA_channel, 0, vmstate_dbdma_cmd,
756627be2f2SMark Cave-Ayland                        dbdma_cmd),
757da26fdc3SJuan Quintela         VMSTATE_END_OF_LIST()
7589b64997fSblueswir1     }
759da26fdc3SJuan Quintela };
7609b64997fSblueswir1 
761da26fdc3SJuan Quintela static const VMStateDescription vmstate_dbdma = {
762da26fdc3SJuan Quintela     .name = "dbdma",
763627be2f2SMark Cave-Ayland     .version_id = 3,
764627be2f2SMark Cave-Ayland     .minimum_version_id = 3,
765da26fdc3SJuan Quintela     .fields = (VMStateField[]) {
766da26fdc3SJuan Quintela         VMSTATE_STRUCT_ARRAY(channels, DBDMAState, DBDMA_CHANNELS, 1,
767da26fdc3SJuan Quintela                              vmstate_dbdma_channel, DBDMA_channel),
768da26fdc3SJuan Quintela         VMSTATE_END_OF_LIST()
7699b64997fSblueswir1     }
770da26fdc3SJuan Quintela };
7719b64997fSblueswir1 
7726e6b7363Sblueswir1 static void dbdma_reset(void *opaque)
7736e6b7363Sblueswir1 {
774c20df14bSJuan Quintela     DBDMAState *s = opaque;
77528ce5ce6Saurel32     int i;
77628ce5ce6Saurel32 
77728ce5ce6Saurel32     for (i = 0; i < DBDMA_CHANNELS; i++)
778c20df14bSJuan Quintela         memset(s->channels[i].regs, 0, DBDMA_SIZE);
7796e6b7363Sblueswir1 }
7806e6b7363Sblueswir1 
7812d7d06d8SHervé Poussineau static void dbdma_unassigned_rw(DBDMA_io *io)
7822d7d06d8SHervé Poussineau {
7832d7d06d8SHervé Poussineau     DBDMA_channel *ch = io->channel;
7842d7d06d8SHervé Poussineau     qemu_log_mask(LOG_GUEST_ERROR, "%s: use of unassigned channel %d\n",
7852d7d06d8SHervé Poussineau                   __func__, ch->channel);
7862d7d06d8SHervé Poussineau }
7872d7d06d8SHervé Poussineau 
7882d7d06d8SHervé Poussineau static void dbdma_unassigned_flush(DBDMA_io *io)
7892d7d06d8SHervé Poussineau {
7902d7d06d8SHervé Poussineau     DBDMA_channel *ch = io->channel;
7912d7d06d8SHervé Poussineau     qemu_log_mask(LOG_GUEST_ERROR, "%s: use of unassigned channel %d\n",
7922d7d06d8SHervé Poussineau                   __func__, ch->channel);
7932d7d06d8SHervé Poussineau }
7942d7d06d8SHervé Poussineau 
79523c5e4caSAvi Kivity void* DBDMA_init (MemoryRegion **dbdma_mem)
7963cbee15bSj_mayer {
797c20df14bSJuan Quintela     DBDMAState *s;
7983e300fa6SAlexander Graf     int i;
79928ce5ce6Saurel32 
8007267c094SAnthony Liguori     s = g_malloc0(sizeof(DBDMAState));
80128ce5ce6Saurel32 
8023e300fa6SAlexander Graf     for (i = 0; i < DBDMA_CHANNELS; i++) {
8033e300fa6SAlexander Graf         DBDMA_io *io = &s->channels[i].io;
8042d7d06d8SHervé Poussineau         DBDMA_channel *ch = &s->channels[i];
8053e300fa6SAlexander Graf         qemu_iovec_init(&io->iov, 1);
8062d7d06d8SHervé Poussineau 
8072d7d06d8SHervé Poussineau         ch->rw = dbdma_unassigned_rw;
8082d7d06d8SHervé Poussineau         ch->flush = dbdma_unassigned_flush;
8092d7d06d8SHervé Poussineau         ch->channel = i;
8102d7d06d8SHervé Poussineau         ch->io.channel = ch;
8113e300fa6SAlexander Graf     }
8123e300fa6SAlexander Graf 
8132c9b15caSPaolo Bonzini     memory_region_init_io(&s->mem, NULL, &dbdma_ops, s, "dbdma", 0x1000);
81423c5e4caSAvi Kivity     *dbdma_mem = &s->mem;
815da26fdc3SJuan Quintela     vmstate_register(NULL, -1, &vmstate_dbdma, s);
816a08d4367SJan Kiszka     qemu_register_reset(dbdma_reset, s);
81728ce5ce6Saurel32 
818d2f0ce21SAlexander Graf     s->bh = qemu_bh_new(DBDMA_run_bh, s);
81928ce5ce6Saurel32 
82028ce5ce6Saurel32     return s;
8213cbee15bSj_mayer }
822