149ab747fSPaolo Bonzini /* 249ab747fSPaolo Bonzini * PowerMac descriptor-based DMA emulation 349ab747fSPaolo Bonzini * 449ab747fSPaolo Bonzini * Copyright (c) 2005-2007 Fabrice Bellard 549ab747fSPaolo Bonzini * Copyright (c) 2007 Jocelyn Mayer 649ab747fSPaolo Bonzini * Copyright (c) 2009 Laurent Vivier 749ab747fSPaolo Bonzini * 849ab747fSPaolo Bonzini * some parts from linux-2.6.28, arch/powerpc/include/asm/dbdma.h 949ab747fSPaolo Bonzini * 1049ab747fSPaolo Bonzini * Definitions for using the Apple Descriptor-Based DMA controller 1149ab747fSPaolo Bonzini * in Power Macintosh computers. 1249ab747fSPaolo Bonzini * 1349ab747fSPaolo Bonzini * Copyright (C) 1996 Paul Mackerras. 1449ab747fSPaolo Bonzini * 1549ab747fSPaolo Bonzini * some parts from mol 0.9.71 1649ab747fSPaolo Bonzini * 1749ab747fSPaolo Bonzini * Descriptor based DMA emulation 1849ab747fSPaolo Bonzini * 1949ab747fSPaolo Bonzini * Copyright (C) 1998-2004 Samuel Rydh (samuel@ibrium.se) 2049ab747fSPaolo Bonzini * 2149ab747fSPaolo Bonzini * Permission is hereby granted, free of charge, to any person obtaining a copy 2249ab747fSPaolo Bonzini * of this software and associated documentation files (the "Software"), to deal 2349ab747fSPaolo Bonzini * in the Software without restriction, including without limitation the rights 2449ab747fSPaolo Bonzini * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell 2549ab747fSPaolo Bonzini * copies of the Software, and to permit persons to whom the Software is 2649ab747fSPaolo Bonzini * furnished to do so, subject to the following conditions: 2749ab747fSPaolo Bonzini * 2849ab747fSPaolo Bonzini * The above copyright notice and this permission notice shall be included in 2949ab747fSPaolo Bonzini * all copies or substantial portions of the Software. 3049ab747fSPaolo Bonzini * 3149ab747fSPaolo Bonzini * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR 3249ab747fSPaolo Bonzini * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, 3349ab747fSPaolo Bonzini * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL 3449ab747fSPaolo Bonzini * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER 3549ab747fSPaolo Bonzini * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, 3649ab747fSPaolo Bonzini * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN 3749ab747fSPaolo Bonzini * THE SOFTWARE. 3849ab747fSPaolo Bonzini */ 3949ab747fSPaolo Bonzini #include "hw/hw.h" 4049ab747fSPaolo Bonzini #include "hw/isa/isa.h" 4149ab747fSPaolo Bonzini #include "hw/ppc/mac_dbdma.h" 4249ab747fSPaolo Bonzini #include "qemu/main-loop.h" 4349ab747fSPaolo Bonzini 4449ab747fSPaolo Bonzini /* debug DBDMA */ 4549ab747fSPaolo Bonzini //#define DEBUG_DBDMA 4649ab747fSPaolo Bonzini 4749ab747fSPaolo Bonzini #ifdef DEBUG_DBDMA 4849ab747fSPaolo Bonzini #define DBDMA_DPRINTF(fmt, ...) \ 4949ab747fSPaolo Bonzini do { printf("DBDMA: " fmt , ## __VA_ARGS__); } while (0) 5049ab747fSPaolo Bonzini #else 5149ab747fSPaolo Bonzini #define DBDMA_DPRINTF(fmt, ...) 5249ab747fSPaolo Bonzini #endif 5349ab747fSPaolo Bonzini 5449ab747fSPaolo Bonzini /* 5549ab747fSPaolo Bonzini */ 5649ab747fSPaolo Bonzini 5749ab747fSPaolo Bonzini /* 5849ab747fSPaolo Bonzini * DBDMA control/status registers. All little-endian. 5949ab747fSPaolo Bonzini */ 6049ab747fSPaolo Bonzini 6149ab747fSPaolo Bonzini #define DBDMA_CONTROL 0x00 6249ab747fSPaolo Bonzini #define DBDMA_STATUS 0x01 6349ab747fSPaolo Bonzini #define DBDMA_CMDPTR_HI 0x02 6449ab747fSPaolo Bonzini #define DBDMA_CMDPTR_LO 0x03 6549ab747fSPaolo Bonzini #define DBDMA_INTR_SEL 0x04 6649ab747fSPaolo Bonzini #define DBDMA_BRANCH_SEL 0x05 6749ab747fSPaolo Bonzini #define DBDMA_WAIT_SEL 0x06 6849ab747fSPaolo Bonzini #define DBDMA_XFER_MODE 0x07 6949ab747fSPaolo Bonzini #define DBDMA_DATA2PTR_HI 0x08 7049ab747fSPaolo Bonzini #define DBDMA_DATA2PTR_LO 0x09 7149ab747fSPaolo Bonzini #define DBDMA_RES1 0x0A 7249ab747fSPaolo Bonzini #define DBDMA_ADDRESS_HI 0x0B 7349ab747fSPaolo Bonzini #define DBDMA_BRANCH_ADDR_HI 0x0C 7449ab747fSPaolo Bonzini #define DBDMA_RES2 0x0D 7549ab747fSPaolo Bonzini #define DBDMA_RES3 0x0E 7649ab747fSPaolo Bonzini #define DBDMA_RES4 0x0F 7749ab747fSPaolo Bonzini 7849ab747fSPaolo Bonzini #define DBDMA_REGS 16 7949ab747fSPaolo Bonzini #define DBDMA_SIZE (DBDMA_REGS * sizeof(uint32_t)) 8049ab747fSPaolo Bonzini 8149ab747fSPaolo Bonzini #define DBDMA_CHANNEL_SHIFT 7 8249ab747fSPaolo Bonzini #define DBDMA_CHANNEL_SIZE (1 << DBDMA_CHANNEL_SHIFT) 8349ab747fSPaolo Bonzini 8449ab747fSPaolo Bonzini #define DBDMA_CHANNELS (0x1000 >> DBDMA_CHANNEL_SHIFT) 8549ab747fSPaolo Bonzini 8649ab747fSPaolo Bonzini /* Bits in control and status registers */ 8749ab747fSPaolo Bonzini 8849ab747fSPaolo Bonzini #define RUN 0x8000 8949ab747fSPaolo Bonzini #define PAUSE 0x4000 9049ab747fSPaolo Bonzini #define FLUSH 0x2000 9149ab747fSPaolo Bonzini #define WAKE 0x1000 9249ab747fSPaolo Bonzini #define DEAD 0x0800 9349ab747fSPaolo Bonzini #define ACTIVE 0x0400 9449ab747fSPaolo Bonzini #define BT 0x0100 9549ab747fSPaolo Bonzini #define DEVSTAT 0x00ff 9649ab747fSPaolo Bonzini 9749ab747fSPaolo Bonzini /* 9849ab747fSPaolo Bonzini * DBDMA command structure. These fields are all little-endian! 9949ab747fSPaolo Bonzini */ 10049ab747fSPaolo Bonzini 10149ab747fSPaolo Bonzini typedef struct dbdma_cmd { 10249ab747fSPaolo Bonzini uint16_t req_count; /* requested byte transfer count */ 10349ab747fSPaolo Bonzini uint16_t command; /* command word (has bit-fields) */ 10449ab747fSPaolo Bonzini uint32_t phy_addr; /* physical data address */ 10549ab747fSPaolo Bonzini uint32_t cmd_dep; /* command-dependent field */ 10649ab747fSPaolo Bonzini uint16_t res_count; /* residual count after completion */ 10749ab747fSPaolo Bonzini uint16_t xfer_status; /* transfer status */ 10849ab747fSPaolo Bonzini } dbdma_cmd; 10949ab747fSPaolo Bonzini 11049ab747fSPaolo Bonzini /* DBDMA command values in command field */ 11149ab747fSPaolo Bonzini 11249ab747fSPaolo Bonzini #define COMMAND_MASK 0xf000 11349ab747fSPaolo Bonzini #define OUTPUT_MORE 0x0000 /* transfer memory data to stream */ 11449ab747fSPaolo Bonzini #define OUTPUT_LAST 0x1000 /* ditto followed by end marker */ 11549ab747fSPaolo Bonzini #define INPUT_MORE 0x2000 /* transfer stream data to memory */ 11649ab747fSPaolo Bonzini #define INPUT_LAST 0x3000 /* ditto, expect end marker */ 11749ab747fSPaolo Bonzini #define STORE_WORD 0x4000 /* write word (4 bytes) to device reg */ 11849ab747fSPaolo Bonzini #define LOAD_WORD 0x5000 /* read word (4 bytes) from device reg */ 11949ab747fSPaolo Bonzini #define DBDMA_NOP 0x6000 /* do nothing */ 12049ab747fSPaolo Bonzini #define DBDMA_STOP 0x7000 /* suspend processing */ 12149ab747fSPaolo Bonzini 12249ab747fSPaolo Bonzini /* Key values in command field */ 12349ab747fSPaolo Bonzini 12449ab747fSPaolo Bonzini #define KEY_MASK 0x0700 12549ab747fSPaolo Bonzini #define KEY_STREAM0 0x0000 /* usual data stream */ 12649ab747fSPaolo Bonzini #define KEY_STREAM1 0x0100 /* control/status stream */ 12749ab747fSPaolo Bonzini #define KEY_STREAM2 0x0200 /* device-dependent stream */ 12849ab747fSPaolo Bonzini #define KEY_STREAM3 0x0300 /* device-dependent stream */ 12949ab747fSPaolo Bonzini #define KEY_STREAM4 0x0400 /* reserved */ 13049ab747fSPaolo Bonzini #define KEY_REGS 0x0500 /* device register space */ 13149ab747fSPaolo Bonzini #define KEY_SYSTEM 0x0600 /* system memory-mapped space */ 13249ab747fSPaolo Bonzini #define KEY_DEVICE 0x0700 /* device memory-mapped space */ 13349ab747fSPaolo Bonzini 13449ab747fSPaolo Bonzini /* Interrupt control values in command field */ 13549ab747fSPaolo Bonzini 13649ab747fSPaolo Bonzini #define INTR_MASK 0x0030 13749ab747fSPaolo Bonzini #define INTR_NEVER 0x0000 /* don't interrupt */ 13849ab747fSPaolo Bonzini #define INTR_IFSET 0x0010 /* intr if condition bit is 1 */ 13949ab747fSPaolo Bonzini #define INTR_IFCLR 0x0020 /* intr if condition bit is 0 */ 14049ab747fSPaolo Bonzini #define INTR_ALWAYS 0x0030 /* always interrupt */ 14149ab747fSPaolo Bonzini 14249ab747fSPaolo Bonzini /* Branch control values in command field */ 14349ab747fSPaolo Bonzini 14449ab747fSPaolo Bonzini #define BR_MASK 0x000c 14549ab747fSPaolo Bonzini #define BR_NEVER 0x0000 /* don't branch */ 14649ab747fSPaolo Bonzini #define BR_IFSET 0x0004 /* branch if condition bit is 1 */ 14749ab747fSPaolo Bonzini #define BR_IFCLR 0x0008 /* branch if condition bit is 0 */ 14849ab747fSPaolo Bonzini #define BR_ALWAYS 0x000c /* always branch */ 14949ab747fSPaolo Bonzini 15049ab747fSPaolo Bonzini /* Wait control values in command field */ 15149ab747fSPaolo Bonzini 15249ab747fSPaolo Bonzini #define WAIT_MASK 0x0003 15349ab747fSPaolo Bonzini #define WAIT_NEVER 0x0000 /* don't wait */ 15449ab747fSPaolo Bonzini #define WAIT_IFSET 0x0001 /* wait if condition bit is 1 */ 15549ab747fSPaolo Bonzini #define WAIT_IFCLR 0x0002 /* wait if condition bit is 0 */ 15649ab747fSPaolo Bonzini #define WAIT_ALWAYS 0x0003 /* always wait */ 15749ab747fSPaolo Bonzini 15849ab747fSPaolo Bonzini typedef struct DBDMA_channel { 15949ab747fSPaolo Bonzini int channel; 16049ab747fSPaolo Bonzini uint32_t regs[DBDMA_REGS]; 16149ab747fSPaolo Bonzini qemu_irq irq; 16249ab747fSPaolo Bonzini DBDMA_io io; 16349ab747fSPaolo Bonzini DBDMA_rw rw; 16449ab747fSPaolo Bonzini DBDMA_flush flush; 16549ab747fSPaolo Bonzini dbdma_cmd current; 16649ab747fSPaolo Bonzini int processing; 16749ab747fSPaolo Bonzini } DBDMA_channel; 16849ab747fSPaolo Bonzini 16949ab747fSPaolo Bonzini typedef struct { 17049ab747fSPaolo Bonzini MemoryRegion mem; 17149ab747fSPaolo Bonzini DBDMA_channel channels[DBDMA_CHANNELS]; 17249ab747fSPaolo Bonzini } DBDMAState; 17349ab747fSPaolo Bonzini 17449ab747fSPaolo Bonzini #ifdef DEBUG_DBDMA 17549ab747fSPaolo Bonzini static void dump_dbdma_cmd(dbdma_cmd *cmd) 17649ab747fSPaolo Bonzini { 17749ab747fSPaolo Bonzini printf("dbdma_cmd %p\n", cmd); 17849ab747fSPaolo Bonzini printf(" req_count 0x%04x\n", le16_to_cpu(cmd->req_count)); 17949ab747fSPaolo Bonzini printf(" command 0x%04x\n", le16_to_cpu(cmd->command)); 18049ab747fSPaolo Bonzini printf(" phy_addr 0x%08x\n", le32_to_cpu(cmd->phy_addr)); 18149ab747fSPaolo Bonzini printf(" cmd_dep 0x%08x\n", le32_to_cpu(cmd->cmd_dep)); 18249ab747fSPaolo Bonzini printf(" res_count 0x%04x\n", le16_to_cpu(cmd->res_count)); 18349ab747fSPaolo Bonzini printf(" xfer_status 0x%04x\n", le16_to_cpu(cmd->xfer_status)); 18449ab747fSPaolo Bonzini } 18549ab747fSPaolo Bonzini #else 18649ab747fSPaolo Bonzini static void dump_dbdma_cmd(dbdma_cmd *cmd) 18749ab747fSPaolo Bonzini { 18849ab747fSPaolo Bonzini } 18949ab747fSPaolo Bonzini #endif 19049ab747fSPaolo Bonzini static void dbdma_cmdptr_load(DBDMA_channel *ch) 19149ab747fSPaolo Bonzini { 19249ab747fSPaolo Bonzini DBDMA_DPRINTF("dbdma_cmdptr_load 0x%08x\n", 19349ab747fSPaolo Bonzini ch->regs[DBDMA_CMDPTR_LO]); 19449ab747fSPaolo Bonzini cpu_physical_memory_read(ch->regs[DBDMA_CMDPTR_LO], 195*e1fe50dcSStefan Weil &ch->current, sizeof(dbdma_cmd)); 19649ab747fSPaolo Bonzini } 19749ab747fSPaolo Bonzini 19849ab747fSPaolo Bonzini static void dbdma_cmdptr_save(DBDMA_channel *ch) 19949ab747fSPaolo Bonzini { 20049ab747fSPaolo Bonzini DBDMA_DPRINTF("dbdma_cmdptr_save 0x%08x\n", 20149ab747fSPaolo Bonzini ch->regs[DBDMA_CMDPTR_LO]); 20249ab747fSPaolo Bonzini DBDMA_DPRINTF("xfer_status 0x%08x res_count 0x%04x\n", 20349ab747fSPaolo Bonzini le16_to_cpu(ch->current.xfer_status), 20449ab747fSPaolo Bonzini le16_to_cpu(ch->current.res_count)); 20549ab747fSPaolo Bonzini cpu_physical_memory_write(ch->regs[DBDMA_CMDPTR_LO], 206*e1fe50dcSStefan Weil &ch->current, sizeof(dbdma_cmd)); 20749ab747fSPaolo Bonzini } 20849ab747fSPaolo Bonzini 20949ab747fSPaolo Bonzini static void kill_channel(DBDMA_channel *ch) 21049ab747fSPaolo Bonzini { 21149ab747fSPaolo Bonzini DBDMA_DPRINTF("kill_channel\n"); 21249ab747fSPaolo Bonzini 21349ab747fSPaolo Bonzini ch->regs[DBDMA_STATUS] |= DEAD; 21449ab747fSPaolo Bonzini ch->regs[DBDMA_STATUS] &= ~ACTIVE; 21549ab747fSPaolo Bonzini 21649ab747fSPaolo Bonzini qemu_irq_raise(ch->irq); 21749ab747fSPaolo Bonzini } 21849ab747fSPaolo Bonzini 21949ab747fSPaolo Bonzini static void conditional_interrupt(DBDMA_channel *ch) 22049ab747fSPaolo Bonzini { 22149ab747fSPaolo Bonzini dbdma_cmd *current = &ch->current; 22249ab747fSPaolo Bonzini uint16_t intr; 22349ab747fSPaolo Bonzini uint16_t sel_mask, sel_value; 22449ab747fSPaolo Bonzini uint32_t status; 22549ab747fSPaolo Bonzini int cond; 22649ab747fSPaolo Bonzini 22749ab747fSPaolo Bonzini DBDMA_DPRINTF("conditional_interrupt\n"); 22849ab747fSPaolo Bonzini 22949ab747fSPaolo Bonzini intr = le16_to_cpu(current->command) & INTR_MASK; 23049ab747fSPaolo Bonzini 23149ab747fSPaolo Bonzini switch(intr) { 23249ab747fSPaolo Bonzini case INTR_NEVER: /* don't interrupt */ 23349ab747fSPaolo Bonzini return; 23449ab747fSPaolo Bonzini case INTR_ALWAYS: /* always interrupt */ 23549ab747fSPaolo Bonzini qemu_irq_raise(ch->irq); 23649ab747fSPaolo Bonzini return; 23749ab747fSPaolo Bonzini } 23849ab747fSPaolo Bonzini 23949ab747fSPaolo Bonzini status = ch->regs[DBDMA_STATUS] & DEVSTAT; 24049ab747fSPaolo Bonzini 24149ab747fSPaolo Bonzini sel_mask = (ch->regs[DBDMA_INTR_SEL] >> 16) & 0x0f; 24249ab747fSPaolo Bonzini sel_value = ch->regs[DBDMA_INTR_SEL] & 0x0f; 24349ab747fSPaolo Bonzini 24449ab747fSPaolo Bonzini cond = (status & sel_mask) == (sel_value & sel_mask); 24549ab747fSPaolo Bonzini 24649ab747fSPaolo Bonzini switch(intr) { 24749ab747fSPaolo Bonzini case INTR_IFSET: /* intr if condition bit is 1 */ 24849ab747fSPaolo Bonzini if (cond) 24949ab747fSPaolo Bonzini qemu_irq_raise(ch->irq); 25049ab747fSPaolo Bonzini return; 25149ab747fSPaolo Bonzini case INTR_IFCLR: /* intr if condition bit is 0 */ 25249ab747fSPaolo Bonzini if (!cond) 25349ab747fSPaolo Bonzini qemu_irq_raise(ch->irq); 25449ab747fSPaolo Bonzini return; 25549ab747fSPaolo Bonzini } 25649ab747fSPaolo Bonzini } 25749ab747fSPaolo Bonzini 25849ab747fSPaolo Bonzini static int conditional_wait(DBDMA_channel *ch) 25949ab747fSPaolo Bonzini { 26049ab747fSPaolo Bonzini dbdma_cmd *current = &ch->current; 26149ab747fSPaolo Bonzini uint16_t wait; 26249ab747fSPaolo Bonzini uint16_t sel_mask, sel_value; 26349ab747fSPaolo Bonzini uint32_t status; 26449ab747fSPaolo Bonzini int cond; 26549ab747fSPaolo Bonzini 26649ab747fSPaolo Bonzini DBDMA_DPRINTF("conditional_wait\n"); 26749ab747fSPaolo Bonzini 26849ab747fSPaolo Bonzini wait = le16_to_cpu(current->command) & WAIT_MASK; 26949ab747fSPaolo Bonzini 27049ab747fSPaolo Bonzini switch(wait) { 27149ab747fSPaolo Bonzini case WAIT_NEVER: /* don't wait */ 27249ab747fSPaolo Bonzini return 0; 27349ab747fSPaolo Bonzini case WAIT_ALWAYS: /* always wait */ 27449ab747fSPaolo Bonzini return 1; 27549ab747fSPaolo Bonzini } 27649ab747fSPaolo Bonzini 27749ab747fSPaolo Bonzini status = ch->regs[DBDMA_STATUS] & DEVSTAT; 27849ab747fSPaolo Bonzini 27949ab747fSPaolo Bonzini sel_mask = (ch->regs[DBDMA_WAIT_SEL] >> 16) & 0x0f; 28049ab747fSPaolo Bonzini sel_value = ch->regs[DBDMA_WAIT_SEL] & 0x0f; 28149ab747fSPaolo Bonzini 28249ab747fSPaolo Bonzini cond = (status & sel_mask) == (sel_value & sel_mask); 28349ab747fSPaolo Bonzini 28449ab747fSPaolo Bonzini switch(wait) { 28549ab747fSPaolo Bonzini case WAIT_IFSET: /* wait if condition bit is 1 */ 28649ab747fSPaolo Bonzini if (cond) 28749ab747fSPaolo Bonzini return 1; 28849ab747fSPaolo Bonzini return 0; 28949ab747fSPaolo Bonzini case WAIT_IFCLR: /* wait if condition bit is 0 */ 29049ab747fSPaolo Bonzini if (!cond) 29149ab747fSPaolo Bonzini return 1; 29249ab747fSPaolo Bonzini return 0; 29349ab747fSPaolo Bonzini } 29449ab747fSPaolo Bonzini return 0; 29549ab747fSPaolo Bonzini } 29649ab747fSPaolo Bonzini 29749ab747fSPaolo Bonzini static void next(DBDMA_channel *ch) 29849ab747fSPaolo Bonzini { 29949ab747fSPaolo Bonzini uint32_t cp; 30049ab747fSPaolo Bonzini 30149ab747fSPaolo Bonzini ch->regs[DBDMA_STATUS] &= ~BT; 30249ab747fSPaolo Bonzini 30349ab747fSPaolo Bonzini cp = ch->regs[DBDMA_CMDPTR_LO]; 30449ab747fSPaolo Bonzini ch->regs[DBDMA_CMDPTR_LO] = cp + sizeof(dbdma_cmd); 30549ab747fSPaolo Bonzini dbdma_cmdptr_load(ch); 30649ab747fSPaolo Bonzini } 30749ab747fSPaolo Bonzini 30849ab747fSPaolo Bonzini static void branch(DBDMA_channel *ch) 30949ab747fSPaolo Bonzini { 31049ab747fSPaolo Bonzini dbdma_cmd *current = &ch->current; 31149ab747fSPaolo Bonzini 31249ab747fSPaolo Bonzini ch->regs[DBDMA_CMDPTR_LO] = current->cmd_dep; 31349ab747fSPaolo Bonzini ch->regs[DBDMA_STATUS] |= BT; 31449ab747fSPaolo Bonzini dbdma_cmdptr_load(ch); 31549ab747fSPaolo Bonzini } 31649ab747fSPaolo Bonzini 31749ab747fSPaolo Bonzini static void conditional_branch(DBDMA_channel *ch) 31849ab747fSPaolo Bonzini { 31949ab747fSPaolo Bonzini dbdma_cmd *current = &ch->current; 32049ab747fSPaolo Bonzini uint16_t br; 32149ab747fSPaolo Bonzini uint16_t sel_mask, sel_value; 32249ab747fSPaolo Bonzini uint32_t status; 32349ab747fSPaolo Bonzini int cond; 32449ab747fSPaolo Bonzini 32549ab747fSPaolo Bonzini DBDMA_DPRINTF("conditional_branch\n"); 32649ab747fSPaolo Bonzini 32749ab747fSPaolo Bonzini /* check if we must branch */ 32849ab747fSPaolo Bonzini 32949ab747fSPaolo Bonzini br = le16_to_cpu(current->command) & BR_MASK; 33049ab747fSPaolo Bonzini 33149ab747fSPaolo Bonzini switch(br) { 33249ab747fSPaolo Bonzini case BR_NEVER: /* don't branch */ 33349ab747fSPaolo Bonzini next(ch); 33449ab747fSPaolo Bonzini return; 33549ab747fSPaolo Bonzini case BR_ALWAYS: /* always branch */ 33649ab747fSPaolo Bonzini branch(ch); 33749ab747fSPaolo Bonzini return; 33849ab747fSPaolo Bonzini } 33949ab747fSPaolo Bonzini 34049ab747fSPaolo Bonzini status = ch->regs[DBDMA_STATUS] & DEVSTAT; 34149ab747fSPaolo Bonzini 34249ab747fSPaolo Bonzini sel_mask = (ch->regs[DBDMA_BRANCH_SEL] >> 16) & 0x0f; 34349ab747fSPaolo Bonzini sel_value = ch->regs[DBDMA_BRANCH_SEL] & 0x0f; 34449ab747fSPaolo Bonzini 34549ab747fSPaolo Bonzini cond = (status & sel_mask) == (sel_value & sel_mask); 34649ab747fSPaolo Bonzini 34749ab747fSPaolo Bonzini switch(br) { 34849ab747fSPaolo Bonzini case BR_IFSET: /* branch if condition bit is 1 */ 34949ab747fSPaolo Bonzini if (cond) 35049ab747fSPaolo Bonzini branch(ch); 35149ab747fSPaolo Bonzini else 35249ab747fSPaolo Bonzini next(ch); 35349ab747fSPaolo Bonzini return; 35449ab747fSPaolo Bonzini case BR_IFCLR: /* branch if condition bit is 0 */ 35549ab747fSPaolo Bonzini if (!cond) 35649ab747fSPaolo Bonzini branch(ch); 35749ab747fSPaolo Bonzini else 35849ab747fSPaolo Bonzini next(ch); 35949ab747fSPaolo Bonzini return; 36049ab747fSPaolo Bonzini } 36149ab747fSPaolo Bonzini } 36249ab747fSPaolo Bonzini 36349ab747fSPaolo Bonzini static QEMUBH *dbdma_bh; 36449ab747fSPaolo Bonzini static void channel_run(DBDMA_channel *ch); 36549ab747fSPaolo Bonzini 36649ab747fSPaolo Bonzini static void dbdma_end(DBDMA_io *io) 36749ab747fSPaolo Bonzini { 36849ab747fSPaolo Bonzini DBDMA_channel *ch = io->channel; 36949ab747fSPaolo Bonzini dbdma_cmd *current = &ch->current; 37049ab747fSPaolo Bonzini 37149ab747fSPaolo Bonzini if (conditional_wait(ch)) 37249ab747fSPaolo Bonzini goto wait; 37349ab747fSPaolo Bonzini 37449ab747fSPaolo Bonzini current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]); 37549ab747fSPaolo Bonzini current->res_count = cpu_to_le16(io->len); 37649ab747fSPaolo Bonzini dbdma_cmdptr_save(ch); 37749ab747fSPaolo Bonzini if (io->is_last) 37849ab747fSPaolo Bonzini ch->regs[DBDMA_STATUS] &= ~FLUSH; 37949ab747fSPaolo Bonzini 38049ab747fSPaolo Bonzini conditional_interrupt(ch); 38149ab747fSPaolo Bonzini conditional_branch(ch); 38249ab747fSPaolo Bonzini 38349ab747fSPaolo Bonzini wait: 38449ab747fSPaolo Bonzini ch->processing = 0; 38549ab747fSPaolo Bonzini if ((ch->regs[DBDMA_STATUS] & RUN) && 38649ab747fSPaolo Bonzini (ch->regs[DBDMA_STATUS] & ACTIVE)) 38749ab747fSPaolo Bonzini channel_run(ch); 38849ab747fSPaolo Bonzini } 38949ab747fSPaolo Bonzini 39049ab747fSPaolo Bonzini static void start_output(DBDMA_channel *ch, int key, uint32_t addr, 39149ab747fSPaolo Bonzini uint16_t req_count, int is_last) 39249ab747fSPaolo Bonzini { 39349ab747fSPaolo Bonzini DBDMA_DPRINTF("start_output\n"); 39449ab747fSPaolo Bonzini 39549ab747fSPaolo Bonzini /* KEY_REGS, KEY_DEVICE and KEY_STREAM 39649ab747fSPaolo Bonzini * are not implemented in the mac-io chip 39749ab747fSPaolo Bonzini */ 39849ab747fSPaolo Bonzini 39949ab747fSPaolo Bonzini DBDMA_DPRINTF("addr 0x%x key 0x%x\n", addr, key); 40049ab747fSPaolo Bonzini if (!addr || key > KEY_STREAM3) { 40149ab747fSPaolo Bonzini kill_channel(ch); 40249ab747fSPaolo Bonzini return; 40349ab747fSPaolo Bonzini } 40449ab747fSPaolo Bonzini 40549ab747fSPaolo Bonzini ch->io.addr = addr; 40649ab747fSPaolo Bonzini ch->io.len = req_count; 40749ab747fSPaolo Bonzini ch->io.is_last = is_last; 40849ab747fSPaolo Bonzini ch->io.dma_end = dbdma_end; 40949ab747fSPaolo Bonzini ch->io.is_dma_out = 1; 41049ab747fSPaolo Bonzini ch->processing = 1; 41149ab747fSPaolo Bonzini if (ch->rw) { 41249ab747fSPaolo Bonzini ch->rw(&ch->io); 41349ab747fSPaolo Bonzini } 41449ab747fSPaolo Bonzini } 41549ab747fSPaolo Bonzini 41649ab747fSPaolo Bonzini static void start_input(DBDMA_channel *ch, int key, uint32_t addr, 41749ab747fSPaolo Bonzini uint16_t req_count, int is_last) 41849ab747fSPaolo Bonzini { 41949ab747fSPaolo Bonzini DBDMA_DPRINTF("start_input\n"); 42049ab747fSPaolo Bonzini 42149ab747fSPaolo Bonzini /* KEY_REGS, KEY_DEVICE and KEY_STREAM 42249ab747fSPaolo Bonzini * are not implemented in the mac-io chip 42349ab747fSPaolo Bonzini */ 42449ab747fSPaolo Bonzini 42549ab747fSPaolo Bonzini if (!addr || key > KEY_STREAM3) { 42649ab747fSPaolo Bonzini kill_channel(ch); 42749ab747fSPaolo Bonzini return; 42849ab747fSPaolo Bonzini } 42949ab747fSPaolo Bonzini 43049ab747fSPaolo Bonzini ch->io.addr = addr; 43149ab747fSPaolo Bonzini ch->io.len = req_count; 43249ab747fSPaolo Bonzini ch->io.is_last = is_last; 43349ab747fSPaolo Bonzini ch->io.dma_end = dbdma_end; 43449ab747fSPaolo Bonzini ch->io.is_dma_out = 0; 43549ab747fSPaolo Bonzini ch->processing = 1; 43649ab747fSPaolo Bonzini if (ch->rw) { 43749ab747fSPaolo Bonzini ch->rw(&ch->io); 43849ab747fSPaolo Bonzini } 43949ab747fSPaolo Bonzini } 44049ab747fSPaolo Bonzini 44149ab747fSPaolo Bonzini static void load_word(DBDMA_channel *ch, int key, uint32_t addr, 44249ab747fSPaolo Bonzini uint16_t len) 44349ab747fSPaolo Bonzini { 44449ab747fSPaolo Bonzini dbdma_cmd *current = &ch->current; 44549ab747fSPaolo Bonzini uint32_t val; 44649ab747fSPaolo Bonzini 44749ab747fSPaolo Bonzini DBDMA_DPRINTF("load_word\n"); 44849ab747fSPaolo Bonzini 44949ab747fSPaolo Bonzini /* only implements KEY_SYSTEM */ 45049ab747fSPaolo Bonzini 45149ab747fSPaolo Bonzini if (key != KEY_SYSTEM) { 45249ab747fSPaolo Bonzini printf("DBDMA: LOAD_WORD, unimplemented key %x\n", key); 45349ab747fSPaolo Bonzini kill_channel(ch); 45449ab747fSPaolo Bonzini return; 45549ab747fSPaolo Bonzini } 45649ab747fSPaolo Bonzini 457*e1fe50dcSStefan Weil cpu_physical_memory_read(addr, &val, len); 45849ab747fSPaolo Bonzini 45949ab747fSPaolo Bonzini if (len == 2) 46049ab747fSPaolo Bonzini val = (val << 16) | (current->cmd_dep & 0x0000ffff); 46149ab747fSPaolo Bonzini else if (len == 1) 46249ab747fSPaolo Bonzini val = (val << 24) | (current->cmd_dep & 0x00ffffff); 46349ab747fSPaolo Bonzini 46449ab747fSPaolo Bonzini current->cmd_dep = val; 46549ab747fSPaolo Bonzini 46649ab747fSPaolo Bonzini if (conditional_wait(ch)) 46749ab747fSPaolo Bonzini goto wait; 46849ab747fSPaolo Bonzini 46949ab747fSPaolo Bonzini current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]); 47049ab747fSPaolo Bonzini dbdma_cmdptr_save(ch); 47149ab747fSPaolo Bonzini ch->regs[DBDMA_STATUS] &= ~FLUSH; 47249ab747fSPaolo Bonzini 47349ab747fSPaolo Bonzini conditional_interrupt(ch); 47449ab747fSPaolo Bonzini next(ch); 47549ab747fSPaolo Bonzini 47649ab747fSPaolo Bonzini wait: 47749ab747fSPaolo Bonzini qemu_bh_schedule(dbdma_bh); 47849ab747fSPaolo Bonzini } 47949ab747fSPaolo Bonzini 48049ab747fSPaolo Bonzini static void store_word(DBDMA_channel *ch, int key, uint32_t addr, 48149ab747fSPaolo Bonzini uint16_t len) 48249ab747fSPaolo Bonzini { 48349ab747fSPaolo Bonzini dbdma_cmd *current = &ch->current; 48449ab747fSPaolo Bonzini uint32_t val; 48549ab747fSPaolo Bonzini 48649ab747fSPaolo Bonzini DBDMA_DPRINTF("store_word\n"); 48749ab747fSPaolo Bonzini 48849ab747fSPaolo Bonzini /* only implements KEY_SYSTEM */ 48949ab747fSPaolo Bonzini 49049ab747fSPaolo Bonzini if (key != KEY_SYSTEM) { 49149ab747fSPaolo Bonzini printf("DBDMA: STORE_WORD, unimplemented key %x\n", key); 49249ab747fSPaolo Bonzini kill_channel(ch); 49349ab747fSPaolo Bonzini return; 49449ab747fSPaolo Bonzini } 49549ab747fSPaolo Bonzini 49649ab747fSPaolo Bonzini val = current->cmd_dep; 49749ab747fSPaolo Bonzini if (len == 2) 49849ab747fSPaolo Bonzini val >>= 16; 49949ab747fSPaolo Bonzini else if (len == 1) 50049ab747fSPaolo Bonzini val >>= 24; 50149ab747fSPaolo Bonzini 502*e1fe50dcSStefan Weil cpu_physical_memory_write(addr, &val, len); 50349ab747fSPaolo Bonzini 50449ab747fSPaolo Bonzini if (conditional_wait(ch)) 50549ab747fSPaolo Bonzini goto wait; 50649ab747fSPaolo Bonzini 50749ab747fSPaolo Bonzini current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]); 50849ab747fSPaolo Bonzini dbdma_cmdptr_save(ch); 50949ab747fSPaolo Bonzini ch->regs[DBDMA_STATUS] &= ~FLUSH; 51049ab747fSPaolo Bonzini 51149ab747fSPaolo Bonzini conditional_interrupt(ch); 51249ab747fSPaolo Bonzini next(ch); 51349ab747fSPaolo Bonzini 51449ab747fSPaolo Bonzini wait: 51549ab747fSPaolo Bonzini qemu_bh_schedule(dbdma_bh); 51649ab747fSPaolo Bonzini } 51749ab747fSPaolo Bonzini 51849ab747fSPaolo Bonzini static void nop(DBDMA_channel *ch) 51949ab747fSPaolo Bonzini { 52049ab747fSPaolo Bonzini dbdma_cmd *current = &ch->current; 52149ab747fSPaolo Bonzini 52249ab747fSPaolo Bonzini if (conditional_wait(ch)) 52349ab747fSPaolo Bonzini goto wait; 52449ab747fSPaolo Bonzini 52549ab747fSPaolo Bonzini current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]); 52649ab747fSPaolo Bonzini dbdma_cmdptr_save(ch); 52749ab747fSPaolo Bonzini 52849ab747fSPaolo Bonzini conditional_interrupt(ch); 52949ab747fSPaolo Bonzini conditional_branch(ch); 53049ab747fSPaolo Bonzini 53149ab747fSPaolo Bonzini wait: 53249ab747fSPaolo Bonzini qemu_bh_schedule(dbdma_bh); 53349ab747fSPaolo Bonzini } 53449ab747fSPaolo Bonzini 53549ab747fSPaolo Bonzini static void stop(DBDMA_channel *ch) 53649ab747fSPaolo Bonzini { 53749ab747fSPaolo Bonzini ch->regs[DBDMA_STATUS] &= ~(ACTIVE|DEAD|FLUSH); 53849ab747fSPaolo Bonzini 53949ab747fSPaolo Bonzini /* the stop command does not increment command pointer */ 54049ab747fSPaolo Bonzini } 54149ab747fSPaolo Bonzini 54249ab747fSPaolo Bonzini static void channel_run(DBDMA_channel *ch) 54349ab747fSPaolo Bonzini { 54449ab747fSPaolo Bonzini dbdma_cmd *current = &ch->current; 54549ab747fSPaolo Bonzini uint16_t cmd, key; 54649ab747fSPaolo Bonzini uint16_t req_count; 54749ab747fSPaolo Bonzini uint32_t phy_addr; 54849ab747fSPaolo Bonzini 54949ab747fSPaolo Bonzini DBDMA_DPRINTF("channel_run\n"); 55049ab747fSPaolo Bonzini dump_dbdma_cmd(current); 55149ab747fSPaolo Bonzini 55249ab747fSPaolo Bonzini /* clear WAKE flag at command fetch */ 55349ab747fSPaolo Bonzini 55449ab747fSPaolo Bonzini ch->regs[DBDMA_STATUS] &= ~WAKE; 55549ab747fSPaolo Bonzini 55649ab747fSPaolo Bonzini cmd = le16_to_cpu(current->command) & COMMAND_MASK; 55749ab747fSPaolo Bonzini 55849ab747fSPaolo Bonzini switch (cmd) { 55949ab747fSPaolo Bonzini case DBDMA_NOP: 56049ab747fSPaolo Bonzini nop(ch); 56149ab747fSPaolo Bonzini return; 56249ab747fSPaolo Bonzini 56349ab747fSPaolo Bonzini case DBDMA_STOP: 56449ab747fSPaolo Bonzini stop(ch); 56549ab747fSPaolo Bonzini return; 56649ab747fSPaolo Bonzini } 56749ab747fSPaolo Bonzini 56849ab747fSPaolo Bonzini key = le16_to_cpu(current->command) & 0x0700; 56949ab747fSPaolo Bonzini req_count = le16_to_cpu(current->req_count); 57049ab747fSPaolo Bonzini phy_addr = le32_to_cpu(current->phy_addr); 57149ab747fSPaolo Bonzini 57249ab747fSPaolo Bonzini if (key == KEY_STREAM4) { 57349ab747fSPaolo Bonzini printf("command %x, invalid key 4\n", cmd); 57449ab747fSPaolo Bonzini kill_channel(ch); 57549ab747fSPaolo Bonzini return; 57649ab747fSPaolo Bonzini } 57749ab747fSPaolo Bonzini 57849ab747fSPaolo Bonzini switch (cmd) { 57949ab747fSPaolo Bonzini case OUTPUT_MORE: 58049ab747fSPaolo Bonzini start_output(ch, key, phy_addr, req_count, 0); 58149ab747fSPaolo Bonzini return; 58249ab747fSPaolo Bonzini 58349ab747fSPaolo Bonzini case OUTPUT_LAST: 58449ab747fSPaolo Bonzini start_output(ch, key, phy_addr, req_count, 1); 58549ab747fSPaolo Bonzini return; 58649ab747fSPaolo Bonzini 58749ab747fSPaolo Bonzini case INPUT_MORE: 58849ab747fSPaolo Bonzini start_input(ch, key, phy_addr, req_count, 0); 58949ab747fSPaolo Bonzini return; 59049ab747fSPaolo Bonzini 59149ab747fSPaolo Bonzini case INPUT_LAST: 59249ab747fSPaolo Bonzini start_input(ch, key, phy_addr, req_count, 1); 59349ab747fSPaolo Bonzini return; 59449ab747fSPaolo Bonzini } 59549ab747fSPaolo Bonzini 59649ab747fSPaolo Bonzini if (key < KEY_REGS) { 59749ab747fSPaolo Bonzini printf("command %x, invalid key %x\n", cmd, key); 59849ab747fSPaolo Bonzini key = KEY_SYSTEM; 59949ab747fSPaolo Bonzini } 60049ab747fSPaolo Bonzini 60149ab747fSPaolo Bonzini /* for LOAD_WORD and STORE_WORD, req_count is on 3 bits 60249ab747fSPaolo Bonzini * and BRANCH is invalid 60349ab747fSPaolo Bonzini */ 60449ab747fSPaolo Bonzini 60549ab747fSPaolo Bonzini req_count = req_count & 0x0007; 60649ab747fSPaolo Bonzini if (req_count & 0x4) { 60749ab747fSPaolo Bonzini req_count = 4; 60849ab747fSPaolo Bonzini phy_addr &= ~3; 60949ab747fSPaolo Bonzini } else if (req_count & 0x2) { 61049ab747fSPaolo Bonzini req_count = 2; 61149ab747fSPaolo Bonzini phy_addr &= ~1; 61249ab747fSPaolo Bonzini } else 61349ab747fSPaolo Bonzini req_count = 1; 61449ab747fSPaolo Bonzini 61549ab747fSPaolo Bonzini switch (cmd) { 61649ab747fSPaolo Bonzini case LOAD_WORD: 61749ab747fSPaolo Bonzini load_word(ch, key, phy_addr, req_count); 61849ab747fSPaolo Bonzini return; 61949ab747fSPaolo Bonzini 62049ab747fSPaolo Bonzini case STORE_WORD: 62149ab747fSPaolo Bonzini store_word(ch, key, phy_addr, req_count); 62249ab747fSPaolo Bonzini return; 62349ab747fSPaolo Bonzini } 62449ab747fSPaolo Bonzini } 62549ab747fSPaolo Bonzini 62649ab747fSPaolo Bonzini static void DBDMA_run(DBDMAState *s) 62749ab747fSPaolo Bonzini { 62849ab747fSPaolo Bonzini int channel; 62949ab747fSPaolo Bonzini 63049ab747fSPaolo Bonzini for (channel = 0; channel < DBDMA_CHANNELS; channel++) { 63149ab747fSPaolo Bonzini DBDMA_channel *ch = &s->channels[channel]; 63249ab747fSPaolo Bonzini uint32_t status = ch->regs[DBDMA_STATUS]; 63349ab747fSPaolo Bonzini if (!ch->processing && (status & RUN) && (status & ACTIVE)) { 63449ab747fSPaolo Bonzini channel_run(ch); 63549ab747fSPaolo Bonzini } 63649ab747fSPaolo Bonzini } 63749ab747fSPaolo Bonzini } 63849ab747fSPaolo Bonzini 63949ab747fSPaolo Bonzini static void DBDMA_run_bh(void *opaque) 64049ab747fSPaolo Bonzini { 64149ab747fSPaolo Bonzini DBDMAState *s = opaque; 64249ab747fSPaolo Bonzini 64349ab747fSPaolo Bonzini DBDMA_DPRINTF("DBDMA_run_bh\n"); 64449ab747fSPaolo Bonzini 64549ab747fSPaolo Bonzini DBDMA_run(s); 64649ab747fSPaolo Bonzini } 64749ab747fSPaolo Bonzini 64849ab747fSPaolo Bonzini void DBDMA_register_channel(void *dbdma, int nchan, qemu_irq irq, 64949ab747fSPaolo Bonzini DBDMA_rw rw, DBDMA_flush flush, 65049ab747fSPaolo Bonzini void *opaque) 65149ab747fSPaolo Bonzini { 65249ab747fSPaolo Bonzini DBDMAState *s = dbdma; 65349ab747fSPaolo Bonzini DBDMA_channel *ch = &s->channels[nchan]; 65449ab747fSPaolo Bonzini 65549ab747fSPaolo Bonzini DBDMA_DPRINTF("DBDMA_register_channel 0x%x\n", nchan); 65649ab747fSPaolo Bonzini 65749ab747fSPaolo Bonzini ch->irq = irq; 65849ab747fSPaolo Bonzini ch->channel = nchan; 65949ab747fSPaolo Bonzini ch->rw = rw; 66049ab747fSPaolo Bonzini ch->flush = flush; 66149ab747fSPaolo Bonzini ch->io.opaque = opaque; 66249ab747fSPaolo Bonzini ch->io.channel = ch; 66349ab747fSPaolo Bonzini } 66449ab747fSPaolo Bonzini 66549ab747fSPaolo Bonzini static void 66649ab747fSPaolo Bonzini dbdma_control_write(DBDMA_channel *ch) 66749ab747fSPaolo Bonzini { 66849ab747fSPaolo Bonzini uint16_t mask, value; 66949ab747fSPaolo Bonzini uint32_t status; 67049ab747fSPaolo Bonzini 67149ab747fSPaolo Bonzini mask = (ch->regs[DBDMA_CONTROL] >> 16) & 0xffff; 67249ab747fSPaolo Bonzini value = ch->regs[DBDMA_CONTROL] & 0xffff; 67349ab747fSPaolo Bonzini 67449ab747fSPaolo Bonzini value &= (RUN | PAUSE | FLUSH | WAKE | DEVSTAT); 67549ab747fSPaolo Bonzini 67649ab747fSPaolo Bonzini status = ch->regs[DBDMA_STATUS]; 67749ab747fSPaolo Bonzini 67849ab747fSPaolo Bonzini status = (value & mask) | (status & ~mask); 67949ab747fSPaolo Bonzini 68049ab747fSPaolo Bonzini if (status & WAKE) 68149ab747fSPaolo Bonzini status |= ACTIVE; 68249ab747fSPaolo Bonzini if (status & RUN) { 68349ab747fSPaolo Bonzini status |= ACTIVE; 68449ab747fSPaolo Bonzini status &= ~DEAD; 68549ab747fSPaolo Bonzini } 68649ab747fSPaolo Bonzini if (status & PAUSE) 68749ab747fSPaolo Bonzini status &= ~ACTIVE; 68849ab747fSPaolo Bonzini if ((ch->regs[DBDMA_STATUS] & RUN) && !(status & RUN)) { 68949ab747fSPaolo Bonzini /* RUN is cleared */ 69049ab747fSPaolo Bonzini status &= ~(ACTIVE|DEAD); 69149ab747fSPaolo Bonzini if ((status & FLUSH) && ch->flush) { 69249ab747fSPaolo Bonzini ch->flush(&ch->io); 69349ab747fSPaolo Bonzini status &= ~FLUSH; 69449ab747fSPaolo Bonzini } 69549ab747fSPaolo Bonzini } 69649ab747fSPaolo Bonzini 69749ab747fSPaolo Bonzini DBDMA_DPRINTF(" status 0x%08x\n", status); 69849ab747fSPaolo Bonzini 69949ab747fSPaolo Bonzini ch->regs[DBDMA_STATUS] = status; 70049ab747fSPaolo Bonzini 70149ab747fSPaolo Bonzini if (status & ACTIVE) 70249ab747fSPaolo Bonzini qemu_bh_schedule(dbdma_bh); 70349ab747fSPaolo Bonzini if ((status & FLUSH) && ch->flush) 70449ab747fSPaolo Bonzini ch->flush(&ch->io); 70549ab747fSPaolo Bonzini } 70649ab747fSPaolo Bonzini 70749ab747fSPaolo Bonzini static void dbdma_write(void *opaque, hwaddr addr, 70849ab747fSPaolo Bonzini uint64_t value, unsigned size) 70949ab747fSPaolo Bonzini { 71049ab747fSPaolo Bonzini int channel = addr >> DBDMA_CHANNEL_SHIFT; 71149ab747fSPaolo Bonzini DBDMAState *s = opaque; 71249ab747fSPaolo Bonzini DBDMA_channel *ch = &s->channels[channel]; 71349ab747fSPaolo Bonzini int reg = (addr - (channel << DBDMA_CHANNEL_SHIFT)) >> 2; 71449ab747fSPaolo Bonzini 71549ab747fSPaolo Bonzini DBDMA_DPRINTF("writel 0x" TARGET_FMT_plx " <= 0x%08x\n", addr, value); 71649ab747fSPaolo Bonzini DBDMA_DPRINTF("channel 0x%x reg 0x%x\n", 71749ab747fSPaolo Bonzini (uint32_t)addr >> DBDMA_CHANNEL_SHIFT, reg); 71849ab747fSPaolo Bonzini 71949ab747fSPaolo Bonzini /* cmdptr cannot be modified if channel is RUN or ACTIVE */ 72049ab747fSPaolo Bonzini 72149ab747fSPaolo Bonzini if (reg == DBDMA_CMDPTR_LO && 72249ab747fSPaolo Bonzini (ch->regs[DBDMA_STATUS] & (RUN | ACTIVE))) 72349ab747fSPaolo Bonzini return; 72449ab747fSPaolo Bonzini 72549ab747fSPaolo Bonzini ch->regs[reg] = value; 72649ab747fSPaolo Bonzini 72749ab747fSPaolo Bonzini switch(reg) { 72849ab747fSPaolo Bonzini case DBDMA_CONTROL: 72949ab747fSPaolo Bonzini dbdma_control_write(ch); 73049ab747fSPaolo Bonzini break; 73149ab747fSPaolo Bonzini case DBDMA_CMDPTR_LO: 73249ab747fSPaolo Bonzini /* 16-byte aligned */ 73349ab747fSPaolo Bonzini ch->regs[DBDMA_CMDPTR_LO] &= ~0xf; 73449ab747fSPaolo Bonzini dbdma_cmdptr_load(ch); 73549ab747fSPaolo Bonzini break; 73649ab747fSPaolo Bonzini case DBDMA_STATUS: 73749ab747fSPaolo Bonzini case DBDMA_INTR_SEL: 73849ab747fSPaolo Bonzini case DBDMA_BRANCH_SEL: 73949ab747fSPaolo Bonzini case DBDMA_WAIT_SEL: 74049ab747fSPaolo Bonzini /* nothing to do */ 74149ab747fSPaolo Bonzini break; 74249ab747fSPaolo Bonzini case DBDMA_XFER_MODE: 74349ab747fSPaolo Bonzini case DBDMA_CMDPTR_HI: 74449ab747fSPaolo Bonzini case DBDMA_DATA2PTR_HI: 74549ab747fSPaolo Bonzini case DBDMA_DATA2PTR_LO: 74649ab747fSPaolo Bonzini case DBDMA_ADDRESS_HI: 74749ab747fSPaolo Bonzini case DBDMA_BRANCH_ADDR_HI: 74849ab747fSPaolo Bonzini case DBDMA_RES1: 74949ab747fSPaolo Bonzini case DBDMA_RES2: 75049ab747fSPaolo Bonzini case DBDMA_RES3: 75149ab747fSPaolo Bonzini case DBDMA_RES4: 75249ab747fSPaolo Bonzini /* unused */ 75349ab747fSPaolo Bonzini break; 75449ab747fSPaolo Bonzini } 75549ab747fSPaolo Bonzini } 75649ab747fSPaolo Bonzini 75749ab747fSPaolo Bonzini static uint64_t dbdma_read(void *opaque, hwaddr addr, 75849ab747fSPaolo Bonzini unsigned size) 75949ab747fSPaolo Bonzini { 76049ab747fSPaolo Bonzini uint32_t value; 76149ab747fSPaolo Bonzini int channel = addr >> DBDMA_CHANNEL_SHIFT; 76249ab747fSPaolo Bonzini DBDMAState *s = opaque; 76349ab747fSPaolo Bonzini DBDMA_channel *ch = &s->channels[channel]; 76449ab747fSPaolo Bonzini int reg = (addr - (channel << DBDMA_CHANNEL_SHIFT)) >> 2; 76549ab747fSPaolo Bonzini 76649ab747fSPaolo Bonzini value = ch->regs[reg]; 76749ab747fSPaolo Bonzini 76849ab747fSPaolo Bonzini DBDMA_DPRINTF("readl 0x" TARGET_FMT_plx " => 0x%08x\n", addr, value); 76949ab747fSPaolo Bonzini DBDMA_DPRINTF("channel 0x%x reg 0x%x\n", 77049ab747fSPaolo Bonzini (uint32_t)addr >> DBDMA_CHANNEL_SHIFT, reg); 77149ab747fSPaolo Bonzini 77249ab747fSPaolo Bonzini switch(reg) { 77349ab747fSPaolo Bonzini case DBDMA_CONTROL: 77449ab747fSPaolo Bonzini value = 0; 77549ab747fSPaolo Bonzini break; 77649ab747fSPaolo Bonzini case DBDMA_STATUS: 77749ab747fSPaolo Bonzini case DBDMA_CMDPTR_LO: 77849ab747fSPaolo Bonzini case DBDMA_INTR_SEL: 77949ab747fSPaolo Bonzini case DBDMA_BRANCH_SEL: 78049ab747fSPaolo Bonzini case DBDMA_WAIT_SEL: 78149ab747fSPaolo Bonzini /* nothing to do */ 78249ab747fSPaolo Bonzini break; 78349ab747fSPaolo Bonzini case DBDMA_XFER_MODE: 78449ab747fSPaolo Bonzini case DBDMA_CMDPTR_HI: 78549ab747fSPaolo Bonzini case DBDMA_DATA2PTR_HI: 78649ab747fSPaolo Bonzini case DBDMA_DATA2PTR_LO: 78749ab747fSPaolo Bonzini case DBDMA_ADDRESS_HI: 78849ab747fSPaolo Bonzini case DBDMA_BRANCH_ADDR_HI: 78949ab747fSPaolo Bonzini /* unused */ 79049ab747fSPaolo Bonzini value = 0; 79149ab747fSPaolo Bonzini break; 79249ab747fSPaolo Bonzini case DBDMA_RES1: 79349ab747fSPaolo Bonzini case DBDMA_RES2: 79449ab747fSPaolo Bonzini case DBDMA_RES3: 79549ab747fSPaolo Bonzini case DBDMA_RES4: 79649ab747fSPaolo Bonzini /* reserved */ 79749ab747fSPaolo Bonzini break; 79849ab747fSPaolo Bonzini } 79949ab747fSPaolo Bonzini 80049ab747fSPaolo Bonzini return value; 80149ab747fSPaolo Bonzini } 80249ab747fSPaolo Bonzini 80349ab747fSPaolo Bonzini static const MemoryRegionOps dbdma_ops = { 80449ab747fSPaolo Bonzini .read = dbdma_read, 80549ab747fSPaolo Bonzini .write = dbdma_write, 80649ab747fSPaolo Bonzini .endianness = DEVICE_LITTLE_ENDIAN, 80749ab747fSPaolo Bonzini .valid = { 80849ab747fSPaolo Bonzini .min_access_size = 4, 80949ab747fSPaolo Bonzini .max_access_size = 4, 81049ab747fSPaolo Bonzini }, 81149ab747fSPaolo Bonzini }; 81249ab747fSPaolo Bonzini 81349ab747fSPaolo Bonzini static const VMStateDescription vmstate_dbdma_channel = { 81449ab747fSPaolo Bonzini .name = "dbdma_channel", 81549ab747fSPaolo Bonzini .version_id = 0, 81649ab747fSPaolo Bonzini .minimum_version_id = 0, 81749ab747fSPaolo Bonzini .minimum_version_id_old = 0, 81849ab747fSPaolo Bonzini .fields = (VMStateField[]) { 81949ab747fSPaolo Bonzini VMSTATE_UINT32_ARRAY(regs, struct DBDMA_channel, DBDMA_REGS), 82049ab747fSPaolo Bonzini VMSTATE_END_OF_LIST() 82149ab747fSPaolo Bonzini } 82249ab747fSPaolo Bonzini }; 82349ab747fSPaolo Bonzini 82449ab747fSPaolo Bonzini static const VMStateDescription vmstate_dbdma = { 82549ab747fSPaolo Bonzini .name = "dbdma", 82649ab747fSPaolo Bonzini .version_id = 2, 82749ab747fSPaolo Bonzini .minimum_version_id = 2, 82849ab747fSPaolo Bonzini .minimum_version_id_old = 2, 82949ab747fSPaolo Bonzini .fields = (VMStateField[]) { 83049ab747fSPaolo Bonzini VMSTATE_STRUCT_ARRAY(channels, DBDMAState, DBDMA_CHANNELS, 1, 83149ab747fSPaolo Bonzini vmstate_dbdma_channel, DBDMA_channel), 83249ab747fSPaolo Bonzini VMSTATE_END_OF_LIST() 83349ab747fSPaolo Bonzini } 83449ab747fSPaolo Bonzini }; 83549ab747fSPaolo Bonzini 83649ab747fSPaolo Bonzini static void dbdma_reset(void *opaque) 83749ab747fSPaolo Bonzini { 83849ab747fSPaolo Bonzini DBDMAState *s = opaque; 83949ab747fSPaolo Bonzini int i; 84049ab747fSPaolo Bonzini 84149ab747fSPaolo Bonzini for (i = 0; i < DBDMA_CHANNELS; i++) 84249ab747fSPaolo Bonzini memset(s->channels[i].regs, 0, DBDMA_SIZE); 84349ab747fSPaolo Bonzini } 84449ab747fSPaolo Bonzini 84549ab747fSPaolo Bonzini void* DBDMA_init (MemoryRegion **dbdma_mem) 84649ab747fSPaolo Bonzini { 84749ab747fSPaolo Bonzini DBDMAState *s; 84849ab747fSPaolo Bonzini 84949ab747fSPaolo Bonzini s = g_malloc0(sizeof(DBDMAState)); 85049ab747fSPaolo Bonzini 85149ab747fSPaolo Bonzini memory_region_init_io(&s->mem, &dbdma_ops, s, "dbdma", 0x1000); 85249ab747fSPaolo Bonzini *dbdma_mem = &s->mem; 85349ab747fSPaolo Bonzini vmstate_register(NULL, -1, &vmstate_dbdma, s); 85449ab747fSPaolo Bonzini qemu_register_reset(dbdma_reset, s); 85549ab747fSPaolo Bonzini 85649ab747fSPaolo Bonzini dbdma_bh = qemu_bh_new(DBDMA_run_bh, s); 85749ab747fSPaolo Bonzini 85849ab747fSPaolo Bonzini return s; 85949ab747fSPaolo Bonzini } 860