13cbee15bSj_mayer /* 23cbee15bSj_mayer * PowerMac descriptor-based DMA emulation 33cbee15bSj_mayer * 43cbee15bSj_mayer * Copyright (c) 2005-2007 Fabrice Bellard 53cbee15bSj_mayer * Copyright (c) 2007 Jocelyn Mayer 628ce5ce6Saurel32 * Copyright (c) 2009 Laurent Vivier 728ce5ce6Saurel32 * 828ce5ce6Saurel32 * some parts from linux-2.6.28, arch/powerpc/include/asm/dbdma.h 928ce5ce6Saurel32 * 1028ce5ce6Saurel32 * Definitions for using the Apple Descriptor-Based DMA controller 1128ce5ce6Saurel32 * in Power Macintosh computers. 1228ce5ce6Saurel32 * 1328ce5ce6Saurel32 * Copyright (C) 1996 Paul Mackerras. 1428ce5ce6Saurel32 * 1528ce5ce6Saurel32 * some parts from mol 0.9.71 1628ce5ce6Saurel32 * 1728ce5ce6Saurel32 * Descriptor based DMA emulation 1828ce5ce6Saurel32 * 1928ce5ce6Saurel32 * Copyright (C) 1998-2004 Samuel Rydh (samuel@ibrium.se) 203cbee15bSj_mayer * 213cbee15bSj_mayer * Permission is hereby granted, free of charge, to any person obtaining a copy 223cbee15bSj_mayer * of this software and associated documentation files (the "Software"), to deal 233cbee15bSj_mayer * in the Software without restriction, including without limitation the rights 243cbee15bSj_mayer * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell 253cbee15bSj_mayer * copies of the Software, and to permit persons to whom the Software is 263cbee15bSj_mayer * furnished to do so, subject to the following conditions: 273cbee15bSj_mayer * 283cbee15bSj_mayer * The above copyright notice and this permission notice shall be included in 293cbee15bSj_mayer * all copies or substantial portions of the Software. 303cbee15bSj_mayer * 313cbee15bSj_mayer * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR 323cbee15bSj_mayer * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, 333cbee15bSj_mayer * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL 343cbee15bSj_mayer * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER 353cbee15bSj_mayer * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, 363cbee15bSj_mayer * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN 373cbee15bSj_mayer * THE SOFTWARE. 383cbee15bSj_mayer */ 390b8fa32fSMarkus Armbruster 400d75590dSPeter Maydell #include "qemu/osdep.h" 4183c9f4caSPaolo Bonzini #include "hw/hw.h" 4264552b6bSMarkus Armbruster #include "hw/irq.h" 430d09e41aSPaolo Bonzini #include "hw/ppc/mac_dbdma.h" 44*d6454270SMarkus Armbruster #include "migration/vmstate.h" 451de7afc9SPaolo Bonzini #include "qemu/main-loop.h" 460b8fa32fSMarkus Armbruster #include "qemu/module.h" 4703dd024fSPaolo Bonzini #include "qemu/log.h" 4888655881SMark Cave-Ayland #include "sysemu/dma.h" 493cbee15bSj_mayer 50ea026b2fSblueswir1 /* debug DBDMA */ 51ba0b17ddSMark Cave-Ayland #define DEBUG_DBDMA 0 523e49c439SMark Cave-Ayland #define DEBUG_DBDMA_CHANMASK ((1ull << DBDMA_CHANNELS) - 1) 53ea026b2fSblueswir1 54ba0b17ddSMark Cave-Ayland #define DBDMA_DPRINTF(fmt, ...) do { \ 55ba0b17ddSMark Cave-Ayland if (DEBUG_DBDMA) { \ 56ba0b17ddSMark Cave-Ayland printf("DBDMA: " fmt , ## __VA_ARGS__); \ 57ba0b17ddSMark Cave-Ayland } \ 582562755eSEric Blake } while (0) 59ea026b2fSblueswir1 603e49c439SMark Cave-Ayland #define DBDMA_DPRINTFCH(ch, fmt, ...) do { \ 613e49c439SMark Cave-Ayland if (DEBUG_DBDMA) { \ 623e49c439SMark Cave-Ayland if ((1ul << (ch)->channel) & DEBUG_DBDMA_CHANMASK) { \ 633e49c439SMark Cave-Ayland printf("DBDMA[%02x]: " fmt , (ch)->channel, ## __VA_ARGS__); \ 643e49c439SMark Cave-Ayland } \ 653e49c439SMark Cave-Ayland } \ 662562755eSEric Blake } while (0) 673e49c439SMark Cave-Ayland 6828ce5ce6Saurel32 /* 6928ce5ce6Saurel32 */ 703cbee15bSj_mayer 71d2f0ce21SAlexander Graf static DBDMAState *dbdma_from_ch(DBDMA_channel *ch) 72d2f0ce21SAlexander Graf { 73d2f0ce21SAlexander Graf return container_of(ch, DBDMAState, channels[ch->channel]); 74d2f0ce21SAlexander Graf } 75d2f0ce21SAlexander Graf 76ba0b17ddSMark Cave-Ayland #if DEBUG_DBDMA 77b7d67813SMark Cave-Ayland static void dump_dbdma_cmd(DBDMA_channel *ch, dbdma_cmd *cmd) 783cbee15bSj_mayer { 79b7d67813SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "dbdma_cmd %p\n", cmd); 80b7d67813SMark Cave-Ayland DBDMA_DPRINTFCH(ch, " req_count 0x%04x\n", le16_to_cpu(cmd->req_count)); 81b7d67813SMark Cave-Ayland DBDMA_DPRINTFCH(ch, " command 0x%04x\n", le16_to_cpu(cmd->command)); 82b7d67813SMark Cave-Ayland DBDMA_DPRINTFCH(ch, " phy_addr 0x%08x\n", le32_to_cpu(cmd->phy_addr)); 83b7d67813SMark Cave-Ayland DBDMA_DPRINTFCH(ch, " cmd_dep 0x%08x\n", le32_to_cpu(cmd->cmd_dep)); 84b7d67813SMark Cave-Ayland DBDMA_DPRINTFCH(ch, " res_count 0x%04x\n", le16_to_cpu(cmd->res_count)); 85b7d67813SMark Cave-Ayland DBDMA_DPRINTFCH(ch, " xfer_status 0x%04x\n", 86b7d67813SMark Cave-Ayland le16_to_cpu(cmd->xfer_status)); 8728ce5ce6Saurel32 } 8828ce5ce6Saurel32 #else 89b7d67813SMark Cave-Ayland static void dump_dbdma_cmd(DBDMA_channel *ch, dbdma_cmd *cmd) 9028ce5ce6Saurel32 { 9128ce5ce6Saurel32 } 9228ce5ce6Saurel32 #endif 9328ce5ce6Saurel32 static void dbdma_cmdptr_load(DBDMA_channel *ch) 9428ce5ce6Saurel32 { 953e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "dbdma_cmdptr_load 0x%08x\n", 96ad674e53SAurelien Jarno ch->regs[DBDMA_CMDPTR_LO]); 9788655881SMark Cave-Ayland dma_memory_read(&address_space_memory, ch->regs[DBDMA_CMDPTR_LO], 98e1fe50dcSStefan Weil &ch->current, sizeof(dbdma_cmd)); 993cbee15bSj_mayer } 1003cbee15bSj_mayer 10128ce5ce6Saurel32 static void dbdma_cmdptr_save(DBDMA_channel *ch) 1023cbee15bSj_mayer { 10377453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, "-> update 0x%08x stat=0x%08x, res=0x%04x\n", 10477453882SBenjamin Herrenschmidt ch->regs[DBDMA_CMDPTR_LO], 10528ce5ce6Saurel32 le16_to_cpu(ch->current.xfer_status), 10628ce5ce6Saurel32 le16_to_cpu(ch->current.res_count)); 10788655881SMark Cave-Ayland dma_memory_write(&address_space_memory, ch->regs[DBDMA_CMDPTR_LO], 108e1fe50dcSStefan Weil &ch->current, sizeof(dbdma_cmd)); 10928ce5ce6Saurel32 } 11028ce5ce6Saurel32 11128ce5ce6Saurel32 static void kill_channel(DBDMA_channel *ch) 11228ce5ce6Saurel32 { 1133e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "kill_channel\n"); 11428ce5ce6Saurel32 115ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] |= DEAD; 116ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] &= ~ACTIVE; 11728ce5ce6Saurel32 11828ce5ce6Saurel32 qemu_irq_raise(ch->irq); 11928ce5ce6Saurel32 } 12028ce5ce6Saurel32 12128ce5ce6Saurel32 static void conditional_interrupt(DBDMA_channel *ch) 12228ce5ce6Saurel32 { 12328ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 12428ce5ce6Saurel32 uint16_t intr; 12528ce5ce6Saurel32 uint16_t sel_mask, sel_value; 12628ce5ce6Saurel32 uint32_t status; 12728ce5ce6Saurel32 int cond; 12828ce5ce6Saurel32 1293e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "%s\n", __func__); 13028ce5ce6Saurel32 131b42ec42dSaurel32 intr = le16_to_cpu(current->command) & INTR_MASK; 13228ce5ce6Saurel32 13328ce5ce6Saurel32 switch(intr) { 13428ce5ce6Saurel32 case INTR_NEVER: /* don't interrupt */ 13528ce5ce6Saurel32 return; 13628ce5ce6Saurel32 case INTR_ALWAYS: /* always interrupt */ 13728ce5ce6Saurel32 qemu_irq_raise(ch->irq); 1383e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "%s: raise\n", __func__); 13928ce5ce6Saurel32 return; 14028ce5ce6Saurel32 } 14128ce5ce6Saurel32 142ad674e53SAurelien Jarno status = ch->regs[DBDMA_STATUS] & DEVSTAT; 14328ce5ce6Saurel32 144ad674e53SAurelien Jarno sel_mask = (ch->regs[DBDMA_INTR_SEL] >> 16) & 0x0f; 145ad674e53SAurelien Jarno sel_value = ch->regs[DBDMA_INTR_SEL] & 0x0f; 14628ce5ce6Saurel32 14728ce5ce6Saurel32 cond = (status & sel_mask) == (sel_value & sel_mask); 14828ce5ce6Saurel32 14928ce5ce6Saurel32 switch(intr) { 15028ce5ce6Saurel32 case INTR_IFSET: /* intr if condition bit is 1 */ 15133ce36bbSAlexander Graf if (cond) { 15228ce5ce6Saurel32 qemu_irq_raise(ch->irq); 1533e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "%s: raise\n", __func__); 15433ce36bbSAlexander Graf } 15528ce5ce6Saurel32 return; 15628ce5ce6Saurel32 case INTR_IFCLR: /* intr if condition bit is 0 */ 15733ce36bbSAlexander Graf if (!cond) { 15828ce5ce6Saurel32 qemu_irq_raise(ch->irq); 1593e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "%s: raise\n", __func__); 16033ce36bbSAlexander Graf } 16128ce5ce6Saurel32 return; 16228ce5ce6Saurel32 } 16328ce5ce6Saurel32 } 16428ce5ce6Saurel32 16528ce5ce6Saurel32 static int conditional_wait(DBDMA_channel *ch) 16628ce5ce6Saurel32 { 16728ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 16828ce5ce6Saurel32 uint16_t wait; 16928ce5ce6Saurel32 uint16_t sel_mask, sel_value; 17028ce5ce6Saurel32 uint32_t status; 17128ce5ce6Saurel32 int cond; 17277453882SBenjamin Herrenschmidt int res = 0; 17328ce5ce6Saurel32 174b42ec42dSaurel32 wait = le16_to_cpu(current->command) & WAIT_MASK; 17528ce5ce6Saurel32 switch(wait) { 17628ce5ce6Saurel32 case WAIT_NEVER: /* don't wait */ 17728ce5ce6Saurel32 return 0; 17828ce5ce6Saurel32 case WAIT_ALWAYS: /* always wait */ 17977453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " [WAIT_ALWAYS]\n"); 18028ce5ce6Saurel32 return 1; 18128ce5ce6Saurel32 } 18228ce5ce6Saurel32 183ad674e53SAurelien Jarno status = ch->regs[DBDMA_STATUS] & DEVSTAT; 18428ce5ce6Saurel32 185ad674e53SAurelien Jarno sel_mask = (ch->regs[DBDMA_WAIT_SEL] >> 16) & 0x0f; 186ad674e53SAurelien Jarno sel_value = ch->regs[DBDMA_WAIT_SEL] & 0x0f; 18728ce5ce6Saurel32 18828ce5ce6Saurel32 cond = (status & sel_mask) == (sel_value & sel_mask); 18928ce5ce6Saurel32 19028ce5ce6Saurel32 switch(wait) { 19128ce5ce6Saurel32 case WAIT_IFSET: /* wait if condition bit is 1 */ 19277453882SBenjamin Herrenschmidt if (cond) { 19377453882SBenjamin Herrenschmidt res = 1; 19428ce5ce6Saurel32 } 19577453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " [WAIT_IFSET=%d]\n", res); 19677453882SBenjamin Herrenschmidt break; 19777453882SBenjamin Herrenschmidt case WAIT_IFCLR: /* wait if condition bit is 0 */ 19877453882SBenjamin Herrenschmidt if (!cond) { 19977453882SBenjamin Herrenschmidt res = 1; 20077453882SBenjamin Herrenschmidt } 20177453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " [WAIT_IFCLR=%d]\n", res); 20277453882SBenjamin Herrenschmidt break; 20377453882SBenjamin Herrenschmidt } 20477453882SBenjamin Herrenschmidt return res; 20528ce5ce6Saurel32 } 20628ce5ce6Saurel32 20728ce5ce6Saurel32 static void next(DBDMA_channel *ch) 20828ce5ce6Saurel32 { 20928ce5ce6Saurel32 uint32_t cp; 21028ce5ce6Saurel32 211ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] &= ~BT; 21228ce5ce6Saurel32 213ad674e53SAurelien Jarno cp = ch->regs[DBDMA_CMDPTR_LO]; 214ad674e53SAurelien Jarno ch->regs[DBDMA_CMDPTR_LO] = cp + sizeof(dbdma_cmd); 21528ce5ce6Saurel32 dbdma_cmdptr_load(ch); 21628ce5ce6Saurel32 } 21728ce5ce6Saurel32 21828ce5ce6Saurel32 static void branch(DBDMA_channel *ch) 21928ce5ce6Saurel32 { 22028ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 22128ce5ce6Saurel32 2223f0d4128SMark Cave-Ayland ch->regs[DBDMA_CMDPTR_LO] = le32_to_cpu(current->cmd_dep); 223ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] |= BT; 22428ce5ce6Saurel32 dbdma_cmdptr_load(ch); 22528ce5ce6Saurel32 } 22628ce5ce6Saurel32 22728ce5ce6Saurel32 static void conditional_branch(DBDMA_channel *ch) 22828ce5ce6Saurel32 { 22928ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 23028ce5ce6Saurel32 uint16_t br; 23128ce5ce6Saurel32 uint16_t sel_mask, sel_value; 23228ce5ce6Saurel32 uint32_t status; 23328ce5ce6Saurel32 int cond; 23428ce5ce6Saurel32 23528ce5ce6Saurel32 /* check if we must branch */ 23628ce5ce6Saurel32 237b42ec42dSaurel32 br = le16_to_cpu(current->command) & BR_MASK; 23828ce5ce6Saurel32 23928ce5ce6Saurel32 switch(br) { 24028ce5ce6Saurel32 case BR_NEVER: /* don't branch */ 24128ce5ce6Saurel32 next(ch); 24228ce5ce6Saurel32 return; 24328ce5ce6Saurel32 case BR_ALWAYS: /* always branch */ 24477453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " [BR_ALWAYS]\n"); 24528ce5ce6Saurel32 branch(ch); 24628ce5ce6Saurel32 return; 24728ce5ce6Saurel32 } 24828ce5ce6Saurel32 249ad674e53SAurelien Jarno status = ch->regs[DBDMA_STATUS] & DEVSTAT; 25028ce5ce6Saurel32 251ad674e53SAurelien Jarno sel_mask = (ch->regs[DBDMA_BRANCH_SEL] >> 16) & 0x0f; 252ad674e53SAurelien Jarno sel_value = ch->regs[DBDMA_BRANCH_SEL] & 0x0f; 25328ce5ce6Saurel32 25428ce5ce6Saurel32 cond = (status & sel_mask) == (sel_value & sel_mask); 25528ce5ce6Saurel32 25628ce5ce6Saurel32 switch(br) { 25728ce5ce6Saurel32 case BR_IFSET: /* branch if condition bit is 1 */ 25877453882SBenjamin Herrenschmidt if (cond) { 25977453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " [BR_IFSET = 1]\n"); 26028ce5ce6Saurel32 branch(ch); 26177453882SBenjamin Herrenschmidt } else { 26277453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " [BR_IFSET = 0]\n"); 26328ce5ce6Saurel32 next(ch); 26477453882SBenjamin Herrenschmidt } 26528ce5ce6Saurel32 return; 26628ce5ce6Saurel32 case BR_IFCLR: /* branch if condition bit is 0 */ 26777453882SBenjamin Herrenschmidt if (!cond) { 26877453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " [BR_IFCLR = 1]\n"); 26928ce5ce6Saurel32 branch(ch); 27077453882SBenjamin Herrenschmidt } else { 27177453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " [BR_IFCLR = 0]\n"); 27228ce5ce6Saurel32 next(ch); 27377453882SBenjamin Herrenschmidt } 27428ce5ce6Saurel32 return; 27528ce5ce6Saurel32 } 27628ce5ce6Saurel32 } 27728ce5ce6Saurel32 278b42ec42dSaurel32 static void channel_run(DBDMA_channel *ch); 279b42ec42dSaurel32 280b42ec42dSaurel32 static void dbdma_end(DBDMA_io *io) 28128ce5ce6Saurel32 { 28228ce5ce6Saurel32 DBDMA_channel *ch = io->channel; 28328ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 28428ce5ce6Saurel32 2853e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "%s\n", __func__); 28633ce36bbSAlexander Graf 287b42ec42dSaurel32 if (conditional_wait(ch)) 288b42ec42dSaurel32 goto wait; 28928ce5ce6Saurel32 290ad674e53SAurelien Jarno current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]); 291ad674e53SAurelien Jarno current->res_count = cpu_to_le16(io->len); 292b42ec42dSaurel32 dbdma_cmdptr_save(ch); 293862c9280Saurel32 if (io->is_last) 294ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] &= ~FLUSH; 29528ce5ce6Saurel32 296b42ec42dSaurel32 conditional_interrupt(ch); 297b42ec42dSaurel32 conditional_branch(ch); 298b42ec42dSaurel32 299b42ec42dSaurel32 wait: 30003ee3b1eSAlexander Graf /* Indicate that we're ready for a new DMA round */ 30103ee3b1eSAlexander Graf ch->io.processing = false; 30203ee3b1eSAlexander Graf 303ad674e53SAurelien Jarno if ((ch->regs[DBDMA_STATUS] & RUN) && 304ad674e53SAurelien Jarno (ch->regs[DBDMA_STATUS] & ACTIVE)) 305b42ec42dSaurel32 channel_run(ch); 30628ce5ce6Saurel32 } 30728ce5ce6Saurel32 308b42ec42dSaurel32 static void start_output(DBDMA_channel *ch, int key, uint32_t addr, 30928ce5ce6Saurel32 uint16_t req_count, int is_last) 31028ce5ce6Saurel32 { 3113e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "start_output\n"); 31228ce5ce6Saurel32 31328ce5ce6Saurel32 /* KEY_REGS, KEY_DEVICE and KEY_STREAM 31428ce5ce6Saurel32 * are not implemented in the mac-io chip 31528ce5ce6Saurel32 */ 31628ce5ce6Saurel32 3173e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "addr 0x%x key 0x%x\n", addr, key); 31828ce5ce6Saurel32 if (!addr || key > KEY_STREAM3) { 31928ce5ce6Saurel32 kill_channel(ch); 320b42ec42dSaurel32 return; 32128ce5ce6Saurel32 } 32228ce5ce6Saurel32 323b42ec42dSaurel32 ch->io.addr = addr; 32428ce5ce6Saurel32 ch->io.len = req_count; 32528ce5ce6Saurel32 ch->io.is_last = is_last; 326b42ec42dSaurel32 ch->io.dma_end = dbdma_end; 327b42ec42dSaurel32 ch->io.is_dma_out = 1; 32803ee3b1eSAlexander Graf ch->io.processing = true; 329a9ceb76dSAlexander Graf if (ch->rw) { 330b42ec42dSaurel32 ch->rw(&ch->io); 33128ce5ce6Saurel32 } 332a9ceb76dSAlexander Graf } 33328ce5ce6Saurel32 334b42ec42dSaurel32 static void start_input(DBDMA_channel *ch, int key, uint32_t addr, 33528ce5ce6Saurel32 uint16_t req_count, int is_last) 33628ce5ce6Saurel32 { 3373e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "start_input\n"); 33828ce5ce6Saurel32 33928ce5ce6Saurel32 /* KEY_REGS, KEY_DEVICE and KEY_STREAM 34028ce5ce6Saurel32 * are not implemented in the mac-io chip 34128ce5ce6Saurel32 */ 34228ce5ce6Saurel32 3433e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "addr 0x%x key 0x%x\n", addr, key); 34428ce5ce6Saurel32 if (!addr || key > KEY_STREAM3) { 34528ce5ce6Saurel32 kill_channel(ch); 346b42ec42dSaurel32 return; 34728ce5ce6Saurel32 } 34828ce5ce6Saurel32 349b42ec42dSaurel32 ch->io.addr = addr; 35028ce5ce6Saurel32 ch->io.len = req_count; 35128ce5ce6Saurel32 ch->io.is_last = is_last; 352b42ec42dSaurel32 ch->io.dma_end = dbdma_end; 353b42ec42dSaurel32 ch->io.is_dma_out = 0; 35403ee3b1eSAlexander Graf ch->io.processing = true; 355a9ceb76dSAlexander Graf if (ch->rw) { 356b42ec42dSaurel32 ch->rw(&ch->io); 35728ce5ce6Saurel32 } 358a9ceb76dSAlexander Graf } 35928ce5ce6Saurel32 360b42ec42dSaurel32 static void load_word(DBDMA_channel *ch, int key, uint32_t addr, 36128ce5ce6Saurel32 uint16_t len) 36228ce5ce6Saurel32 { 36328ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 36428ce5ce6Saurel32 365e12f50b9SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "load_word %d bytes, addr=%08x\n", len, addr); 36628ce5ce6Saurel32 36728ce5ce6Saurel32 /* only implements KEY_SYSTEM */ 36828ce5ce6Saurel32 36928ce5ce6Saurel32 if (key != KEY_SYSTEM) { 37028ce5ce6Saurel32 printf("DBDMA: LOAD_WORD, unimplemented key %x\n", key); 37128ce5ce6Saurel32 kill_channel(ch); 372b42ec42dSaurel32 return; 37328ce5ce6Saurel32 } 37428ce5ce6Saurel32 375e12f50b9SMark Cave-Ayland dma_memory_read(&address_space_memory, addr, ¤t->cmd_dep, len); 37628ce5ce6Saurel32 37728ce5ce6Saurel32 if (conditional_wait(ch)) 378b42ec42dSaurel32 goto wait; 37928ce5ce6Saurel32 380ad674e53SAurelien Jarno current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]); 38128ce5ce6Saurel32 dbdma_cmdptr_save(ch); 382ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] &= ~FLUSH; 38328ce5ce6Saurel32 38428ce5ce6Saurel32 conditional_interrupt(ch); 38528ce5ce6Saurel32 next(ch); 38628ce5ce6Saurel32 387b42ec42dSaurel32 wait: 388d2f0ce21SAlexander Graf DBDMA_kick(dbdma_from_ch(ch)); 38928ce5ce6Saurel32 } 39028ce5ce6Saurel32 391b42ec42dSaurel32 static void store_word(DBDMA_channel *ch, int key, uint32_t addr, 39228ce5ce6Saurel32 uint16_t len) 39328ce5ce6Saurel32 { 39428ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 39528ce5ce6Saurel32 396e12f50b9SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "store_word %d bytes, addr=%08x pa=%x\n", 397e12f50b9SMark Cave-Ayland len, addr, le32_to_cpu(current->cmd_dep)); 39828ce5ce6Saurel32 39928ce5ce6Saurel32 /* only implements KEY_SYSTEM */ 40028ce5ce6Saurel32 40128ce5ce6Saurel32 if (key != KEY_SYSTEM) { 40228ce5ce6Saurel32 printf("DBDMA: STORE_WORD, unimplemented key %x\n", key); 40328ce5ce6Saurel32 kill_channel(ch); 404b42ec42dSaurel32 return; 40528ce5ce6Saurel32 } 40628ce5ce6Saurel32 407e12f50b9SMark Cave-Ayland dma_memory_write(&address_space_memory, addr, ¤t->cmd_dep, len); 40828ce5ce6Saurel32 40928ce5ce6Saurel32 if (conditional_wait(ch)) 410b42ec42dSaurel32 goto wait; 41128ce5ce6Saurel32 412ad674e53SAurelien Jarno current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]); 41328ce5ce6Saurel32 dbdma_cmdptr_save(ch); 414ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] &= ~FLUSH; 41528ce5ce6Saurel32 41628ce5ce6Saurel32 conditional_interrupt(ch); 41728ce5ce6Saurel32 next(ch); 41828ce5ce6Saurel32 419b42ec42dSaurel32 wait: 420d2f0ce21SAlexander Graf DBDMA_kick(dbdma_from_ch(ch)); 42128ce5ce6Saurel32 } 42228ce5ce6Saurel32 423b42ec42dSaurel32 static void nop(DBDMA_channel *ch) 42428ce5ce6Saurel32 { 42528ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 42628ce5ce6Saurel32 42728ce5ce6Saurel32 if (conditional_wait(ch)) 428b42ec42dSaurel32 goto wait; 42928ce5ce6Saurel32 430ad674e53SAurelien Jarno current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]); 43128ce5ce6Saurel32 dbdma_cmdptr_save(ch); 43228ce5ce6Saurel32 43328ce5ce6Saurel32 conditional_interrupt(ch); 43428ce5ce6Saurel32 conditional_branch(ch); 43528ce5ce6Saurel32 436b42ec42dSaurel32 wait: 437d2f0ce21SAlexander Graf DBDMA_kick(dbdma_from_ch(ch)); 43828ce5ce6Saurel32 } 43928ce5ce6Saurel32 440b42ec42dSaurel32 static void stop(DBDMA_channel *ch) 44128ce5ce6Saurel32 { 44277453882SBenjamin Herrenschmidt ch->regs[DBDMA_STATUS] &= ~(ACTIVE); 44328ce5ce6Saurel32 44428ce5ce6Saurel32 /* the stop command does not increment command pointer */ 44528ce5ce6Saurel32 } 44628ce5ce6Saurel32 447b42ec42dSaurel32 static void channel_run(DBDMA_channel *ch) 44828ce5ce6Saurel32 { 44928ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 45028ce5ce6Saurel32 uint16_t cmd, key; 45128ce5ce6Saurel32 uint16_t req_count; 45228ce5ce6Saurel32 uint32_t phy_addr; 45328ce5ce6Saurel32 4543e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "channel_run\n"); 455b7d67813SMark Cave-Ayland dump_dbdma_cmd(ch, current); 45628ce5ce6Saurel32 45728ce5ce6Saurel32 /* clear WAKE flag at command fetch */ 45828ce5ce6Saurel32 459ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] &= ~WAKE; 46028ce5ce6Saurel32 46128ce5ce6Saurel32 cmd = le16_to_cpu(current->command) & COMMAND_MASK; 46228ce5ce6Saurel32 46328ce5ce6Saurel32 switch (cmd) { 46428ce5ce6Saurel32 case DBDMA_NOP: 465b42ec42dSaurel32 nop(ch); 466b42ec42dSaurel32 return; 46728ce5ce6Saurel32 46828ce5ce6Saurel32 case DBDMA_STOP: 469b42ec42dSaurel32 stop(ch); 470b42ec42dSaurel32 return; 47128ce5ce6Saurel32 } 47228ce5ce6Saurel32 47328ce5ce6Saurel32 key = le16_to_cpu(current->command) & 0x0700; 47428ce5ce6Saurel32 req_count = le16_to_cpu(current->req_count); 47528ce5ce6Saurel32 phy_addr = le32_to_cpu(current->phy_addr); 47628ce5ce6Saurel32 47728ce5ce6Saurel32 if (key == KEY_STREAM4) { 47828ce5ce6Saurel32 printf("command %x, invalid key 4\n", cmd); 47928ce5ce6Saurel32 kill_channel(ch); 480b42ec42dSaurel32 return; 48128ce5ce6Saurel32 } 48228ce5ce6Saurel32 48328ce5ce6Saurel32 switch (cmd) { 48428ce5ce6Saurel32 case OUTPUT_MORE: 48577453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, "* OUTPUT_MORE *\n"); 486b42ec42dSaurel32 start_output(ch, key, phy_addr, req_count, 0); 487b42ec42dSaurel32 return; 48828ce5ce6Saurel32 48928ce5ce6Saurel32 case OUTPUT_LAST: 49077453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, "* OUTPUT_LAST *\n"); 491b42ec42dSaurel32 start_output(ch, key, phy_addr, req_count, 1); 492b42ec42dSaurel32 return; 49328ce5ce6Saurel32 49428ce5ce6Saurel32 case INPUT_MORE: 49577453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, "* INPUT_MORE *\n"); 496b42ec42dSaurel32 start_input(ch, key, phy_addr, req_count, 0); 497b42ec42dSaurel32 return; 49828ce5ce6Saurel32 49928ce5ce6Saurel32 case INPUT_LAST: 50077453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, "* INPUT_LAST *\n"); 501b42ec42dSaurel32 start_input(ch, key, phy_addr, req_count, 1); 502b42ec42dSaurel32 return; 50328ce5ce6Saurel32 } 50428ce5ce6Saurel32 50528ce5ce6Saurel32 if (key < KEY_REGS) { 50628ce5ce6Saurel32 printf("command %x, invalid key %x\n", cmd, key); 50728ce5ce6Saurel32 key = KEY_SYSTEM; 50828ce5ce6Saurel32 } 50928ce5ce6Saurel32 51028ce5ce6Saurel32 /* for LOAD_WORD and STORE_WORD, req_count is on 3 bits 51128ce5ce6Saurel32 * and BRANCH is invalid 51228ce5ce6Saurel32 */ 51328ce5ce6Saurel32 51428ce5ce6Saurel32 req_count = req_count & 0x0007; 51528ce5ce6Saurel32 if (req_count & 0x4) { 51628ce5ce6Saurel32 req_count = 4; 51728ce5ce6Saurel32 phy_addr &= ~3; 51828ce5ce6Saurel32 } else if (req_count & 0x2) { 51928ce5ce6Saurel32 req_count = 2; 52028ce5ce6Saurel32 phy_addr &= ~1; 52128ce5ce6Saurel32 } else 52228ce5ce6Saurel32 req_count = 1; 52328ce5ce6Saurel32 52428ce5ce6Saurel32 switch (cmd) { 52528ce5ce6Saurel32 case LOAD_WORD: 52677453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, "* LOAD_WORD *\n"); 527b42ec42dSaurel32 load_word(ch, key, phy_addr, req_count); 528b42ec42dSaurel32 return; 52928ce5ce6Saurel32 53028ce5ce6Saurel32 case STORE_WORD: 53177453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, "* STORE_WORD *\n"); 532b42ec42dSaurel32 store_word(ch, key, phy_addr, req_count); 533b42ec42dSaurel32 return; 53428ce5ce6Saurel32 } 53528ce5ce6Saurel32 } 53628ce5ce6Saurel32 537c20df14bSJuan Quintela static void DBDMA_run(DBDMAState *s) 53828ce5ce6Saurel32 { 53928ce5ce6Saurel32 int channel; 54028ce5ce6Saurel32 541c20df14bSJuan Quintela for (channel = 0; channel < DBDMA_CHANNELS; channel++) { 542c20df14bSJuan Quintela DBDMA_channel *ch = &s->channels[channel]; 543ad674e53SAurelien Jarno uint32_t status = ch->regs[DBDMA_STATUS]; 54403ee3b1eSAlexander Graf if (!ch->io.processing && (status & RUN) && (status & ACTIVE)) { 545b42ec42dSaurel32 channel_run(ch); 54628ce5ce6Saurel32 } 54728ce5ce6Saurel32 } 548c20df14bSJuan Quintela } 54928ce5ce6Saurel32 55028ce5ce6Saurel32 static void DBDMA_run_bh(void *opaque) 55128ce5ce6Saurel32 { 552c20df14bSJuan Quintela DBDMAState *s = opaque; 55328ce5ce6Saurel32 5543e49c439SMark Cave-Ayland DBDMA_DPRINTF("-> DBDMA_run_bh\n"); 555c20df14bSJuan Quintela DBDMA_run(s); 5563e49c439SMark Cave-Ayland DBDMA_DPRINTF("<- DBDMA_run_bh\n"); 55728ce5ce6Saurel32 } 55828ce5ce6Saurel32 559d1e562deSAlexander Graf void DBDMA_kick(DBDMAState *dbdma) 560d1e562deSAlexander Graf { 561d2f0ce21SAlexander Graf qemu_bh_schedule(dbdma->bh); 562d1e562deSAlexander Graf } 563d1e562deSAlexander Graf 56428ce5ce6Saurel32 void DBDMA_register_channel(void *dbdma, int nchan, qemu_irq irq, 565862c9280Saurel32 DBDMA_rw rw, DBDMA_flush flush, 56628ce5ce6Saurel32 void *opaque) 56728ce5ce6Saurel32 { 568c20df14bSJuan Quintela DBDMAState *s = dbdma; 569c20df14bSJuan Quintela DBDMA_channel *ch = &s->channels[nchan]; 57028ce5ce6Saurel32 5713e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "DBDMA_register_channel 0x%x\n", nchan); 57228ce5ce6Saurel32 5732d7d06d8SHervé Poussineau assert(rw); 5742d7d06d8SHervé Poussineau assert(flush); 5752d7d06d8SHervé Poussineau 57628ce5ce6Saurel32 ch->irq = irq; 577b42ec42dSaurel32 ch->rw = rw; 578862c9280Saurel32 ch->flush = flush; 57928ce5ce6Saurel32 ch->io.opaque = opaque; 58028ce5ce6Saurel32 } 58128ce5ce6Saurel32 58277453882SBenjamin Herrenschmidt static void dbdma_control_write(DBDMA_channel *ch) 58328ce5ce6Saurel32 { 58428ce5ce6Saurel32 uint16_t mask, value; 58528ce5ce6Saurel32 uint32_t status; 58677453882SBenjamin Herrenschmidt bool do_flush = false; 58728ce5ce6Saurel32 588ad674e53SAurelien Jarno mask = (ch->regs[DBDMA_CONTROL] >> 16) & 0xffff; 589ad674e53SAurelien Jarno value = ch->regs[DBDMA_CONTROL] & 0xffff; 59028ce5ce6Saurel32 59177453882SBenjamin Herrenschmidt /* This is the status register which we'll update 59277453882SBenjamin Herrenschmidt * appropriately and store back 59377453882SBenjamin Herrenschmidt */ 594ad674e53SAurelien Jarno status = ch->regs[DBDMA_STATUS]; 59528ce5ce6Saurel32 59677453882SBenjamin Herrenschmidt /* RUN and PAUSE are bits under SW control only 59777453882SBenjamin Herrenschmidt * FLUSH and WAKE are set by SW and cleared by HW 59877453882SBenjamin Herrenschmidt * DEAD, ACTIVE and BT are only under HW control 59977453882SBenjamin Herrenschmidt * 60077453882SBenjamin Herrenschmidt * We handle ACTIVE separately at the end of the 60177453882SBenjamin Herrenschmidt * logic to ensure all cases are covered. 60277453882SBenjamin Herrenschmidt */ 60328ce5ce6Saurel32 60477453882SBenjamin Herrenschmidt /* Setting RUN will tentatively activate the channel 60577453882SBenjamin Herrenschmidt */ 60677453882SBenjamin Herrenschmidt if ((mask & RUN) && (value & RUN)) { 60777453882SBenjamin Herrenschmidt status |= RUN; 60877453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " Setting RUN !\n"); 60928ce5ce6Saurel32 } 61077453882SBenjamin Herrenschmidt 61177453882SBenjamin Herrenschmidt /* Clearing RUN 1->0 will stop the channel */ 61277453882SBenjamin Herrenschmidt if ((mask & RUN) && !(value & RUN)) { 61377453882SBenjamin Herrenschmidt /* This has the side effect of clearing the DEAD bit */ 61477453882SBenjamin Herrenschmidt status &= ~(DEAD | RUN); 61577453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " Clearing RUN !\n"); 61677453882SBenjamin Herrenschmidt } 61777453882SBenjamin Herrenschmidt 61877453882SBenjamin Herrenschmidt /* Setting WAKE wakes up an idle channel if it's running 61977453882SBenjamin Herrenschmidt * 62077453882SBenjamin Herrenschmidt * Note: The doc doesn't say so but assume that only works 62177453882SBenjamin Herrenschmidt * on a channel whose RUN bit is set. 62277453882SBenjamin Herrenschmidt * 62377453882SBenjamin Herrenschmidt * We set WAKE in status, it's not terribly useful as it will 62477453882SBenjamin Herrenschmidt * be cleared on the next command fetch but it seems to mimmic 62577453882SBenjamin Herrenschmidt * the HW behaviour and is useful for the way we handle 62677453882SBenjamin Herrenschmidt * ACTIVE further down. 62777453882SBenjamin Herrenschmidt */ 62877453882SBenjamin Herrenschmidt if ((mask & WAKE) && (value & WAKE) && (status & RUN)) { 62977453882SBenjamin Herrenschmidt status |= WAKE; 63077453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " Setting WAKE !\n"); 63177453882SBenjamin Herrenschmidt } 63277453882SBenjamin Herrenschmidt 63377453882SBenjamin Herrenschmidt /* PAUSE being set will deactivate (or prevent activation) 63477453882SBenjamin Herrenschmidt * of the channel. We just copy it over for now, ACTIVE will 63577453882SBenjamin Herrenschmidt * be re-evaluated later. 63677453882SBenjamin Herrenschmidt */ 63777453882SBenjamin Herrenschmidt if (mask & PAUSE) { 63877453882SBenjamin Herrenschmidt status = (status & ~PAUSE) | (value & PAUSE); 63977453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " %sing PAUSE !\n", 64077453882SBenjamin Herrenschmidt (value & PAUSE) ? "sett" : "clear"); 64177453882SBenjamin Herrenschmidt } 64277453882SBenjamin Herrenschmidt 64377453882SBenjamin Herrenschmidt /* FLUSH is its own thing */ 64477453882SBenjamin Herrenschmidt if ((mask & FLUSH) && (value & FLUSH)) { 64577453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " Setting FLUSH !\n"); 64677453882SBenjamin Herrenschmidt /* We set flush directly in the status register, we do *NOT* 64777453882SBenjamin Herrenschmidt * set it in "status" so that it gets naturally cleared when 64877453882SBenjamin Herrenschmidt * we update the status register further down. That way it 64977453882SBenjamin Herrenschmidt * will be set only during the HW flush operation so it is 65077453882SBenjamin Herrenschmidt * visible to any completions happening during that time. 65177453882SBenjamin Herrenschmidt */ 65277453882SBenjamin Herrenschmidt ch->regs[DBDMA_STATUS] |= FLUSH; 65377453882SBenjamin Herrenschmidt do_flush = true; 65477453882SBenjamin Herrenschmidt } 65577453882SBenjamin Herrenschmidt 65677453882SBenjamin Herrenschmidt /* If either RUN or PAUSE is clear, so should ACTIVE be, 65777453882SBenjamin Herrenschmidt * otherwise, ACTIVE will be set if we modified RUN, PAUSE or 65877453882SBenjamin Herrenschmidt * set WAKE. That means that PAUSE was just cleared, RUN was 65977453882SBenjamin Herrenschmidt * just set or WAKE was just set. 66077453882SBenjamin Herrenschmidt */ 66177453882SBenjamin Herrenschmidt if ((status & PAUSE) || !(status & RUN)) { 66228ce5ce6Saurel32 status &= ~ACTIVE; 66377453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " -> ACTIVE down !\n"); 66477453882SBenjamin Herrenschmidt 66577453882SBenjamin Herrenschmidt /* We stopped processing, we want the underlying HW command 66677453882SBenjamin Herrenschmidt * to complete *before* we clear the ACTIVE bit. Otherwise 66777453882SBenjamin Herrenschmidt * we can get into a situation where the command status will 66877453882SBenjamin Herrenschmidt * have RUN or ACTIVE not set which is going to confuse the 66977453882SBenjamin Herrenschmidt * MacOS driver. 67077453882SBenjamin Herrenschmidt */ 67177453882SBenjamin Herrenschmidt do_flush = true; 67277453882SBenjamin Herrenschmidt } else if (mask & (RUN | PAUSE)) { 67377453882SBenjamin Herrenschmidt status |= ACTIVE; 67477453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " -> ACTIVE up !\n"); 67577453882SBenjamin Herrenschmidt } else if ((mask & WAKE) && (value & WAKE)) { 67677453882SBenjamin Herrenschmidt status |= ACTIVE; 67777453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " -> ACTIVE up !\n"); 6781cde732dSMark Cave-Ayland } 6791cde732dSMark Cave-Ayland 68077453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " new status=0x%08x\n", status); 68177453882SBenjamin Herrenschmidt 68277453882SBenjamin Herrenschmidt /* If we need to flush the underlying HW, do it now, this happens 68377453882SBenjamin Herrenschmidt * both on FLUSH commands and when stopping the channel for safety. 68477453882SBenjamin Herrenschmidt */ 68577453882SBenjamin Herrenschmidt if (do_flush && ch->flush) { 686987422bcSAmadeusz Sławiński ch->flush(&ch->io); 687987422bcSAmadeusz Sławiński } 68828ce5ce6Saurel32 68977453882SBenjamin Herrenschmidt /* Finally update the status register image */ 690ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] = status; 69128ce5ce6Saurel32 69277453882SBenjamin Herrenschmidt /* If active, make sure the BH gets to run */ 693d2f0ce21SAlexander Graf if (status & ACTIVE) { 694d2f0ce21SAlexander Graf DBDMA_kick(dbdma_from_ch(ch)); 695d2f0ce21SAlexander Graf } 696d2f0ce21SAlexander Graf } 6973cbee15bSj_mayer 698a8170e5eSAvi Kivity static void dbdma_write(void *opaque, hwaddr addr, 69923c5e4caSAvi Kivity uint64_t value, unsigned size) 7003cbee15bSj_mayer { 70128ce5ce6Saurel32 int channel = addr >> DBDMA_CHANNEL_SHIFT; 702c20df14bSJuan Quintela DBDMAState *s = opaque; 703c20df14bSJuan Quintela DBDMA_channel *ch = &s->channels[channel]; 70428ce5ce6Saurel32 int reg = (addr - (channel << DBDMA_CHANNEL_SHIFT)) >> 2; 70528ce5ce6Saurel32 7063e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "writel 0x" TARGET_FMT_plx " <= 0x%08"PRIx64"\n", 70758c0c311SAlexander Graf addr, value); 7083e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "channel 0x%x reg 0x%x\n", 70928ce5ce6Saurel32 (uint32_t)addr >> DBDMA_CHANNEL_SHIFT, reg); 71028ce5ce6Saurel32 7117eaba824SAlexander Graf /* cmdptr cannot be modified if channel is ACTIVE */ 71228ce5ce6Saurel32 7137eaba824SAlexander Graf if (reg == DBDMA_CMDPTR_LO && (ch->regs[DBDMA_STATUS] & ACTIVE)) { 71428ce5ce6Saurel32 return; 7157eaba824SAlexander Graf } 71628ce5ce6Saurel32 71728ce5ce6Saurel32 ch->regs[reg] = value; 71828ce5ce6Saurel32 71928ce5ce6Saurel32 switch(reg) { 72028ce5ce6Saurel32 case DBDMA_CONTROL: 72128ce5ce6Saurel32 dbdma_control_write(ch); 72228ce5ce6Saurel32 break; 72328ce5ce6Saurel32 case DBDMA_CMDPTR_LO: 72428ce5ce6Saurel32 /* 16-byte aligned */ 725ad674e53SAurelien Jarno ch->regs[DBDMA_CMDPTR_LO] &= ~0xf; 72628ce5ce6Saurel32 dbdma_cmdptr_load(ch); 72728ce5ce6Saurel32 break; 72828ce5ce6Saurel32 case DBDMA_STATUS: 72928ce5ce6Saurel32 case DBDMA_INTR_SEL: 73028ce5ce6Saurel32 case DBDMA_BRANCH_SEL: 73128ce5ce6Saurel32 case DBDMA_WAIT_SEL: 73228ce5ce6Saurel32 /* nothing to do */ 73328ce5ce6Saurel32 break; 73428ce5ce6Saurel32 case DBDMA_XFER_MODE: 73528ce5ce6Saurel32 case DBDMA_CMDPTR_HI: 73628ce5ce6Saurel32 case DBDMA_DATA2PTR_HI: 73728ce5ce6Saurel32 case DBDMA_DATA2PTR_LO: 73828ce5ce6Saurel32 case DBDMA_ADDRESS_HI: 73928ce5ce6Saurel32 case DBDMA_BRANCH_ADDR_HI: 74028ce5ce6Saurel32 case DBDMA_RES1: 74128ce5ce6Saurel32 case DBDMA_RES2: 74228ce5ce6Saurel32 case DBDMA_RES3: 74328ce5ce6Saurel32 case DBDMA_RES4: 74428ce5ce6Saurel32 /* unused */ 74528ce5ce6Saurel32 break; 7463cbee15bSj_mayer } 7473cbee15bSj_mayer } 7483cbee15bSj_mayer 749a8170e5eSAvi Kivity static uint64_t dbdma_read(void *opaque, hwaddr addr, 75023c5e4caSAvi Kivity unsigned size) 7513cbee15bSj_mayer { 75228ce5ce6Saurel32 uint32_t value; 75328ce5ce6Saurel32 int channel = addr >> DBDMA_CHANNEL_SHIFT; 754c20df14bSJuan Quintela DBDMAState *s = opaque; 755c20df14bSJuan Quintela DBDMA_channel *ch = &s->channels[channel]; 75628ce5ce6Saurel32 int reg = (addr - (channel << DBDMA_CHANNEL_SHIFT)) >> 2; 757ea026b2fSblueswir1 75828ce5ce6Saurel32 value = ch->regs[reg]; 75928ce5ce6Saurel32 76028ce5ce6Saurel32 switch(reg) { 76128ce5ce6Saurel32 case DBDMA_CONTROL: 76277453882SBenjamin Herrenschmidt value = ch->regs[DBDMA_STATUS]; 76328ce5ce6Saurel32 break; 76428ce5ce6Saurel32 case DBDMA_STATUS: 76528ce5ce6Saurel32 case DBDMA_CMDPTR_LO: 76628ce5ce6Saurel32 case DBDMA_INTR_SEL: 76728ce5ce6Saurel32 case DBDMA_BRANCH_SEL: 76828ce5ce6Saurel32 case DBDMA_WAIT_SEL: 76928ce5ce6Saurel32 /* nothing to do */ 77028ce5ce6Saurel32 break; 77128ce5ce6Saurel32 case DBDMA_XFER_MODE: 77228ce5ce6Saurel32 case DBDMA_CMDPTR_HI: 77328ce5ce6Saurel32 case DBDMA_DATA2PTR_HI: 77428ce5ce6Saurel32 case DBDMA_DATA2PTR_LO: 77528ce5ce6Saurel32 case DBDMA_ADDRESS_HI: 77628ce5ce6Saurel32 case DBDMA_BRANCH_ADDR_HI: 77728ce5ce6Saurel32 /* unused */ 77828ce5ce6Saurel32 value = 0; 77928ce5ce6Saurel32 break; 78028ce5ce6Saurel32 case DBDMA_RES1: 78128ce5ce6Saurel32 case DBDMA_RES2: 78228ce5ce6Saurel32 case DBDMA_RES3: 78328ce5ce6Saurel32 case DBDMA_RES4: 78428ce5ce6Saurel32 /* reserved */ 78528ce5ce6Saurel32 break; 78628ce5ce6Saurel32 } 78728ce5ce6Saurel32 78877453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, "readl 0x" TARGET_FMT_plx " => 0x%08x\n", addr, value); 78977453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, "channel 0x%x reg 0x%x\n", 79077453882SBenjamin Herrenschmidt (uint32_t)addr >> DBDMA_CHANNEL_SHIFT, reg); 79177453882SBenjamin Herrenschmidt 79228ce5ce6Saurel32 return value; 7933cbee15bSj_mayer } 7943cbee15bSj_mayer 79523c5e4caSAvi Kivity static const MemoryRegionOps dbdma_ops = { 79623c5e4caSAvi Kivity .read = dbdma_read, 79723c5e4caSAvi Kivity .write = dbdma_write, 79823c5e4caSAvi Kivity .endianness = DEVICE_LITTLE_ENDIAN, 79923c5e4caSAvi Kivity .valid = { 80023c5e4caSAvi Kivity .min_access_size = 4, 80123c5e4caSAvi Kivity .max_access_size = 4, 80223c5e4caSAvi Kivity }, 8033cbee15bSj_mayer }; 8043cbee15bSj_mayer 805627be2f2SMark Cave-Ayland static const VMStateDescription vmstate_dbdma_io = { 806627be2f2SMark Cave-Ayland .name = "dbdma_io", 807da26fdc3SJuan Quintela .version_id = 0, 808da26fdc3SJuan Quintela .minimum_version_id = 0, 809da26fdc3SJuan Quintela .fields = (VMStateField[]) { 810627be2f2SMark Cave-Ayland VMSTATE_UINT64(addr, struct DBDMA_io), 811627be2f2SMark Cave-Ayland VMSTATE_INT32(len, struct DBDMA_io), 812627be2f2SMark Cave-Ayland VMSTATE_INT32(is_last, struct DBDMA_io), 813627be2f2SMark Cave-Ayland VMSTATE_INT32(is_dma_out, struct DBDMA_io), 814627be2f2SMark Cave-Ayland VMSTATE_BOOL(processing, struct DBDMA_io), 815627be2f2SMark Cave-Ayland VMSTATE_END_OF_LIST() 816627be2f2SMark Cave-Ayland } 817627be2f2SMark Cave-Ayland }; 818627be2f2SMark Cave-Ayland 819627be2f2SMark Cave-Ayland static const VMStateDescription vmstate_dbdma_cmd = { 820627be2f2SMark Cave-Ayland .name = "dbdma_cmd", 821627be2f2SMark Cave-Ayland .version_id = 0, 822627be2f2SMark Cave-Ayland .minimum_version_id = 0, 823627be2f2SMark Cave-Ayland .fields = (VMStateField[]) { 824627be2f2SMark Cave-Ayland VMSTATE_UINT16(req_count, dbdma_cmd), 825627be2f2SMark Cave-Ayland VMSTATE_UINT16(command, dbdma_cmd), 826627be2f2SMark Cave-Ayland VMSTATE_UINT32(phy_addr, dbdma_cmd), 827627be2f2SMark Cave-Ayland VMSTATE_UINT32(cmd_dep, dbdma_cmd), 828627be2f2SMark Cave-Ayland VMSTATE_UINT16(res_count, dbdma_cmd), 829627be2f2SMark Cave-Ayland VMSTATE_UINT16(xfer_status, dbdma_cmd), 830627be2f2SMark Cave-Ayland VMSTATE_END_OF_LIST() 831627be2f2SMark Cave-Ayland } 832627be2f2SMark Cave-Ayland }; 833627be2f2SMark Cave-Ayland 834627be2f2SMark Cave-Ayland static const VMStateDescription vmstate_dbdma_channel = { 835627be2f2SMark Cave-Ayland .name = "dbdma_channel", 836627be2f2SMark Cave-Ayland .version_id = 1, 837627be2f2SMark Cave-Ayland .minimum_version_id = 1, 838627be2f2SMark Cave-Ayland .fields = (VMStateField[]) { 839da26fdc3SJuan Quintela VMSTATE_UINT32_ARRAY(regs, struct DBDMA_channel, DBDMA_REGS), 840627be2f2SMark Cave-Ayland VMSTATE_STRUCT(io, struct DBDMA_channel, 0, vmstate_dbdma_io, DBDMA_io), 841627be2f2SMark Cave-Ayland VMSTATE_STRUCT(current, struct DBDMA_channel, 0, vmstate_dbdma_cmd, 842627be2f2SMark Cave-Ayland dbdma_cmd), 843da26fdc3SJuan Quintela VMSTATE_END_OF_LIST() 8449b64997fSblueswir1 } 845da26fdc3SJuan Quintela }; 8469b64997fSblueswir1 847da26fdc3SJuan Quintela static const VMStateDescription vmstate_dbdma = { 848da26fdc3SJuan Quintela .name = "dbdma", 849627be2f2SMark Cave-Ayland .version_id = 3, 850627be2f2SMark Cave-Ayland .minimum_version_id = 3, 851da26fdc3SJuan Quintela .fields = (VMStateField[]) { 852da26fdc3SJuan Quintela VMSTATE_STRUCT_ARRAY(channels, DBDMAState, DBDMA_CHANNELS, 1, 853da26fdc3SJuan Quintela vmstate_dbdma_channel, DBDMA_channel), 854da26fdc3SJuan Quintela VMSTATE_END_OF_LIST() 8559b64997fSblueswir1 } 856da26fdc3SJuan Quintela }; 8579b64997fSblueswir1 8581d27f351SMark Cave-Ayland static void mac_dbdma_reset(DeviceState *d) 8596e6b7363Sblueswir1 { 8601d27f351SMark Cave-Ayland DBDMAState *s = MAC_DBDMA(d); 86128ce5ce6Saurel32 int i; 86228ce5ce6Saurel32 8631d27f351SMark Cave-Ayland for (i = 0; i < DBDMA_CHANNELS; i++) { 864c20df14bSJuan Quintela memset(s->channels[i].regs, 0, DBDMA_SIZE); 8656e6b7363Sblueswir1 } 8661d27f351SMark Cave-Ayland } 8676e6b7363Sblueswir1 8682d7d06d8SHervé Poussineau static void dbdma_unassigned_rw(DBDMA_io *io) 8692d7d06d8SHervé Poussineau { 8702d7d06d8SHervé Poussineau DBDMA_channel *ch = io->channel; 87177453882SBenjamin Herrenschmidt dbdma_cmd *current = &ch->current; 87277453882SBenjamin Herrenschmidt uint16_t cmd; 8732d7d06d8SHervé Poussineau qemu_log_mask(LOG_GUEST_ERROR, "%s: use of unassigned channel %d\n", 8742d7d06d8SHervé Poussineau __func__, ch->channel); 8752df77896SMark Cave-Ayland ch->io.processing = false; 87677453882SBenjamin Herrenschmidt 87777453882SBenjamin Herrenschmidt cmd = le16_to_cpu(current->command) & COMMAND_MASK; 87877453882SBenjamin Herrenschmidt if (cmd == OUTPUT_MORE || cmd == OUTPUT_LAST || 87977453882SBenjamin Herrenschmidt cmd == INPUT_MORE || cmd == INPUT_LAST) { 88077453882SBenjamin Herrenschmidt current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]); 88177453882SBenjamin Herrenschmidt current->res_count = cpu_to_le16(io->len); 88277453882SBenjamin Herrenschmidt dbdma_cmdptr_save(ch); 88377453882SBenjamin Herrenschmidt } 8842d7d06d8SHervé Poussineau } 8852d7d06d8SHervé Poussineau 8862d7d06d8SHervé Poussineau static void dbdma_unassigned_flush(DBDMA_io *io) 8872d7d06d8SHervé Poussineau { 8882d7d06d8SHervé Poussineau DBDMA_channel *ch = io->channel; 8892d7d06d8SHervé Poussineau qemu_log_mask(LOG_GUEST_ERROR, "%s: use of unassigned channel %d\n", 8902d7d06d8SHervé Poussineau __func__, ch->channel); 8912d7d06d8SHervé Poussineau } 8922d7d06d8SHervé Poussineau 8931d27f351SMark Cave-Ayland static void mac_dbdma_init(Object *obj) 8941d27f351SMark Cave-Ayland { 8951d27f351SMark Cave-Ayland SysBusDevice *sbd = SYS_BUS_DEVICE(obj); 8961d27f351SMark Cave-Ayland DBDMAState *s = MAC_DBDMA(obj); 8971d27f351SMark Cave-Ayland int i; 89828ce5ce6Saurel32 8993e300fa6SAlexander Graf for (i = 0; i < DBDMA_CHANNELS; i++) { 9002d7d06d8SHervé Poussineau DBDMA_channel *ch = &s->channels[i]; 9012d7d06d8SHervé Poussineau 9022d7d06d8SHervé Poussineau ch->rw = dbdma_unassigned_rw; 9032d7d06d8SHervé Poussineau ch->flush = dbdma_unassigned_flush; 9042d7d06d8SHervé Poussineau ch->channel = i; 9052d7d06d8SHervé Poussineau ch->io.channel = ch; 9063e300fa6SAlexander Graf } 9073e300fa6SAlexander Graf 9081d27f351SMark Cave-Ayland memory_region_init_io(&s->mem, obj, &dbdma_ops, s, "dbdma", 0x1000); 9091d27f351SMark Cave-Ayland sysbus_init_mmio(sbd, &s->mem); 9101d27f351SMark Cave-Ayland } 9111d27f351SMark Cave-Ayland 9121d27f351SMark Cave-Ayland static void mac_dbdma_realize(DeviceState *dev, Error **errp) 9131d27f351SMark Cave-Ayland { 9141d27f351SMark Cave-Ayland DBDMAState *s = MAC_DBDMA(dev); 91528ce5ce6Saurel32 916d2f0ce21SAlexander Graf s->bh = qemu_bh_new(DBDMA_run_bh, s); 9173cbee15bSj_mayer } 9181d27f351SMark Cave-Ayland 9191d27f351SMark Cave-Ayland static void mac_dbdma_class_init(ObjectClass *oc, void *data) 9201d27f351SMark Cave-Ayland { 9211d27f351SMark Cave-Ayland DeviceClass *dc = DEVICE_CLASS(oc); 9221d27f351SMark Cave-Ayland 9231d27f351SMark Cave-Ayland dc->realize = mac_dbdma_realize; 9241d27f351SMark Cave-Ayland dc->reset = mac_dbdma_reset; 9251d27f351SMark Cave-Ayland dc->vmsd = &vmstate_dbdma; 9261d27f351SMark Cave-Ayland } 9271d27f351SMark Cave-Ayland 9281d27f351SMark Cave-Ayland static const TypeInfo mac_dbdma_type_info = { 9291d27f351SMark Cave-Ayland .name = TYPE_MAC_DBDMA, 9301d27f351SMark Cave-Ayland .parent = TYPE_SYS_BUS_DEVICE, 9311d27f351SMark Cave-Ayland .instance_size = sizeof(DBDMAState), 9321d27f351SMark Cave-Ayland .instance_init = mac_dbdma_init, 9331d27f351SMark Cave-Ayland .class_init = mac_dbdma_class_init 9341d27f351SMark Cave-Ayland }; 9351d27f351SMark Cave-Ayland 9361d27f351SMark Cave-Ayland static void mac_dbdma_register_types(void) 9371d27f351SMark Cave-Ayland { 9381d27f351SMark Cave-Ayland type_register_static(&mac_dbdma_type_info); 9391d27f351SMark Cave-Ayland } 9401d27f351SMark Cave-Ayland 9411d27f351SMark Cave-Ayland type_init(mac_dbdma_register_types) 942