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 { 993e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "dbdma_cmdptr_save 0x%08x\n", 100ad674e53SAurelien Jarno ch->regs[DBDMA_CMDPTR_LO]); 1013e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "xfer_status 0x%08x res_count 0x%04x\n", 10228ce5ce6Saurel32 le16_to_cpu(ch->current.xfer_status), 10328ce5ce6Saurel32 le16_to_cpu(ch->current.res_count)); 10488655881SMark Cave-Ayland dma_memory_write(&address_space_memory, ch->regs[DBDMA_CMDPTR_LO], 105e1fe50dcSStefan Weil &ch->current, sizeof(dbdma_cmd)); 10628ce5ce6Saurel32 } 10728ce5ce6Saurel32 10828ce5ce6Saurel32 static void kill_channel(DBDMA_channel *ch) 10928ce5ce6Saurel32 { 1103e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "kill_channel\n"); 11128ce5ce6Saurel32 112ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] |= DEAD; 113ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] &= ~ACTIVE; 11428ce5ce6Saurel32 11528ce5ce6Saurel32 qemu_irq_raise(ch->irq); 11628ce5ce6Saurel32 } 11728ce5ce6Saurel32 11828ce5ce6Saurel32 static void conditional_interrupt(DBDMA_channel *ch) 11928ce5ce6Saurel32 { 12028ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 12128ce5ce6Saurel32 uint16_t intr; 12228ce5ce6Saurel32 uint16_t sel_mask, sel_value; 12328ce5ce6Saurel32 uint32_t status; 12428ce5ce6Saurel32 int cond; 12528ce5ce6Saurel32 1263e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "%s\n", __func__); 12728ce5ce6Saurel32 128b42ec42dSaurel32 intr = le16_to_cpu(current->command) & INTR_MASK; 12928ce5ce6Saurel32 13028ce5ce6Saurel32 switch(intr) { 13128ce5ce6Saurel32 case INTR_NEVER: /* don't interrupt */ 13228ce5ce6Saurel32 return; 13328ce5ce6Saurel32 case INTR_ALWAYS: /* always interrupt */ 13428ce5ce6Saurel32 qemu_irq_raise(ch->irq); 1353e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "%s: raise\n", __func__); 13628ce5ce6Saurel32 return; 13728ce5ce6Saurel32 } 13828ce5ce6Saurel32 139ad674e53SAurelien Jarno status = ch->regs[DBDMA_STATUS] & DEVSTAT; 14028ce5ce6Saurel32 141ad674e53SAurelien Jarno sel_mask = (ch->regs[DBDMA_INTR_SEL] >> 16) & 0x0f; 142ad674e53SAurelien Jarno sel_value = ch->regs[DBDMA_INTR_SEL] & 0x0f; 14328ce5ce6Saurel32 14428ce5ce6Saurel32 cond = (status & sel_mask) == (sel_value & sel_mask); 14528ce5ce6Saurel32 14628ce5ce6Saurel32 switch(intr) { 14728ce5ce6Saurel32 case INTR_IFSET: /* intr if condition bit is 1 */ 14833ce36bbSAlexander Graf if (cond) { 14928ce5ce6Saurel32 qemu_irq_raise(ch->irq); 1503e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "%s: raise\n", __func__); 15133ce36bbSAlexander Graf } 15228ce5ce6Saurel32 return; 15328ce5ce6Saurel32 case INTR_IFCLR: /* intr if condition bit is 0 */ 15433ce36bbSAlexander Graf if (!cond) { 15528ce5ce6Saurel32 qemu_irq_raise(ch->irq); 1563e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "%s: raise\n", __func__); 15733ce36bbSAlexander Graf } 15828ce5ce6Saurel32 return; 15928ce5ce6Saurel32 } 16028ce5ce6Saurel32 } 16128ce5ce6Saurel32 16228ce5ce6Saurel32 static int conditional_wait(DBDMA_channel *ch) 16328ce5ce6Saurel32 { 16428ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 16528ce5ce6Saurel32 uint16_t wait; 16628ce5ce6Saurel32 uint16_t sel_mask, sel_value; 16728ce5ce6Saurel32 uint32_t status; 16828ce5ce6Saurel32 int cond; 16928ce5ce6Saurel32 1703e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "conditional_wait\n"); 17128ce5ce6Saurel32 172b42ec42dSaurel32 wait = le16_to_cpu(current->command) & WAIT_MASK; 17328ce5ce6Saurel32 17428ce5ce6Saurel32 switch(wait) { 17528ce5ce6Saurel32 case WAIT_NEVER: /* don't wait */ 17628ce5ce6Saurel32 return 0; 17728ce5ce6Saurel32 case WAIT_ALWAYS: /* always wait */ 17828ce5ce6Saurel32 return 1; 17928ce5ce6Saurel32 } 18028ce5ce6Saurel32 181ad674e53SAurelien Jarno status = ch->regs[DBDMA_STATUS] & DEVSTAT; 18228ce5ce6Saurel32 183ad674e53SAurelien Jarno sel_mask = (ch->regs[DBDMA_WAIT_SEL] >> 16) & 0x0f; 184ad674e53SAurelien Jarno sel_value = ch->regs[DBDMA_WAIT_SEL] & 0x0f; 18528ce5ce6Saurel32 18628ce5ce6Saurel32 cond = (status & sel_mask) == (sel_value & sel_mask); 18728ce5ce6Saurel32 18828ce5ce6Saurel32 switch(wait) { 18928ce5ce6Saurel32 case WAIT_IFSET: /* wait if condition bit is 1 */ 19028ce5ce6Saurel32 if (cond) 19128ce5ce6Saurel32 return 1; 19228ce5ce6Saurel32 return 0; 19328ce5ce6Saurel32 case WAIT_IFCLR: /* wait if condition bit is 0 */ 19428ce5ce6Saurel32 if (!cond) 19528ce5ce6Saurel32 return 1; 19628ce5ce6Saurel32 return 0; 19728ce5ce6Saurel32 } 19828ce5ce6Saurel32 return 0; 19928ce5ce6Saurel32 } 20028ce5ce6Saurel32 20128ce5ce6Saurel32 static void next(DBDMA_channel *ch) 20228ce5ce6Saurel32 { 20328ce5ce6Saurel32 uint32_t cp; 20428ce5ce6Saurel32 205ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] &= ~BT; 20628ce5ce6Saurel32 207ad674e53SAurelien Jarno cp = ch->regs[DBDMA_CMDPTR_LO]; 208ad674e53SAurelien Jarno ch->regs[DBDMA_CMDPTR_LO] = cp + sizeof(dbdma_cmd); 20928ce5ce6Saurel32 dbdma_cmdptr_load(ch); 21028ce5ce6Saurel32 } 21128ce5ce6Saurel32 21228ce5ce6Saurel32 static void branch(DBDMA_channel *ch) 21328ce5ce6Saurel32 { 21428ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 21528ce5ce6Saurel32 2163f0d4128SMark Cave-Ayland ch->regs[DBDMA_CMDPTR_LO] = le32_to_cpu(current->cmd_dep); 217ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] |= BT; 21828ce5ce6Saurel32 dbdma_cmdptr_load(ch); 21928ce5ce6Saurel32 } 22028ce5ce6Saurel32 22128ce5ce6Saurel32 static void conditional_branch(DBDMA_channel *ch) 22228ce5ce6Saurel32 { 22328ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 22428ce5ce6Saurel32 uint16_t br; 22528ce5ce6Saurel32 uint16_t sel_mask, sel_value; 22628ce5ce6Saurel32 uint32_t status; 22728ce5ce6Saurel32 int cond; 22828ce5ce6Saurel32 2293e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "conditional_branch\n"); 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 */ 24028ce5ce6Saurel32 branch(ch); 24128ce5ce6Saurel32 return; 24228ce5ce6Saurel32 } 24328ce5ce6Saurel32 244ad674e53SAurelien Jarno status = ch->regs[DBDMA_STATUS] & DEVSTAT; 24528ce5ce6Saurel32 246ad674e53SAurelien Jarno sel_mask = (ch->regs[DBDMA_BRANCH_SEL] >> 16) & 0x0f; 247ad674e53SAurelien Jarno sel_value = ch->regs[DBDMA_BRANCH_SEL] & 0x0f; 24828ce5ce6Saurel32 24928ce5ce6Saurel32 cond = (status & sel_mask) == (sel_value & sel_mask); 25028ce5ce6Saurel32 25128ce5ce6Saurel32 switch(br) { 25228ce5ce6Saurel32 case BR_IFSET: /* branch if condition bit is 1 */ 25328ce5ce6Saurel32 if (cond) 25428ce5ce6Saurel32 branch(ch); 25528ce5ce6Saurel32 else 25628ce5ce6Saurel32 next(ch); 25728ce5ce6Saurel32 return; 25828ce5ce6Saurel32 case BR_IFCLR: /* branch if condition bit is 0 */ 25928ce5ce6Saurel32 if (!cond) 26028ce5ce6Saurel32 branch(ch); 26128ce5ce6Saurel32 else 26228ce5ce6Saurel32 next(ch); 26328ce5ce6Saurel32 return; 26428ce5ce6Saurel32 } 26528ce5ce6Saurel32 } 26628ce5ce6Saurel32 267b42ec42dSaurel32 static void channel_run(DBDMA_channel *ch); 268b42ec42dSaurel32 269b42ec42dSaurel32 static void dbdma_end(DBDMA_io *io) 27028ce5ce6Saurel32 { 27128ce5ce6Saurel32 DBDMA_channel *ch = io->channel; 27228ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 27328ce5ce6Saurel32 2743e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "%s\n", __func__); 27533ce36bbSAlexander Graf 276b42ec42dSaurel32 if (conditional_wait(ch)) 277b42ec42dSaurel32 goto wait; 27828ce5ce6Saurel32 279ad674e53SAurelien Jarno current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]); 280ad674e53SAurelien Jarno current->res_count = cpu_to_le16(io->len); 281b42ec42dSaurel32 dbdma_cmdptr_save(ch); 282862c9280Saurel32 if (io->is_last) 283ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] &= ~FLUSH; 28428ce5ce6Saurel32 285b42ec42dSaurel32 conditional_interrupt(ch); 286b42ec42dSaurel32 conditional_branch(ch); 287b42ec42dSaurel32 288b42ec42dSaurel32 wait: 28903ee3b1eSAlexander Graf /* Indicate that we're ready for a new DMA round */ 29003ee3b1eSAlexander Graf ch->io.processing = false; 29103ee3b1eSAlexander Graf 292ad674e53SAurelien Jarno if ((ch->regs[DBDMA_STATUS] & RUN) && 293ad674e53SAurelien Jarno (ch->regs[DBDMA_STATUS] & ACTIVE)) 294b42ec42dSaurel32 channel_run(ch); 29528ce5ce6Saurel32 } 29628ce5ce6Saurel32 297b42ec42dSaurel32 static void start_output(DBDMA_channel *ch, int key, uint32_t addr, 29828ce5ce6Saurel32 uint16_t req_count, int is_last) 29928ce5ce6Saurel32 { 3003e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "start_output\n"); 30128ce5ce6Saurel32 30228ce5ce6Saurel32 /* KEY_REGS, KEY_DEVICE and KEY_STREAM 30328ce5ce6Saurel32 * are not implemented in the mac-io chip 30428ce5ce6Saurel32 */ 30528ce5ce6Saurel32 3063e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "addr 0x%x key 0x%x\n", addr, key); 30728ce5ce6Saurel32 if (!addr || key > KEY_STREAM3) { 30828ce5ce6Saurel32 kill_channel(ch); 309b42ec42dSaurel32 return; 31028ce5ce6Saurel32 } 31128ce5ce6Saurel32 312b42ec42dSaurel32 ch->io.addr = addr; 31328ce5ce6Saurel32 ch->io.len = req_count; 31428ce5ce6Saurel32 ch->io.is_last = is_last; 315b42ec42dSaurel32 ch->io.dma_end = dbdma_end; 316b42ec42dSaurel32 ch->io.is_dma_out = 1; 31703ee3b1eSAlexander Graf ch->io.processing = true; 318a9ceb76dSAlexander Graf if (ch->rw) { 319b42ec42dSaurel32 ch->rw(&ch->io); 32028ce5ce6Saurel32 } 321a9ceb76dSAlexander Graf } 32228ce5ce6Saurel32 323b42ec42dSaurel32 static void start_input(DBDMA_channel *ch, int key, uint32_t addr, 32428ce5ce6Saurel32 uint16_t req_count, int is_last) 32528ce5ce6Saurel32 { 3263e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "start_input\n"); 32728ce5ce6Saurel32 32828ce5ce6Saurel32 /* KEY_REGS, KEY_DEVICE and KEY_STREAM 32928ce5ce6Saurel32 * are not implemented in the mac-io chip 33028ce5ce6Saurel32 */ 33128ce5ce6Saurel32 3323e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "addr 0x%x key 0x%x\n", addr, key); 33328ce5ce6Saurel32 if (!addr || key > KEY_STREAM3) { 33428ce5ce6Saurel32 kill_channel(ch); 335b42ec42dSaurel32 return; 33628ce5ce6Saurel32 } 33728ce5ce6Saurel32 338b42ec42dSaurel32 ch->io.addr = addr; 33928ce5ce6Saurel32 ch->io.len = req_count; 34028ce5ce6Saurel32 ch->io.is_last = is_last; 341b42ec42dSaurel32 ch->io.dma_end = dbdma_end; 342b42ec42dSaurel32 ch->io.is_dma_out = 0; 34303ee3b1eSAlexander Graf ch->io.processing = true; 344a9ceb76dSAlexander Graf if (ch->rw) { 345b42ec42dSaurel32 ch->rw(&ch->io); 34628ce5ce6Saurel32 } 347a9ceb76dSAlexander Graf } 34828ce5ce6Saurel32 349b42ec42dSaurel32 static void load_word(DBDMA_channel *ch, int key, uint32_t addr, 35028ce5ce6Saurel32 uint16_t len) 35128ce5ce6Saurel32 { 35228ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 35328ce5ce6Saurel32 354*e12f50b9SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "load_word %d bytes, addr=%08x\n", len, addr); 35528ce5ce6Saurel32 35628ce5ce6Saurel32 /* only implements KEY_SYSTEM */ 35728ce5ce6Saurel32 35828ce5ce6Saurel32 if (key != KEY_SYSTEM) { 35928ce5ce6Saurel32 printf("DBDMA: LOAD_WORD, unimplemented key %x\n", key); 36028ce5ce6Saurel32 kill_channel(ch); 361b42ec42dSaurel32 return; 36228ce5ce6Saurel32 } 36328ce5ce6Saurel32 364*e12f50b9SMark Cave-Ayland dma_memory_read(&address_space_memory, addr, ¤t->cmd_dep, len); 36528ce5ce6Saurel32 36628ce5ce6Saurel32 if (conditional_wait(ch)) 367b42ec42dSaurel32 goto wait; 36828ce5ce6Saurel32 369ad674e53SAurelien Jarno current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]); 37028ce5ce6Saurel32 dbdma_cmdptr_save(ch); 371ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] &= ~FLUSH; 37228ce5ce6Saurel32 37328ce5ce6Saurel32 conditional_interrupt(ch); 37428ce5ce6Saurel32 next(ch); 37528ce5ce6Saurel32 376b42ec42dSaurel32 wait: 377d2f0ce21SAlexander Graf DBDMA_kick(dbdma_from_ch(ch)); 37828ce5ce6Saurel32 } 37928ce5ce6Saurel32 380b42ec42dSaurel32 static void store_word(DBDMA_channel *ch, int key, uint32_t addr, 38128ce5ce6Saurel32 uint16_t len) 38228ce5ce6Saurel32 { 38328ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 38428ce5ce6Saurel32 385*e12f50b9SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "store_word %d bytes, addr=%08x pa=%x\n", 386*e12f50b9SMark Cave-Ayland len, addr, le32_to_cpu(current->cmd_dep)); 38728ce5ce6Saurel32 38828ce5ce6Saurel32 /* only implements KEY_SYSTEM */ 38928ce5ce6Saurel32 39028ce5ce6Saurel32 if (key != KEY_SYSTEM) { 39128ce5ce6Saurel32 printf("DBDMA: STORE_WORD, unimplemented key %x\n", key); 39228ce5ce6Saurel32 kill_channel(ch); 393b42ec42dSaurel32 return; 39428ce5ce6Saurel32 } 39528ce5ce6Saurel32 396*e12f50b9SMark Cave-Ayland dma_memory_write(&address_space_memory, addr, ¤t->cmd_dep, len); 39728ce5ce6Saurel32 39828ce5ce6Saurel32 if (conditional_wait(ch)) 399b42ec42dSaurel32 goto wait; 40028ce5ce6Saurel32 401ad674e53SAurelien Jarno current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]); 40228ce5ce6Saurel32 dbdma_cmdptr_save(ch); 403ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] &= ~FLUSH; 40428ce5ce6Saurel32 40528ce5ce6Saurel32 conditional_interrupt(ch); 40628ce5ce6Saurel32 next(ch); 40728ce5ce6Saurel32 408b42ec42dSaurel32 wait: 409d2f0ce21SAlexander Graf DBDMA_kick(dbdma_from_ch(ch)); 41028ce5ce6Saurel32 } 41128ce5ce6Saurel32 412b42ec42dSaurel32 static void nop(DBDMA_channel *ch) 41328ce5ce6Saurel32 { 41428ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 41528ce5ce6Saurel32 41628ce5ce6Saurel32 if (conditional_wait(ch)) 417b42ec42dSaurel32 goto wait; 41828ce5ce6Saurel32 419ad674e53SAurelien Jarno current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]); 42028ce5ce6Saurel32 dbdma_cmdptr_save(ch); 42128ce5ce6Saurel32 42228ce5ce6Saurel32 conditional_interrupt(ch); 42328ce5ce6Saurel32 conditional_branch(ch); 42428ce5ce6Saurel32 425b42ec42dSaurel32 wait: 426d2f0ce21SAlexander Graf DBDMA_kick(dbdma_from_ch(ch)); 42728ce5ce6Saurel32 } 42828ce5ce6Saurel32 429b42ec42dSaurel32 static void stop(DBDMA_channel *ch) 43028ce5ce6Saurel32 { 431ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] &= ~(ACTIVE|DEAD|FLUSH); 43228ce5ce6Saurel32 43328ce5ce6Saurel32 /* the stop command does not increment command pointer */ 43428ce5ce6Saurel32 } 43528ce5ce6Saurel32 436b42ec42dSaurel32 static void channel_run(DBDMA_channel *ch) 43728ce5ce6Saurel32 { 43828ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 43928ce5ce6Saurel32 uint16_t cmd, key; 44028ce5ce6Saurel32 uint16_t req_count; 44128ce5ce6Saurel32 uint32_t phy_addr; 44228ce5ce6Saurel32 4433e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "channel_run\n"); 44428ce5ce6Saurel32 dump_dbdma_cmd(current); 44528ce5ce6Saurel32 44628ce5ce6Saurel32 /* clear WAKE flag at command fetch */ 44728ce5ce6Saurel32 448ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] &= ~WAKE; 44928ce5ce6Saurel32 45028ce5ce6Saurel32 cmd = le16_to_cpu(current->command) & COMMAND_MASK; 45128ce5ce6Saurel32 45228ce5ce6Saurel32 switch (cmd) { 45328ce5ce6Saurel32 case DBDMA_NOP: 454b42ec42dSaurel32 nop(ch); 455b42ec42dSaurel32 return; 45628ce5ce6Saurel32 45728ce5ce6Saurel32 case DBDMA_STOP: 458b42ec42dSaurel32 stop(ch); 459b42ec42dSaurel32 return; 46028ce5ce6Saurel32 } 46128ce5ce6Saurel32 46228ce5ce6Saurel32 key = le16_to_cpu(current->command) & 0x0700; 46328ce5ce6Saurel32 req_count = le16_to_cpu(current->req_count); 46428ce5ce6Saurel32 phy_addr = le32_to_cpu(current->phy_addr); 46528ce5ce6Saurel32 46628ce5ce6Saurel32 if (key == KEY_STREAM4) { 46728ce5ce6Saurel32 printf("command %x, invalid key 4\n", cmd); 46828ce5ce6Saurel32 kill_channel(ch); 469b42ec42dSaurel32 return; 47028ce5ce6Saurel32 } 47128ce5ce6Saurel32 47228ce5ce6Saurel32 switch (cmd) { 47328ce5ce6Saurel32 case OUTPUT_MORE: 474b42ec42dSaurel32 start_output(ch, key, phy_addr, req_count, 0); 475b42ec42dSaurel32 return; 47628ce5ce6Saurel32 47728ce5ce6Saurel32 case OUTPUT_LAST: 478b42ec42dSaurel32 start_output(ch, key, phy_addr, req_count, 1); 479b42ec42dSaurel32 return; 48028ce5ce6Saurel32 48128ce5ce6Saurel32 case INPUT_MORE: 482b42ec42dSaurel32 start_input(ch, key, phy_addr, req_count, 0); 483b42ec42dSaurel32 return; 48428ce5ce6Saurel32 48528ce5ce6Saurel32 case INPUT_LAST: 486b42ec42dSaurel32 start_input(ch, key, phy_addr, req_count, 1); 487b42ec42dSaurel32 return; 48828ce5ce6Saurel32 } 48928ce5ce6Saurel32 49028ce5ce6Saurel32 if (key < KEY_REGS) { 49128ce5ce6Saurel32 printf("command %x, invalid key %x\n", cmd, key); 49228ce5ce6Saurel32 key = KEY_SYSTEM; 49328ce5ce6Saurel32 } 49428ce5ce6Saurel32 49528ce5ce6Saurel32 /* for LOAD_WORD and STORE_WORD, req_count is on 3 bits 49628ce5ce6Saurel32 * and BRANCH is invalid 49728ce5ce6Saurel32 */ 49828ce5ce6Saurel32 49928ce5ce6Saurel32 req_count = req_count & 0x0007; 50028ce5ce6Saurel32 if (req_count & 0x4) { 50128ce5ce6Saurel32 req_count = 4; 50228ce5ce6Saurel32 phy_addr &= ~3; 50328ce5ce6Saurel32 } else if (req_count & 0x2) { 50428ce5ce6Saurel32 req_count = 2; 50528ce5ce6Saurel32 phy_addr &= ~1; 50628ce5ce6Saurel32 } else 50728ce5ce6Saurel32 req_count = 1; 50828ce5ce6Saurel32 50928ce5ce6Saurel32 switch (cmd) { 51028ce5ce6Saurel32 case LOAD_WORD: 511b42ec42dSaurel32 load_word(ch, key, phy_addr, req_count); 512b42ec42dSaurel32 return; 51328ce5ce6Saurel32 51428ce5ce6Saurel32 case STORE_WORD: 515b42ec42dSaurel32 store_word(ch, key, phy_addr, req_count); 516b42ec42dSaurel32 return; 51728ce5ce6Saurel32 } 51828ce5ce6Saurel32 } 51928ce5ce6Saurel32 520c20df14bSJuan Quintela static void DBDMA_run(DBDMAState *s) 52128ce5ce6Saurel32 { 52228ce5ce6Saurel32 int channel; 52328ce5ce6Saurel32 524c20df14bSJuan Quintela for (channel = 0; channel < DBDMA_CHANNELS; channel++) { 525c20df14bSJuan Quintela DBDMA_channel *ch = &s->channels[channel]; 526ad674e53SAurelien Jarno uint32_t status = ch->regs[DBDMA_STATUS]; 52703ee3b1eSAlexander Graf if (!ch->io.processing && (status & RUN) && (status & ACTIVE)) { 528b42ec42dSaurel32 channel_run(ch); 52928ce5ce6Saurel32 } 53028ce5ce6Saurel32 } 531c20df14bSJuan Quintela } 53228ce5ce6Saurel32 53328ce5ce6Saurel32 static void DBDMA_run_bh(void *opaque) 53428ce5ce6Saurel32 { 535c20df14bSJuan Quintela DBDMAState *s = opaque; 53628ce5ce6Saurel32 5373e49c439SMark Cave-Ayland DBDMA_DPRINTF("-> DBDMA_run_bh\n"); 538c20df14bSJuan Quintela DBDMA_run(s); 5393e49c439SMark Cave-Ayland DBDMA_DPRINTF("<- DBDMA_run_bh\n"); 54028ce5ce6Saurel32 } 54128ce5ce6Saurel32 542d1e562deSAlexander Graf void DBDMA_kick(DBDMAState *dbdma) 543d1e562deSAlexander Graf { 544d2f0ce21SAlexander Graf qemu_bh_schedule(dbdma->bh); 545d1e562deSAlexander Graf } 546d1e562deSAlexander Graf 54728ce5ce6Saurel32 void DBDMA_register_channel(void *dbdma, int nchan, qemu_irq irq, 548862c9280Saurel32 DBDMA_rw rw, DBDMA_flush flush, 54928ce5ce6Saurel32 void *opaque) 55028ce5ce6Saurel32 { 551c20df14bSJuan Quintela DBDMAState *s = dbdma; 552c20df14bSJuan Quintela DBDMA_channel *ch = &s->channels[nchan]; 55328ce5ce6Saurel32 5543e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "DBDMA_register_channel 0x%x\n", nchan); 55528ce5ce6Saurel32 5562d7d06d8SHervé Poussineau assert(rw); 5572d7d06d8SHervé Poussineau assert(flush); 5582d7d06d8SHervé Poussineau 55928ce5ce6Saurel32 ch->irq = irq; 560b42ec42dSaurel32 ch->rw = rw; 561862c9280Saurel32 ch->flush = flush; 56228ce5ce6Saurel32 ch->io.opaque = opaque; 56328ce5ce6Saurel32 } 56428ce5ce6Saurel32 56528ce5ce6Saurel32 static void 56628ce5ce6Saurel32 dbdma_control_write(DBDMA_channel *ch) 56728ce5ce6Saurel32 { 56828ce5ce6Saurel32 uint16_t mask, value; 56928ce5ce6Saurel32 uint32_t status; 57028ce5ce6Saurel32 571ad674e53SAurelien Jarno mask = (ch->regs[DBDMA_CONTROL] >> 16) & 0xffff; 572ad674e53SAurelien Jarno value = ch->regs[DBDMA_CONTROL] & 0xffff; 57328ce5ce6Saurel32 57428ce5ce6Saurel32 value &= (RUN | PAUSE | FLUSH | WAKE | DEVSTAT); 57528ce5ce6Saurel32 576ad674e53SAurelien Jarno status = ch->regs[DBDMA_STATUS]; 57728ce5ce6Saurel32 57828ce5ce6Saurel32 status = (value & mask) | (status & ~mask); 57928ce5ce6Saurel32 58028ce5ce6Saurel32 if (status & WAKE) 58128ce5ce6Saurel32 status |= ACTIVE; 58228ce5ce6Saurel32 if (status & RUN) { 58328ce5ce6Saurel32 status |= ACTIVE; 58428ce5ce6Saurel32 status &= ~DEAD; 58528ce5ce6Saurel32 } 58628ce5ce6Saurel32 if (status & PAUSE) 58728ce5ce6Saurel32 status &= ~ACTIVE; 588ad674e53SAurelien Jarno if ((ch->regs[DBDMA_STATUS] & RUN) && !(status & RUN)) { 58928ce5ce6Saurel32 /* RUN is cleared */ 59028ce5ce6Saurel32 status &= ~(ACTIVE|DEAD); 5911cde732dSMark Cave-Ayland } 5921cde732dSMark Cave-Ayland 593987422bcSAmadeusz Sławiński if ((status & FLUSH) && ch->flush) { 594987422bcSAmadeusz Sławiński ch->flush(&ch->io); 595987422bcSAmadeusz Sławiński status &= ~FLUSH; 596987422bcSAmadeusz Sławiński } 59728ce5ce6Saurel32 5983e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, " status 0x%08x\n", status); 59928ce5ce6Saurel32 600ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] = status; 60128ce5ce6Saurel32 602d2f0ce21SAlexander Graf if (status & ACTIVE) { 603d2f0ce21SAlexander Graf DBDMA_kick(dbdma_from_ch(ch)); 604d2f0ce21SAlexander Graf } 605d2f0ce21SAlexander Graf } 6063cbee15bSj_mayer 607a8170e5eSAvi Kivity static void dbdma_write(void *opaque, hwaddr addr, 60823c5e4caSAvi Kivity uint64_t value, unsigned size) 6093cbee15bSj_mayer { 61028ce5ce6Saurel32 int channel = addr >> DBDMA_CHANNEL_SHIFT; 611c20df14bSJuan Quintela DBDMAState *s = opaque; 612c20df14bSJuan Quintela DBDMA_channel *ch = &s->channels[channel]; 61328ce5ce6Saurel32 int reg = (addr - (channel << DBDMA_CHANNEL_SHIFT)) >> 2; 61428ce5ce6Saurel32 6153e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "writel 0x" TARGET_FMT_plx " <= 0x%08"PRIx64"\n", 61658c0c311SAlexander Graf addr, value); 6173e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "channel 0x%x reg 0x%x\n", 61828ce5ce6Saurel32 (uint32_t)addr >> DBDMA_CHANNEL_SHIFT, reg); 61928ce5ce6Saurel32 6207eaba824SAlexander Graf /* cmdptr cannot be modified if channel is ACTIVE */ 62128ce5ce6Saurel32 6227eaba824SAlexander Graf if (reg == DBDMA_CMDPTR_LO && (ch->regs[DBDMA_STATUS] & ACTIVE)) { 62328ce5ce6Saurel32 return; 6247eaba824SAlexander Graf } 62528ce5ce6Saurel32 62628ce5ce6Saurel32 ch->regs[reg] = value; 62728ce5ce6Saurel32 62828ce5ce6Saurel32 switch(reg) { 62928ce5ce6Saurel32 case DBDMA_CONTROL: 63028ce5ce6Saurel32 dbdma_control_write(ch); 63128ce5ce6Saurel32 break; 63228ce5ce6Saurel32 case DBDMA_CMDPTR_LO: 63328ce5ce6Saurel32 /* 16-byte aligned */ 634ad674e53SAurelien Jarno ch->regs[DBDMA_CMDPTR_LO] &= ~0xf; 63528ce5ce6Saurel32 dbdma_cmdptr_load(ch); 63628ce5ce6Saurel32 break; 63728ce5ce6Saurel32 case DBDMA_STATUS: 63828ce5ce6Saurel32 case DBDMA_INTR_SEL: 63928ce5ce6Saurel32 case DBDMA_BRANCH_SEL: 64028ce5ce6Saurel32 case DBDMA_WAIT_SEL: 64128ce5ce6Saurel32 /* nothing to do */ 64228ce5ce6Saurel32 break; 64328ce5ce6Saurel32 case DBDMA_XFER_MODE: 64428ce5ce6Saurel32 case DBDMA_CMDPTR_HI: 64528ce5ce6Saurel32 case DBDMA_DATA2PTR_HI: 64628ce5ce6Saurel32 case DBDMA_DATA2PTR_LO: 64728ce5ce6Saurel32 case DBDMA_ADDRESS_HI: 64828ce5ce6Saurel32 case DBDMA_BRANCH_ADDR_HI: 64928ce5ce6Saurel32 case DBDMA_RES1: 65028ce5ce6Saurel32 case DBDMA_RES2: 65128ce5ce6Saurel32 case DBDMA_RES3: 65228ce5ce6Saurel32 case DBDMA_RES4: 65328ce5ce6Saurel32 /* unused */ 65428ce5ce6Saurel32 break; 6553cbee15bSj_mayer } 6563cbee15bSj_mayer } 6573cbee15bSj_mayer 658a8170e5eSAvi Kivity static uint64_t dbdma_read(void *opaque, hwaddr addr, 65923c5e4caSAvi Kivity unsigned size) 6603cbee15bSj_mayer { 66128ce5ce6Saurel32 uint32_t value; 66228ce5ce6Saurel32 int channel = addr >> DBDMA_CHANNEL_SHIFT; 663c20df14bSJuan Quintela DBDMAState *s = opaque; 664c20df14bSJuan Quintela DBDMA_channel *ch = &s->channels[channel]; 66528ce5ce6Saurel32 int reg = (addr - (channel << DBDMA_CHANNEL_SHIFT)) >> 2; 666ea026b2fSblueswir1 66728ce5ce6Saurel32 value = ch->regs[reg]; 66828ce5ce6Saurel32 6693e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "readl 0x" TARGET_FMT_plx " => 0x%08x\n", addr, value); 6703e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "channel 0x%x reg 0x%x\n", 67128ce5ce6Saurel32 (uint32_t)addr >> DBDMA_CHANNEL_SHIFT, reg); 67228ce5ce6Saurel32 67328ce5ce6Saurel32 switch(reg) { 67428ce5ce6Saurel32 case DBDMA_CONTROL: 67528ce5ce6Saurel32 value = 0; 67628ce5ce6Saurel32 break; 67728ce5ce6Saurel32 case DBDMA_STATUS: 67828ce5ce6Saurel32 case DBDMA_CMDPTR_LO: 67928ce5ce6Saurel32 case DBDMA_INTR_SEL: 68028ce5ce6Saurel32 case DBDMA_BRANCH_SEL: 68128ce5ce6Saurel32 case DBDMA_WAIT_SEL: 68228ce5ce6Saurel32 /* nothing to do */ 68328ce5ce6Saurel32 break; 68428ce5ce6Saurel32 case DBDMA_XFER_MODE: 68528ce5ce6Saurel32 case DBDMA_CMDPTR_HI: 68628ce5ce6Saurel32 case DBDMA_DATA2PTR_HI: 68728ce5ce6Saurel32 case DBDMA_DATA2PTR_LO: 68828ce5ce6Saurel32 case DBDMA_ADDRESS_HI: 68928ce5ce6Saurel32 case DBDMA_BRANCH_ADDR_HI: 69028ce5ce6Saurel32 /* unused */ 69128ce5ce6Saurel32 value = 0; 69228ce5ce6Saurel32 break; 69328ce5ce6Saurel32 case DBDMA_RES1: 69428ce5ce6Saurel32 case DBDMA_RES2: 69528ce5ce6Saurel32 case DBDMA_RES3: 69628ce5ce6Saurel32 case DBDMA_RES4: 69728ce5ce6Saurel32 /* reserved */ 69828ce5ce6Saurel32 break; 69928ce5ce6Saurel32 } 70028ce5ce6Saurel32 70128ce5ce6Saurel32 return value; 7023cbee15bSj_mayer } 7033cbee15bSj_mayer 70423c5e4caSAvi Kivity static const MemoryRegionOps dbdma_ops = { 70523c5e4caSAvi Kivity .read = dbdma_read, 70623c5e4caSAvi Kivity .write = dbdma_write, 70723c5e4caSAvi Kivity .endianness = DEVICE_LITTLE_ENDIAN, 70823c5e4caSAvi Kivity .valid = { 70923c5e4caSAvi Kivity .min_access_size = 4, 71023c5e4caSAvi Kivity .max_access_size = 4, 71123c5e4caSAvi Kivity }, 7123cbee15bSj_mayer }; 7133cbee15bSj_mayer 714627be2f2SMark Cave-Ayland static const VMStateDescription vmstate_dbdma_io = { 715627be2f2SMark Cave-Ayland .name = "dbdma_io", 716da26fdc3SJuan Quintela .version_id = 0, 717da26fdc3SJuan Quintela .minimum_version_id = 0, 718da26fdc3SJuan Quintela .fields = (VMStateField[]) { 719627be2f2SMark Cave-Ayland VMSTATE_UINT64(addr, struct DBDMA_io), 720627be2f2SMark Cave-Ayland VMSTATE_INT32(len, struct DBDMA_io), 721627be2f2SMark Cave-Ayland VMSTATE_INT32(is_last, struct DBDMA_io), 722627be2f2SMark Cave-Ayland VMSTATE_INT32(is_dma_out, struct DBDMA_io), 723627be2f2SMark Cave-Ayland VMSTATE_BOOL(processing, struct DBDMA_io), 724627be2f2SMark Cave-Ayland VMSTATE_END_OF_LIST() 725627be2f2SMark Cave-Ayland } 726627be2f2SMark Cave-Ayland }; 727627be2f2SMark Cave-Ayland 728627be2f2SMark Cave-Ayland static const VMStateDescription vmstate_dbdma_cmd = { 729627be2f2SMark Cave-Ayland .name = "dbdma_cmd", 730627be2f2SMark Cave-Ayland .version_id = 0, 731627be2f2SMark Cave-Ayland .minimum_version_id = 0, 732627be2f2SMark Cave-Ayland .fields = (VMStateField[]) { 733627be2f2SMark Cave-Ayland VMSTATE_UINT16(req_count, dbdma_cmd), 734627be2f2SMark Cave-Ayland VMSTATE_UINT16(command, dbdma_cmd), 735627be2f2SMark Cave-Ayland VMSTATE_UINT32(phy_addr, dbdma_cmd), 736627be2f2SMark Cave-Ayland VMSTATE_UINT32(cmd_dep, dbdma_cmd), 737627be2f2SMark Cave-Ayland VMSTATE_UINT16(res_count, dbdma_cmd), 738627be2f2SMark Cave-Ayland VMSTATE_UINT16(xfer_status, dbdma_cmd), 739627be2f2SMark Cave-Ayland VMSTATE_END_OF_LIST() 740627be2f2SMark Cave-Ayland } 741627be2f2SMark Cave-Ayland }; 742627be2f2SMark Cave-Ayland 743627be2f2SMark Cave-Ayland static const VMStateDescription vmstate_dbdma_channel = { 744627be2f2SMark Cave-Ayland .name = "dbdma_channel", 745627be2f2SMark Cave-Ayland .version_id = 1, 746627be2f2SMark Cave-Ayland .minimum_version_id = 1, 747627be2f2SMark Cave-Ayland .fields = (VMStateField[]) { 748da26fdc3SJuan Quintela VMSTATE_UINT32_ARRAY(regs, struct DBDMA_channel, DBDMA_REGS), 749627be2f2SMark Cave-Ayland VMSTATE_STRUCT(io, struct DBDMA_channel, 0, vmstate_dbdma_io, DBDMA_io), 750627be2f2SMark Cave-Ayland VMSTATE_STRUCT(current, struct DBDMA_channel, 0, vmstate_dbdma_cmd, 751627be2f2SMark Cave-Ayland dbdma_cmd), 752da26fdc3SJuan Quintela VMSTATE_END_OF_LIST() 7539b64997fSblueswir1 } 754da26fdc3SJuan Quintela }; 7559b64997fSblueswir1 756da26fdc3SJuan Quintela static const VMStateDescription vmstate_dbdma = { 757da26fdc3SJuan Quintela .name = "dbdma", 758627be2f2SMark Cave-Ayland .version_id = 3, 759627be2f2SMark Cave-Ayland .minimum_version_id = 3, 760da26fdc3SJuan Quintela .fields = (VMStateField[]) { 761da26fdc3SJuan Quintela VMSTATE_STRUCT_ARRAY(channels, DBDMAState, DBDMA_CHANNELS, 1, 762da26fdc3SJuan Quintela vmstate_dbdma_channel, DBDMA_channel), 763da26fdc3SJuan Quintela VMSTATE_END_OF_LIST() 7649b64997fSblueswir1 } 765da26fdc3SJuan Quintela }; 7669b64997fSblueswir1 7676e6b7363Sblueswir1 static void dbdma_reset(void *opaque) 7686e6b7363Sblueswir1 { 769c20df14bSJuan Quintela DBDMAState *s = opaque; 77028ce5ce6Saurel32 int i; 77128ce5ce6Saurel32 77228ce5ce6Saurel32 for (i = 0; i < DBDMA_CHANNELS; i++) 773c20df14bSJuan Quintela memset(s->channels[i].regs, 0, DBDMA_SIZE); 7746e6b7363Sblueswir1 } 7756e6b7363Sblueswir1 7762d7d06d8SHervé Poussineau static void dbdma_unassigned_rw(DBDMA_io *io) 7772d7d06d8SHervé Poussineau { 7782d7d06d8SHervé Poussineau DBDMA_channel *ch = io->channel; 7792d7d06d8SHervé Poussineau qemu_log_mask(LOG_GUEST_ERROR, "%s: use of unassigned channel %d\n", 7802d7d06d8SHervé Poussineau __func__, ch->channel); 7812d7d06d8SHervé Poussineau } 7822d7d06d8SHervé Poussineau 7832d7d06d8SHervé Poussineau static void dbdma_unassigned_flush(DBDMA_io *io) 7842d7d06d8SHervé Poussineau { 7852d7d06d8SHervé Poussineau DBDMA_channel *ch = io->channel; 7862d7d06d8SHervé Poussineau qemu_log_mask(LOG_GUEST_ERROR, "%s: use of unassigned channel %d\n", 7872d7d06d8SHervé Poussineau __func__, ch->channel); 7882d7d06d8SHervé Poussineau } 7892d7d06d8SHervé Poussineau 79023c5e4caSAvi Kivity void* DBDMA_init (MemoryRegion **dbdma_mem) 7913cbee15bSj_mayer { 792c20df14bSJuan Quintela DBDMAState *s; 7933e300fa6SAlexander Graf int i; 79428ce5ce6Saurel32 7957267c094SAnthony Liguori s = g_malloc0(sizeof(DBDMAState)); 79628ce5ce6Saurel32 7973e300fa6SAlexander Graf for (i = 0; i < DBDMA_CHANNELS; i++) { 7983e300fa6SAlexander Graf DBDMA_io *io = &s->channels[i].io; 7992d7d06d8SHervé Poussineau DBDMA_channel *ch = &s->channels[i]; 8003e300fa6SAlexander Graf qemu_iovec_init(&io->iov, 1); 8012d7d06d8SHervé Poussineau 8022d7d06d8SHervé Poussineau ch->rw = dbdma_unassigned_rw; 8032d7d06d8SHervé Poussineau ch->flush = dbdma_unassigned_flush; 8042d7d06d8SHervé Poussineau ch->channel = i; 8052d7d06d8SHervé Poussineau ch->io.channel = ch; 8063e300fa6SAlexander Graf } 8073e300fa6SAlexander Graf 8082c9b15caSPaolo Bonzini memory_region_init_io(&s->mem, NULL, &dbdma_ops, s, "dbdma", 0x1000); 80923c5e4caSAvi Kivity *dbdma_mem = &s->mem; 810da26fdc3SJuan Quintela vmstate_register(NULL, -1, &vmstate_dbdma, s); 811a08d4367SJan Kiszka qemu_register_reset(dbdma_reset, s); 81228ce5ce6Saurel32 813d2f0ce21SAlexander Graf s->bh = qemu_bh_new(DBDMA_run_bh, s); 81428ce5ce6Saurel32 81528ce5ce6Saurel32 return s; 8163cbee15bSj_mayer } 817