xref: /qemu/hw/misc/macio/mac_dbdma.c (revision e1fe50dcb3c86e25ce482a7f67f2ac5405bced8a)
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  */
3983c9f4caSPaolo Bonzini #include "hw/hw.h"
400d09e41aSPaolo Bonzini #include "hw/isa/isa.h"
410d09e41aSPaolo Bonzini #include "hw/ppc/mac_dbdma.h"
421de7afc9SPaolo Bonzini #include "qemu/main-loop.h"
433cbee15bSj_mayer 
44ea026b2fSblueswir1 /* debug DBDMA */
45ea026b2fSblueswir1 //#define DEBUG_DBDMA
46ea026b2fSblueswir1 
47ea026b2fSblueswir1 #ifdef DEBUG_DBDMA
48001faf32SBlue Swirl #define DBDMA_DPRINTF(fmt, ...)                                 \
49001faf32SBlue Swirl     do { printf("DBDMA: " fmt , ## __VA_ARGS__); } while (0)
50ea026b2fSblueswir1 #else
51001faf32SBlue Swirl #define DBDMA_DPRINTF(fmt, ...)
52ea026b2fSblueswir1 #endif
53ea026b2fSblueswir1 
5428ce5ce6Saurel32 /*
5528ce5ce6Saurel32  */
563cbee15bSj_mayer 
5728ce5ce6Saurel32 /*
5828ce5ce6Saurel32  * DBDMA control/status registers.  All little-endian.
5928ce5ce6Saurel32  */
6028ce5ce6Saurel32 
6128ce5ce6Saurel32 #define DBDMA_CONTROL         0x00
6228ce5ce6Saurel32 #define DBDMA_STATUS          0x01
6328ce5ce6Saurel32 #define DBDMA_CMDPTR_HI       0x02
6428ce5ce6Saurel32 #define DBDMA_CMDPTR_LO       0x03
6528ce5ce6Saurel32 #define DBDMA_INTR_SEL        0x04
6628ce5ce6Saurel32 #define DBDMA_BRANCH_SEL      0x05
6728ce5ce6Saurel32 #define DBDMA_WAIT_SEL        0x06
6828ce5ce6Saurel32 #define DBDMA_XFER_MODE       0x07
6928ce5ce6Saurel32 #define DBDMA_DATA2PTR_HI     0x08
7028ce5ce6Saurel32 #define DBDMA_DATA2PTR_LO     0x09
7128ce5ce6Saurel32 #define DBDMA_RES1            0x0A
7228ce5ce6Saurel32 #define DBDMA_ADDRESS_HI      0x0B
7328ce5ce6Saurel32 #define DBDMA_BRANCH_ADDR_HI  0x0C
7428ce5ce6Saurel32 #define DBDMA_RES2            0x0D
7528ce5ce6Saurel32 #define DBDMA_RES3            0x0E
7628ce5ce6Saurel32 #define DBDMA_RES4            0x0F
7728ce5ce6Saurel32 
7828ce5ce6Saurel32 #define DBDMA_REGS            16
7928ce5ce6Saurel32 #define DBDMA_SIZE            (DBDMA_REGS * sizeof(uint32_t))
8028ce5ce6Saurel32 
8128ce5ce6Saurel32 #define DBDMA_CHANNEL_SHIFT   7
8228ce5ce6Saurel32 #define DBDMA_CHANNEL_SIZE    (1 << DBDMA_CHANNEL_SHIFT)
8328ce5ce6Saurel32 
8428ce5ce6Saurel32 #define DBDMA_CHANNELS        (0x1000 >> DBDMA_CHANNEL_SHIFT)
8528ce5ce6Saurel32 
8628ce5ce6Saurel32 /* Bits in control and status registers */
8728ce5ce6Saurel32 
8828ce5ce6Saurel32 #define RUN	0x8000
8928ce5ce6Saurel32 #define PAUSE	0x4000
9028ce5ce6Saurel32 #define FLUSH	0x2000
9128ce5ce6Saurel32 #define WAKE	0x1000
9228ce5ce6Saurel32 #define DEAD	0x0800
9328ce5ce6Saurel32 #define ACTIVE	0x0400
9428ce5ce6Saurel32 #define BT	0x0100
9528ce5ce6Saurel32 #define DEVSTAT	0x00ff
9628ce5ce6Saurel32 
9728ce5ce6Saurel32 /*
9828ce5ce6Saurel32  * DBDMA command structure.  These fields are all little-endian!
9928ce5ce6Saurel32  */
10028ce5ce6Saurel32 
10128ce5ce6Saurel32 typedef struct dbdma_cmd {
10228ce5ce6Saurel32     uint16_t req_count;	  /* requested byte transfer count */
10328ce5ce6Saurel32     uint16_t command;	  /* command word (has bit-fields) */
10428ce5ce6Saurel32     uint32_t phy_addr;	  /* physical data address */
10528ce5ce6Saurel32     uint32_t cmd_dep;	  /* command-dependent field */
10628ce5ce6Saurel32     uint16_t res_count;	  /* residual count after completion */
10728ce5ce6Saurel32     uint16_t xfer_status; /* transfer status */
10828ce5ce6Saurel32 } dbdma_cmd;
10928ce5ce6Saurel32 
11028ce5ce6Saurel32 /* DBDMA command values in command field */
11128ce5ce6Saurel32 
11228ce5ce6Saurel32 #define COMMAND_MASK    0xf000
11328ce5ce6Saurel32 #define OUTPUT_MORE	0x0000	/* transfer memory data to stream */
11428ce5ce6Saurel32 #define OUTPUT_LAST	0x1000	/* ditto followed by end marker */
11528ce5ce6Saurel32 #define INPUT_MORE	0x2000	/* transfer stream data to memory */
11628ce5ce6Saurel32 #define INPUT_LAST	0x3000	/* ditto, expect end marker */
11728ce5ce6Saurel32 #define STORE_WORD	0x4000	/* write word (4 bytes) to device reg */
11828ce5ce6Saurel32 #define LOAD_WORD	0x5000	/* read word (4 bytes) from device reg */
11928ce5ce6Saurel32 #define DBDMA_NOP	0x6000	/* do nothing */
12028ce5ce6Saurel32 #define DBDMA_STOP	0x7000	/* suspend processing */
12128ce5ce6Saurel32 
12228ce5ce6Saurel32 /* Key values in command field */
12328ce5ce6Saurel32 
12428ce5ce6Saurel32 #define KEY_MASK        0x0700
12528ce5ce6Saurel32 #define KEY_STREAM0	0x0000	/* usual data stream */
12628ce5ce6Saurel32 #define KEY_STREAM1	0x0100	/* control/status stream */
12728ce5ce6Saurel32 #define KEY_STREAM2	0x0200	/* device-dependent stream */
12828ce5ce6Saurel32 #define KEY_STREAM3	0x0300	/* device-dependent stream */
12928ce5ce6Saurel32 #define KEY_STREAM4	0x0400	/* reserved */
13028ce5ce6Saurel32 #define KEY_REGS	0x0500	/* device register space */
13128ce5ce6Saurel32 #define KEY_SYSTEM	0x0600	/* system memory-mapped space */
13228ce5ce6Saurel32 #define KEY_DEVICE	0x0700	/* device memory-mapped space */
13328ce5ce6Saurel32 
13428ce5ce6Saurel32 /* Interrupt control values in command field */
13528ce5ce6Saurel32 
13628ce5ce6Saurel32 #define INTR_MASK       0x0030
13728ce5ce6Saurel32 #define INTR_NEVER	0x0000	/* don't interrupt */
13828ce5ce6Saurel32 #define INTR_IFSET	0x0010	/* intr if condition bit is 1 */
13928ce5ce6Saurel32 #define INTR_IFCLR	0x0020	/* intr if condition bit is 0 */
14028ce5ce6Saurel32 #define INTR_ALWAYS	0x0030	/* always interrupt */
14128ce5ce6Saurel32 
14228ce5ce6Saurel32 /* Branch control values in command field */
14328ce5ce6Saurel32 
14428ce5ce6Saurel32 #define BR_MASK         0x000c
14528ce5ce6Saurel32 #define BR_NEVER	0x0000	/* don't branch */
14628ce5ce6Saurel32 #define BR_IFSET	0x0004	/* branch if condition bit is 1 */
14728ce5ce6Saurel32 #define BR_IFCLR	0x0008	/* branch if condition bit is 0 */
14828ce5ce6Saurel32 #define BR_ALWAYS	0x000c	/* always branch */
14928ce5ce6Saurel32 
15028ce5ce6Saurel32 /* Wait control values in command field */
15128ce5ce6Saurel32 
15228ce5ce6Saurel32 #define WAIT_MASK       0x0003
15328ce5ce6Saurel32 #define WAIT_NEVER	0x0000	/* don't wait */
15428ce5ce6Saurel32 #define WAIT_IFSET	0x0001	/* wait if condition bit is 1 */
15528ce5ce6Saurel32 #define WAIT_IFCLR	0x0002	/* wait if condition bit is 0 */
15628ce5ce6Saurel32 #define WAIT_ALWAYS	0x0003	/* always wait */
15728ce5ce6Saurel32 
15828ce5ce6Saurel32 typedef struct DBDMA_channel {
15928ce5ce6Saurel32     int channel;
16028ce5ce6Saurel32     uint32_t regs[DBDMA_REGS];
16128ce5ce6Saurel32     qemu_irq irq;
162b42ec42dSaurel32     DBDMA_io io;
163b42ec42dSaurel32     DBDMA_rw rw;
164862c9280Saurel32     DBDMA_flush flush;
16528ce5ce6Saurel32     dbdma_cmd current;
166b42ec42dSaurel32     int processing;
16728ce5ce6Saurel32 } DBDMA_channel;
16828ce5ce6Saurel32 
169c20df14bSJuan Quintela typedef struct {
17023c5e4caSAvi Kivity     MemoryRegion mem;
171c20df14bSJuan Quintela     DBDMA_channel channels[DBDMA_CHANNELS];
172c20df14bSJuan Quintela } DBDMAState;
173c20df14bSJuan Quintela 
17428ce5ce6Saurel32 #ifdef DEBUG_DBDMA
17528ce5ce6Saurel32 static void dump_dbdma_cmd(dbdma_cmd *cmd)
1763cbee15bSj_mayer {
17728ce5ce6Saurel32     printf("dbdma_cmd %p\n", cmd);
17828ce5ce6Saurel32     printf("    req_count 0x%04x\n", le16_to_cpu(cmd->req_count));
17928ce5ce6Saurel32     printf("    command 0x%04x\n", le16_to_cpu(cmd->command));
18028ce5ce6Saurel32     printf("    phy_addr 0x%08x\n", le32_to_cpu(cmd->phy_addr));
18128ce5ce6Saurel32     printf("    cmd_dep 0x%08x\n", le32_to_cpu(cmd->cmd_dep));
18228ce5ce6Saurel32     printf("    res_count 0x%04x\n", le16_to_cpu(cmd->res_count));
18328ce5ce6Saurel32     printf("    xfer_status 0x%04x\n", le16_to_cpu(cmd->xfer_status));
18428ce5ce6Saurel32 }
18528ce5ce6Saurel32 #else
18628ce5ce6Saurel32 static void dump_dbdma_cmd(dbdma_cmd *cmd)
18728ce5ce6Saurel32 {
18828ce5ce6Saurel32 }
18928ce5ce6Saurel32 #endif
19028ce5ce6Saurel32 static void dbdma_cmdptr_load(DBDMA_channel *ch)
19128ce5ce6Saurel32 {
19228ce5ce6Saurel32     DBDMA_DPRINTF("dbdma_cmdptr_load 0x%08x\n",
193ad674e53SAurelien Jarno                   ch->regs[DBDMA_CMDPTR_LO]);
194ad674e53SAurelien Jarno     cpu_physical_memory_read(ch->regs[DBDMA_CMDPTR_LO],
195*e1fe50dcSStefan Weil                              &ch->current, sizeof(dbdma_cmd));
1963cbee15bSj_mayer }
1973cbee15bSj_mayer 
19828ce5ce6Saurel32 static void dbdma_cmdptr_save(DBDMA_channel *ch)
1993cbee15bSj_mayer {
20028ce5ce6Saurel32     DBDMA_DPRINTF("dbdma_cmdptr_save 0x%08x\n",
201ad674e53SAurelien Jarno                   ch->regs[DBDMA_CMDPTR_LO]);
20228ce5ce6Saurel32     DBDMA_DPRINTF("xfer_status 0x%08x res_count 0x%04x\n",
20328ce5ce6Saurel32                   le16_to_cpu(ch->current.xfer_status),
20428ce5ce6Saurel32                   le16_to_cpu(ch->current.res_count));
205ad674e53SAurelien Jarno     cpu_physical_memory_write(ch->regs[DBDMA_CMDPTR_LO],
206*e1fe50dcSStefan Weil                               &ch->current, sizeof(dbdma_cmd));
20728ce5ce6Saurel32 }
20828ce5ce6Saurel32 
20928ce5ce6Saurel32 static void kill_channel(DBDMA_channel *ch)
21028ce5ce6Saurel32 {
21128ce5ce6Saurel32     DBDMA_DPRINTF("kill_channel\n");
21228ce5ce6Saurel32 
213ad674e53SAurelien Jarno     ch->regs[DBDMA_STATUS] |= DEAD;
214ad674e53SAurelien Jarno     ch->regs[DBDMA_STATUS] &= ~ACTIVE;
21528ce5ce6Saurel32 
21628ce5ce6Saurel32     qemu_irq_raise(ch->irq);
21728ce5ce6Saurel32 }
21828ce5ce6Saurel32 
21928ce5ce6Saurel32 static void conditional_interrupt(DBDMA_channel *ch)
22028ce5ce6Saurel32 {
22128ce5ce6Saurel32     dbdma_cmd *current = &ch->current;
22228ce5ce6Saurel32     uint16_t intr;
22328ce5ce6Saurel32     uint16_t sel_mask, sel_value;
22428ce5ce6Saurel32     uint32_t status;
22528ce5ce6Saurel32     int cond;
22628ce5ce6Saurel32 
22728ce5ce6Saurel32     DBDMA_DPRINTF("conditional_interrupt\n");
22828ce5ce6Saurel32 
229b42ec42dSaurel32     intr = le16_to_cpu(current->command) & INTR_MASK;
23028ce5ce6Saurel32 
23128ce5ce6Saurel32     switch(intr) {
23228ce5ce6Saurel32     case INTR_NEVER:  /* don't interrupt */
23328ce5ce6Saurel32         return;
23428ce5ce6Saurel32     case INTR_ALWAYS: /* always interrupt */
23528ce5ce6Saurel32         qemu_irq_raise(ch->irq);
23628ce5ce6Saurel32         return;
23728ce5ce6Saurel32     }
23828ce5ce6Saurel32 
239ad674e53SAurelien Jarno     status = ch->regs[DBDMA_STATUS] & DEVSTAT;
24028ce5ce6Saurel32 
241ad674e53SAurelien Jarno     sel_mask = (ch->regs[DBDMA_INTR_SEL] >> 16) & 0x0f;
242ad674e53SAurelien Jarno     sel_value = ch->regs[DBDMA_INTR_SEL] & 0x0f;
24328ce5ce6Saurel32 
24428ce5ce6Saurel32     cond = (status & sel_mask) == (sel_value & sel_mask);
24528ce5ce6Saurel32 
24628ce5ce6Saurel32     switch(intr) {
24728ce5ce6Saurel32     case INTR_IFSET:  /* intr if condition bit is 1 */
24828ce5ce6Saurel32         if (cond)
24928ce5ce6Saurel32             qemu_irq_raise(ch->irq);
25028ce5ce6Saurel32         return;
25128ce5ce6Saurel32     case INTR_IFCLR:  /* intr if condition bit is 0 */
25228ce5ce6Saurel32         if (!cond)
25328ce5ce6Saurel32             qemu_irq_raise(ch->irq);
25428ce5ce6Saurel32         return;
25528ce5ce6Saurel32     }
25628ce5ce6Saurel32 }
25728ce5ce6Saurel32 
25828ce5ce6Saurel32 static int conditional_wait(DBDMA_channel *ch)
25928ce5ce6Saurel32 {
26028ce5ce6Saurel32     dbdma_cmd *current = &ch->current;
26128ce5ce6Saurel32     uint16_t wait;
26228ce5ce6Saurel32     uint16_t sel_mask, sel_value;
26328ce5ce6Saurel32     uint32_t status;
26428ce5ce6Saurel32     int cond;
26528ce5ce6Saurel32 
26628ce5ce6Saurel32     DBDMA_DPRINTF("conditional_wait\n");
26728ce5ce6Saurel32 
268b42ec42dSaurel32     wait = le16_to_cpu(current->command) & WAIT_MASK;
26928ce5ce6Saurel32 
27028ce5ce6Saurel32     switch(wait) {
27128ce5ce6Saurel32     case WAIT_NEVER:  /* don't wait */
27228ce5ce6Saurel32         return 0;
27328ce5ce6Saurel32     case WAIT_ALWAYS: /* always wait */
27428ce5ce6Saurel32         return 1;
27528ce5ce6Saurel32     }
27628ce5ce6Saurel32 
277ad674e53SAurelien Jarno     status = ch->regs[DBDMA_STATUS] & DEVSTAT;
27828ce5ce6Saurel32 
279ad674e53SAurelien Jarno     sel_mask = (ch->regs[DBDMA_WAIT_SEL] >> 16) & 0x0f;
280ad674e53SAurelien Jarno     sel_value = ch->regs[DBDMA_WAIT_SEL] & 0x0f;
28128ce5ce6Saurel32 
28228ce5ce6Saurel32     cond = (status & sel_mask) == (sel_value & sel_mask);
28328ce5ce6Saurel32 
28428ce5ce6Saurel32     switch(wait) {
28528ce5ce6Saurel32     case WAIT_IFSET:  /* wait if condition bit is 1 */
28628ce5ce6Saurel32         if (cond)
28728ce5ce6Saurel32             return 1;
28828ce5ce6Saurel32         return 0;
28928ce5ce6Saurel32     case WAIT_IFCLR:  /* wait if condition bit is 0 */
29028ce5ce6Saurel32         if (!cond)
29128ce5ce6Saurel32             return 1;
29228ce5ce6Saurel32         return 0;
29328ce5ce6Saurel32     }
29428ce5ce6Saurel32     return 0;
29528ce5ce6Saurel32 }
29628ce5ce6Saurel32 
29728ce5ce6Saurel32 static void next(DBDMA_channel *ch)
29828ce5ce6Saurel32 {
29928ce5ce6Saurel32     uint32_t cp;
30028ce5ce6Saurel32 
301ad674e53SAurelien Jarno     ch->regs[DBDMA_STATUS] &= ~BT;
30228ce5ce6Saurel32 
303ad674e53SAurelien Jarno     cp = ch->regs[DBDMA_CMDPTR_LO];
304ad674e53SAurelien Jarno     ch->regs[DBDMA_CMDPTR_LO] = cp + sizeof(dbdma_cmd);
30528ce5ce6Saurel32     dbdma_cmdptr_load(ch);
30628ce5ce6Saurel32 }
30728ce5ce6Saurel32 
30828ce5ce6Saurel32 static void branch(DBDMA_channel *ch)
30928ce5ce6Saurel32 {
31028ce5ce6Saurel32     dbdma_cmd *current = &ch->current;
31128ce5ce6Saurel32 
31228ce5ce6Saurel32     ch->regs[DBDMA_CMDPTR_LO] = current->cmd_dep;
313ad674e53SAurelien Jarno     ch->regs[DBDMA_STATUS] |= BT;
31428ce5ce6Saurel32     dbdma_cmdptr_load(ch);
31528ce5ce6Saurel32 }
31628ce5ce6Saurel32 
31728ce5ce6Saurel32 static void conditional_branch(DBDMA_channel *ch)
31828ce5ce6Saurel32 {
31928ce5ce6Saurel32     dbdma_cmd *current = &ch->current;
32028ce5ce6Saurel32     uint16_t br;
32128ce5ce6Saurel32     uint16_t sel_mask, sel_value;
32228ce5ce6Saurel32     uint32_t status;
32328ce5ce6Saurel32     int cond;
32428ce5ce6Saurel32 
32528ce5ce6Saurel32     DBDMA_DPRINTF("conditional_branch\n");
32628ce5ce6Saurel32 
32728ce5ce6Saurel32     /* check if we must branch */
32828ce5ce6Saurel32 
329b42ec42dSaurel32     br = le16_to_cpu(current->command) & BR_MASK;
33028ce5ce6Saurel32 
33128ce5ce6Saurel32     switch(br) {
33228ce5ce6Saurel32     case BR_NEVER:  /* don't branch */
33328ce5ce6Saurel32         next(ch);
33428ce5ce6Saurel32         return;
33528ce5ce6Saurel32     case BR_ALWAYS: /* always branch */
33628ce5ce6Saurel32         branch(ch);
33728ce5ce6Saurel32         return;
33828ce5ce6Saurel32     }
33928ce5ce6Saurel32 
340ad674e53SAurelien Jarno     status = ch->regs[DBDMA_STATUS] & DEVSTAT;
34128ce5ce6Saurel32 
342ad674e53SAurelien Jarno     sel_mask = (ch->regs[DBDMA_BRANCH_SEL] >> 16) & 0x0f;
343ad674e53SAurelien Jarno     sel_value = ch->regs[DBDMA_BRANCH_SEL] & 0x0f;
34428ce5ce6Saurel32 
34528ce5ce6Saurel32     cond = (status & sel_mask) == (sel_value & sel_mask);
34628ce5ce6Saurel32 
34728ce5ce6Saurel32     switch(br) {
34828ce5ce6Saurel32     case BR_IFSET:  /* branch if condition bit is 1 */
34928ce5ce6Saurel32         if (cond)
35028ce5ce6Saurel32             branch(ch);
35128ce5ce6Saurel32         else
35228ce5ce6Saurel32             next(ch);
35328ce5ce6Saurel32         return;
35428ce5ce6Saurel32     case BR_IFCLR:  /* branch if condition bit is 0 */
35528ce5ce6Saurel32         if (!cond)
35628ce5ce6Saurel32             branch(ch);
35728ce5ce6Saurel32         else
35828ce5ce6Saurel32             next(ch);
35928ce5ce6Saurel32         return;
36028ce5ce6Saurel32     }
36128ce5ce6Saurel32 }
36228ce5ce6Saurel32 
363b42ec42dSaurel32 static QEMUBH *dbdma_bh;
364b42ec42dSaurel32 static void channel_run(DBDMA_channel *ch);
365b42ec42dSaurel32 
366b42ec42dSaurel32 static void dbdma_end(DBDMA_io *io)
36728ce5ce6Saurel32 {
36828ce5ce6Saurel32     DBDMA_channel *ch = io->channel;
36928ce5ce6Saurel32     dbdma_cmd *current = &ch->current;
37028ce5ce6Saurel32 
371b42ec42dSaurel32     if (conditional_wait(ch))
372b42ec42dSaurel32         goto wait;
37328ce5ce6Saurel32 
374ad674e53SAurelien Jarno     current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]);
375ad674e53SAurelien Jarno     current->res_count = cpu_to_le16(io->len);
376b42ec42dSaurel32     dbdma_cmdptr_save(ch);
377862c9280Saurel32     if (io->is_last)
378ad674e53SAurelien Jarno         ch->regs[DBDMA_STATUS] &= ~FLUSH;
37928ce5ce6Saurel32 
380b42ec42dSaurel32     conditional_interrupt(ch);
381b42ec42dSaurel32     conditional_branch(ch);
382b42ec42dSaurel32 
383b42ec42dSaurel32 wait:
384b42ec42dSaurel32     ch->processing = 0;
385ad674e53SAurelien Jarno     if ((ch->regs[DBDMA_STATUS] & RUN) &&
386ad674e53SAurelien Jarno         (ch->regs[DBDMA_STATUS] & ACTIVE))
387b42ec42dSaurel32         channel_run(ch);
38828ce5ce6Saurel32 }
38928ce5ce6Saurel32 
390b42ec42dSaurel32 static void start_output(DBDMA_channel *ch, int key, uint32_t addr,
39128ce5ce6Saurel32                         uint16_t req_count, int is_last)
39228ce5ce6Saurel32 {
39328ce5ce6Saurel32     DBDMA_DPRINTF("start_output\n");
39428ce5ce6Saurel32 
39528ce5ce6Saurel32     /* KEY_REGS, KEY_DEVICE and KEY_STREAM
39628ce5ce6Saurel32      * are not implemented in the mac-io chip
39728ce5ce6Saurel32      */
39828ce5ce6Saurel32 
39928ce5ce6Saurel32     DBDMA_DPRINTF("addr 0x%x key 0x%x\n", addr, key);
40028ce5ce6Saurel32     if (!addr || key > KEY_STREAM3) {
40128ce5ce6Saurel32         kill_channel(ch);
402b42ec42dSaurel32         return;
40328ce5ce6Saurel32     }
40428ce5ce6Saurel32 
405b42ec42dSaurel32     ch->io.addr = addr;
40628ce5ce6Saurel32     ch->io.len = req_count;
40728ce5ce6Saurel32     ch->io.is_last = is_last;
408b42ec42dSaurel32     ch->io.dma_end = dbdma_end;
409b42ec42dSaurel32     ch->io.is_dma_out = 1;
410b42ec42dSaurel32     ch->processing = 1;
411a9ceb76dSAlexander Graf     if (ch->rw) {
412b42ec42dSaurel32         ch->rw(&ch->io);
41328ce5ce6Saurel32     }
414a9ceb76dSAlexander Graf }
41528ce5ce6Saurel32 
416b42ec42dSaurel32 static void start_input(DBDMA_channel *ch, int key, uint32_t addr,
41728ce5ce6Saurel32                        uint16_t req_count, int is_last)
41828ce5ce6Saurel32 {
41928ce5ce6Saurel32     DBDMA_DPRINTF("start_input\n");
42028ce5ce6Saurel32 
42128ce5ce6Saurel32     /* KEY_REGS, KEY_DEVICE and KEY_STREAM
42228ce5ce6Saurel32      * are not implemented in the mac-io chip
42328ce5ce6Saurel32      */
42428ce5ce6Saurel32 
42528ce5ce6Saurel32     if (!addr || key > KEY_STREAM3) {
42628ce5ce6Saurel32         kill_channel(ch);
427b42ec42dSaurel32         return;
42828ce5ce6Saurel32     }
42928ce5ce6Saurel32 
430b42ec42dSaurel32     ch->io.addr = addr;
43128ce5ce6Saurel32     ch->io.len = req_count;
43228ce5ce6Saurel32     ch->io.is_last = is_last;
433b42ec42dSaurel32     ch->io.dma_end = dbdma_end;
434b42ec42dSaurel32     ch->io.is_dma_out = 0;
435b42ec42dSaurel32     ch->processing = 1;
436a9ceb76dSAlexander Graf     if (ch->rw) {
437b42ec42dSaurel32         ch->rw(&ch->io);
43828ce5ce6Saurel32     }
439a9ceb76dSAlexander Graf }
44028ce5ce6Saurel32 
441b42ec42dSaurel32 static void load_word(DBDMA_channel *ch, int key, uint32_t addr,
44228ce5ce6Saurel32                      uint16_t len)
44328ce5ce6Saurel32 {
44428ce5ce6Saurel32     dbdma_cmd *current = &ch->current;
44528ce5ce6Saurel32     uint32_t val;
44628ce5ce6Saurel32 
44728ce5ce6Saurel32     DBDMA_DPRINTF("load_word\n");
44828ce5ce6Saurel32 
44928ce5ce6Saurel32     /* only implements KEY_SYSTEM */
45028ce5ce6Saurel32 
45128ce5ce6Saurel32     if (key != KEY_SYSTEM) {
45228ce5ce6Saurel32         printf("DBDMA: LOAD_WORD, unimplemented key %x\n", key);
45328ce5ce6Saurel32         kill_channel(ch);
454b42ec42dSaurel32         return;
45528ce5ce6Saurel32     }
45628ce5ce6Saurel32 
457*e1fe50dcSStefan Weil     cpu_physical_memory_read(addr, &val, len);
45828ce5ce6Saurel32 
45928ce5ce6Saurel32     if (len == 2)
46028ce5ce6Saurel32         val = (val << 16) | (current->cmd_dep & 0x0000ffff);
46128ce5ce6Saurel32     else if (len == 1)
46228ce5ce6Saurel32         val = (val << 24) | (current->cmd_dep & 0x00ffffff);
46328ce5ce6Saurel32 
46428ce5ce6Saurel32     current->cmd_dep = val;
46528ce5ce6Saurel32 
46628ce5ce6Saurel32     if (conditional_wait(ch))
467b42ec42dSaurel32         goto wait;
46828ce5ce6Saurel32 
469ad674e53SAurelien Jarno     current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]);
47028ce5ce6Saurel32     dbdma_cmdptr_save(ch);
471ad674e53SAurelien Jarno     ch->regs[DBDMA_STATUS] &= ~FLUSH;
47228ce5ce6Saurel32 
47328ce5ce6Saurel32     conditional_interrupt(ch);
47428ce5ce6Saurel32     next(ch);
47528ce5ce6Saurel32 
476b42ec42dSaurel32 wait:
477b42ec42dSaurel32     qemu_bh_schedule(dbdma_bh);
47828ce5ce6Saurel32 }
47928ce5ce6Saurel32 
480b42ec42dSaurel32 static void store_word(DBDMA_channel *ch, int key, uint32_t addr,
48128ce5ce6Saurel32                       uint16_t len)
48228ce5ce6Saurel32 {
48328ce5ce6Saurel32     dbdma_cmd *current = &ch->current;
48428ce5ce6Saurel32     uint32_t val;
48528ce5ce6Saurel32 
48628ce5ce6Saurel32     DBDMA_DPRINTF("store_word\n");
48728ce5ce6Saurel32 
48828ce5ce6Saurel32     /* only implements KEY_SYSTEM */
48928ce5ce6Saurel32 
49028ce5ce6Saurel32     if (key != KEY_SYSTEM) {
49128ce5ce6Saurel32         printf("DBDMA: STORE_WORD, unimplemented key %x\n", key);
49228ce5ce6Saurel32         kill_channel(ch);
493b42ec42dSaurel32         return;
49428ce5ce6Saurel32     }
49528ce5ce6Saurel32 
49628ce5ce6Saurel32     val = current->cmd_dep;
49728ce5ce6Saurel32     if (len == 2)
49828ce5ce6Saurel32         val >>= 16;
49928ce5ce6Saurel32     else if (len == 1)
50028ce5ce6Saurel32         val >>= 24;
50128ce5ce6Saurel32 
502*e1fe50dcSStefan Weil     cpu_physical_memory_write(addr, &val, len);
50328ce5ce6Saurel32 
50428ce5ce6Saurel32     if (conditional_wait(ch))
505b42ec42dSaurel32         goto wait;
50628ce5ce6Saurel32 
507ad674e53SAurelien Jarno     current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]);
50828ce5ce6Saurel32     dbdma_cmdptr_save(ch);
509ad674e53SAurelien Jarno     ch->regs[DBDMA_STATUS] &= ~FLUSH;
51028ce5ce6Saurel32 
51128ce5ce6Saurel32     conditional_interrupt(ch);
51228ce5ce6Saurel32     next(ch);
51328ce5ce6Saurel32 
514b42ec42dSaurel32 wait:
515b42ec42dSaurel32     qemu_bh_schedule(dbdma_bh);
51628ce5ce6Saurel32 }
51728ce5ce6Saurel32 
518b42ec42dSaurel32 static void nop(DBDMA_channel *ch)
51928ce5ce6Saurel32 {
52028ce5ce6Saurel32     dbdma_cmd *current = &ch->current;
52128ce5ce6Saurel32 
52228ce5ce6Saurel32     if (conditional_wait(ch))
523b42ec42dSaurel32         goto wait;
52428ce5ce6Saurel32 
525ad674e53SAurelien Jarno     current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]);
52628ce5ce6Saurel32     dbdma_cmdptr_save(ch);
52728ce5ce6Saurel32 
52828ce5ce6Saurel32     conditional_interrupt(ch);
52928ce5ce6Saurel32     conditional_branch(ch);
53028ce5ce6Saurel32 
531b42ec42dSaurel32 wait:
532b42ec42dSaurel32     qemu_bh_schedule(dbdma_bh);
53328ce5ce6Saurel32 }
53428ce5ce6Saurel32 
535b42ec42dSaurel32 static void stop(DBDMA_channel *ch)
53628ce5ce6Saurel32 {
537ad674e53SAurelien Jarno     ch->regs[DBDMA_STATUS] &= ~(ACTIVE|DEAD|FLUSH);
53828ce5ce6Saurel32 
53928ce5ce6Saurel32     /* the stop command does not increment command pointer */
54028ce5ce6Saurel32 }
54128ce5ce6Saurel32 
542b42ec42dSaurel32 static void channel_run(DBDMA_channel *ch)
54328ce5ce6Saurel32 {
54428ce5ce6Saurel32     dbdma_cmd *current = &ch->current;
54528ce5ce6Saurel32     uint16_t cmd, key;
54628ce5ce6Saurel32     uint16_t req_count;
54728ce5ce6Saurel32     uint32_t phy_addr;
54828ce5ce6Saurel32 
54928ce5ce6Saurel32     DBDMA_DPRINTF("channel_run\n");
55028ce5ce6Saurel32     dump_dbdma_cmd(current);
55128ce5ce6Saurel32 
55228ce5ce6Saurel32     /* clear WAKE flag at command fetch */
55328ce5ce6Saurel32 
554ad674e53SAurelien Jarno     ch->regs[DBDMA_STATUS] &= ~WAKE;
55528ce5ce6Saurel32 
55628ce5ce6Saurel32     cmd = le16_to_cpu(current->command) & COMMAND_MASK;
55728ce5ce6Saurel32 
55828ce5ce6Saurel32     switch (cmd) {
55928ce5ce6Saurel32     case DBDMA_NOP:
560b42ec42dSaurel32         nop(ch);
561b42ec42dSaurel32 	return;
56228ce5ce6Saurel32 
56328ce5ce6Saurel32     case DBDMA_STOP:
564b42ec42dSaurel32         stop(ch);
565b42ec42dSaurel32 	return;
56628ce5ce6Saurel32     }
56728ce5ce6Saurel32 
56828ce5ce6Saurel32     key = le16_to_cpu(current->command) & 0x0700;
56928ce5ce6Saurel32     req_count = le16_to_cpu(current->req_count);
57028ce5ce6Saurel32     phy_addr = le32_to_cpu(current->phy_addr);
57128ce5ce6Saurel32 
57228ce5ce6Saurel32     if (key == KEY_STREAM4) {
57328ce5ce6Saurel32         printf("command %x, invalid key 4\n", cmd);
57428ce5ce6Saurel32         kill_channel(ch);
575b42ec42dSaurel32         return;
57628ce5ce6Saurel32     }
57728ce5ce6Saurel32 
57828ce5ce6Saurel32     switch (cmd) {
57928ce5ce6Saurel32     case OUTPUT_MORE:
580b42ec42dSaurel32         start_output(ch, key, phy_addr, req_count, 0);
581b42ec42dSaurel32 	return;
58228ce5ce6Saurel32 
58328ce5ce6Saurel32     case OUTPUT_LAST:
584b42ec42dSaurel32         start_output(ch, key, phy_addr, req_count, 1);
585b42ec42dSaurel32 	return;
58628ce5ce6Saurel32 
58728ce5ce6Saurel32     case INPUT_MORE:
588b42ec42dSaurel32         start_input(ch, key, phy_addr, req_count, 0);
589b42ec42dSaurel32 	return;
59028ce5ce6Saurel32 
59128ce5ce6Saurel32     case INPUT_LAST:
592b42ec42dSaurel32         start_input(ch, key, phy_addr, req_count, 1);
593b42ec42dSaurel32 	return;
59428ce5ce6Saurel32     }
59528ce5ce6Saurel32 
59628ce5ce6Saurel32     if (key < KEY_REGS) {
59728ce5ce6Saurel32         printf("command %x, invalid key %x\n", cmd, key);
59828ce5ce6Saurel32         key = KEY_SYSTEM;
59928ce5ce6Saurel32     }
60028ce5ce6Saurel32 
60128ce5ce6Saurel32     /* for LOAD_WORD and STORE_WORD, req_count is on 3 bits
60228ce5ce6Saurel32      * and BRANCH is invalid
60328ce5ce6Saurel32      */
60428ce5ce6Saurel32 
60528ce5ce6Saurel32     req_count = req_count & 0x0007;
60628ce5ce6Saurel32     if (req_count & 0x4) {
60728ce5ce6Saurel32         req_count = 4;
60828ce5ce6Saurel32         phy_addr &= ~3;
60928ce5ce6Saurel32     } else if (req_count & 0x2) {
61028ce5ce6Saurel32         req_count = 2;
61128ce5ce6Saurel32         phy_addr &= ~1;
61228ce5ce6Saurel32     } else
61328ce5ce6Saurel32         req_count = 1;
61428ce5ce6Saurel32 
61528ce5ce6Saurel32     switch (cmd) {
61628ce5ce6Saurel32     case LOAD_WORD:
617b42ec42dSaurel32         load_word(ch, key, phy_addr, req_count);
618b42ec42dSaurel32 	return;
61928ce5ce6Saurel32 
62028ce5ce6Saurel32     case STORE_WORD:
621b42ec42dSaurel32         store_word(ch, key, phy_addr, req_count);
622b42ec42dSaurel32 	return;
62328ce5ce6Saurel32     }
62428ce5ce6Saurel32 }
62528ce5ce6Saurel32 
626c20df14bSJuan Quintela static void DBDMA_run(DBDMAState *s)
62728ce5ce6Saurel32 {
62828ce5ce6Saurel32     int channel;
62928ce5ce6Saurel32 
630c20df14bSJuan Quintela     for (channel = 0; channel < DBDMA_CHANNELS; channel++) {
631c20df14bSJuan Quintela         DBDMA_channel *ch = &s->channels[channel];
632ad674e53SAurelien Jarno         uint32_t status = ch->regs[DBDMA_STATUS];
633c20df14bSJuan Quintela         if (!ch->processing && (status & RUN) && (status & ACTIVE)) {
634b42ec42dSaurel32             channel_run(ch);
63528ce5ce6Saurel32         }
63628ce5ce6Saurel32     }
637c20df14bSJuan Quintela }
63828ce5ce6Saurel32 
63928ce5ce6Saurel32 static void DBDMA_run_bh(void *opaque)
64028ce5ce6Saurel32 {
641c20df14bSJuan Quintela     DBDMAState *s = opaque;
64228ce5ce6Saurel32 
64328ce5ce6Saurel32     DBDMA_DPRINTF("DBDMA_run_bh\n");
64428ce5ce6Saurel32 
645c20df14bSJuan Quintela     DBDMA_run(s);
64628ce5ce6Saurel32 }
64728ce5ce6Saurel32 
64828ce5ce6Saurel32 void DBDMA_register_channel(void *dbdma, int nchan, qemu_irq irq,
649862c9280Saurel32                             DBDMA_rw rw, DBDMA_flush flush,
65028ce5ce6Saurel32                             void *opaque)
65128ce5ce6Saurel32 {
652c20df14bSJuan Quintela     DBDMAState *s = dbdma;
653c20df14bSJuan Quintela     DBDMA_channel *ch = &s->channels[nchan];
65428ce5ce6Saurel32 
65528ce5ce6Saurel32     DBDMA_DPRINTF("DBDMA_register_channel 0x%x\n", nchan);
65628ce5ce6Saurel32 
65728ce5ce6Saurel32     ch->irq = irq;
65828ce5ce6Saurel32     ch->channel = nchan;
659b42ec42dSaurel32     ch->rw = rw;
660862c9280Saurel32     ch->flush = flush;
66128ce5ce6Saurel32     ch->io.opaque = opaque;
66228ce5ce6Saurel32     ch->io.channel = ch;
66328ce5ce6Saurel32 }
66428ce5ce6Saurel32 
66528ce5ce6Saurel32 static void
66628ce5ce6Saurel32 dbdma_control_write(DBDMA_channel *ch)
66728ce5ce6Saurel32 {
66828ce5ce6Saurel32     uint16_t mask, value;
66928ce5ce6Saurel32     uint32_t status;
67028ce5ce6Saurel32 
671ad674e53SAurelien Jarno     mask = (ch->regs[DBDMA_CONTROL] >> 16) & 0xffff;
672ad674e53SAurelien Jarno     value = ch->regs[DBDMA_CONTROL] & 0xffff;
67328ce5ce6Saurel32 
67428ce5ce6Saurel32     value &= (RUN | PAUSE | FLUSH | WAKE | DEVSTAT);
67528ce5ce6Saurel32 
676ad674e53SAurelien Jarno     status = ch->regs[DBDMA_STATUS];
67728ce5ce6Saurel32 
67828ce5ce6Saurel32     status = (value & mask) | (status & ~mask);
67928ce5ce6Saurel32 
68028ce5ce6Saurel32     if (status & WAKE)
68128ce5ce6Saurel32         status |= ACTIVE;
68228ce5ce6Saurel32     if (status & RUN) {
68328ce5ce6Saurel32         status |= ACTIVE;
68428ce5ce6Saurel32         status &= ~DEAD;
68528ce5ce6Saurel32     }
68628ce5ce6Saurel32     if (status & PAUSE)
68728ce5ce6Saurel32         status &= ~ACTIVE;
688ad674e53SAurelien Jarno     if ((ch->regs[DBDMA_STATUS] & RUN) && !(status & RUN)) {
68928ce5ce6Saurel32         /* RUN is cleared */
69028ce5ce6Saurel32         status &= ~(ACTIVE|DEAD);
691987422bcSAmadeusz Sławiński         if ((status & FLUSH) && ch->flush) {
692987422bcSAmadeusz Sławiński             ch->flush(&ch->io);
693987422bcSAmadeusz Sławiński             status &= ~FLUSH;
694987422bcSAmadeusz Sławiński         }
69528ce5ce6Saurel32     }
69628ce5ce6Saurel32 
69728ce5ce6Saurel32     DBDMA_DPRINTF("    status 0x%08x\n", status);
69828ce5ce6Saurel32 
699ad674e53SAurelien Jarno     ch->regs[DBDMA_STATUS] = status;
70028ce5ce6Saurel32 
701b42ec42dSaurel32     if (status & ACTIVE)
702b42ec42dSaurel32         qemu_bh_schedule(dbdma_bh);
703a9ceb76dSAlexander Graf     if ((status & FLUSH) && ch->flush)
704862c9280Saurel32         ch->flush(&ch->io);
7053cbee15bSj_mayer }
7063cbee15bSj_mayer 
707a8170e5eSAvi Kivity static void dbdma_write(void *opaque, hwaddr addr,
70823c5e4caSAvi Kivity                         uint64_t value, unsigned size)
7093cbee15bSj_mayer {
71028ce5ce6Saurel32     int channel = addr >> DBDMA_CHANNEL_SHIFT;
711c20df14bSJuan Quintela     DBDMAState *s = opaque;
712c20df14bSJuan Quintela     DBDMA_channel *ch = &s->channels[channel];
71328ce5ce6Saurel32     int reg = (addr - (channel << DBDMA_CHANNEL_SHIFT)) >> 2;
71428ce5ce6Saurel32 
715ea026b2fSblueswir1     DBDMA_DPRINTF("writel 0x" TARGET_FMT_plx " <= 0x%08x\n", addr, value);
71628ce5ce6Saurel32     DBDMA_DPRINTF("channel 0x%x reg 0x%x\n",
71728ce5ce6Saurel32                   (uint32_t)addr >> DBDMA_CHANNEL_SHIFT, reg);
71828ce5ce6Saurel32 
71928ce5ce6Saurel32     /* cmdptr cannot be modified if channel is RUN or ACTIVE */
72028ce5ce6Saurel32 
72128ce5ce6Saurel32     if (reg == DBDMA_CMDPTR_LO &&
722ad674e53SAurelien Jarno         (ch->regs[DBDMA_STATUS] & (RUN | ACTIVE)))
72328ce5ce6Saurel32 	return;
72428ce5ce6Saurel32 
72528ce5ce6Saurel32     ch->regs[reg] = value;
72628ce5ce6Saurel32 
72728ce5ce6Saurel32     switch(reg) {
72828ce5ce6Saurel32     case DBDMA_CONTROL:
72928ce5ce6Saurel32         dbdma_control_write(ch);
73028ce5ce6Saurel32         break;
73128ce5ce6Saurel32     case DBDMA_CMDPTR_LO:
73228ce5ce6Saurel32         /* 16-byte aligned */
733ad674e53SAurelien Jarno         ch->regs[DBDMA_CMDPTR_LO] &= ~0xf;
73428ce5ce6Saurel32         dbdma_cmdptr_load(ch);
73528ce5ce6Saurel32         break;
73628ce5ce6Saurel32     case DBDMA_STATUS:
73728ce5ce6Saurel32     case DBDMA_INTR_SEL:
73828ce5ce6Saurel32     case DBDMA_BRANCH_SEL:
73928ce5ce6Saurel32     case DBDMA_WAIT_SEL:
74028ce5ce6Saurel32         /* nothing to do */
74128ce5ce6Saurel32         break;
74228ce5ce6Saurel32     case DBDMA_XFER_MODE:
74328ce5ce6Saurel32     case DBDMA_CMDPTR_HI:
74428ce5ce6Saurel32     case DBDMA_DATA2PTR_HI:
74528ce5ce6Saurel32     case DBDMA_DATA2PTR_LO:
74628ce5ce6Saurel32     case DBDMA_ADDRESS_HI:
74728ce5ce6Saurel32     case DBDMA_BRANCH_ADDR_HI:
74828ce5ce6Saurel32     case DBDMA_RES1:
74928ce5ce6Saurel32     case DBDMA_RES2:
75028ce5ce6Saurel32     case DBDMA_RES3:
75128ce5ce6Saurel32     case DBDMA_RES4:
75228ce5ce6Saurel32         /* unused */
75328ce5ce6Saurel32         break;
7543cbee15bSj_mayer     }
7553cbee15bSj_mayer }
7563cbee15bSj_mayer 
757a8170e5eSAvi Kivity static uint64_t dbdma_read(void *opaque, hwaddr addr,
75823c5e4caSAvi Kivity                            unsigned size)
7593cbee15bSj_mayer {
76028ce5ce6Saurel32     uint32_t value;
76128ce5ce6Saurel32     int channel = addr >> DBDMA_CHANNEL_SHIFT;
762c20df14bSJuan Quintela     DBDMAState *s = opaque;
763c20df14bSJuan Quintela     DBDMA_channel *ch = &s->channels[channel];
76428ce5ce6Saurel32     int reg = (addr - (channel << DBDMA_CHANNEL_SHIFT)) >> 2;
765ea026b2fSblueswir1 
76628ce5ce6Saurel32     value = ch->regs[reg];
76728ce5ce6Saurel32 
76828ce5ce6Saurel32     DBDMA_DPRINTF("readl 0x" TARGET_FMT_plx " => 0x%08x\n", addr, value);
76928ce5ce6Saurel32     DBDMA_DPRINTF("channel 0x%x reg 0x%x\n",
77028ce5ce6Saurel32                   (uint32_t)addr >> DBDMA_CHANNEL_SHIFT, reg);
77128ce5ce6Saurel32 
77228ce5ce6Saurel32     switch(reg) {
77328ce5ce6Saurel32     case DBDMA_CONTROL:
77428ce5ce6Saurel32         value = 0;
77528ce5ce6Saurel32         break;
77628ce5ce6Saurel32     case DBDMA_STATUS:
77728ce5ce6Saurel32     case DBDMA_CMDPTR_LO:
77828ce5ce6Saurel32     case DBDMA_INTR_SEL:
77928ce5ce6Saurel32     case DBDMA_BRANCH_SEL:
78028ce5ce6Saurel32     case DBDMA_WAIT_SEL:
78128ce5ce6Saurel32         /* nothing to do */
78228ce5ce6Saurel32         break;
78328ce5ce6Saurel32     case DBDMA_XFER_MODE:
78428ce5ce6Saurel32     case DBDMA_CMDPTR_HI:
78528ce5ce6Saurel32     case DBDMA_DATA2PTR_HI:
78628ce5ce6Saurel32     case DBDMA_DATA2PTR_LO:
78728ce5ce6Saurel32     case DBDMA_ADDRESS_HI:
78828ce5ce6Saurel32     case DBDMA_BRANCH_ADDR_HI:
78928ce5ce6Saurel32         /* unused */
79028ce5ce6Saurel32         value = 0;
79128ce5ce6Saurel32         break;
79228ce5ce6Saurel32     case DBDMA_RES1:
79328ce5ce6Saurel32     case DBDMA_RES2:
79428ce5ce6Saurel32     case DBDMA_RES3:
79528ce5ce6Saurel32     case DBDMA_RES4:
79628ce5ce6Saurel32         /* reserved */
79728ce5ce6Saurel32         break;
79828ce5ce6Saurel32     }
79928ce5ce6Saurel32 
80028ce5ce6Saurel32     return value;
8013cbee15bSj_mayer }
8023cbee15bSj_mayer 
80323c5e4caSAvi Kivity static const MemoryRegionOps dbdma_ops = {
80423c5e4caSAvi Kivity     .read = dbdma_read,
80523c5e4caSAvi Kivity     .write = dbdma_write,
80623c5e4caSAvi Kivity     .endianness = DEVICE_LITTLE_ENDIAN,
80723c5e4caSAvi Kivity     .valid = {
80823c5e4caSAvi Kivity         .min_access_size = 4,
80923c5e4caSAvi Kivity         .max_access_size = 4,
81023c5e4caSAvi Kivity     },
8113cbee15bSj_mayer };
8123cbee15bSj_mayer 
813da26fdc3SJuan Quintela static const VMStateDescription vmstate_dbdma_channel = {
814da26fdc3SJuan Quintela     .name = "dbdma_channel",
815da26fdc3SJuan Quintela     .version_id = 0,
816da26fdc3SJuan Quintela     .minimum_version_id = 0,
817da26fdc3SJuan Quintela     .minimum_version_id_old = 0,
818da26fdc3SJuan Quintela     .fields      = (VMStateField[]) {
819da26fdc3SJuan Quintela         VMSTATE_UINT32_ARRAY(regs, struct DBDMA_channel, DBDMA_REGS),
820da26fdc3SJuan Quintela         VMSTATE_END_OF_LIST()
8219b64997fSblueswir1     }
822da26fdc3SJuan Quintela };
8239b64997fSblueswir1 
824da26fdc3SJuan Quintela static const VMStateDescription vmstate_dbdma = {
825da26fdc3SJuan Quintela     .name = "dbdma",
826da26fdc3SJuan Quintela     .version_id = 2,
827da26fdc3SJuan Quintela     .minimum_version_id = 2,
828da26fdc3SJuan Quintela     .minimum_version_id_old = 2,
829da26fdc3SJuan Quintela     .fields      = (VMStateField[]) {
830da26fdc3SJuan Quintela         VMSTATE_STRUCT_ARRAY(channels, DBDMAState, DBDMA_CHANNELS, 1,
831da26fdc3SJuan Quintela                              vmstate_dbdma_channel, DBDMA_channel),
832da26fdc3SJuan Quintela         VMSTATE_END_OF_LIST()
8339b64997fSblueswir1     }
834da26fdc3SJuan Quintela };
8359b64997fSblueswir1 
8366e6b7363Sblueswir1 static void dbdma_reset(void *opaque)
8376e6b7363Sblueswir1 {
838c20df14bSJuan Quintela     DBDMAState *s = opaque;
83928ce5ce6Saurel32     int i;
84028ce5ce6Saurel32 
84128ce5ce6Saurel32     for (i = 0; i < DBDMA_CHANNELS; i++)
842c20df14bSJuan Quintela         memset(s->channels[i].regs, 0, DBDMA_SIZE);
8436e6b7363Sblueswir1 }
8446e6b7363Sblueswir1 
84523c5e4caSAvi Kivity void* DBDMA_init (MemoryRegion **dbdma_mem)
8463cbee15bSj_mayer {
847c20df14bSJuan Quintela     DBDMAState *s;
84828ce5ce6Saurel32 
8497267c094SAnthony Liguori     s = g_malloc0(sizeof(DBDMAState));
85028ce5ce6Saurel32 
85123c5e4caSAvi Kivity     memory_region_init_io(&s->mem, &dbdma_ops, s, "dbdma", 0x1000);
85223c5e4caSAvi Kivity     *dbdma_mem = &s->mem;
853da26fdc3SJuan Quintela     vmstate_register(NULL, -1, &vmstate_dbdma, s);
854a08d4367SJan Kiszka     qemu_register_reset(dbdma_reset, s);
85528ce5ce6Saurel32 
85628ce5ce6Saurel32     dbdma_bh = qemu_bh_new(DBDMA_run_bh, s);
85728ce5ce6Saurel32 
85828ce5ce6Saurel32     return s;
8593cbee15bSj_mayer }
860