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 */ 390d75590dSPeter Maydell #include "qemu/osdep.h" 4049ab747fSPaolo Bonzini #include "hw/hw.h" 4149ab747fSPaolo Bonzini #include "hw/isa/isa.h" 4249ab747fSPaolo Bonzini #include "hw/ppc/mac_dbdma.h" 4349ab747fSPaolo Bonzini #include "qemu/main-loop.h" 4403dd024fSPaolo Bonzini #include "qemu/log.h" 4588655881SMark Cave-Ayland #include "sysemu/dma.h" 4649ab747fSPaolo Bonzini 4749ab747fSPaolo Bonzini /* debug DBDMA */ 48ba0b17ddSMark Cave-Ayland #define DEBUG_DBDMA 0 493e49c439SMark Cave-Ayland #define DEBUG_DBDMA_CHANMASK ((1ull << DBDMA_CHANNELS) - 1) 5049ab747fSPaolo Bonzini 51ba0b17ddSMark Cave-Ayland #define DBDMA_DPRINTF(fmt, ...) do { \ 52ba0b17ddSMark Cave-Ayland if (DEBUG_DBDMA) { \ 53ba0b17ddSMark Cave-Ayland printf("DBDMA: " fmt , ## __VA_ARGS__); \ 54ba0b17ddSMark Cave-Ayland } \ 55ba0b17ddSMark Cave-Ayland } while (0); 5649ab747fSPaolo Bonzini 573e49c439SMark Cave-Ayland #define DBDMA_DPRINTFCH(ch, fmt, ...) do { \ 583e49c439SMark Cave-Ayland if (DEBUG_DBDMA) { \ 593e49c439SMark Cave-Ayland if ((1ul << (ch)->channel) & DEBUG_DBDMA_CHANMASK) { \ 603e49c439SMark Cave-Ayland printf("DBDMA[%02x]: " fmt , (ch)->channel, ## __VA_ARGS__); \ 613e49c439SMark Cave-Ayland } \ 623e49c439SMark Cave-Ayland } \ 633e49c439SMark Cave-Ayland } while (0); 643e49c439SMark Cave-Ayland 6549ab747fSPaolo Bonzini /* 6649ab747fSPaolo Bonzini */ 6749ab747fSPaolo Bonzini 68d2f0ce21SAlexander Graf static DBDMAState *dbdma_from_ch(DBDMA_channel *ch) 69d2f0ce21SAlexander Graf { 70d2f0ce21SAlexander Graf return container_of(ch, DBDMAState, channels[ch->channel]); 71d2f0ce21SAlexander Graf } 72d2f0ce21SAlexander Graf 73ba0b17ddSMark Cave-Ayland #if DEBUG_DBDMA 7449ab747fSPaolo Bonzini static void dump_dbdma_cmd(dbdma_cmd *cmd) 7549ab747fSPaolo Bonzini { 7649ab747fSPaolo Bonzini printf("dbdma_cmd %p\n", cmd); 7749ab747fSPaolo Bonzini printf(" req_count 0x%04x\n", le16_to_cpu(cmd->req_count)); 7849ab747fSPaolo Bonzini printf(" command 0x%04x\n", le16_to_cpu(cmd->command)); 7949ab747fSPaolo Bonzini printf(" phy_addr 0x%08x\n", le32_to_cpu(cmd->phy_addr)); 8049ab747fSPaolo Bonzini printf(" cmd_dep 0x%08x\n", le32_to_cpu(cmd->cmd_dep)); 8149ab747fSPaolo Bonzini printf(" res_count 0x%04x\n", le16_to_cpu(cmd->res_count)); 8249ab747fSPaolo Bonzini printf(" xfer_status 0x%04x\n", le16_to_cpu(cmd->xfer_status)); 8349ab747fSPaolo Bonzini } 8449ab747fSPaolo Bonzini #else 8549ab747fSPaolo Bonzini static void dump_dbdma_cmd(dbdma_cmd *cmd) 8649ab747fSPaolo Bonzini { 8749ab747fSPaolo Bonzini } 8849ab747fSPaolo Bonzini #endif 8949ab747fSPaolo Bonzini static void dbdma_cmdptr_load(DBDMA_channel *ch) 9049ab747fSPaolo Bonzini { 913e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "dbdma_cmdptr_load 0x%08x\n", 9249ab747fSPaolo Bonzini ch->regs[DBDMA_CMDPTR_LO]); 9388655881SMark Cave-Ayland dma_memory_read(&address_space_memory, ch->regs[DBDMA_CMDPTR_LO], 94e1fe50dcSStefan Weil &ch->current, sizeof(dbdma_cmd)); 9549ab747fSPaolo Bonzini } 9649ab747fSPaolo Bonzini 9749ab747fSPaolo Bonzini static void dbdma_cmdptr_save(DBDMA_channel *ch) 9849ab747fSPaolo Bonzini { 99*77453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, "-> update 0x%08x stat=0x%08x, res=0x%04x\n", 100*77453882SBenjamin Herrenschmidt ch->regs[DBDMA_CMDPTR_LO], 10149ab747fSPaolo Bonzini le16_to_cpu(ch->current.xfer_status), 10249ab747fSPaolo Bonzini le16_to_cpu(ch->current.res_count)); 10388655881SMark Cave-Ayland dma_memory_write(&address_space_memory, ch->regs[DBDMA_CMDPTR_LO], 104e1fe50dcSStefan Weil &ch->current, sizeof(dbdma_cmd)); 10549ab747fSPaolo Bonzini } 10649ab747fSPaolo Bonzini 10749ab747fSPaolo Bonzini static void kill_channel(DBDMA_channel *ch) 10849ab747fSPaolo Bonzini { 1093e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "kill_channel\n"); 11049ab747fSPaolo Bonzini 11149ab747fSPaolo Bonzini ch->regs[DBDMA_STATUS] |= DEAD; 11249ab747fSPaolo Bonzini ch->regs[DBDMA_STATUS] &= ~ACTIVE; 11349ab747fSPaolo Bonzini 11449ab747fSPaolo Bonzini qemu_irq_raise(ch->irq); 11549ab747fSPaolo Bonzini } 11649ab747fSPaolo Bonzini 11749ab747fSPaolo Bonzini static void conditional_interrupt(DBDMA_channel *ch) 11849ab747fSPaolo Bonzini { 11949ab747fSPaolo Bonzini dbdma_cmd *current = &ch->current; 12049ab747fSPaolo Bonzini uint16_t intr; 12149ab747fSPaolo Bonzini uint16_t sel_mask, sel_value; 12249ab747fSPaolo Bonzini uint32_t status; 12349ab747fSPaolo Bonzini int cond; 12449ab747fSPaolo Bonzini 1253e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "%s\n", __func__); 12649ab747fSPaolo Bonzini 12749ab747fSPaolo Bonzini intr = le16_to_cpu(current->command) & INTR_MASK; 12849ab747fSPaolo Bonzini 12949ab747fSPaolo Bonzini switch(intr) { 13049ab747fSPaolo Bonzini case INTR_NEVER: /* don't interrupt */ 13149ab747fSPaolo Bonzini return; 13249ab747fSPaolo Bonzini case INTR_ALWAYS: /* always interrupt */ 13349ab747fSPaolo Bonzini qemu_irq_raise(ch->irq); 1343e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "%s: raise\n", __func__); 13549ab747fSPaolo Bonzini return; 13649ab747fSPaolo Bonzini } 13749ab747fSPaolo Bonzini 13849ab747fSPaolo Bonzini status = ch->regs[DBDMA_STATUS] & DEVSTAT; 13949ab747fSPaolo Bonzini 14049ab747fSPaolo Bonzini sel_mask = (ch->regs[DBDMA_INTR_SEL] >> 16) & 0x0f; 14149ab747fSPaolo Bonzini sel_value = ch->regs[DBDMA_INTR_SEL] & 0x0f; 14249ab747fSPaolo Bonzini 14349ab747fSPaolo Bonzini cond = (status & sel_mask) == (sel_value & sel_mask); 14449ab747fSPaolo Bonzini 14549ab747fSPaolo Bonzini switch(intr) { 14649ab747fSPaolo Bonzini case INTR_IFSET: /* intr if condition bit is 1 */ 14733ce36bbSAlexander Graf if (cond) { 14849ab747fSPaolo Bonzini qemu_irq_raise(ch->irq); 1493e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "%s: raise\n", __func__); 15033ce36bbSAlexander Graf } 15149ab747fSPaolo Bonzini return; 15249ab747fSPaolo Bonzini case INTR_IFCLR: /* intr if condition bit is 0 */ 15333ce36bbSAlexander Graf if (!cond) { 15449ab747fSPaolo Bonzini qemu_irq_raise(ch->irq); 1553e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "%s: raise\n", __func__); 15633ce36bbSAlexander Graf } 15749ab747fSPaolo Bonzini return; 15849ab747fSPaolo Bonzini } 15949ab747fSPaolo Bonzini } 16049ab747fSPaolo Bonzini 16149ab747fSPaolo Bonzini static int conditional_wait(DBDMA_channel *ch) 16249ab747fSPaolo Bonzini { 16349ab747fSPaolo Bonzini dbdma_cmd *current = &ch->current; 16449ab747fSPaolo Bonzini uint16_t wait; 16549ab747fSPaolo Bonzini uint16_t sel_mask, sel_value; 16649ab747fSPaolo Bonzini uint32_t status; 16749ab747fSPaolo Bonzini int cond; 168*77453882SBenjamin Herrenschmidt int res = 0; 16949ab747fSPaolo Bonzini 17049ab747fSPaolo Bonzini wait = le16_to_cpu(current->command) & WAIT_MASK; 17149ab747fSPaolo Bonzini switch(wait) { 17249ab747fSPaolo Bonzini case WAIT_NEVER: /* don't wait */ 17349ab747fSPaolo Bonzini return 0; 17449ab747fSPaolo Bonzini case WAIT_ALWAYS: /* always wait */ 175*77453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " [WAIT_ALWAYS]\n"); 17649ab747fSPaolo Bonzini return 1; 17749ab747fSPaolo Bonzini } 17849ab747fSPaolo Bonzini 17949ab747fSPaolo Bonzini status = ch->regs[DBDMA_STATUS] & DEVSTAT; 18049ab747fSPaolo Bonzini 18149ab747fSPaolo Bonzini sel_mask = (ch->regs[DBDMA_WAIT_SEL] >> 16) & 0x0f; 18249ab747fSPaolo Bonzini sel_value = ch->regs[DBDMA_WAIT_SEL] & 0x0f; 18349ab747fSPaolo Bonzini 18449ab747fSPaolo Bonzini cond = (status & sel_mask) == (sel_value & sel_mask); 18549ab747fSPaolo Bonzini 18649ab747fSPaolo Bonzini switch(wait) { 18749ab747fSPaolo Bonzini case WAIT_IFSET: /* wait if condition bit is 1 */ 188*77453882SBenjamin Herrenschmidt if (cond) { 189*77453882SBenjamin Herrenschmidt res = 1; 19049ab747fSPaolo Bonzini } 191*77453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " [WAIT_IFSET=%d]\n", res); 192*77453882SBenjamin Herrenschmidt break; 193*77453882SBenjamin Herrenschmidt case WAIT_IFCLR: /* wait if condition bit is 0 */ 194*77453882SBenjamin Herrenschmidt if (!cond) { 195*77453882SBenjamin Herrenschmidt res = 1; 196*77453882SBenjamin Herrenschmidt } 197*77453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " [WAIT_IFCLR=%d]\n", res); 198*77453882SBenjamin Herrenschmidt break; 199*77453882SBenjamin Herrenschmidt } 200*77453882SBenjamin Herrenschmidt return res; 20149ab747fSPaolo Bonzini } 20249ab747fSPaolo Bonzini 20349ab747fSPaolo Bonzini static void next(DBDMA_channel *ch) 20449ab747fSPaolo Bonzini { 20549ab747fSPaolo Bonzini uint32_t cp; 20649ab747fSPaolo Bonzini 20749ab747fSPaolo Bonzini ch->regs[DBDMA_STATUS] &= ~BT; 20849ab747fSPaolo Bonzini 20949ab747fSPaolo Bonzini cp = ch->regs[DBDMA_CMDPTR_LO]; 21049ab747fSPaolo Bonzini ch->regs[DBDMA_CMDPTR_LO] = cp + sizeof(dbdma_cmd); 21149ab747fSPaolo Bonzini dbdma_cmdptr_load(ch); 21249ab747fSPaolo Bonzini } 21349ab747fSPaolo Bonzini 21449ab747fSPaolo Bonzini static void branch(DBDMA_channel *ch) 21549ab747fSPaolo Bonzini { 21649ab747fSPaolo Bonzini dbdma_cmd *current = &ch->current; 21749ab747fSPaolo Bonzini 2183f0d4128SMark Cave-Ayland ch->regs[DBDMA_CMDPTR_LO] = le32_to_cpu(current->cmd_dep); 21949ab747fSPaolo Bonzini ch->regs[DBDMA_STATUS] |= BT; 22049ab747fSPaolo Bonzini dbdma_cmdptr_load(ch); 22149ab747fSPaolo Bonzini } 22249ab747fSPaolo Bonzini 22349ab747fSPaolo Bonzini static void conditional_branch(DBDMA_channel *ch) 22449ab747fSPaolo Bonzini { 22549ab747fSPaolo Bonzini dbdma_cmd *current = &ch->current; 22649ab747fSPaolo Bonzini uint16_t br; 22749ab747fSPaolo Bonzini uint16_t sel_mask, sel_value; 22849ab747fSPaolo Bonzini uint32_t status; 22949ab747fSPaolo Bonzini int cond; 23049ab747fSPaolo Bonzini 23149ab747fSPaolo Bonzini /* check if we must branch */ 23249ab747fSPaolo Bonzini 23349ab747fSPaolo Bonzini br = le16_to_cpu(current->command) & BR_MASK; 23449ab747fSPaolo Bonzini 23549ab747fSPaolo Bonzini switch(br) { 23649ab747fSPaolo Bonzini case BR_NEVER: /* don't branch */ 23749ab747fSPaolo Bonzini next(ch); 23849ab747fSPaolo Bonzini return; 23949ab747fSPaolo Bonzini case BR_ALWAYS: /* always branch */ 240*77453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " [BR_ALWAYS]\n"); 24149ab747fSPaolo Bonzini branch(ch); 24249ab747fSPaolo Bonzini return; 24349ab747fSPaolo Bonzini } 24449ab747fSPaolo Bonzini 24549ab747fSPaolo Bonzini status = ch->regs[DBDMA_STATUS] & DEVSTAT; 24649ab747fSPaolo Bonzini 24749ab747fSPaolo Bonzini sel_mask = (ch->regs[DBDMA_BRANCH_SEL] >> 16) & 0x0f; 24849ab747fSPaolo Bonzini sel_value = ch->regs[DBDMA_BRANCH_SEL] & 0x0f; 24949ab747fSPaolo Bonzini 25049ab747fSPaolo Bonzini cond = (status & sel_mask) == (sel_value & sel_mask); 25149ab747fSPaolo Bonzini 25249ab747fSPaolo Bonzini switch(br) { 25349ab747fSPaolo Bonzini case BR_IFSET: /* branch if condition bit is 1 */ 254*77453882SBenjamin Herrenschmidt if (cond) { 255*77453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " [BR_IFSET = 1]\n"); 25649ab747fSPaolo Bonzini branch(ch); 257*77453882SBenjamin Herrenschmidt } else { 258*77453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " [BR_IFSET = 0]\n"); 25949ab747fSPaolo Bonzini next(ch); 260*77453882SBenjamin Herrenschmidt } 26149ab747fSPaolo Bonzini return; 26249ab747fSPaolo Bonzini case BR_IFCLR: /* branch if condition bit is 0 */ 263*77453882SBenjamin Herrenschmidt if (!cond) { 264*77453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " [BR_IFCLR = 1]\n"); 26549ab747fSPaolo Bonzini branch(ch); 266*77453882SBenjamin Herrenschmidt } else { 267*77453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " [BR_IFCLR = 0]\n"); 26849ab747fSPaolo Bonzini next(ch); 269*77453882SBenjamin Herrenschmidt } 27049ab747fSPaolo Bonzini return; 27149ab747fSPaolo Bonzini } 27249ab747fSPaolo Bonzini } 27349ab747fSPaolo Bonzini 27449ab747fSPaolo Bonzini static void channel_run(DBDMA_channel *ch); 27549ab747fSPaolo Bonzini 27649ab747fSPaolo Bonzini static void dbdma_end(DBDMA_io *io) 27749ab747fSPaolo Bonzini { 27849ab747fSPaolo Bonzini DBDMA_channel *ch = io->channel; 27949ab747fSPaolo Bonzini dbdma_cmd *current = &ch->current; 28049ab747fSPaolo Bonzini 2813e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "%s\n", __func__); 28233ce36bbSAlexander Graf 28349ab747fSPaolo Bonzini if (conditional_wait(ch)) 28449ab747fSPaolo Bonzini goto wait; 28549ab747fSPaolo Bonzini 28649ab747fSPaolo Bonzini current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]); 28749ab747fSPaolo Bonzini current->res_count = cpu_to_le16(io->len); 28849ab747fSPaolo Bonzini dbdma_cmdptr_save(ch); 28949ab747fSPaolo Bonzini if (io->is_last) 29049ab747fSPaolo Bonzini ch->regs[DBDMA_STATUS] &= ~FLUSH; 29149ab747fSPaolo Bonzini 29249ab747fSPaolo Bonzini conditional_interrupt(ch); 29349ab747fSPaolo Bonzini conditional_branch(ch); 29449ab747fSPaolo Bonzini 29549ab747fSPaolo Bonzini wait: 29603ee3b1eSAlexander Graf /* Indicate that we're ready for a new DMA round */ 29703ee3b1eSAlexander Graf ch->io.processing = false; 29803ee3b1eSAlexander Graf 29949ab747fSPaolo Bonzini if ((ch->regs[DBDMA_STATUS] & RUN) && 30049ab747fSPaolo Bonzini (ch->regs[DBDMA_STATUS] & ACTIVE)) 30149ab747fSPaolo Bonzini channel_run(ch); 30249ab747fSPaolo Bonzini } 30349ab747fSPaolo Bonzini 30449ab747fSPaolo Bonzini static void start_output(DBDMA_channel *ch, int key, uint32_t addr, 30549ab747fSPaolo Bonzini uint16_t req_count, int is_last) 30649ab747fSPaolo Bonzini { 3073e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "start_output\n"); 30849ab747fSPaolo Bonzini 30949ab747fSPaolo Bonzini /* KEY_REGS, KEY_DEVICE and KEY_STREAM 31049ab747fSPaolo Bonzini * are not implemented in the mac-io chip 31149ab747fSPaolo Bonzini */ 31249ab747fSPaolo Bonzini 3133e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "addr 0x%x key 0x%x\n", addr, key); 31449ab747fSPaolo Bonzini if (!addr || key > KEY_STREAM3) { 31549ab747fSPaolo Bonzini kill_channel(ch); 31649ab747fSPaolo Bonzini return; 31749ab747fSPaolo Bonzini } 31849ab747fSPaolo Bonzini 31949ab747fSPaolo Bonzini ch->io.addr = addr; 32049ab747fSPaolo Bonzini ch->io.len = req_count; 32149ab747fSPaolo Bonzini ch->io.is_last = is_last; 32249ab747fSPaolo Bonzini ch->io.dma_end = dbdma_end; 32349ab747fSPaolo Bonzini ch->io.is_dma_out = 1; 32403ee3b1eSAlexander Graf ch->io.processing = true; 32549ab747fSPaolo Bonzini if (ch->rw) { 32649ab747fSPaolo Bonzini ch->rw(&ch->io); 32749ab747fSPaolo Bonzini } 32849ab747fSPaolo Bonzini } 32949ab747fSPaolo Bonzini 33049ab747fSPaolo Bonzini static void start_input(DBDMA_channel *ch, int key, uint32_t addr, 33149ab747fSPaolo Bonzini uint16_t req_count, int is_last) 33249ab747fSPaolo Bonzini { 3333e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "start_input\n"); 33449ab747fSPaolo Bonzini 33549ab747fSPaolo Bonzini /* KEY_REGS, KEY_DEVICE and KEY_STREAM 33649ab747fSPaolo Bonzini * are not implemented in the mac-io chip 33749ab747fSPaolo Bonzini */ 33849ab747fSPaolo Bonzini 3393e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "addr 0x%x key 0x%x\n", addr, key); 34049ab747fSPaolo Bonzini if (!addr || key > KEY_STREAM3) { 34149ab747fSPaolo Bonzini kill_channel(ch); 34249ab747fSPaolo Bonzini return; 34349ab747fSPaolo Bonzini } 34449ab747fSPaolo Bonzini 34549ab747fSPaolo Bonzini ch->io.addr = addr; 34649ab747fSPaolo Bonzini ch->io.len = req_count; 34749ab747fSPaolo Bonzini ch->io.is_last = is_last; 34849ab747fSPaolo Bonzini ch->io.dma_end = dbdma_end; 34949ab747fSPaolo Bonzini ch->io.is_dma_out = 0; 35003ee3b1eSAlexander Graf ch->io.processing = true; 35149ab747fSPaolo Bonzini if (ch->rw) { 35249ab747fSPaolo Bonzini ch->rw(&ch->io); 35349ab747fSPaolo Bonzini } 35449ab747fSPaolo Bonzini } 35549ab747fSPaolo Bonzini 35649ab747fSPaolo Bonzini static void load_word(DBDMA_channel *ch, int key, uint32_t addr, 35749ab747fSPaolo Bonzini uint16_t len) 35849ab747fSPaolo Bonzini { 35949ab747fSPaolo Bonzini dbdma_cmd *current = &ch->current; 36049ab747fSPaolo Bonzini 361e12f50b9SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "load_word %d bytes, addr=%08x\n", len, addr); 36249ab747fSPaolo Bonzini 36349ab747fSPaolo Bonzini /* only implements KEY_SYSTEM */ 36449ab747fSPaolo Bonzini 36549ab747fSPaolo Bonzini if (key != KEY_SYSTEM) { 36649ab747fSPaolo Bonzini printf("DBDMA: LOAD_WORD, unimplemented key %x\n", key); 36749ab747fSPaolo Bonzini kill_channel(ch); 36849ab747fSPaolo Bonzini return; 36949ab747fSPaolo Bonzini } 37049ab747fSPaolo Bonzini 371e12f50b9SMark Cave-Ayland dma_memory_read(&address_space_memory, addr, ¤t->cmd_dep, len); 37249ab747fSPaolo Bonzini 37349ab747fSPaolo Bonzini if (conditional_wait(ch)) 37449ab747fSPaolo Bonzini goto wait; 37549ab747fSPaolo Bonzini 37649ab747fSPaolo Bonzini current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]); 37749ab747fSPaolo Bonzini dbdma_cmdptr_save(ch); 37849ab747fSPaolo Bonzini ch->regs[DBDMA_STATUS] &= ~FLUSH; 37949ab747fSPaolo Bonzini 38049ab747fSPaolo Bonzini conditional_interrupt(ch); 38149ab747fSPaolo Bonzini next(ch); 38249ab747fSPaolo Bonzini 38349ab747fSPaolo Bonzini wait: 384d2f0ce21SAlexander Graf DBDMA_kick(dbdma_from_ch(ch)); 38549ab747fSPaolo Bonzini } 38649ab747fSPaolo Bonzini 38749ab747fSPaolo Bonzini static void store_word(DBDMA_channel *ch, int key, uint32_t addr, 38849ab747fSPaolo Bonzini uint16_t len) 38949ab747fSPaolo Bonzini { 39049ab747fSPaolo Bonzini dbdma_cmd *current = &ch->current; 39149ab747fSPaolo Bonzini 392e12f50b9SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "store_word %d bytes, addr=%08x pa=%x\n", 393e12f50b9SMark Cave-Ayland len, addr, le32_to_cpu(current->cmd_dep)); 39449ab747fSPaolo Bonzini 39549ab747fSPaolo Bonzini /* only implements KEY_SYSTEM */ 39649ab747fSPaolo Bonzini 39749ab747fSPaolo Bonzini if (key != KEY_SYSTEM) { 39849ab747fSPaolo Bonzini printf("DBDMA: STORE_WORD, unimplemented key %x\n", key); 39949ab747fSPaolo Bonzini kill_channel(ch); 40049ab747fSPaolo Bonzini return; 40149ab747fSPaolo Bonzini } 40249ab747fSPaolo Bonzini 403e12f50b9SMark Cave-Ayland dma_memory_write(&address_space_memory, addr, ¤t->cmd_dep, len); 40449ab747fSPaolo Bonzini 40549ab747fSPaolo Bonzini if (conditional_wait(ch)) 40649ab747fSPaolo Bonzini goto wait; 40749ab747fSPaolo Bonzini 40849ab747fSPaolo Bonzini current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]); 40949ab747fSPaolo Bonzini dbdma_cmdptr_save(ch); 41049ab747fSPaolo Bonzini ch->regs[DBDMA_STATUS] &= ~FLUSH; 41149ab747fSPaolo Bonzini 41249ab747fSPaolo Bonzini conditional_interrupt(ch); 41349ab747fSPaolo Bonzini next(ch); 41449ab747fSPaolo Bonzini 41549ab747fSPaolo Bonzini wait: 416d2f0ce21SAlexander Graf DBDMA_kick(dbdma_from_ch(ch)); 41749ab747fSPaolo Bonzini } 41849ab747fSPaolo Bonzini 41949ab747fSPaolo Bonzini static void nop(DBDMA_channel *ch) 42049ab747fSPaolo Bonzini { 42149ab747fSPaolo Bonzini dbdma_cmd *current = &ch->current; 42249ab747fSPaolo Bonzini 42349ab747fSPaolo Bonzini if (conditional_wait(ch)) 42449ab747fSPaolo Bonzini goto wait; 42549ab747fSPaolo Bonzini 42649ab747fSPaolo Bonzini current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]); 42749ab747fSPaolo Bonzini dbdma_cmdptr_save(ch); 42849ab747fSPaolo Bonzini 42949ab747fSPaolo Bonzini conditional_interrupt(ch); 43049ab747fSPaolo Bonzini conditional_branch(ch); 43149ab747fSPaolo Bonzini 43249ab747fSPaolo Bonzini wait: 433d2f0ce21SAlexander Graf DBDMA_kick(dbdma_from_ch(ch)); 43449ab747fSPaolo Bonzini } 43549ab747fSPaolo Bonzini 43649ab747fSPaolo Bonzini static void stop(DBDMA_channel *ch) 43749ab747fSPaolo Bonzini { 438*77453882SBenjamin Herrenschmidt ch->regs[DBDMA_STATUS] &= ~(ACTIVE); 43949ab747fSPaolo Bonzini 44049ab747fSPaolo Bonzini /* the stop command does not increment command pointer */ 44149ab747fSPaolo Bonzini } 44249ab747fSPaolo Bonzini 44349ab747fSPaolo Bonzini static void channel_run(DBDMA_channel *ch) 44449ab747fSPaolo Bonzini { 44549ab747fSPaolo Bonzini dbdma_cmd *current = &ch->current; 44649ab747fSPaolo Bonzini uint16_t cmd, key; 44749ab747fSPaolo Bonzini uint16_t req_count; 44849ab747fSPaolo Bonzini uint32_t phy_addr; 44949ab747fSPaolo Bonzini 4503e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "channel_run\n"); 45149ab747fSPaolo Bonzini dump_dbdma_cmd(current); 45249ab747fSPaolo Bonzini 45349ab747fSPaolo Bonzini /* clear WAKE flag at command fetch */ 45449ab747fSPaolo Bonzini 45549ab747fSPaolo Bonzini ch->regs[DBDMA_STATUS] &= ~WAKE; 45649ab747fSPaolo Bonzini 45749ab747fSPaolo Bonzini cmd = le16_to_cpu(current->command) & COMMAND_MASK; 45849ab747fSPaolo Bonzini 45949ab747fSPaolo Bonzini switch (cmd) { 46049ab747fSPaolo Bonzini case DBDMA_NOP: 46149ab747fSPaolo Bonzini nop(ch); 46249ab747fSPaolo Bonzini return; 46349ab747fSPaolo Bonzini 46449ab747fSPaolo Bonzini case DBDMA_STOP: 46549ab747fSPaolo Bonzini stop(ch); 46649ab747fSPaolo Bonzini return; 46749ab747fSPaolo Bonzini } 46849ab747fSPaolo Bonzini 46949ab747fSPaolo Bonzini key = le16_to_cpu(current->command) & 0x0700; 47049ab747fSPaolo Bonzini req_count = le16_to_cpu(current->req_count); 47149ab747fSPaolo Bonzini phy_addr = le32_to_cpu(current->phy_addr); 47249ab747fSPaolo Bonzini 47349ab747fSPaolo Bonzini if (key == KEY_STREAM4) { 47449ab747fSPaolo Bonzini printf("command %x, invalid key 4\n", cmd); 47549ab747fSPaolo Bonzini kill_channel(ch); 47649ab747fSPaolo Bonzini return; 47749ab747fSPaolo Bonzini } 47849ab747fSPaolo Bonzini 47949ab747fSPaolo Bonzini switch (cmd) { 48049ab747fSPaolo Bonzini case OUTPUT_MORE: 481*77453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, "* OUTPUT_MORE *\n"); 48249ab747fSPaolo Bonzini start_output(ch, key, phy_addr, req_count, 0); 48349ab747fSPaolo Bonzini return; 48449ab747fSPaolo Bonzini 48549ab747fSPaolo Bonzini case OUTPUT_LAST: 486*77453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, "* OUTPUT_LAST *\n"); 48749ab747fSPaolo Bonzini start_output(ch, key, phy_addr, req_count, 1); 48849ab747fSPaolo Bonzini return; 48949ab747fSPaolo Bonzini 49049ab747fSPaolo Bonzini case INPUT_MORE: 491*77453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, "* INPUT_MORE *\n"); 49249ab747fSPaolo Bonzini start_input(ch, key, phy_addr, req_count, 0); 49349ab747fSPaolo Bonzini return; 49449ab747fSPaolo Bonzini 49549ab747fSPaolo Bonzini case INPUT_LAST: 496*77453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, "* INPUT_LAST *\n"); 49749ab747fSPaolo Bonzini start_input(ch, key, phy_addr, req_count, 1); 49849ab747fSPaolo Bonzini return; 49949ab747fSPaolo Bonzini } 50049ab747fSPaolo Bonzini 50149ab747fSPaolo Bonzini if (key < KEY_REGS) { 50249ab747fSPaolo Bonzini printf("command %x, invalid key %x\n", cmd, key); 50349ab747fSPaolo Bonzini key = KEY_SYSTEM; 50449ab747fSPaolo Bonzini } 50549ab747fSPaolo Bonzini 50649ab747fSPaolo Bonzini /* for LOAD_WORD and STORE_WORD, req_count is on 3 bits 50749ab747fSPaolo Bonzini * and BRANCH is invalid 50849ab747fSPaolo Bonzini */ 50949ab747fSPaolo Bonzini 51049ab747fSPaolo Bonzini req_count = req_count & 0x0007; 51149ab747fSPaolo Bonzini if (req_count & 0x4) { 51249ab747fSPaolo Bonzini req_count = 4; 51349ab747fSPaolo Bonzini phy_addr &= ~3; 51449ab747fSPaolo Bonzini } else if (req_count & 0x2) { 51549ab747fSPaolo Bonzini req_count = 2; 51649ab747fSPaolo Bonzini phy_addr &= ~1; 51749ab747fSPaolo Bonzini } else 51849ab747fSPaolo Bonzini req_count = 1; 51949ab747fSPaolo Bonzini 52049ab747fSPaolo Bonzini switch (cmd) { 52149ab747fSPaolo Bonzini case LOAD_WORD: 522*77453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, "* LOAD_WORD *\n"); 52349ab747fSPaolo Bonzini load_word(ch, key, phy_addr, req_count); 52449ab747fSPaolo Bonzini return; 52549ab747fSPaolo Bonzini 52649ab747fSPaolo Bonzini case STORE_WORD: 527*77453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, "* STORE_WORD *\n"); 52849ab747fSPaolo Bonzini store_word(ch, key, phy_addr, req_count); 52949ab747fSPaolo Bonzini return; 53049ab747fSPaolo Bonzini } 53149ab747fSPaolo Bonzini } 53249ab747fSPaolo Bonzini 53349ab747fSPaolo Bonzini static void DBDMA_run(DBDMAState *s) 53449ab747fSPaolo Bonzini { 53549ab747fSPaolo Bonzini int channel; 53649ab747fSPaolo Bonzini 53749ab747fSPaolo Bonzini for (channel = 0; channel < DBDMA_CHANNELS; channel++) { 53849ab747fSPaolo Bonzini DBDMA_channel *ch = &s->channels[channel]; 53949ab747fSPaolo Bonzini uint32_t status = ch->regs[DBDMA_STATUS]; 54003ee3b1eSAlexander Graf if (!ch->io.processing && (status & RUN) && (status & ACTIVE)) { 54149ab747fSPaolo Bonzini channel_run(ch); 54249ab747fSPaolo Bonzini } 54349ab747fSPaolo Bonzini } 54449ab747fSPaolo Bonzini } 54549ab747fSPaolo Bonzini 54649ab747fSPaolo Bonzini static void DBDMA_run_bh(void *opaque) 54749ab747fSPaolo Bonzini { 54849ab747fSPaolo Bonzini DBDMAState *s = opaque; 54949ab747fSPaolo Bonzini 5503e49c439SMark Cave-Ayland DBDMA_DPRINTF("-> DBDMA_run_bh\n"); 55149ab747fSPaolo Bonzini DBDMA_run(s); 5523e49c439SMark Cave-Ayland DBDMA_DPRINTF("<- DBDMA_run_bh\n"); 55349ab747fSPaolo Bonzini } 55449ab747fSPaolo Bonzini 555d1e562deSAlexander Graf void DBDMA_kick(DBDMAState *dbdma) 556d1e562deSAlexander Graf { 557d2f0ce21SAlexander Graf qemu_bh_schedule(dbdma->bh); 558d1e562deSAlexander Graf } 559d1e562deSAlexander Graf 56049ab747fSPaolo Bonzini void DBDMA_register_channel(void *dbdma, int nchan, qemu_irq irq, 56149ab747fSPaolo Bonzini DBDMA_rw rw, DBDMA_flush flush, 56249ab747fSPaolo Bonzini void *opaque) 56349ab747fSPaolo Bonzini { 56449ab747fSPaolo Bonzini DBDMAState *s = dbdma; 56549ab747fSPaolo Bonzini DBDMA_channel *ch = &s->channels[nchan]; 56649ab747fSPaolo Bonzini 5673e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "DBDMA_register_channel 0x%x\n", nchan); 56849ab747fSPaolo Bonzini 5692d7d06d8SHervé Poussineau assert(rw); 5702d7d06d8SHervé Poussineau assert(flush); 5712d7d06d8SHervé Poussineau 57249ab747fSPaolo Bonzini ch->irq = irq; 57349ab747fSPaolo Bonzini ch->rw = rw; 57449ab747fSPaolo Bonzini ch->flush = flush; 57549ab747fSPaolo Bonzini ch->io.opaque = opaque; 57649ab747fSPaolo Bonzini } 57749ab747fSPaolo Bonzini 578*77453882SBenjamin Herrenschmidt static void dbdma_control_write(DBDMA_channel *ch) 57949ab747fSPaolo Bonzini { 58049ab747fSPaolo Bonzini uint16_t mask, value; 58149ab747fSPaolo Bonzini uint32_t status; 582*77453882SBenjamin Herrenschmidt bool do_flush = false; 58349ab747fSPaolo Bonzini 58449ab747fSPaolo Bonzini mask = (ch->regs[DBDMA_CONTROL] >> 16) & 0xffff; 58549ab747fSPaolo Bonzini value = ch->regs[DBDMA_CONTROL] & 0xffff; 58649ab747fSPaolo Bonzini 587*77453882SBenjamin Herrenschmidt /* This is the status register which we'll update 588*77453882SBenjamin Herrenschmidt * appropriately and store back 589*77453882SBenjamin Herrenschmidt */ 59049ab747fSPaolo Bonzini status = ch->regs[DBDMA_STATUS]; 59149ab747fSPaolo Bonzini 592*77453882SBenjamin Herrenschmidt /* RUN and PAUSE are bits under SW control only 593*77453882SBenjamin Herrenschmidt * FLUSH and WAKE are set by SW and cleared by HW 594*77453882SBenjamin Herrenschmidt * DEAD, ACTIVE and BT are only under HW control 595*77453882SBenjamin Herrenschmidt * 596*77453882SBenjamin Herrenschmidt * We handle ACTIVE separately at the end of the 597*77453882SBenjamin Herrenschmidt * logic to ensure all cases are covered. 598*77453882SBenjamin Herrenschmidt */ 59949ab747fSPaolo Bonzini 600*77453882SBenjamin Herrenschmidt /* Setting RUN will tentatively activate the channel 601*77453882SBenjamin Herrenschmidt */ 602*77453882SBenjamin Herrenschmidt if ((mask & RUN) && (value & RUN)) { 603*77453882SBenjamin Herrenschmidt status |= RUN; 604*77453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " Setting RUN !\n"); 60549ab747fSPaolo Bonzini } 606*77453882SBenjamin Herrenschmidt 607*77453882SBenjamin Herrenschmidt /* Clearing RUN 1->0 will stop the channel */ 608*77453882SBenjamin Herrenschmidt if ((mask & RUN) && !(value & RUN)) { 609*77453882SBenjamin Herrenschmidt /* This has the side effect of clearing the DEAD bit */ 610*77453882SBenjamin Herrenschmidt status &= ~(DEAD | RUN); 611*77453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " Clearing RUN !\n"); 612*77453882SBenjamin Herrenschmidt } 613*77453882SBenjamin Herrenschmidt 614*77453882SBenjamin Herrenschmidt /* Setting WAKE wakes up an idle channel if it's running 615*77453882SBenjamin Herrenschmidt * 616*77453882SBenjamin Herrenschmidt * Note: The doc doesn't say so but assume that only works 617*77453882SBenjamin Herrenschmidt * on a channel whose RUN bit is set. 618*77453882SBenjamin Herrenschmidt * 619*77453882SBenjamin Herrenschmidt * We set WAKE in status, it's not terribly useful as it will 620*77453882SBenjamin Herrenschmidt * be cleared on the next command fetch but it seems to mimmic 621*77453882SBenjamin Herrenschmidt * the HW behaviour and is useful for the way we handle 622*77453882SBenjamin Herrenschmidt * ACTIVE further down. 623*77453882SBenjamin Herrenschmidt */ 624*77453882SBenjamin Herrenschmidt if ((mask & WAKE) && (value & WAKE) && (status & RUN)) { 625*77453882SBenjamin Herrenschmidt status |= WAKE; 626*77453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " Setting WAKE !\n"); 627*77453882SBenjamin Herrenschmidt } 628*77453882SBenjamin Herrenschmidt 629*77453882SBenjamin Herrenschmidt /* PAUSE being set will deactivate (or prevent activation) 630*77453882SBenjamin Herrenschmidt * of the channel. We just copy it over for now, ACTIVE will 631*77453882SBenjamin Herrenschmidt * be re-evaluated later. 632*77453882SBenjamin Herrenschmidt */ 633*77453882SBenjamin Herrenschmidt if (mask & PAUSE) { 634*77453882SBenjamin Herrenschmidt status = (status & ~PAUSE) | (value & PAUSE); 635*77453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " %sing PAUSE !\n", 636*77453882SBenjamin Herrenschmidt (value & PAUSE) ? "sett" : "clear"); 637*77453882SBenjamin Herrenschmidt } 638*77453882SBenjamin Herrenschmidt 639*77453882SBenjamin Herrenschmidt /* FLUSH is its own thing */ 640*77453882SBenjamin Herrenschmidt if ((mask & FLUSH) && (value & FLUSH)) { 641*77453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " Setting FLUSH !\n"); 642*77453882SBenjamin Herrenschmidt /* We set flush directly in the status register, we do *NOT* 643*77453882SBenjamin Herrenschmidt * set it in "status" so that it gets naturally cleared when 644*77453882SBenjamin Herrenschmidt * we update the status register further down. That way it 645*77453882SBenjamin Herrenschmidt * will be set only during the HW flush operation so it is 646*77453882SBenjamin Herrenschmidt * visible to any completions happening during that time. 647*77453882SBenjamin Herrenschmidt */ 648*77453882SBenjamin Herrenschmidt ch->regs[DBDMA_STATUS] |= FLUSH; 649*77453882SBenjamin Herrenschmidt do_flush = true; 650*77453882SBenjamin Herrenschmidt } 651*77453882SBenjamin Herrenschmidt 652*77453882SBenjamin Herrenschmidt /* If either RUN or PAUSE is clear, so should ACTIVE be, 653*77453882SBenjamin Herrenschmidt * otherwise, ACTIVE will be set if we modified RUN, PAUSE or 654*77453882SBenjamin Herrenschmidt * set WAKE. That means that PAUSE was just cleared, RUN was 655*77453882SBenjamin Herrenschmidt * just set or WAKE was just set. 656*77453882SBenjamin Herrenschmidt */ 657*77453882SBenjamin Herrenschmidt if ((status & PAUSE) || !(status & RUN)) { 65849ab747fSPaolo Bonzini status &= ~ACTIVE; 659*77453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " -> ACTIVE down !\n"); 660*77453882SBenjamin Herrenschmidt 661*77453882SBenjamin Herrenschmidt /* We stopped processing, we want the underlying HW command 662*77453882SBenjamin Herrenschmidt * to complete *before* we clear the ACTIVE bit. Otherwise 663*77453882SBenjamin Herrenschmidt * we can get into a situation where the command status will 664*77453882SBenjamin Herrenschmidt * have RUN or ACTIVE not set which is going to confuse the 665*77453882SBenjamin Herrenschmidt * MacOS driver. 666*77453882SBenjamin Herrenschmidt */ 667*77453882SBenjamin Herrenschmidt do_flush = true; 668*77453882SBenjamin Herrenschmidt } else if (mask & (RUN | PAUSE)) { 669*77453882SBenjamin Herrenschmidt status |= ACTIVE; 670*77453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " -> ACTIVE up !\n"); 671*77453882SBenjamin Herrenschmidt } else if ((mask & WAKE) && (value & WAKE)) { 672*77453882SBenjamin Herrenschmidt status |= ACTIVE; 673*77453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " -> ACTIVE up !\n"); 6741cde732dSMark Cave-Ayland } 6751cde732dSMark Cave-Ayland 676*77453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " new status=0x%08x\n", status); 677*77453882SBenjamin Herrenschmidt 678*77453882SBenjamin Herrenschmidt /* If we need to flush the underlying HW, do it now, this happens 679*77453882SBenjamin Herrenschmidt * both on FLUSH commands and when stopping the channel for safety. 680*77453882SBenjamin Herrenschmidt */ 681*77453882SBenjamin Herrenschmidt if (do_flush && ch->flush) { 68249ab747fSPaolo Bonzini ch->flush(&ch->io); 68349ab747fSPaolo Bonzini } 68449ab747fSPaolo Bonzini 685*77453882SBenjamin Herrenschmidt /* Finally update the status register image */ 68649ab747fSPaolo Bonzini ch->regs[DBDMA_STATUS] = status; 68749ab747fSPaolo Bonzini 688*77453882SBenjamin Herrenschmidt /* If active, make sure the BH gets to run */ 689d2f0ce21SAlexander Graf if (status & ACTIVE) { 690d2f0ce21SAlexander Graf DBDMA_kick(dbdma_from_ch(ch)); 691d2f0ce21SAlexander Graf } 692d2f0ce21SAlexander Graf } 69349ab747fSPaolo Bonzini 69449ab747fSPaolo Bonzini static void dbdma_write(void *opaque, hwaddr addr, 69549ab747fSPaolo Bonzini uint64_t value, unsigned size) 69649ab747fSPaolo Bonzini { 69749ab747fSPaolo Bonzini int channel = addr >> DBDMA_CHANNEL_SHIFT; 69849ab747fSPaolo Bonzini DBDMAState *s = opaque; 69949ab747fSPaolo Bonzini DBDMA_channel *ch = &s->channels[channel]; 70049ab747fSPaolo Bonzini int reg = (addr - (channel << DBDMA_CHANNEL_SHIFT)) >> 2; 70149ab747fSPaolo Bonzini 7023e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "writel 0x" TARGET_FMT_plx " <= 0x%08"PRIx64"\n", 70358c0c311SAlexander Graf addr, value); 7043e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "channel 0x%x reg 0x%x\n", 70549ab747fSPaolo Bonzini (uint32_t)addr >> DBDMA_CHANNEL_SHIFT, reg); 70649ab747fSPaolo Bonzini 7077eaba824SAlexander Graf /* cmdptr cannot be modified if channel is ACTIVE */ 70849ab747fSPaolo Bonzini 7097eaba824SAlexander Graf if (reg == DBDMA_CMDPTR_LO && (ch->regs[DBDMA_STATUS] & ACTIVE)) { 71049ab747fSPaolo Bonzini return; 7117eaba824SAlexander Graf } 71249ab747fSPaolo Bonzini 71349ab747fSPaolo Bonzini ch->regs[reg] = value; 71449ab747fSPaolo Bonzini 71549ab747fSPaolo Bonzini switch(reg) { 71649ab747fSPaolo Bonzini case DBDMA_CONTROL: 71749ab747fSPaolo Bonzini dbdma_control_write(ch); 71849ab747fSPaolo Bonzini break; 71949ab747fSPaolo Bonzini case DBDMA_CMDPTR_LO: 72049ab747fSPaolo Bonzini /* 16-byte aligned */ 72149ab747fSPaolo Bonzini ch->regs[DBDMA_CMDPTR_LO] &= ~0xf; 72249ab747fSPaolo Bonzini dbdma_cmdptr_load(ch); 72349ab747fSPaolo Bonzini break; 72449ab747fSPaolo Bonzini case DBDMA_STATUS: 72549ab747fSPaolo Bonzini case DBDMA_INTR_SEL: 72649ab747fSPaolo Bonzini case DBDMA_BRANCH_SEL: 72749ab747fSPaolo Bonzini case DBDMA_WAIT_SEL: 72849ab747fSPaolo Bonzini /* nothing to do */ 72949ab747fSPaolo Bonzini break; 73049ab747fSPaolo Bonzini case DBDMA_XFER_MODE: 73149ab747fSPaolo Bonzini case DBDMA_CMDPTR_HI: 73249ab747fSPaolo Bonzini case DBDMA_DATA2PTR_HI: 73349ab747fSPaolo Bonzini case DBDMA_DATA2PTR_LO: 73449ab747fSPaolo Bonzini case DBDMA_ADDRESS_HI: 73549ab747fSPaolo Bonzini case DBDMA_BRANCH_ADDR_HI: 73649ab747fSPaolo Bonzini case DBDMA_RES1: 73749ab747fSPaolo Bonzini case DBDMA_RES2: 73849ab747fSPaolo Bonzini case DBDMA_RES3: 73949ab747fSPaolo Bonzini case DBDMA_RES4: 74049ab747fSPaolo Bonzini /* unused */ 74149ab747fSPaolo Bonzini break; 74249ab747fSPaolo Bonzini } 74349ab747fSPaolo Bonzini } 74449ab747fSPaolo Bonzini 74549ab747fSPaolo Bonzini static uint64_t dbdma_read(void *opaque, hwaddr addr, 74649ab747fSPaolo Bonzini unsigned size) 74749ab747fSPaolo Bonzini { 74849ab747fSPaolo Bonzini uint32_t value; 74949ab747fSPaolo Bonzini int channel = addr >> DBDMA_CHANNEL_SHIFT; 75049ab747fSPaolo Bonzini DBDMAState *s = opaque; 75149ab747fSPaolo Bonzini DBDMA_channel *ch = &s->channels[channel]; 75249ab747fSPaolo Bonzini int reg = (addr - (channel << DBDMA_CHANNEL_SHIFT)) >> 2; 75349ab747fSPaolo Bonzini 75449ab747fSPaolo Bonzini value = ch->regs[reg]; 75549ab747fSPaolo Bonzini 75649ab747fSPaolo Bonzini switch(reg) { 75749ab747fSPaolo Bonzini case DBDMA_CONTROL: 758*77453882SBenjamin Herrenschmidt value = ch->regs[DBDMA_STATUS]; 75949ab747fSPaolo Bonzini break; 76049ab747fSPaolo Bonzini case DBDMA_STATUS: 76149ab747fSPaolo Bonzini case DBDMA_CMDPTR_LO: 76249ab747fSPaolo Bonzini case DBDMA_INTR_SEL: 76349ab747fSPaolo Bonzini case DBDMA_BRANCH_SEL: 76449ab747fSPaolo Bonzini case DBDMA_WAIT_SEL: 76549ab747fSPaolo Bonzini /* nothing to do */ 76649ab747fSPaolo Bonzini break; 76749ab747fSPaolo Bonzini case DBDMA_XFER_MODE: 76849ab747fSPaolo Bonzini case DBDMA_CMDPTR_HI: 76949ab747fSPaolo Bonzini case DBDMA_DATA2PTR_HI: 77049ab747fSPaolo Bonzini case DBDMA_DATA2PTR_LO: 77149ab747fSPaolo Bonzini case DBDMA_ADDRESS_HI: 77249ab747fSPaolo Bonzini case DBDMA_BRANCH_ADDR_HI: 77349ab747fSPaolo Bonzini /* unused */ 77449ab747fSPaolo Bonzini value = 0; 77549ab747fSPaolo Bonzini break; 77649ab747fSPaolo Bonzini case DBDMA_RES1: 77749ab747fSPaolo Bonzini case DBDMA_RES2: 77849ab747fSPaolo Bonzini case DBDMA_RES3: 77949ab747fSPaolo Bonzini case DBDMA_RES4: 78049ab747fSPaolo Bonzini /* reserved */ 78149ab747fSPaolo Bonzini break; 78249ab747fSPaolo Bonzini } 78349ab747fSPaolo Bonzini 784*77453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, "readl 0x" TARGET_FMT_plx " => 0x%08x\n", addr, value); 785*77453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, "channel 0x%x reg 0x%x\n", 786*77453882SBenjamin Herrenschmidt (uint32_t)addr >> DBDMA_CHANNEL_SHIFT, reg); 787*77453882SBenjamin Herrenschmidt 78849ab747fSPaolo Bonzini return value; 78949ab747fSPaolo Bonzini } 79049ab747fSPaolo Bonzini 79149ab747fSPaolo Bonzini static const MemoryRegionOps dbdma_ops = { 79249ab747fSPaolo Bonzini .read = dbdma_read, 79349ab747fSPaolo Bonzini .write = dbdma_write, 79449ab747fSPaolo Bonzini .endianness = DEVICE_LITTLE_ENDIAN, 79549ab747fSPaolo Bonzini .valid = { 79649ab747fSPaolo Bonzini .min_access_size = 4, 79749ab747fSPaolo Bonzini .max_access_size = 4, 79849ab747fSPaolo Bonzini }, 79949ab747fSPaolo Bonzini }; 80049ab747fSPaolo Bonzini 801627be2f2SMark Cave-Ayland static const VMStateDescription vmstate_dbdma_io = { 802627be2f2SMark Cave-Ayland .name = "dbdma_io", 80349ab747fSPaolo Bonzini .version_id = 0, 80449ab747fSPaolo Bonzini .minimum_version_id = 0, 80549ab747fSPaolo Bonzini .fields = (VMStateField[]) { 806627be2f2SMark Cave-Ayland VMSTATE_UINT64(addr, struct DBDMA_io), 807627be2f2SMark Cave-Ayland VMSTATE_INT32(len, struct DBDMA_io), 808627be2f2SMark Cave-Ayland VMSTATE_INT32(is_last, struct DBDMA_io), 809627be2f2SMark Cave-Ayland VMSTATE_INT32(is_dma_out, struct DBDMA_io), 810627be2f2SMark Cave-Ayland VMSTATE_BOOL(processing, struct DBDMA_io), 811627be2f2SMark Cave-Ayland VMSTATE_END_OF_LIST() 812627be2f2SMark Cave-Ayland } 813627be2f2SMark Cave-Ayland }; 814627be2f2SMark Cave-Ayland 815627be2f2SMark Cave-Ayland static const VMStateDescription vmstate_dbdma_cmd = { 816627be2f2SMark Cave-Ayland .name = "dbdma_cmd", 817627be2f2SMark Cave-Ayland .version_id = 0, 818627be2f2SMark Cave-Ayland .minimum_version_id = 0, 819627be2f2SMark Cave-Ayland .fields = (VMStateField[]) { 820627be2f2SMark Cave-Ayland VMSTATE_UINT16(req_count, dbdma_cmd), 821627be2f2SMark Cave-Ayland VMSTATE_UINT16(command, dbdma_cmd), 822627be2f2SMark Cave-Ayland VMSTATE_UINT32(phy_addr, dbdma_cmd), 823627be2f2SMark Cave-Ayland VMSTATE_UINT32(cmd_dep, dbdma_cmd), 824627be2f2SMark Cave-Ayland VMSTATE_UINT16(res_count, dbdma_cmd), 825627be2f2SMark Cave-Ayland VMSTATE_UINT16(xfer_status, dbdma_cmd), 826627be2f2SMark Cave-Ayland VMSTATE_END_OF_LIST() 827627be2f2SMark Cave-Ayland } 828627be2f2SMark Cave-Ayland }; 829627be2f2SMark Cave-Ayland 830627be2f2SMark Cave-Ayland static const VMStateDescription vmstate_dbdma_channel = { 831627be2f2SMark Cave-Ayland .name = "dbdma_channel", 832627be2f2SMark Cave-Ayland .version_id = 1, 833627be2f2SMark Cave-Ayland .minimum_version_id = 1, 834627be2f2SMark Cave-Ayland .fields = (VMStateField[]) { 83549ab747fSPaolo Bonzini VMSTATE_UINT32_ARRAY(regs, struct DBDMA_channel, DBDMA_REGS), 836627be2f2SMark Cave-Ayland VMSTATE_STRUCT(io, struct DBDMA_channel, 0, vmstate_dbdma_io, DBDMA_io), 837627be2f2SMark Cave-Ayland VMSTATE_STRUCT(current, struct DBDMA_channel, 0, vmstate_dbdma_cmd, 838627be2f2SMark Cave-Ayland dbdma_cmd), 83949ab747fSPaolo Bonzini VMSTATE_END_OF_LIST() 84049ab747fSPaolo Bonzini } 84149ab747fSPaolo Bonzini }; 84249ab747fSPaolo Bonzini 84349ab747fSPaolo Bonzini static const VMStateDescription vmstate_dbdma = { 84449ab747fSPaolo Bonzini .name = "dbdma", 845627be2f2SMark Cave-Ayland .version_id = 3, 846627be2f2SMark Cave-Ayland .minimum_version_id = 3, 84749ab747fSPaolo Bonzini .fields = (VMStateField[]) { 84849ab747fSPaolo Bonzini VMSTATE_STRUCT_ARRAY(channels, DBDMAState, DBDMA_CHANNELS, 1, 84949ab747fSPaolo Bonzini vmstate_dbdma_channel, DBDMA_channel), 85049ab747fSPaolo Bonzini VMSTATE_END_OF_LIST() 85149ab747fSPaolo Bonzini } 85249ab747fSPaolo Bonzini }; 85349ab747fSPaolo Bonzini 85449ab747fSPaolo Bonzini static void dbdma_reset(void *opaque) 85549ab747fSPaolo Bonzini { 85649ab747fSPaolo Bonzini DBDMAState *s = opaque; 85749ab747fSPaolo Bonzini int i; 85849ab747fSPaolo Bonzini 85949ab747fSPaolo Bonzini for (i = 0; i < DBDMA_CHANNELS; i++) 86049ab747fSPaolo Bonzini memset(s->channels[i].regs, 0, DBDMA_SIZE); 86149ab747fSPaolo Bonzini } 86249ab747fSPaolo Bonzini 8632d7d06d8SHervé Poussineau static void dbdma_unassigned_rw(DBDMA_io *io) 8642d7d06d8SHervé Poussineau { 8652d7d06d8SHervé Poussineau DBDMA_channel *ch = io->channel; 866*77453882SBenjamin Herrenschmidt dbdma_cmd *current = &ch->current; 867*77453882SBenjamin Herrenschmidt uint16_t cmd; 8682d7d06d8SHervé Poussineau qemu_log_mask(LOG_GUEST_ERROR, "%s: use of unassigned channel %d\n", 8692d7d06d8SHervé Poussineau __func__, ch->channel); 8702df77896SMark Cave-Ayland ch->io.processing = false; 871*77453882SBenjamin Herrenschmidt 872*77453882SBenjamin Herrenschmidt cmd = le16_to_cpu(current->command) & COMMAND_MASK; 873*77453882SBenjamin Herrenschmidt if (cmd == OUTPUT_MORE || cmd == OUTPUT_LAST || 874*77453882SBenjamin Herrenschmidt cmd == INPUT_MORE || cmd == INPUT_LAST) { 875*77453882SBenjamin Herrenschmidt current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]); 876*77453882SBenjamin Herrenschmidt current->res_count = cpu_to_le16(io->len); 877*77453882SBenjamin Herrenschmidt dbdma_cmdptr_save(ch); 878*77453882SBenjamin Herrenschmidt } 8792d7d06d8SHervé Poussineau } 8802d7d06d8SHervé Poussineau 8812d7d06d8SHervé Poussineau static void dbdma_unassigned_flush(DBDMA_io *io) 8822d7d06d8SHervé Poussineau { 8832d7d06d8SHervé Poussineau DBDMA_channel *ch = io->channel; 8842d7d06d8SHervé Poussineau qemu_log_mask(LOG_GUEST_ERROR, "%s: use of unassigned channel %d\n", 8852d7d06d8SHervé Poussineau __func__, ch->channel); 8862d7d06d8SHervé Poussineau } 8872d7d06d8SHervé Poussineau 88849ab747fSPaolo Bonzini void* DBDMA_init (MemoryRegion **dbdma_mem) 88949ab747fSPaolo Bonzini { 89049ab747fSPaolo Bonzini DBDMAState *s; 8913e300fa6SAlexander Graf int i; 89249ab747fSPaolo Bonzini 89349ab747fSPaolo Bonzini s = g_malloc0(sizeof(DBDMAState)); 89449ab747fSPaolo Bonzini 8953e300fa6SAlexander Graf for (i = 0; i < DBDMA_CHANNELS; i++) { 8963e300fa6SAlexander Graf DBDMA_io *io = &s->channels[i].io; 8972d7d06d8SHervé Poussineau DBDMA_channel *ch = &s->channels[i]; 8983e300fa6SAlexander Graf qemu_iovec_init(&io->iov, 1); 8992d7d06d8SHervé Poussineau 9002d7d06d8SHervé Poussineau ch->rw = dbdma_unassigned_rw; 9012d7d06d8SHervé Poussineau ch->flush = dbdma_unassigned_flush; 9022d7d06d8SHervé Poussineau ch->channel = i; 9032d7d06d8SHervé Poussineau ch->io.channel = ch; 9043e300fa6SAlexander Graf } 9053e300fa6SAlexander Graf 9062c9b15caSPaolo Bonzini memory_region_init_io(&s->mem, NULL, &dbdma_ops, s, "dbdma", 0x1000); 90749ab747fSPaolo Bonzini *dbdma_mem = &s->mem; 90849ab747fSPaolo Bonzini vmstate_register(NULL, -1, &vmstate_dbdma, s); 90949ab747fSPaolo Bonzini qemu_register_reset(dbdma_reset, s); 91049ab747fSPaolo Bonzini 911d2f0ce21SAlexander Graf s->bh = qemu_bh_new(DBDMA_run_bh, s); 91249ab747fSPaolo Bonzini 91349ab747fSPaolo Bonzini return s; 91449ab747fSPaolo Bonzini } 915