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 */ 390d75590dSPeter Maydell #include "qemu/osdep.h" 4083c9f4caSPaolo Bonzini #include "hw/hw.h" 410d09e41aSPaolo Bonzini #include "hw/isa/isa.h" 420d09e41aSPaolo Bonzini #include "hw/ppc/mac_dbdma.h" 431de7afc9SPaolo Bonzini #include "qemu/main-loop.h" 4403dd024fSPaolo Bonzini #include "qemu/log.h" 4588655881SMark Cave-Ayland #include "sysemu/dma.h" 463cbee15bSj_mayer 47ea026b2fSblueswir1 /* debug DBDMA */ 48ba0b17ddSMark Cave-Ayland #define DEBUG_DBDMA 0 493e49c439SMark Cave-Ayland #define DEBUG_DBDMA_CHANMASK ((1ull << DBDMA_CHANNELS) - 1) 50ea026b2fSblueswir1 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); 56ea026b2fSblueswir1 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 6528ce5ce6Saurel32 /* 6628ce5ce6Saurel32 */ 673cbee15bSj_mayer 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 7428ce5ce6Saurel32 static void dump_dbdma_cmd(dbdma_cmd *cmd) 753cbee15bSj_mayer { 7628ce5ce6Saurel32 printf("dbdma_cmd %p\n", cmd); 7728ce5ce6Saurel32 printf(" req_count 0x%04x\n", le16_to_cpu(cmd->req_count)); 7828ce5ce6Saurel32 printf(" command 0x%04x\n", le16_to_cpu(cmd->command)); 7928ce5ce6Saurel32 printf(" phy_addr 0x%08x\n", le32_to_cpu(cmd->phy_addr)); 8028ce5ce6Saurel32 printf(" cmd_dep 0x%08x\n", le32_to_cpu(cmd->cmd_dep)); 8128ce5ce6Saurel32 printf(" res_count 0x%04x\n", le16_to_cpu(cmd->res_count)); 8228ce5ce6Saurel32 printf(" xfer_status 0x%04x\n", le16_to_cpu(cmd->xfer_status)); 8328ce5ce6Saurel32 } 8428ce5ce6Saurel32 #else 8528ce5ce6Saurel32 static void dump_dbdma_cmd(dbdma_cmd *cmd) 8628ce5ce6Saurel32 { 8728ce5ce6Saurel32 } 8828ce5ce6Saurel32 #endif 8928ce5ce6Saurel32 static void dbdma_cmdptr_load(DBDMA_channel *ch) 9028ce5ce6Saurel32 { 913e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "dbdma_cmdptr_load 0x%08x\n", 92ad674e53SAurelien Jarno 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)); 953cbee15bSj_mayer } 963cbee15bSj_mayer 9728ce5ce6Saurel32 static void dbdma_cmdptr_save(DBDMA_channel *ch) 983cbee15bSj_mayer { 9977453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, "-> update 0x%08x stat=0x%08x, res=0x%04x\n", 10077453882SBenjamin Herrenschmidt ch->regs[DBDMA_CMDPTR_LO], 10128ce5ce6Saurel32 le16_to_cpu(ch->current.xfer_status), 10228ce5ce6Saurel32 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)); 10528ce5ce6Saurel32 } 10628ce5ce6Saurel32 10728ce5ce6Saurel32 static void kill_channel(DBDMA_channel *ch) 10828ce5ce6Saurel32 { 1093e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "kill_channel\n"); 11028ce5ce6Saurel32 111ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] |= DEAD; 112ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] &= ~ACTIVE; 11328ce5ce6Saurel32 11428ce5ce6Saurel32 qemu_irq_raise(ch->irq); 11528ce5ce6Saurel32 } 11628ce5ce6Saurel32 11728ce5ce6Saurel32 static void conditional_interrupt(DBDMA_channel *ch) 11828ce5ce6Saurel32 { 11928ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 12028ce5ce6Saurel32 uint16_t intr; 12128ce5ce6Saurel32 uint16_t sel_mask, sel_value; 12228ce5ce6Saurel32 uint32_t status; 12328ce5ce6Saurel32 int cond; 12428ce5ce6Saurel32 1253e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "%s\n", __func__); 12628ce5ce6Saurel32 127b42ec42dSaurel32 intr = le16_to_cpu(current->command) & INTR_MASK; 12828ce5ce6Saurel32 12928ce5ce6Saurel32 switch(intr) { 13028ce5ce6Saurel32 case INTR_NEVER: /* don't interrupt */ 13128ce5ce6Saurel32 return; 13228ce5ce6Saurel32 case INTR_ALWAYS: /* always interrupt */ 13328ce5ce6Saurel32 qemu_irq_raise(ch->irq); 1343e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "%s: raise\n", __func__); 13528ce5ce6Saurel32 return; 13628ce5ce6Saurel32 } 13728ce5ce6Saurel32 138ad674e53SAurelien Jarno status = ch->regs[DBDMA_STATUS] & DEVSTAT; 13928ce5ce6Saurel32 140ad674e53SAurelien Jarno sel_mask = (ch->regs[DBDMA_INTR_SEL] >> 16) & 0x0f; 141ad674e53SAurelien Jarno sel_value = ch->regs[DBDMA_INTR_SEL] & 0x0f; 14228ce5ce6Saurel32 14328ce5ce6Saurel32 cond = (status & sel_mask) == (sel_value & sel_mask); 14428ce5ce6Saurel32 14528ce5ce6Saurel32 switch(intr) { 14628ce5ce6Saurel32 case INTR_IFSET: /* intr if condition bit is 1 */ 14733ce36bbSAlexander Graf if (cond) { 14828ce5ce6Saurel32 qemu_irq_raise(ch->irq); 1493e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "%s: raise\n", __func__); 15033ce36bbSAlexander Graf } 15128ce5ce6Saurel32 return; 15228ce5ce6Saurel32 case INTR_IFCLR: /* intr if condition bit is 0 */ 15333ce36bbSAlexander Graf if (!cond) { 15428ce5ce6Saurel32 qemu_irq_raise(ch->irq); 1553e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "%s: raise\n", __func__); 15633ce36bbSAlexander Graf } 15728ce5ce6Saurel32 return; 15828ce5ce6Saurel32 } 15928ce5ce6Saurel32 } 16028ce5ce6Saurel32 16128ce5ce6Saurel32 static int conditional_wait(DBDMA_channel *ch) 16228ce5ce6Saurel32 { 16328ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 16428ce5ce6Saurel32 uint16_t wait; 16528ce5ce6Saurel32 uint16_t sel_mask, sel_value; 16628ce5ce6Saurel32 uint32_t status; 16728ce5ce6Saurel32 int cond; 16877453882SBenjamin Herrenschmidt int res = 0; 16928ce5ce6Saurel32 170b42ec42dSaurel32 wait = le16_to_cpu(current->command) & WAIT_MASK; 17128ce5ce6Saurel32 switch(wait) { 17228ce5ce6Saurel32 case WAIT_NEVER: /* don't wait */ 17328ce5ce6Saurel32 return 0; 17428ce5ce6Saurel32 case WAIT_ALWAYS: /* always wait */ 17577453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " [WAIT_ALWAYS]\n"); 17628ce5ce6Saurel32 return 1; 17728ce5ce6Saurel32 } 17828ce5ce6Saurel32 179ad674e53SAurelien Jarno status = ch->regs[DBDMA_STATUS] & DEVSTAT; 18028ce5ce6Saurel32 181ad674e53SAurelien Jarno sel_mask = (ch->regs[DBDMA_WAIT_SEL] >> 16) & 0x0f; 182ad674e53SAurelien Jarno sel_value = ch->regs[DBDMA_WAIT_SEL] & 0x0f; 18328ce5ce6Saurel32 18428ce5ce6Saurel32 cond = (status & sel_mask) == (sel_value & sel_mask); 18528ce5ce6Saurel32 18628ce5ce6Saurel32 switch(wait) { 18728ce5ce6Saurel32 case WAIT_IFSET: /* wait if condition bit is 1 */ 18877453882SBenjamin Herrenschmidt if (cond) { 18977453882SBenjamin Herrenschmidt res = 1; 19028ce5ce6Saurel32 } 19177453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " [WAIT_IFSET=%d]\n", res); 19277453882SBenjamin Herrenschmidt break; 19377453882SBenjamin Herrenschmidt case WAIT_IFCLR: /* wait if condition bit is 0 */ 19477453882SBenjamin Herrenschmidt if (!cond) { 19577453882SBenjamin Herrenschmidt res = 1; 19677453882SBenjamin Herrenschmidt } 19777453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " [WAIT_IFCLR=%d]\n", res); 19877453882SBenjamin Herrenschmidt break; 19977453882SBenjamin Herrenschmidt } 20077453882SBenjamin Herrenschmidt return res; 20128ce5ce6Saurel32 } 20228ce5ce6Saurel32 20328ce5ce6Saurel32 static void next(DBDMA_channel *ch) 20428ce5ce6Saurel32 { 20528ce5ce6Saurel32 uint32_t cp; 20628ce5ce6Saurel32 207ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] &= ~BT; 20828ce5ce6Saurel32 209ad674e53SAurelien Jarno cp = ch->regs[DBDMA_CMDPTR_LO]; 210ad674e53SAurelien Jarno ch->regs[DBDMA_CMDPTR_LO] = cp + sizeof(dbdma_cmd); 21128ce5ce6Saurel32 dbdma_cmdptr_load(ch); 21228ce5ce6Saurel32 } 21328ce5ce6Saurel32 21428ce5ce6Saurel32 static void branch(DBDMA_channel *ch) 21528ce5ce6Saurel32 { 21628ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 21728ce5ce6Saurel32 2183f0d4128SMark Cave-Ayland ch->regs[DBDMA_CMDPTR_LO] = le32_to_cpu(current->cmd_dep); 219ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] |= BT; 22028ce5ce6Saurel32 dbdma_cmdptr_load(ch); 22128ce5ce6Saurel32 } 22228ce5ce6Saurel32 22328ce5ce6Saurel32 static void conditional_branch(DBDMA_channel *ch) 22428ce5ce6Saurel32 { 22528ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 22628ce5ce6Saurel32 uint16_t br; 22728ce5ce6Saurel32 uint16_t sel_mask, sel_value; 22828ce5ce6Saurel32 uint32_t status; 22928ce5ce6Saurel32 int cond; 23028ce5ce6Saurel32 23128ce5ce6Saurel32 /* check if we must branch */ 23228ce5ce6Saurel32 233b42ec42dSaurel32 br = le16_to_cpu(current->command) & BR_MASK; 23428ce5ce6Saurel32 23528ce5ce6Saurel32 switch(br) { 23628ce5ce6Saurel32 case BR_NEVER: /* don't branch */ 23728ce5ce6Saurel32 next(ch); 23828ce5ce6Saurel32 return; 23928ce5ce6Saurel32 case BR_ALWAYS: /* always branch */ 24077453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " [BR_ALWAYS]\n"); 24128ce5ce6Saurel32 branch(ch); 24228ce5ce6Saurel32 return; 24328ce5ce6Saurel32 } 24428ce5ce6Saurel32 245ad674e53SAurelien Jarno status = ch->regs[DBDMA_STATUS] & DEVSTAT; 24628ce5ce6Saurel32 247ad674e53SAurelien Jarno sel_mask = (ch->regs[DBDMA_BRANCH_SEL] >> 16) & 0x0f; 248ad674e53SAurelien Jarno sel_value = ch->regs[DBDMA_BRANCH_SEL] & 0x0f; 24928ce5ce6Saurel32 25028ce5ce6Saurel32 cond = (status & sel_mask) == (sel_value & sel_mask); 25128ce5ce6Saurel32 25228ce5ce6Saurel32 switch(br) { 25328ce5ce6Saurel32 case BR_IFSET: /* branch if condition bit is 1 */ 25477453882SBenjamin Herrenschmidt if (cond) { 25577453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " [BR_IFSET = 1]\n"); 25628ce5ce6Saurel32 branch(ch); 25777453882SBenjamin Herrenschmidt } else { 25877453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " [BR_IFSET = 0]\n"); 25928ce5ce6Saurel32 next(ch); 26077453882SBenjamin Herrenschmidt } 26128ce5ce6Saurel32 return; 26228ce5ce6Saurel32 case BR_IFCLR: /* branch if condition bit is 0 */ 26377453882SBenjamin Herrenschmidt if (!cond) { 26477453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " [BR_IFCLR = 1]\n"); 26528ce5ce6Saurel32 branch(ch); 26677453882SBenjamin Herrenschmidt } else { 26777453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " [BR_IFCLR = 0]\n"); 26828ce5ce6Saurel32 next(ch); 26977453882SBenjamin Herrenschmidt } 27028ce5ce6Saurel32 return; 27128ce5ce6Saurel32 } 27228ce5ce6Saurel32 } 27328ce5ce6Saurel32 274b42ec42dSaurel32 static void channel_run(DBDMA_channel *ch); 275b42ec42dSaurel32 276b42ec42dSaurel32 static void dbdma_end(DBDMA_io *io) 27728ce5ce6Saurel32 { 27828ce5ce6Saurel32 DBDMA_channel *ch = io->channel; 27928ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 28028ce5ce6Saurel32 2813e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "%s\n", __func__); 28233ce36bbSAlexander Graf 283b42ec42dSaurel32 if (conditional_wait(ch)) 284b42ec42dSaurel32 goto wait; 28528ce5ce6Saurel32 286ad674e53SAurelien Jarno current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]); 287ad674e53SAurelien Jarno current->res_count = cpu_to_le16(io->len); 288b42ec42dSaurel32 dbdma_cmdptr_save(ch); 289862c9280Saurel32 if (io->is_last) 290ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] &= ~FLUSH; 29128ce5ce6Saurel32 292b42ec42dSaurel32 conditional_interrupt(ch); 293b42ec42dSaurel32 conditional_branch(ch); 294b42ec42dSaurel32 295b42ec42dSaurel32 wait: 29603ee3b1eSAlexander Graf /* Indicate that we're ready for a new DMA round */ 29703ee3b1eSAlexander Graf ch->io.processing = false; 29803ee3b1eSAlexander Graf 299ad674e53SAurelien Jarno if ((ch->regs[DBDMA_STATUS] & RUN) && 300ad674e53SAurelien Jarno (ch->regs[DBDMA_STATUS] & ACTIVE)) 301b42ec42dSaurel32 channel_run(ch); 30228ce5ce6Saurel32 } 30328ce5ce6Saurel32 304b42ec42dSaurel32 static void start_output(DBDMA_channel *ch, int key, uint32_t addr, 30528ce5ce6Saurel32 uint16_t req_count, int is_last) 30628ce5ce6Saurel32 { 3073e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "start_output\n"); 30828ce5ce6Saurel32 30928ce5ce6Saurel32 /* KEY_REGS, KEY_DEVICE and KEY_STREAM 31028ce5ce6Saurel32 * are not implemented in the mac-io chip 31128ce5ce6Saurel32 */ 31228ce5ce6Saurel32 3133e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "addr 0x%x key 0x%x\n", addr, key); 31428ce5ce6Saurel32 if (!addr || key > KEY_STREAM3) { 31528ce5ce6Saurel32 kill_channel(ch); 316b42ec42dSaurel32 return; 31728ce5ce6Saurel32 } 31828ce5ce6Saurel32 319b42ec42dSaurel32 ch->io.addr = addr; 32028ce5ce6Saurel32 ch->io.len = req_count; 32128ce5ce6Saurel32 ch->io.is_last = is_last; 322b42ec42dSaurel32 ch->io.dma_end = dbdma_end; 323b42ec42dSaurel32 ch->io.is_dma_out = 1; 32403ee3b1eSAlexander Graf ch->io.processing = true; 325a9ceb76dSAlexander Graf if (ch->rw) { 326b42ec42dSaurel32 ch->rw(&ch->io); 32728ce5ce6Saurel32 } 328a9ceb76dSAlexander Graf } 32928ce5ce6Saurel32 330b42ec42dSaurel32 static void start_input(DBDMA_channel *ch, int key, uint32_t addr, 33128ce5ce6Saurel32 uint16_t req_count, int is_last) 33228ce5ce6Saurel32 { 3333e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "start_input\n"); 33428ce5ce6Saurel32 33528ce5ce6Saurel32 /* KEY_REGS, KEY_DEVICE and KEY_STREAM 33628ce5ce6Saurel32 * are not implemented in the mac-io chip 33728ce5ce6Saurel32 */ 33828ce5ce6Saurel32 3393e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "addr 0x%x key 0x%x\n", addr, key); 34028ce5ce6Saurel32 if (!addr || key > KEY_STREAM3) { 34128ce5ce6Saurel32 kill_channel(ch); 342b42ec42dSaurel32 return; 34328ce5ce6Saurel32 } 34428ce5ce6Saurel32 345b42ec42dSaurel32 ch->io.addr = addr; 34628ce5ce6Saurel32 ch->io.len = req_count; 34728ce5ce6Saurel32 ch->io.is_last = is_last; 348b42ec42dSaurel32 ch->io.dma_end = dbdma_end; 349b42ec42dSaurel32 ch->io.is_dma_out = 0; 35003ee3b1eSAlexander Graf ch->io.processing = true; 351a9ceb76dSAlexander Graf if (ch->rw) { 352b42ec42dSaurel32 ch->rw(&ch->io); 35328ce5ce6Saurel32 } 354a9ceb76dSAlexander Graf } 35528ce5ce6Saurel32 356b42ec42dSaurel32 static void load_word(DBDMA_channel *ch, int key, uint32_t addr, 35728ce5ce6Saurel32 uint16_t len) 35828ce5ce6Saurel32 { 35928ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 36028ce5ce6Saurel32 361e12f50b9SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "load_word %d bytes, addr=%08x\n", len, addr); 36228ce5ce6Saurel32 36328ce5ce6Saurel32 /* only implements KEY_SYSTEM */ 36428ce5ce6Saurel32 36528ce5ce6Saurel32 if (key != KEY_SYSTEM) { 36628ce5ce6Saurel32 printf("DBDMA: LOAD_WORD, unimplemented key %x\n", key); 36728ce5ce6Saurel32 kill_channel(ch); 368b42ec42dSaurel32 return; 36928ce5ce6Saurel32 } 37028ce5ce6Saurel32 371e12f50b9SMark Cave-Ayland dma_memory_read(&address_space_memory, addr, ¤t->cmd_dep, len); 37228ce5ce6Saurel32 37328ce5ce6Saurel32 if (conditional_wait(ch)) 374b42ec42dSaurel32 goto wait; 37528ce5ce6Saurel32 376ad674e53SAurelien Jarno current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]); 37728ce5ce6Saurel32 dbdma_cmdptr_save(ch); 378ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] &= ~FLUSH; 37928ce5ce6Saurel32 38028ce5ce6Saurel32 conditional_interrupt(ch); 38128ce5ce6Saurel32 next(ch); 38228ce5ce6Saurel32 383b42ec42dSaurel32 wait: 384d2f0ce21SAlexander Graf DBDMA_kick(dbdma_from_ch(ch)); 38528ce5ce6Saurel32 } 38628ce5ce6Saurel32 387b42ec42dSaurel32 static void store_word(DBDMA_channel *ch, int key, uint32_t addr, 38828ce5ce6Saurel32 uint16_t len) 38928ce5ce6Saurel32 { 39028ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 39128ce5ce6Saurel32 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)); 39428ce5ce6Saurel32 39528ce5ce6Saurel32 /* only implements KEY_SYSTEM */ 39628ce5ce6Saurel32 39728ce5ce6Saurel32 if (key != KEY_SYSTEM) { 39828ce5ce6Saurel32 printf("DBDMA: STORE_WORD, unimplemented key %x\n", key); 39928ce5ce6Saurel32 kill_channel(ch); 400b42ec42dSaurel32 return; 40128ce5ce6Saurel32 } 40228ce5ce6Saurel32 403e12f50b9SMark Cave-Ayland dma_memory_write(&address_space_memory, addr, ¤t->cmd_dep, len); 40428ce5ce6Saurel32 40528ce5ce6Saurel32 if (conditional_wait(ch)) 406b42ec42dSaurel32 goto wait; 40728ce5ce6Saurel32 408ad674e53SAurelien Jarno current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]); 40928ce5ce6Saurel32 dbdma_cmdptr_save(ch); 410ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] &= ~FLUSH; 41128ce5ce6Saurel32 41228ce5ce6Saurel32 conditional_interrupt(ch); 41328ce5ce6Saurel32 next(ch); 41428ce5ce6Saurel32 415b42ec42dSaurel32 wait: 416d2f0ce21SAlexander Graf DBDMA_kick(dbdma_from_ch(ch)); 41728ce5ce6Saurel32 } 41828ce5ce6Saurel32 419b42ec42dSaurel32 static void nop(DBDMA_channel *ch) 42028ce5ce6Saurel32 { 42128ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 42228ce5ce6Saurel32 42328ce5ce6Saurel32 if (conditional_wait(ch)) 424b42ec42dSaurel32 goto wait; 42528ce5ce6Saurel32 426ad674e53SAurelien Jarno current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]); 42728ce5ce6Saurel32 dbdma_cmdptr_save(ch); 42828ce5ce6Saurel32 42928ce5ce6Saurel32 conditional_interrupt(ch); 43028ce5ce6Saurel32 conditional_branch(ch); 43128ce5ce6Saurel32 432b42ec42dSaurel32 wait: 433d2f0ce21SAlexander Graf DBDMA_kick(dbdma_from_ch(ch)); 43428ce5ce6Saurel32 } 43528ce5ce6Saurel32 436b42ec42dSaurel32 static void stop(DBDMA_channel *ch) 43728ce5ce6Saurel32 { 43877453882SBenjamin Herrenschmidt ch->regs[DBDMA_STATUS] &= ~(ACTIVE); 43928ce5ce6Saurel32 44028ce5ce6Saurel32 /* the stop command does not increment command pointer */ 44128ce5ce6Saurel32 } 44228ce5ce6Saurel32 443b42ec42dSaurel32 static void channel_run(DBDMA_channel *ch) 44428ce5ce6Saurel32 { 44528ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 44628ce5ce6Saurel32 uint16_t cmd, key; 44728ce5ce6Saurel32 uint16_t req_count; 44828ce5ce6Saurel32 uint32_t phy_addr; 44928ce5ce6Saurel32 4503e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "channel_run\n"); 45128ce5ce6Saurel32 dump_dbdma_cmd(current); 45228ce5ce6Saurel32 45328ce5ce6Saurel32 /* clear WAKE flag at command fetch */ 45428ce5ce6Saurel32 455ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] &= ~WAKE; 45628ce5ce6Saurel32 45728ce5ce6Saurel32 cmd = le16_to_cpu(current->command) & COMMAND_MASK; 45828ce5ce6Saurel32 45928ce5ce6Saurel32 switch (cmd) { 46028ce5ce6Saurel32 case DBDMA_NOP: 461b42ec42dSaurel32 nop(ch); 462b42ec42dSaurel32 return; 46328ce5ce6Saurel32 46428ce5ce6Saurel32 case DBDMA_STOP: 465b42ec42dSaurel32 stop(ch); 466b42ec42dSaurel32 return; 46728ce5ce6Saurel32 } 46828ce5ce6Saurel32 46928ce5ce6Saurel32 key = le16_to_cpu(current->command) & 0x0700; 47028ce5ce6Saurel32 req_count = le16_to_cpu(current->req_count); 47128ce5ce6Saurel32 phy_addr = le32_to_cpu(current->phy_addr); 47228ce5ce6Saurel32 47328ce5ce6Saurel32 if (key == KEY_STREAM4) { 47428ce5ce6Saurel32 printf("command %x, invalid key 4\n", cmd); 47528ce5ce6Saurel32 kill_channel(ch); 476b42ec42dSaurel32 return; 47728ce5ce6Saurel32 } 47828ce5ce6Saurel32 47928ce5ce6Saurel32 switch (cmd) { 48028ce5ce6Saurel32 case OUTPUT_MORE: 48177453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, "* OUTPUT_MORE *\n"); 482b42ec42dSaurel32 start_output(ch, key, phy_addr, req_count, 0); 483b42ec42dSaurel32 return; 48428ce5ce6Saurel32 48528ce5ce6Saurel32 case OUTPUT_LAST: 48677453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, "* OUTPUT_LAST *\n"); 487b42ec42dSaurel32 start_output(ch, key, phy_addr, req_count, 1); 488b42ec42dSaurel32 return; 48928ce5ce6Saurel32 49028ce5ce6Saurel32 case INPUT_MORE: 49177453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, "* INPUT_MORE *\n"); 492b42ec42dSaurel32 start_input(ch, key, phy_addr, req_count, 0); 493b42ec42dSaurel32 return; 49428ce5ce6Saurel32 49528ce5ce6Saurel32 case INPUT_LAST: 49677453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, "* INPUT_LAST *\n"); 497b42ec42dSaurel32 start_input(ch, key, phy_addr, req_count, 1); 498b42ec42dSaurel32 return; 49928ce5ce6Saurel32 } 50028ce5ce6Saurel32 50128ce5ce6Saurel32 if (key < KEY_REGS) { 50228ce5ce6Saurel32 printf("command %x, invalid key %x\n", cmd, key); 50328ce5ce6Saurel32 key = KEY_SYSTEM; 50428ce5ce6Saurel32 } 50528ce5ce6Saurel32 50628ce5ce6Saurel32 /* for LOAD_WORD and STORE_WORD, req_count is on 3 bits 50728ce5ce6Saurel32 * and BRANCH is invalid 50828ce5ce6Saurel32 */ 50928ce5ce6Saurel32 51028ce5ce6Saurel32 req_count = req_count & 0x0007; 51128ce5ce6Saurel32 if (req_count & 0x4) { 51228ce5ce6Saurel32 req_count = 4; 51328ce5ce6Saurel32 phy_addr &= ~3; 51428ce5ce6Saurel32 } else if (req_count & 0x2) { 51528ce5ce6Saurel32 req_count = 2; 51628ce5ce6Saurel32 phy_addr &= ~1; 51728ce5ce6Saurel32 } else 51828ce5ce6Saurel32 req_count = 1; 51928ce5ce6Saurel32 52028ce5ce6Saurel32 switch (cmd) { 52128ce5ce6Saurel32 case LOAD_WORD: 52277453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, "* LOAD_WORD *\n"); 523b42ec42dSaurel32 load_word(ch, key, phy_addr, req_count); 524b42ec42dSaurel32 return; 52528ce5ce6Saurel32 52628ce5ce6Saurel32 case STORE_WORD: 52777453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, "* STORE_WORD *\n"); 528b42ec42dSaurel32 store_word(ch, key, phy_addr, req_count); 529b42ec42dSaurel32 return; 53028ce5ce6Saurel32 } 53128ce5ce6Saurel32 } 53228ce5ce6Saurel32 533c20df14bSJuan Quintela static void DBDMA_run(DBDMAState *s) 53428ce5ce6Saurel32 { 53528ce5ce6Saurel32 int channel; 53628ce5ce6Saurel32 537c20df14bSJuan Quintela for (channel = 0; channel < DBDMA_CHANNELS; channel++) { 538c20df14bSJuan Quintela DBDMA_channel *ch = &s->channels[channel]; 539ad674e53SAurelien Jarno uint32_t status = ch->regs[DBDMA_STATUS]; 54003ee3b1eSAlexander Graf if (!ch->io.processing && (status & RUN) && (status & ACTIVE)) { 541b42ec42dSaurel32 channel_run(ch); 54228ce5ce6Saurel32 } 54328ce5ce6Saurel32 } 544c20df14bSJuan Quintela } 54528ce5ce6Saurel32 54628ce5ce6Saurel32 static void DBDMA_run_bh(void *opaque) 54728ce5ce6Saurel32 { 548c20df14bSJuan Quintela DBDMAState *s = opaque; 54928ce5ce6Saurel32 5503e49c439SMark Cave-Ayland DBDMA_DPRINTF("-> DBDMA_run_bh\n"); 551c20df14bSJuan Quintela DBDMA_run(s); 5523e49c439SMark Cave-Ayland DBDMA_DPRINTF("<- DBDMA_run_bh\n"); 55328ce5ce6Saurel32 } 55428ce5ce6Saurel32 555d1e562deSAlexander Graf void DBDMA_kick(DBDMAState *dbdma) 556d1e562deSAlexander Graf { 557d2f0ce21SAlexander Graf qemu_bh_schedule(dbdma->bh); 558d1e562deSAlexander Graf } 559d1e562deSAlexander Graf 56028ce5ce6Saurel32 void DBDMA_register_channel(void *dbdma, int nchan, qemu_irq irq, 561862c9280Saurel32 DBDMA_rw rw, DBDMA_flush flush, 56228ce5ce6Saurel32 void *opaque) 56328ce5ce6Saurel32 { 564c20df14bSJuan Quintela DBDMAState *s = dbdma; 565c20df14bSJuan Quintela DBDMA_channel *ch = &s->channels[nchan]; 56628ce5ce6Saurel32 5673e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "DBDMA_register_channel 0x%x\n", nchan); 56828ce5ce6Saurel32 5692d7d06d8SHervé Poussineau assert(rw); 5702d7d06d8SHervé Poussineau assert(flush); 5712d7d06d8SHervé Poussineau 57228ce5ce6Saurel32 ch->irq = irq; 573b42ec42dSaurel32 ch->rw = rw; 574862c9280Saurel32 ch->flush = flush; 57528ce5ce6Saurel32 ch->io.opaque = opaque; 57628ce5ce6Saurel32 } 57728ce5ce6Saurel32 57877453882SBenjamin Herrenschmidt static void dbdma_control_write(DBDMA_channel *ch) 57928ce5ce6Saurel32 { 58028ce5ce6Saurel32 uint16_t mask, value; 58128ce5ce6Saurel32 uint32_t status; 58277453882SBenjamin Herrenschmidt bool do_flush = false; 58328ce5ce6Saurel32 584ad674e53SAurelien Jarno mask = (ch->regs[DBDMA_CONTROL] >> 16) & 0xffff; 585ad674e53SAurelien Jarno value = ch->regs[DBDMA_CONTROL] & 0xffff; 58628ce5ce6Saurel32 58777453882SBenjamin Herrenschmidt /* This is the status register which we'll update 58877453882SBenjamin Herrenschmidt * appropriately and store back 58977453882SBenjamin Herrenschmidt */ 590ad674e53SAurelien Jarno status = ch->regs[DBDMA_STATUS]; 59128ce5ce6Saurel32 59277453882SBenjamin Herrenschmidt /* RUN and PAUSE are bits under SW control only 59377453882SBenjamin Herrenschmidt * FLUSH and WAKE are set by SW and cleared by HW 59477453882SBenjamin Herrenschmidt * DEAD, ACTIVE and BT are only under HW control 59577453882SBenjamin Herrenschmidt * 59677453882SBenjamin Herrenschmidt * We handle ACTIVE separately at the end of the 59777453882SBenjamin Herrenschmidt * logic to ensure all cases are covered. 59877453882SBenjamin Herrenschmidt */ 59928ce5ce6Saurel32 60077453882SBenjamin Herrenschmidt /* Setting RUN will tentatively activate the channel 60177453882SBenjamin Herrenschmidt */ 60277453882SBenjamin Herrenschmidt if ((mask & RUN) && (value & RUN)) { 60377453882SBenjamin Herrenschmidt status |= RUN; 60477453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " Setting RUN !\n"); 60528ce5ce6Saurel32 } 60677453882SBenjamin Herrenschmidt 60777453882SBenjamin Herrenschmidt /* Clearing RUN 1->0 will stop the channel */ 60877453882SBenjamin Herrenschmidt if ((mask & RUN) && !(value & RUN)) { 60977453882SBenjamin Herrenschmidt /* This has the side effect of clearing the DEAD bit */ 61077453882SBenjamin Herrenschmidt status &= ~(DEAD | RUN); 61177453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " Clearing RUN !\n"); 61277453882SBenjamin Herrenschmidt } 61377453882SBenjamin Herrenschmidt 61477453882SBenjamin Herrenschmidt /* Setting WAKE wakes up an idle channel if it's running 61577453882SBenjamin Herrenschmidt * 61677453882SBenjamin Herrenschmidt * Note: The doc doesn't say so but assume that only works 61777453882SBenjamin Herrenschmidt * on a channel whose RUN bit is set. 61877453882SBenjamin Herrenschmidt * 61977453882SBenjamin Herrenschmidt * We set WAKE in status, it's not terribly useful as it will 62077453882SBenjamin Herrenschmidt * be cleared on the next command fetch but it seems to mimmic 62177453882SBenjamin Herrenschmidt * the HW behaviour and is useful for the way we handle 62277453882SBenjamin Herrenschmidt * ACTIVE further down. 62377453882SBenjamin Herrenschmidt */ 62477453882SBenjamin Herrenschmidt if ((mask & WAKE) && (value & WAKE) && (status & RUN)) { 62577453882SBenjamin Herrenschmidt status |= WAKE; 62677453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " Setting WAKE !\n"); 62777453882SBenjamin Herrenschmidt } 62877453882SBenjamin Herrenschmidt 62977453882SBenjamin Herrenschmidt /* PAUSE being set will deactivate (or prevent activation) 63077453882SBenjamin Herrenschmidt * of the channel. We just copy it over for now, ACTIVE will 63177453882SBenjamin Herrenschmidt * be re-evaluated later. 63277453882SBenjamin Herrenschmidt */ 63377453882SBenjamin Herrenschmidt if (mask & PAUSE) { 63477453882SBenjamin Herrenschmidt status = (status & ~PAUSE) | (value & PAUSE); 63577453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " %sing PAUSE !\n", 63677453882SBenjamin Herrenschmidt (value & PAUSE) ? "sett" : "clear"); 63777453882SBenjamin Herrenschmidt } 63877453882SBenjamin Herrenschmidt 63977453882SBenjamin Herrenschmidt /* FLUSH is its own thing */ 64077453882SBenjamin Herrenschmidt if ((mask & FLUSH) && (value & FLUSH)) { 64177453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " Setting FLUSH !\n"); 64277453882SBenjamin Herrenschmidt /* We set flush directly in the status register, we do *NOT* 64377453882SBenjamin Herrenschmidt * set it in "status" so that it gets naturally cleared when 64477453882SBenjamin Herrenschmidt * we update the status register further down. That way it 64577453882SBenjamin Herrenschmidt * will be set only during the HW flush operation so it is 64677453882SBenjamin Herrenschmidt * visible to any completions happening during that time. 64777453882SBenjamin Herrenschmidt */ 64877453882SBenjamin Herrenschmidt ch->regs[DBDMA_STATUS] |= FLUSH; 64977453882SBenjamin Herrenschmidt do_flush = true; 65077453882SBenjamin Herrenschmidt } 65177453882SBenjamin Herrenschmidt 65277453882SBenjamin Herrenschmidt /* If either RUN or PAUSE is clear, so should ACTIVE be, 65377453882SBenjamin Herrenschmidt * otherwise, ACTIVE will be set if we modified RUN, PAUSE or 65477453882SBenjamin Herrenschmidt * set WAKE. That means that PAUSE was just cleared, RUN was 65577453882SBenjamin Herrenschmidt * just set or WAKE was just set. 65677453882SBenjamin Herrenschmidt */ 65777453882SBenjamin Herrenschmidt if ((status & PAUSE) || !(status & RUN)) { 65828ce5ce6Saurel32 status &= ~ACTIVE; 65977453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " -> ACTIVE down !\n"); 66077453882SBenjamin Herrenschmidt 66177453882SBenjamin Herrenschmidt /* We stopped processing, we want the underlying HW command 66277453882SBenjamin Herrenschmidt * to complete *before* we clear the ACTIVE bit. Otherwise 66377453882SBenjamin Herrenschmidt * we can get into a situation where the command status will 66477453882SBenjamin Herrenschmidt * have RUN or ACTIVE not set which is going to confuse the 66577453882SBenjamin Herrenschmidt * MacOS driver. 66677453882SBenjamin Herrenschmidt */ 66777453882SBenjamin Herrenschmidt do_flush = true; 66877453882SBenjamin Herrenschmidt } else if (mask & (RUN | PAUSE)) { 66977453882SBenjamin Herrenschmidt status |= ACTIVE; 67077453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " -> ACTIVE up !\n"); 67177453882SBenjamin Herrenschmidt } else if ((mask & WAKE) && (value & WAKE)) { 67277453882SBenjamin Herrenschmidt status |= ACTIVE; 67377453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " -> ACTIVE up !\n"); 6741cde732dSMark Cave-Ayland } 6751cde732dSMark Cave-Ayland 67677453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " new status=0x%08x\n", status); 67777453882SBenjamin Herrenschmidt 67877453882SBenjamin Herrenschmidt /* If we need to flush the underlying HW, do it now, this happens 67977453882SBenjamin Herrenschmidt * both on FLUSH commands and when stopping the channel for safety. 68077453882SBenjamin Herrenschmidt */ 68177453882SBenjamin Herrenschmidt if (do_flush && ch->flush) { 682987422bcSAmadeusz Sławiński ch->flush(&ch->io); 683987422bcSAmadeusz Sławiński } 68428ce5ce6Saurel32 68577453882SBenjamin Herrenschmidt /* Finally update the status register image */ 686ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] = status; 68728ce5ce6Saurel32 68877453882SBenjamin 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 } 6933cbee15bSj_mayer 694a8170e5eSAvi Kivity static void dbdma_write(void *opaque, hwaddr addr, 69523c5e4caSAvi Kivity uint64_t value, unsigned size) 6963cbee15bSj_mayer { 69728ce5ce6Saurel32 int channel = addr >> DBDMA_CHANNEL_SHIFT; 698c20df14bSJuan Quintela DBDMAState *s = opaque; 699c20df14bSJuan Quintela DBDMA_channel *ch = &s->channels[channel]; 70028ce5ce6Saurel32 int reg = (addr - (channel << DBDMA_CHANNEL_SHIFT)) >> 2; 70128ce5ce6Saurel32 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", 70528ce5ce6Saurel32 (uint32_t)addr >> DBDMA_CHANNEL_SHIFT, reg); 70628ce5ce6Saurel32 7077eaba824SAlexander Graf /* cmdptr cannot be modified if channel is ACTIVE */ 70828ce5ce6Saurel32 7097eaba824SAlexander Graf if (reg == DBDMA_CMDPTR_LO && (ch->regs[DBDMA_STATUS] & ACTIVE)) { 71028ce5ce6Saurel32 return; 7117eaba824SAlexander Graf } 71228ce5ce6Saurel32 71328ce5ce6Saurel32 ch->regs[reg] = value; 71428ce5ce6Saurel32 71528ce5ce6Saurel32 switch(reg) { 71628ce5ce6Saurel32 case DBDMA_CONTROL: 71728ce5ce6Saurel32 dbdma_control_write(ch); 71828ce5ce6Saurel32 break; 71928ce5ce6Saurel32 case DBDMA_CMDPTR_LO: 72028ce5ce6Saurel32 /* 16-byte aligned */ 721ad674e53SAurelien Jarno ch->regs[DBDMA_CMDPTR_LO] &= ~0xf; 72228ce5ce6Saurel32 dbdma_cmdptr_load(ch); 72328ce5ce6Saurel32 break; 72428ce5ce6Saurel32 case DBDMA_STATUS: 72528ce5ce6Saurel32 case DBDMA_INTR_SEL: 72628ce5ce6Saurel32 case DBDMA_BRANCH_SEL: 72728ce5ce6Saurel32 case DBDMA_WAIT_SEL: 72828ce5ce6Saurel32 /* nothing to do */ 72928ce5ce6Saurel32 break; 73028ce5ce6Saurel32 case DBDMA_XFER_MODE: 73128ce5ce6Saurel32 case DBDMA_CMDPTR_HI: 73228ce5ce6Saurel32 case DBDMA_DATA2PTR_HI: 73328ce5ce6Saurel32 case DBDMA_DATA2PTR_LO: 73428ce5ce6Saurel32 case DBDMA_ADDRESS_HI: 73528ce5ce6Saurel32 case DBDMA_BRANCH_ADDR_HI: 73628ce5ce6Saurel32 case DBDMA_RES1: 73728ce5ce6Saurel32 case DBDMA_RES2: 73828ce5ce6Saurel32 case DBDMA_RES3: 73928ce5ce6Saurel32 case DBDMA_RES4: 74028ce5ce6Saurel32 /* unused */ 74128ce5ce6Saurel32 break; 7423cbee15bSj_mayer } 7433cbee15bSj_mayer } 7443cbee15bSj_mayer 745a8170e5eSAvi Kivity static uint64_t dbdma_read(void *opaque, hwaddr addr, 74623c5e4caSAvi Kivity unsigned size) 7473cbee15bSj_mayer { 74828ce5ce6Saurel32 uint32_t value; 74928ce5ce6Saurel32 int channel = addr >> DBDMA_CHANNEL_SHIFT; 750c20df14bSJuan Quintela DBDMAState *s = opaque; 751c20df14bSJuan Quintela DBDMA_channel *ch = &s->channels[channel]; 75228ce5ce6Saurel32 int reg = (addr - (channel << DBDMA_CHANNEL_SHIFT)) >> 2; 753ea026b2fSblueswir1 75428ce5ce6Saurel32 value = ch->regs[reg]; 75528ce5ce6Saurel32 75628ce5ce6Saurel32 switch(reg) { 75728ce5ce6Saurel32 case DBDMA_CONTROL: 75877453882SBenjamin Herrenschmidt value = ch->regs[DBDMA_STATUS]; 75928ce5ce6Saurel32 break; 76028ce5ce6Saurel32 case DBDMA_STATUS: 76128ce5ce6Saurel32 case DBDMA_CMDPTR_LO: 76228ce5ce6Saurel32 case DBDMA_INTR_SEL: 76328ce5ce6Saurel32 case DBDMA_BRANCH_SEL: 76428ce5ce6Saurel32 case DBDMA_WAIT_SEL: 76528ce5ce6Saurel32 /* nothing to do */ 76628ce5ce6Saurel32 break; 76728ce5ce6Saurel32 case DBDMA_XFER_MODE: 76828ce5ce6Saurel32 case DBDMA_CMDPTR_HI: 76928ce5ce6Saurel32 case DBDMA_DATA2PTR_HI: 77028ce5ce6Saurel32 case DBDMA_DATA2PTR_LO: 77128ce5ce6Saurel32 case DBDMA_ADDRESS_HI: 77228ce5ce6Saurel32 case DBDMA_BRANCH_ADDR_HI: 77328ce5ce6Saurel32 /* unused */ 77428ce5ce6Saurel32 value = 0; 77528ce5ce6Saurel32 break; 77628ce5ce6Saurel32 case DBDMA_RES1: 77728ce5ce6Saurel32 case DBDMA_RES2: 77828ce5ce6Saurel32 case DBDMA_RES3: 77928ce5ce6Saurel32 case DBDMA_RES4: 78028ce5ce6Saurel32 /* reserved */ 78128ce5ce6Saurel32 break; 78228ce5ce6Saurel32 } 78328ce5ce6Saurel32 78477453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, "readl 0x" TARGET_FMT_plx " => 0x%08x\n", addr, value); 78577453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, "channel 0x%x reg 0x%x\n", 78677453882SBenjamin Herrenschmidt (uint32_t)addr >> DBDMA_CHANNEL_SHIFT, reg); 78777453882SBenjamin Herrenschmidt 78828ce5ce6Saurel32 return value; 7893cbee15bSj_mayer } 7903cbee15bSj_mayer 79123c5e4caSAvi Kivity static const MemoryRegionOps dbdma_ops = { 79223c5e4caSAvi Kivity .read = dbdma_read, 79323c5e4caSAvi Kivity .write = dbdma_write, 79423c5e4caSAvi Kivity .endianness = DEVICE_LITTLE_ENDIAN, 79523c5e4caSAvi Kivity .valid = { 79623c5e4caSAvi Kivity .min_access_size = 4, 79723c5e4caSAvi Kivity .max_access_size = 4, 79823c5e4caSAvi Kivity }, 7993cbee15bSj_mayer }; 8003cbee15bSj_mayer 801627be2f2SMark Cave-Ayland static const VMStateDescription vmstate_dbdma_io = { 802627be2f2SMark Cave-Ayland .name = "dbdma_io", 803da26fdc3SJuan Quintela .version_id = 0, 804da26fdc3SJuan Quintela .minimum_version_id = 0, 805da26fdc3SJuan Quintela .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[]) { 835da26fdc3SJuan Quintela 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), 839da26fdc3SJuan Quintela VMSTATE_END_OF_LIST() 8409b64997fSblueswir1 } 841da26fdc3SJuan Quintela }; 8429b64997fSblueswir1 843da26fdc3SJuan Quintela static const VMStateDescription vmstate_dbdma = { 844da26fdc3SJuan Quintela .name = "dbdma", 845627be2f2SMark Cave-Ayland .version_id = 3, 846627be2f2SMark Cave-Ayland .minimum_version_id = 3, 847da26fdc3SJuan Quintela .fields = (VMStateField[]) { 848da26fdc3SJuan Quintela VMSTATE_STRUCT_ARRAY(channels, DBDMAState, DBDMA_CHANNELS, 1, 849da26fdc3SJuan Quintela vmstate_dbdma_channel, DBDMA_channel), 850da26fdc3SJuan Quintela VMSTATE_END_OF_LIST() 8519b64997fSblueswir1 } 852da26fdc3SJuan Quintela }; 8539b64997fSblueswir1 854*1d27f351SMark Cave-Ayland static void mac_dbdma_reset(DeviceState *d) 8556e6b7363Sblueswir1 { 856*1d27f351SMark Cave-Ayland DBDMAState *s = MAC_DBDMA(d); 85728ce5ce6Saurel32 int i; 85828ce5ce6Saurel32 859*1d27f351SMark Cave-Ayland for (i = 0; i < DBDMA_CHANNELS; i++) { 860c20df14bSJuan Quintela memset(s->channels[i].regs, 0, DBDMA_SIZE); 8616e6b7363Sblueswir1 } 862*1d27f351SMark Cave-Ayland } 8636e6b7363Sblueswir1 8642d7d06d8SHervé Poussineau static void dbdma_unassigned_rw(DBDMA_io *io) 8652d7d06d8SHervé Poussineau { 8662d7d06d8SHervé Poussineau DBDMA_channel *ch = io->channel; 86777453882SBenjamin Herrenschmidt dbdma_cmd *current = &ch->current; 86877453882SBenjamin Herrenschmidt uint16_t cmd; 8692d7d06d8SHervé Poussineau qemu_log_mask(LOG_GUEST_ERROR, "%s: use of unassigned channel %d\n", 8702d7d06d8SHervé Poussineau __func__, ch->channel); 8712df77896SMark Cave-Ayland ch->io.processing = false; 87277453882SBenjamin Herrenschmidt 87377453882SBenjamin Herrenschmidt cmd = le16_to_cpu(current->command) & COMMAND_MASK; 87477453882SBenjamin Herrenschmidt if (cmd == OUTPUT_MORE || cmd == OUTPUT_LAST || 87577453882SBenjamin Herrenschmidt cmd == INPUT_MORE || cmd == INPUT_LAST) { 87677453882SBenjamin Herrenschmidt current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]); 87777453882SBenjamin Herrenschmidt current->res_count = cpu_to_le16(io->len); 87877453882SBenjamin Herrenschmidt dbdma_cmdptr_save(ch); 87977453882SBenjamin Herrenschmidt } 8802d7d06d8SHervé Poussineau } 8812d7d06d8SHervé Poussineau 8822d7d06d8SHervé Poussineau static void dbdma_unassigned_flush(DBDMA_io *io) 8832d7d06d8SHervé Poussineau { 8842d7d06d8SHervé Poussineau DBDMA_channel *ch = io->channel; 8852d7d06d8SHervé Poussineau qemu_log_mask(LOG_GUEST_ERROR, "%s: use of unassigned channel %d\n", 8862d7d06d8SHervé Poussineau __func__, ch->channel); 8872d7d06d8SHervé Poussineau } 8882d7d06d8SHervé Poussineau 88923c5e4caSAvi Kivity void* DBDMA_init (MemoryRegion **dbdma_mem) 8903cbee15bSj_mayer { 891c20df14bSJuan Quintela DBDMAState *s; 892*1d27f351SMark Cave-Ayland SysBusDevice *sbd; 89328ce5ce6Saurel32 894*1d27f351SMark Cave-Ayland s = MAC_DBDMA(object_new(TYPE_MAC_DBDMA)); 895*1d27f351SMark Cave-Ayland object_property_set_bool(OBJECT(s), true, "realized", NULL); 896*1d27f351SMark Cave-Ayland 897*1d27f351SMark Cave-Ayland sbd = SYS_BUS_DEVICE(s); 898*1d27f351SMark Cave-Ayland *dbdma_mem = sysbus_mmio_get_region(sbd, 0); 899*1d27f351SMark Cave-Ayland 900*1d27f351SMark Cave-Ayland return s; 901*1d27f351SMark Cave-Ayland } 902*1d27f351SMark Cave-Ayland 903*1d27f351SMark Cave-Ayland static void mac_dbdma_init(Object *obj) 904*1d27f351SMark Cave-Ayland { 905*1d27f351SMark Cave-Ayland SysBusDevice *sbd = SYS_BUS_DEVICE(obj); 906*1d27f351SMark Cave-Ayland DBDMAState *s = MAC_DBDMA(obj); 907*1d27f351SMark Cave-Ayland int i; 90828ce5ce6Saurel32 9093e300fa6SAlexander Graf for (i = 0; i < DBDMA_CHANNELS; i++) { 9102d7d06d8SHervé Poussineau DBDMA_channel *ch = &s->channels[i]; 9112d7d06d8SHervé Poussineau 9122d7d06d8SHervé Poussineau ch->rw = dbdma_unassigned_rw; 9132d7d06d8SHervé Poussineau ch->flush = dbdma_unassigned_flush; 9142d7d06d8SHervé Poussineau ch->channel = i; 9152d7d06d8SHervé Poussineau ch->io.channel = ch; 9163e300fa6SAlexander Graf } 9173e300fa6SAlexander Graf 918*1d27f351SMark Cave-Ayland memory_region_init_io(&s->mem, obj, &dbdma_ops, s, "dbdma", 0x1000); 919*1d27f351SMark Cave-Ayland sysbus_init_mmio(sbd, &s->mem); 920*1d27f351SMark Cave-Ayland } 921*1d27f351SMark Cave-Ayland 922*1d27f351SMark Cave-Ayland static void mac_dbdma_realize(DeviceState *dev, Error **errp) 923*1d27f351SMark Cave-Ayland { 924*1d27f351SMark Cave-Ayland DBDMAState *s = MAC_DBDMA(dev); 92528ce5ce6Saurel32 926d2f0ce21SAlexander Graf s->bh = qemu_bh_new(DBDMA_run_bh, s); 9273cbee15bSj_mayer } 928*1d27f351SMark Cave-Ayland 929*1d27f351SMark Cave-Ayland static void mac_dbdma_class_init(ObjectClass *oc, void *data) 930*1d27f351SMark Cave-Ayland { 931*1d27f351SMark Cave-Ayland DeviceClass *dc = DEVICE_CLASS(oc); 932*1d27f351SMark Cave-Ayland 933*1d27f351SMark Cave-Ayland dc->realize = mac_dbdma_realize; 934*1d27f351SMark Cave-Ayland dc->reset = mac_dbdma_reset; 935*1d27f351SMark Cave-Ayland dc->vmsd = &vmstate_dbdma; 936*1d27f351SMark Cave-Ayland } 937*1d27f351SMark Cave-Ayland 938*1d27f351SMark Cave-Ayland static const TypeInfo mac_dbdma_type_info = { 939*1d27f351SMark Cave-Ayland .name = TYPE_MAC_DBDMA, 940*1d27f351SMark Cave-Ayland .parent = TYPE_SYS_BUS_DEVICE, 941*1d27f351SMark Cave-Ayland .instance_size = sizeof(DBDMAState), 942*1d27f351SMark Cave-Ayland .instance_init = mac_dbdma_init, 943*1d27f351SMark Cave-Ayland .class_init = mac_dbdma_class_init 944*1d27f351SMark Cave-Ayland }; 945*1d27f351SMark Cave-Ayland 946*1d27f351SMark Cave-Ayland static void mac_dbdma_register_types(void) 947*1d27f351SMark Cave-Ayland { 948*1d27f351SMark Cave-Ayland type_register_static(&mac_dbdma_type_info); 949*1d27f351SMark Cave-Ayland } 950*1d27f351SMark Cave-Ayland 951*1d27f351SMark Cave-Ayland type_init(mac_dbdma_register_types) 952