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], 195e1fe50dcSStefan 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], 206e1fe50dcSStefan 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 22733ce36bbSAlexander Graf DBDMA_DPRINTF("%s\n", __func__); 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); 23633ce36bbSAlexander Graf DBDMA_DPRINTF("%s: raise\n", __func__); 23749ab747fSPaolo Bonzini return; 23849ab747fSPaolo Bonzini } 23949ab747fSPaolo Bonzini 24049ab747fSPaolo Bonzini status = ch->regs[DBDMA_STATUS] & DEVSTAT; 24149ab747fSPaolo Bonzini 24249ab747fSPaolo Bonzini sel_mask = (ch->regs[DBDMA_INTR_SEL] >> 16) & 0x0f; 24349ab747fSPaolo Bonzini sel_value = ch->regs[DBDMA_INTR_SEL] & 0x0f; 24449ab747fSPaolo Bonzini 24549ab747fSPaolo Bonzini cond = (status & sel_mask) == (sel_value & sel_mask); 24649ab747fSPaolo Bonzini 24749ab747fSPaolo Bonzini switch(intr) { 24849ab747fSPaolo Bonzini case INTR_IFSET: /* intr if condition bit is 1 */ 24933ce36bbSAlexander Graf if (cond) { 25049ab747fSPaolo Bonzini qemu_irq_raise(ch->irq); 25133ce36bbSAlexander Graf DBDMA_DPRINTF("%s: raise\n", __func__); 25233ce36bbSAlexander Graf } 25349ab747fSPaolo Bonzini return; 25449ab747fSPaolo Bonzini case INTR_IFCLR: /* intr if condition bit is 0 */ 25533ce36bbSAlexander Graf if (!cond) { 25649ab747fSPaolo Bonzini qemu_irq_raise(ch->irq); 25733ce36bbSAlexander Graf DBDMA_DPRINTF("%s: raise\n", __func__); 25833ce36bbSAlexander Graf } 25949ab747fSPaolo Bonzini return; 26049ab747fSPaolo Bonzini } 26149ab747fSPaolo Bonzini } 26249ab747fSPaolo Bonzini 26349ab747fSPaolo Bonzini static int conditional_wait(DBDMA_channel *ch) 26449ab747fSPaolo Bonzini { 26549ab747fSPaolo Bonzini dbdma_cmd *current = &ch->current; 26649ab747fSPaolo Bonzini uint16_t wait; 26749ab747fSPaolo Bonzini uint16_t sel_mask, sel_value; 26849ab747fSPaolo Bonzini uint32_t status; 26949ab747fSPaolo Bonzini int cond; 27049ab747fSPaolo Bonzini 27149ab747fSPaolo Bonzini DBDMA_DPRINTF("conditional_wait\n"); 27249ab747fSPaolo Bonzini 27349ab747fSPaolo Bonzini wait = le16_to_cpu(current->command) & WAIT_MASK; 27449ab747fSPaolo Bonzini 27549ab747fSPaolo Bonzini switch(wait) { 27649ab747fSPaolo Bonzini case WAIT_NEVER: /* don't wait */ 27749ab747fSPaolo Bonzini return 0; 27849ab747fSPaolo Bonzini case WAIT_ALWAYS: /* always wait */ 27949ab747fSPaolo Bonzini return 1; 28049ab747fSPaolo Bonzini } 28149ab747fSPaolo Bonzini 28249ab747fSPaolo Bonzini status = ch->regs[DBDMA_STATUS] & DEVSTAT; 28349ab747fSPaolo Bonzini 28449ab747fSPaolo Bonzini sel_mask = (ch->regs[DBDMA_WAIT_SEL] >> 16) & 0x0f; 28549ab747fSPaolo Bonzini sel_value = ch->regs[DBDMA_WAIT_SEL] & 0x0f; 28649ab747fSPaolo Bonzini 28749ab747fSPaolo Bonzini cond = (status & sel_mask) == (sel_value & sel_mask); 28849ab747fSPaolo Bonzini 28949ab747fSPaolo Bonzini switch(wait) { 29049ab747fSPaolo Bonzini case WAIT_IFSET: /* wait if condition bit is 1 */ 29149ab747fSPaolo Bonzini if (cond) 29249ab747fSPaolo Bonzini return 1; 29349ab747fSPaolo Bonzini return 0; 29449ab747fSPaolo Bonzini case WAIT_IFCLR: /* wait if condition bit is 0 */ 29549ab747fSPaolo Bonzini if (!cond) 29649ab747fSPaolo Bonzini return 1; 29749ab747fSPaolo Bonzini return 0; 29849ab747fSPaolo Bonzini } 29949ab747fSPaolo Bonzini return 0; 30049ab747fSPaolo Bonzini } 30149ab747fSPaolo Bonzini 30249ab747fSPaolo Bonzini static void next(DBDMA_channel *ch) 30349ab747fSPaolo Bonzini { 30449ab747fSPaolo Bonzini uint32_t cp; 30549ab747fSPaolo Bonzini 30649ab747fSPaolo Bonzini ch->regs[DBDMA_STATUS] &= ~BT; 30749ab747fSPaolo Bonzini 30849ab747fSPaolo Bonzini cp = ch->regs[DBDMA_CMDPTR_LO]; 30949ab747fSPaolo Bonzini ch->regs[DBDMA_CMDPTR_LO] = cp + sizeof(dbdma_cmd); 31049ab747fSPaolo Bonzini dbdma_cmdptr_load(ch); 31149ab747fSPaolo Bonzini } 31249ab747fSPaolo Bonzini 31349ab747fSPaolo Bonzini static void branch(DBDMA_channel *ch) 31449ab747fSPaolo Bonzini { 31549ab747fSPaolo Bonzini dbdma_cmd *current = &ch->current; 31649ab747fSPaolo Bonzini 31749ab747fSPaolo Bonzini ch->regs[DBDMA_CMDPTR_LO] = current->cmd_dep; 31849ab747fSPaolo Bonzini ch->regs[DBDMA_STATUS] |= BT; 31949ab747fSPaolo Bonzini dbdma_cmdptr_load(ch); 32049ab747fSPaolo Bonzini } 32149ab747fSPaolo Bonzini 32249ab747fSPaolo Bonzini static void conditional_branch(DBDMA_channel *ch) 32349ab747fSPaolo Bonzini { 32449ab747fSPaolo Bonzini dbdma_cmd *current = &ch->current; 32549ab747fSPaolo Bonzini uint16_t br; 32649ab747fSPaolo Bonzini uint16_t sel_mask, sel_value; 32749ab747fSPaolo Bonzini uint32_t status; 32849ab747fSPaolo Bonzini int cond; 32949ab747fSPaolo Bonzini 33049ab747fSPaolo Bonzini DBDMA_DPRINTF("conditional_branch\n"); 33149ab747fSPaolo Bonzini 33249ab747fSPaolo Bonzini /* check if we must branch */ 33349ab747fSPaolo Bonzini 33449ab747fSPaolo Bonzini br = le16_to_cpu(current->command) & BR_MASK; 33549ab747fSPaolo Bonzini 33649ab747fSPaolo Bonzini switch(br) { 33749ab747fSPaolo Bonzini case BR_NEVER: /* don't branch */ 33849ab747fSPaolo Bonzini next(ch); 33949ab747fSPaolo Bonzini return; 34049ab747fSPaolo Bonzini case BR_ALWAYS: /* always branch */ 34149ab747fSPaolo Bonzini branch(ch); 34249ab747fSPaolo Bonzini return; 34349ab747fSPaolo Bonzini } 34449ab747fSPaolo Bonzini 34549ab747fSPaolo Bonzini status = ch->regs[DBDMA_STATUS] & DEVSTAT; 34649ab747fSPaolo Bonzini 34749ab747fSPaolo Bonzini sel_mask = (ch->regs[DBDMA_BRANCH_SEL] >> 16) & 0x0f; 34849ab747fSPaolo Bonzini sel_value = ch->regs[DBDMA_BRANCH_SEL] & 0x0f; 34949ab747fSPaolo Bonzini 35049ab747fSPaolo Bonzini cond = (status & sel_mask) == (sel_value & sel_mask); 35149ab747fSPaolo Bonzini 35249ab747fSPaolo Bonzini switch(br) { 35349ab747fSPaolo Bonzini case BR_IFSET: /* branch if condition bit is 1 */ 35449ab747fSPaolo Bonzini if (cond) 35549ab747fSPaolo Bonzini branch(ch); 35649ab747fSPaolo Bonzini else 35749ab747fSPaolo Bonzini next(ch); 35849ab747fSPaolo Bonzini return; 35949ab747fSPaolo Bonzini case BR_IFCLR: /* branch if condition bit is 0 */ 36049ab747fSPaolo Bonzini if (!cond) 36149ab747fSPaolo Bonzini branch(ch); 36249ab747fSPaolo Bonzini else 36349ab747fSPaolo Bonzini next(ch); 36449ab747fSPaolo Bonzini return; 36549ab747fSPaolo Bonzini } 36649ab747fSPaolo Bonzini } 36749ab747fSPaolo Bonzini 36849ab747fSPaolo Bonzini static QEMUBH *dbdma_bh; 36949ab747fSPaolo Bonzini static void channel_run(DBDMA_channel *ch); 37049ab747fSPaolo Bonzini 37149ab747fSPaolo Bonzini static void dbdma_end(DBDMA_io *io) 37249ab747fSPaolo Bonzini { 37349ab747fSPaolo Bonzini DBDMA_channel *ch = io->channel; 37449ab747fSPaolo Bonzini dbdma_cmd *current = &ch->current; 37549ab747fSPaolo Bonzini 37633ce36bbSAlexander Graf DBDMA_DPRINTF("%s\n", __func__); 37733ce36bbSAlexander Graf 37849ab747fSPaolo Bonzini if (conditional_wait(ch)) 37949ab747fSPaolo Bonzini goto wait; 38049ab747fSPaolo Bonzini 38149ab747fSPaolo Bonzini current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]); 38249ab747fSPaolo Bonzini current->res_count = cpu_to_le16(io->len); 38349ab747fSPaolo Bonzini dbdma_cmdptr_save(ch); 38449ab747fSPaolo Bonzini if (io->is_last) 38549ab747fSPaolo Bonzini ch->regs[DBDMA_STATUS] &= ~FLUSH; 38649ab747fSPaolo Bonzini 38749ab747fSPaolo Bonzini conditional_interrupt(ch); 38849ab747fSPaolo Bonzini conditional_branch(ch); 38949ab747fSPaolo Bonzini 39049ab747fSPaolo Bonzini wait: 39149ab747fSPaolo Bonzini ch->processing = 0; 39249ab747fSPaolo Bonzini if ((ch->regs[DBDMA_STATUS] & RUN) && 39349ab747fSPaolo Bonzini (ch->regs[DBDMA_STATUS] & ACTIVE)) 39449ab747fSPaolo Bonzini channel_run(ch); 39549ab747fSPaolo Bonzini } 39649ab747fSPaolo Bonzini 39749ab747fSPaolo Bonzini static void start_output(DBDMA_channel *ch, int key, uint32_t addr, 39849ab747fSPaolo Bonzini uint16_t req_count, int is_last) 39949ab747fSPaolo Bonzini { 40049ab747fSPaolo Bonzini DBDMA_DPRINTF("start_output\n"); 40149ab747fSPaolo Bonzini 40249ab747fSPaolo Bonzini /* KEY_REGS, KEY_DEVICE and KEY_STREAM 40349ab747fSPaolo Bonzini * are not implemented in the mac-io chip 40449ab747fSPaolo Bonzini */ 40549ab747fSPaolo Bonzini 40649ab747fSPaolo Bonzini DBDMA_DPRINTF("addr 0x%x key 0x%x\n", addr, key); 40749ab747fSPaolo Bonzini if (!addr || key > KEY_STREAM3) { 40849ab747fSPaolo Bonzini kill_channel(ch); 40949ab747fSPaolo Bonzini return; 41049ab747fSPaolo Bonzini } 41149ab747fSPaolo Bonzini 41249ab747fSPaolo Bonzini ch->io.addr = addr; 41349ab747fSPaolo Bonzini ch->io.len = req_count; 41449ab747fSPaolo Bonzini ch->io.is_last = is_last; 41549ab747fSPaolo Bonzini ch->io.dma_end = dbdma_end; 41649ab747fSPaolo Bonzini ch->io.is_dma_out = 1; 41749ab747fSPaolo Bonzini ch->processing = 1; 41849ab747fSPaolo Bonzini if (ch->rw) { 41949ab747fSPaolo Bonzini ch->rw(&ch->io); 42049ab747fSPaolo Bonzini } 42149ab747fSPaolo Bonzini } 42249ab747fSPaolo Bonzini 42349ab747fSPaolo Bonzini static void start_input(DBDMA_channel *ch, int key, uint32_t addr, 42449ab747fSPaolo Bonzini uint16_t req_count, int is_last) 42549ab747fSPaolo Bonzini { 42649ab747fSPaolo Bonzini DBDMA_DPRINTF("start_input\n"); 42749ab747fSPaolo Bonzini 42849ab747fSPaolo Bonzini /* KEY_REGS, KEY_DEVICE and KEY_STREAM 42949ab747fSPaolo Bonzini * are not implemented in the mac-io chip 43049ab747fSPaolo Bonzini */ 43149ab747fSPaolo Bonzini 43233ce36bbSAlexander Graf DBDMA_DPRINTF("addr 0x%x key 0x%x\n", addr, key); 43349ab747fSPaolo Bonzini if (!addr || key > KEY_STREAM3) { 43449ab747fSPaolo Bonzini kill_channel(ch); 43549ab747fSPaolo Bonzini return; 43649ab747fSPaolo Bonzini } 43749ab747fSPaolo Bonzini 43849ab747fSPaolo Bonzini ch->io.addr = addr; 43949ab747fSPaolo Bonzini ch->io.len = req_count; 44049ab747fSPaolo Bonzini ch->io.is_last = is_last; 44149ab747fSPaolo Bonzini ch->io.dma_end = dbdma_end; 44249ab747fSPaolo Bonzini ch->io.is_dma_out = 0; 44349ab747fSPaolo Bonzini ch->processing = 1; 44449ab747fSPaolo Bonzini if (ch->rw) { 44549ab747fSPaolo Bonzini ch->rw(&ch->io); 44649ab747fSPaolo Bonzini } 44749ab747fSPaolo Bonzini } 44849ab747fSPaolo Bonzini 44949ab747fSPaolo Bonzini static void load_word(DBDMA_channel *ch, int key, uint32_t addr, 45049ab747fSPaolo Bonzini uint16_t len) 45149ab747fSPaolo Bonzini { 45249ab747fSPaolo Bonzini dbdma_cmd *current = &ch->current; 45349ab747fSPaolo Bonzini uint32_t val; 45449ab747fSPaolo Bonzini 45549ab747fSPaolo Bonzini DBDMA_DPRINTF("load_word\n"); 45649ab747fSPaolo Bonzini 45749ab747fSPaolo Bonzini /* only implements KEY_SYSTEM */ 45849ab747fSPaolo Bonzini 45949ab747fSPaolo Bonzini if (key != KEY_SYSTEM) { 46049ab747fSPaolo Bonzini printf("DBDMA: LOAD_WORD, unimplemented key %x\n", key); 46149ab747fSPaolo Bonzini kill_channel(ch); 46249ab747fSPaolo Bonzini return; 46349ab747fSPaolo Bonzini } 46449ab747fSPaolo Bonzini 465e1fe50dcSStefan Weil cpu_physical_memory_read(addr, &val, len); 46649ab747fSPaolo Bonzini 46749ab747fSPaolo Bonzini if (len == 2) 46849ab747fSPaolo Bonzini val = (val << 16) | (current->cmd_dep & 0x0000ffff); 46949ab747fSPaolo Bonzini else if (len == 1) 47049ab747fSPaolo Bonzini val = (val << 24) | (current->cmd_dep & 0x00ffffff); 47149ab747fSPaolo Bonzini 47249ab747fSPaolo Bonzini current->cmd_dep = val; 47349ab747fSPaolo Bonzini 47449ab747fSPaolo Bonzini if (conditional_wait(ch)) 47549ab747fSPaolo Bonzini goto wait; 47649ab747fSPaolo Bonzini 47749ab747fSPaolo Bonzini current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]); 47849ab747fSPaolo Bonzini dbdma_cmdptr_save(ch); 47949ab747fSPaolo Bonzini ch->regs[DBDMA_STATUS] &= ~FLUSH; 48049ab747fSPaolo Bonzini 48149ab747fSPaolo Bonzini conditional_interrupt(ch); 48249ab747fSPaolo Bonzini next(ch); 48349ab747fSPaolo Bonzini 48449ab747fSPaolo Bonzini wait: 48549ab747fSPaolo Bonzini qemu_bh_schedule(dbdma_bh); 48649ab747fSPaolo Bonzini } 48749ab747fSPaolo Bonzini 48849ab747fSPaolo Bonzini static void store_word(DBDMA_channel *ch, int key, uint32_t addr, 48949ab747fSPaolo Bonzini uint16_t len) 49049ab747fSPaolo Bonzini { 49149ab747fSPaolo Bonzini dbdma_cmd *current = &ch->current; 49249ab747fSPaolo Bonzini uint32_t val; 49349ab747fSPaolo Bonzini 49449ab747fSPaolo Bonzini DBDMA_DPRINTF("store_word\n"); 49549ab747fSPaolo Bonzini 49649ab747fSPaolo Bonzini /* only implements KEY_SYSTEM */ 49749ab747fSPaolo Bonzini 49849ab747fSPaolo Bonzini if (key != KEY_SYSTEM) { 49949ab747fSPaolo Bonzini printf("DBDMA: STORE_WORD, unimplemented key %x\n", key); 50049ab747fSPaolo Bonzini kill_channel(ch); 50149ab747fSPaolo Bonzini return; 50249ab747fSPaolo Bonzini } 50349ab747fSPaolo Bonzini 50449ab747fSPaolo Bonzini val = current->cmd_dep; 50549ab747fSPaolo Bonzini if (len == 2) 50649ab747fSPaolo Bonzini val >>= 16; 50749ab747fSPaolo Bonzini else if (len == 1) 50849ab747fSPaolo Bonzini val >>= 24; 50949ab747fSPaolo Bonzini 510e1fe50dcSStefan Weil cpu_physical_memory_write(addr, &val, len); 51149ab747fSPaolo Bonzini 51249ab747fSPaolo Bonzini if (conditional_wait(ch)) 51349ab747fSPaolo Bonzini goto wait; 51449ab747fSPaolo Bonzini 51549ab747fSPaolo Bonzini current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]); 51649ab747fSPaolo Bonzini dbdma_cmdptr_save(ch); 51749ab747fSPaolo Bonzini ch->regs[DBDMA_STATUS] &= ~FLUSH; 51849ab747fSPaolo Bonzini 51949ab747fSPaolo Bonzini conditional_interrupt(ch); 52049ab747fSPaolo Bonzini next(ch); 52149ab747fSPaolo Bonzini 52249ab747fSPaolo Bonzini wait: 52349ab747fSPaolo Bonzini qemu_bh_schedule(dbdma_bh); 52449ab747fSPaolo Bonzini } 52549ab747fSPaolo Bonzini 52649ab747fSPaolo Bonzini static void nop(DBDMA_channel *ch) 52749ab747fSPaolo Bonzini { 52849ab747fSPaolo Bonzini dbdma_cmd *current = &ch->current; 52949ab747fSPaolo Bonzini 53049ab747fSPaolo Bonzini if (conditional_wait(ch)) 53149ab747fSPaolo Bonzini goto wait; 53249ab747fSPaolo Bonzini 53349ab747fSPaolo Bonzini current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]); 53449ab747fSPaolo Bonzini dbdma_cmdptr_save(ch); 53549ab747fSPaolo Bonzini 53649ab747fSPaolo Bonzini conditional_interrupt(ch); 53749ab747fSPaolo Bonzini conditional_branch(ch); 53849ab747fSPaolo Bonzini 53949ab747fSPaolo Bonzini wait: 54049ab747fSPaolo Bonzini qemu_bh_schedule(dbdma_bh); 54149ab747fSPaolo Bonzini } 54249ab747fSPaolo Bonzini 54349ab747fSPaolo Bonzini static void stop(DBDMA_channel *ch) 54449ab747fSPaolo Bonzini { 54549ab747fSPaolo Bonzini ch->regs[DBDMA_STATUS] &= ~(ACTIVE|DEAD|FLUSH); 54649ab747fSPaolo Bonzini 54749ab747fSPaolo Bonzini /* the stop command does not increment command pointer */ 54849ab747fSPaolo Bonzini } 54949ab747fSPaolo Bonzini 55049ab747fSPaolo Bonzini static void channel_run(DBDMA_channel *ch) 55149ab747fSPaolo Bonzini { 55249ab747fSPaolo Bonzini dbdma_cmd *current = &ch->current; 55349ab747fSPaolo Bonzini uint16_t cmd, key; 55449ab747fSPaolo Bonzini uint16_t req_count; 55549ab747fSPaolo Bonzini uint32_t phy_addr; 55649ab747fSPaolo Bonzini 55749ab747fSPaolo Bonzini DBDMA_DPRINTF("channel_run\n"); 55849ab747fSPaolo Bonzini dump_dbdma_cmd(current); 55949ab747fSPaolo Bonzini 56049ab747fSPaolo Bonzini /* clear WAKE flag at command fetch */ 56149ab747fSPaolo Bonzini 56249ab747fSPaolo Bonzini ch->regs[DBDMA_STATUS] &= ~WAKE; 56349ab747fSPaolo Bonzini 56449ab747fSPaolo Bonzini cmd = le16_to_cpu(current->command) & COMMAND_MASK; 56549ab747fSPaolo Bonzini 56649ab747fSPaolo Bonzini switch (cmd) { 56749ab747fSPaolo Bonzini case DBDMA_NOP: 56849ab747fSPaolo Bonzini nop(ch); 56949ab747fSPaolo Bonzini return; 57049ab747fSPaolo Bonzini 57149ab747fSPaolo Bonzini case DBDMA_STOP: 57249ab747fSPaolo Bonzini stop(ch); 57349ab747fSPaolo Bonzini return; 57449ab747fSPaolo Bonzini } 57549ab747fSPaolo Bonzini 57649ab747fSPaolo Bonzini key = le16_to_cpu(current->command) & 0x0700; 57749ab747fSPaolo Bonzini req_count = le16_to_cpu(current->req_count); 57849ab747fSPaolo Bonzini phy_addr = le32_to_cpu(current->phy_addr); 57949ab747fSPaolo Bonzini 58049ab747fSPaolo Bonzini if (key == KEY_STREAM4) { 58149ab747fSPaolo Bonzini printf("command %x, invalid key 4\n", cmd); 58249ab747fSPaolo Bonzini kill_channel(ch); 58349ab747fSPaolo Bonzini return; 58449ab747fSPaolo Bonzini } 58549ab747fSPaolo Bonzini 58649ab747fSPaolo Bonzini switch (cmd) { 58749ab747fSPaolo Bonzini case OUTPUT_MORE: 58849ab747fSPaolo Bonzini start_output(ch, key, phy_addr, req_count, 0); 58949ab747fSPaolo Bonzini return; 59049ab747fSPaolo Bonzini 59149ab747fSPaolo Bonzini case OUTPUT_LAST: 59249ab747fSPaolo Bonzini start_output(ch, key, phy_addr, req_count, 1); 59349ab747fSPaolo Bonzini return; 59449ab747fSPaolo Bonzini 59549ab747fSPaolo Bonzini case INPUT_MORE: 59649ab747fSPaolo Bonzini start_input(ch, key, phy_addr, req_count, 0); 59749ab747fSPaolo Bonzini return; 59849ab747fSPaolo Bonzini 59949ab747fSPaolo Bonzini case INPUT_LAST: 60049ab747fSPaolo Bonzini start_input(ch, key, phy_addr, req_count, 1); 60149ab747fSPaolo Bonzini return; 60249ab747fSPaolo Bonzini } 60349ab747fSPaolo Bonzini 60449ab747fSPaolo Bonzini if (key < KEY_REGS) { 60549ab747fSPaolo Bonzini printf("command %x, invalid key %x\n", cmd, key); 60649ab747fSPaolo Bonzini key = KEY_SYSTEM; 60749ab747fSPaolo Bonzini } 60849ab747fSPaolo Bonzini 60949ab747fSPaolo Bonzini /* for LOAD_WORD and STORE_WORD, req_count is on 3 bits 61049ab747fSPaolo Bonzini * and BRANCH is invalid 61149ab747fSPaolo Bonzini */ 61249ab747fSPaolo Bonzini 61349ab747fSPaolo Bonzini req_count = req_count & 0x0007; 61449ab747fSPaolo Bonzini if (req_count & 0x4) { 61549ab747fSPaolo Bonzini req_count = 4; 61649ab747fSPaolo Bonzini phy_addr &= ~3; 61749ab747fSPaolo Bonzini } else if (req_count & 0x2) { 61849ab747fSPaolo Bonzini req_count = 2; 61949ab747fSPaolo Bonzini phy_addr &= ~1; 62049ab747fSPaolo Bonzini } else 62149ab747fSPaolo Bonzini req_count = 1; 62249ab747fSPaolo Bonzini 62349ab747fSPaolo Bonzini switch (cmd) { 62449ab747fSPaolo Bonzini case LOAD_WORD: 62549ab747fSPaolo Bonzini load_word(ch, key, phy_addr, req_count); 62649ab747fSPaolo Bonzini return; 62749ab747fSPaolo Bonzini 62849ab747fSPaolo Bonzini case STORE_WORD: 62949ab747fSPaolo Bonzini store_word(ch, key, phy_addr, req_count); 63049ab747fSPaolo Bonzini return; 63149ab747fSPaolo Bonzini } 63249ab747fSPaolo Bonzini } 63349ab747fSPaolo Bonzini 63449ab747fSPaolo Bonzini static void DBDMA_run(DBDMAState *s) 63549ab747fSPaolo Bonzini { 63649ab747fSPaolo Bonzini int channel; 63749ab747fSPaolo Bonzini 63849ab747fSPaolo Bonzini for (channel = 0; channel < DBDMA_CHANNELS; channel++) { 63949ab747fSPaolo Bonzini DBDMA_channel *ch = &s->channels[channel]; 64049ab747fSPaolo Bonzini uint32_t status = ch->regs[DBDMA_STATUS]; 64149ab747fSPaolo Bonzini if (!ch->processing && (status & RUN) && (status & ACTIVE)) { 64249ab747fSPaolo Bonzini channel_run(ch); 64349ab747fSPaolo Bonzini } 64449ab747fSPaolo Bonzini } 64549ab747fSPaolo Bonzini } 64649ab747fSPaolo Bonzini 64749ab747fSPaolo Bonzini static void DBDMA_run_bh(void *opaque) 64849ab747fSPaolo Bonzini { 64949ab747fSPaolo Bonzini DBDMAState *s = opaque; 65049ab747fSPaolo Bonzini 65149ab747fSPaolo Bonzini DBDMA_DPRINTF("DBDMA_run_bh\n"); 65249ab747fSPaolo Bonzini 65349ab747fSPaolo Bonzini DBDMA_run(s); 65449ab747fSPaolo Bonzini } 65549ab747fSPaolo Bonzini 65649ab747fSPaolo Bonzini void DBDMA_register_channel(void *dbdma, int nchan, qemu_irq irq, 65749ab747fSPaolo Bonzini DBDMA_rw rw, DBDMA_flush flush, 65849ab747fSPaolo Bonzini void *opaque) 65949ab747fSPaolo Bonzini { 66049ab747fSPaolo Bonzini DBDMAState *s = dbdma; 66149ab747fSPaolo Bonzini DBDMA_channel *ch = &s->channels[nchan]; 66249ab747fSPaolo Bonzini 66349ab747fSPaolo Bonzini DBDMA_DPRINTF("DBDMA_register_channel 0x%x\n", nchan); 66449ab747fSPaolo Bonzini 66549ab747fSPaolo Bonzini ch->irq = irq; 66649ab747fSPaolo Bonzini ch->channel = nchan; 66749ab747fSPaolo Bonzini ch->rw = rw; 66849ab747fSPaolo Bonzini ch->flush = flush; 66949ab747fSPaolo Bonzini ch->io.opaque = opaque; 67049ab747fSPaolo Bonzini ch->io.channel = ch; 67149ab747fSPaolo Bonzini } 67249ab747fSPaolo Bonzini 67349ab747fSPaolo Bonzini static void 67449ab747fSPaolo Bonzini dbdma_control_write(DBDMA_channel *ch) 67549ab747fSPaolo Bonzini { 67649ab747fSPaolo Bonzini uint16_t mask, value; 67749ab747fSPaolo Bonzini uint32_t status; 67849ab747fSPaolo Bonzini 67949ab747fSPaolo Bonzini mask = (ch->regs[DBDMA_CONTROL] >> 16) & 0xffff; 68049ab747fSPaolo Bonzini value = ch->regs[DBDMA_CONTROL] & 0xffff; 68149ab747fSPaolo Bonzini 68249ab747fSPaolo Bonzini value &= (RUN | PAUSE | FLUSH | WAKE | DEVSTAT); 68349ab747fSPaolo Bonzini 68449ab747fSPaolo Bonzini status = ch->regs[DBDMA_STATUS]; 68549ab747fSPaolo Bonzini 68649ab747fSPaolo Bonzini status = (value & mask) | (status & ~mask); 68749ab747fSPaolo Bonzini 68849ab747fSPaolo Bonzini if (status & WAKE) 68949ab747fSPaolo Bonzini status |= ACTIVE; 69049ab747fSPaolo Bonzini if (status & RUN) { 69149ab747fSPaolo Bonzini status |= ACTIVE; 69249ab747fSPaolo Bonzini status &= ~DEAD; 69349ab747fSPaolo Bonzini } 69449ab747fSPaolo Bonzini if (status & PAUSE) 69549ab747fSPaolo Bonzini status &= ~ACTIVE; 69649ab747fSPaolo Bonzini if ((ch->regs[DBDMA_STATUS] & RUN) && !(status & RUN)) { 69749ab747fSPaolo Bonzini /* RUN is cleared */ 69849ab747fSPaolo Bonzini status &= ~(ACTIVE|DEAD); 69949ab747fSPaolo Bonzini if ((status & FLUSH) && ch->flush) { 70049ab747fSPaolo Bonzini ch->flush(&ch->io); 70149ab747fSPaolo Bonzini status &= ~FLUSH; 70249ab747fSPaolo Bonzini } 70349ab747fSPaolo Bonzini } 70449ab747fSPaolo Bonzini 70549ab747fSPaolo Bonzini DBDMA_DPRINTF(" status 0x%08x\n", status); 70649ab747fSPaolo Bonzini 70749ab747fSPaolo Bonzini ch->regs[DBDMA_STATUS] = status; 70849ab747fSPaolo Bonzini 70949ab747fSPaolo Bonzini if (status & ACTIVE) 71049ab747fSPaolo Bonzini qemu_bh_schedule(dbdma_bh); 71149ab747fSPaolo Bonzini if ((status & FLUSH) && ch->flush) 71249ab747fSPaolo Bonzini ch->flush(&ch->io); 71349ab747fSPaolo Bonzini } 71449ab747fSPaolo Bonzini 71549ab747fSPaolo Bonzini static void dbdma_write(void *opaque, hwaddr addr, 71649ab747fSPaolo Bonzini uint64_t value, unsigned size) 71749ab747fSPaolo Bonzini { 71849ab747fSPaolo Bonzini int channel = addr >> DBDMA_CHANNEL_SHIFT; 71949ab747fSPaolo Bonzini DBDMAState *s = opaque; 72049ab747fSPaolo Bonzini DBDMA_channel *ch = &s->channels[channel]; 72149ab747fSPaolo Bonzini int reg = (addr - (channel << DBDMA_CHANNEL_SHIFT)) >> 2; 72249ab747fSPaolo Bonzini 72358c0c311SAlexander Graf DBDMA_DPRINTF("writel 0x" TARGET_FMT_plx " <= 0x%08"PRIx64"\n", 72458c0c311SAlexander Graf addr, value); 72549ab747fSPaolo Bonzini DBDMA_DPRINTF("channel 0x%x reg 0x%x\n", 72649ab747fSPaolo Bonzini (uint32_t)addr >> DBDMA_CHANNEL_SHIFT, reg); 72749ab747fSPaolo Bonzini 728*7eaba824SAlexander Graf /* cmdptr cannot be modified if channel is ACTIVE */ 72949ab747fSPaolo Bonzini 730*7eaba824SAlexander Graf if (reg == DBDMA_CMDPTR_LO && (ch->regs[DBDMA_STATUS] & ACTIVE)) { 73149ab747fSPaolo Bonzini return; 732*7eaba824SAlexander Graf } 73349ab747fSPaolo Bonzini 73449ab747fSPaolo Bonzini ch->regs[reg] = value; 73549ab747fSPaolo Bonzini 73649ab747fSPaolo Bonzini switch(reg) { 73749ab747fSPaolo Bonzini case DBDMA_CONTROL: 73849ab747fSPaolo Bonzini dbdma_control_write(ch); 73949ab747fSPaolo Bonzini break; 74049ab747fSPaolo Bonzini case DBDMA_CMDPTR_LO: 74149ab747fSPaolo Bonzini /* 16-byte aligned */ 74249ab747fSPaolo Bonzini ch->regs[DBDMA_CMDPTR_LO] &= ~0xf; 74349ab747fSPaolo Bonzini dbdma_cmdptr_load(ch); 74449ab747fSPaolo Bonzini break; 74549ab747fSPaolo Bonzini case DBDMA_STATUS: 74649ab747fSPaolo Bonzini case DBDMA_INTR_SEL: 74749ab747fSPaolo Bonzini case DBDMA_BRANCH_SEL: 74849ab747fSPaolo Bonzini case DBDMA_WAIT_SEL: 74949ab747fSPaolo Bonzini /* nothing to do */ 75049ab747fSPaolo Bonzini break; 75149ab747fSPaolo Bonzini case DBDMA_XFER_MODE: 75249ab747fSPaolo Bonzini case DBDMA_CMDPTR_HI: 75349ab747fSPaolo Bonzini case DBDMA_DATA2PTR_HI: 75449ab747fSPaolo Bonzini case DBDMA_DATA2PTR_LO: 75549ab747fSPaolo Bonzini case DBDMA_ADDRESS_HI: 75649ab747fSPaolo Bonzini case DBDMA_BRANCH_ADDR_HI: 75749ab747fSPaolo Bonzini case DBDMA_RES1: 75849ab747fSPaolo Bonzini case DBDMA_RES2: 75949ab747fSPaolo Bonzini case DBDMA_RES3: 76049ab747fSPaolo Bonzini case DBDMA_RES4: 76149ab747fSPaolo Bonzini /* unused */ 76249ab747fSPaolo Bonzini break; 76349ab747fSPaolo Bonzini } 76449ab747fSPaolo Bonzini } 76549ab747fSPaolo Bonzini 76649ab747fSPaolo Bonzini static uint64_t dbdma_read(void *opaque, hwaddr addr, 76749ab747fSPaolo Bonzini unsigned size) 76849ab747fSPaolo Bonzini { 76949ab747fSPaolo Bonzini uint32_t value; 77049ab747fSPaolo Bonzini int channel = addr >> DBDMA_CHANNEL_SHIFT; 77149ab747fSPaolo Bonzini DBDMAState *s = opaque; 77249ab747fSPaolo Bonzini DBDMA_channel *ch = &s->channels[channel]; 77349ab747fSPaolo Bonzini int reg = (addr - (channel << DBDMA_CHANNEL_SHIFT)) >> 2; 77449ab747fSPaolo Bonzini 77549ab747fSPaolo Bonzini value = ch->regs[reg]; 77649ab747fSPaolo Bonzini 77749ab747fSPaolo Bonzini DBDMA_DPRINTF("readl 0x" TARGET_FMT_plx " => 0x%08x\n", addr, value); 77849ab747fSPaolo Bonzini DBDMA_DPRINTF("channel 0x%x reg 0x%x\n", 77949ab747fSPaolo Bonzini (uint32_t)addr >> DBDMA_CHANNEL_SHIFT, reg); 78049ab747fSPaolo Bonzini 78149ab747fSPaolo Bonzini switch(reg) { 78249ab747fSPaolo Bonzini case DBDMA_CONTROL: 78349ab747fSPaolo Bonzini value = 0; 78449ab747fSPaolo Bonzini break; 78549ab747fSPaolo Bonzini case DBDMA_STATUS: 78649ab747fSPaolo Bonzini case DBDMA_CMDPTR_LO: 78749ab747fSPaolo Bonzini case DBDMA_INTR_SEL: 78849ab747fSPaolo Bonzini case DBDMA_BRANCH_SEL: 78949ab747fSPaolo Bonzini case DBDMA_WAIT_SEL: 79049ab747fSPaolo Bonzini /* nothing to do */ 79149ab747fSPaolo Bonzini break; 79249ab747fSPaolo Bonzini case DBDMA_XFER_MODE: 79349ab747fSPaolo Bonzini case DBDMA_CMDPTR_HI: 79449ab747fSPaolo Bonzini case DBDMA_DATA2PTR_HI: 79549ab747fSPaolo Bonzini case DBDMA_DATA2PTR_LO: 79649ab747fSPaolo Bonzini case DBDMA_ADDRESS_HI: 79749ab747fSPaolo Bonzini case DBDMA_BRANCH_ADDR_HI: 79849ab747fSPaolo Bonzini /* unused */ 79949ab747fSPaolo Bonzini value = 0; 80049ab747fSPaolo Bonzini break; 80149ab747fSPaolo Bonzini case DBDMA_RES1: 80249ab747fSPaolo Bonzini case DBDMA_RES2: 80349ab747fSPaolo Bonzini case DBDMA_RES3: 80449ab747fSPaolo Bonzini case DBDMA_RES4: 80549ab747fSPaolo Bonzini /* reserved */ 80649ab747fSPaolo Bonzini break; 80749ab747fSPaolo Bonzini } 80849ab747fSPaolo Bonzini 80949ab747fSPaolo Bonzini return value; 81049ab747fSPaolo Bonzini } 81149ab747fSPaolo Bonzini 81249ab747fSPaolo Bonzini static const MemoryRegionOps dbdma_ops = { 81349ab747fSPaolo Bonzini .read = dbdma_read, 81449ab747fSPaolo Bonzini .write = dbdma_write, 81549ab747fSPaolo Bonzini .endianness = DEVICE_LITTLE_ENDIAN, 81649ab747fSPaolo Bonzini .valid = { 81749ab747fSPaolo Bonzini .min_access_size = 4, 81849ab747fSPaolo Bonzini .max_access_size = 4, 81949ab747fSPaolo Bonzini }, 82049ab747fSPaolo Bonzini }; 82149ab747fSPaolo Bonzini 82249ab747fSPaolo Bonzini static const VMStateDescription vmstate_dbdma_channel = { 82349ab747fSPaolo Bonzini .name = "dbdma_channel", 82449ab747fSPaolo Bonzini .version_id = 0, 82549ab747fSPaolo Bonzini .minimum_version_id = 0, 82649ab747fSPaolo Bonzini .minimum_version_id_old = 0, 82749ab747fSPaolo Bonzini .fields = (VMStateField[]) { 82849ab747fSPaolo Bonzini VMSTATE_UINT32_ARRAY(regs, struct DBDMA_channel, DBDMA_REGS), 82949ab747fSPaolo Bonzini VMSTATE_END_OF_LIST() 83049ab747fSPaolo Bonzini } 83149ab747fSPaolo Bonzini }; 83249ab747fSPaolo Bonzini 83349ab747fSPaolo Bonzini static const VMStateDescription vmstate_dbdma = { 83449ab747fSPaolo Bonzini .name = "dbdma", 83549ab747fSPaolo Bonzini .version_id = 2, 83649ab747fSPaolo Bonzini .minimum_version_id = 2, 83749ab747fSPaolo Bonzini .minimum_version_id_old = 2, 83849ab747fSPaolo Bonzini .fields = (VMStateField[]) { 83949ab747fSPaolo Bonzini VMSTATE_STRUCT_ARRAY(channels, DBDMAState, DBDMA_CHANNELS, 1, 84049ab747fSPaolo Bonzini vmstate_dbdma_channel, DBDMA_channel), 84149ab747fSPaolo Bonzini VMSTATE_END_OF_LIST() 84249ab747fSPaolo Bonzini } 84349ab747fSPaolo Bonzini }; 84449ab747fSPaolo Bonzini 84549ab747fSPaolo Bonzini static void dbdma_reset(void *opaque) 84649ab747fSPaolo Bonzini { 84749ab747fSPaolo Bonzini DBDMAState *s = opaque; 84849ab747fSPaolo Bonzini int i; 84949ab747fSPaolo Bonzini 85049ab747fSPaolo Bonzini for (i = 0; i < DBDMA_CHANNELS; i++) 85149ab747fSPaolo Bonzini memset(s->channels[i].regs, 0, DBDMA_SIZE); 85249ab747fSPaolo Bonzini } 85349ab747fSPaolo Bonzini 85449ab747fSPaolo Bonzini void* DBDMA_init (MemoryRegion **dbdma_mem) 85549ab747fSPaolo Bonzini { 85649ab747fSPaolo Bonzini DBDMAState *s; 85749ab747fSPaolo Bonzini 85849ab747fSPaolo Bonzini s = g_malloc0(sizeof(DBDMAState)); 85949ab747fSPaolo Bonzini 8602c9b15caSPaolo Bonzini memory_region_init_io(&s->mem, NULL, &dbdma_ops, s, "dbdma", 0x1000); 86149ab747fSPaolo Bonzini *dbdma_mem = &s->mem; 86249ab747fSPaolo Bonzini vmstate_register(NULL, -1, &vmstate_dbdma, s); 86349ab747fSPaolo Bonzini qemu_register_reset(dbdma_reset, s); 86449ab747fSPaolo Bonzini 86549ab747fSPaolo Bonzini dbdma_bh = qemu_bh_new(DBDMA_run_bh, s); 86649ab747fSPaolo Bonzini 86749ab747fSPaolo Bonzini return s; 86849ab747fSPaolo Bonzini } 869