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" 44*03dd024fSPaolo Bonzini #include "qemu/log.h" 453cbee15bSj_mayer 46ea026b2fSblueswir1 /* debug DBDMA */ 47ea026b2fSblueswir1 //#define DEBUG_DBDMA 48ea026b2fSblueswir1 49ea026b2fSblueswir1 #ifdef DEBUG_DBDMA 50001faf32SBlue Swirl #define DBDMA_DPRINTF(fmt, ...) \ 51001faf32SBlue Swirl do { printf("DBDMA: " fmt , ## __VA_ARGS__); } while (0) 52ea026b2fSblueswir1 #else 53001faf32SBlue Swirl #define DBDMA_DPRINTF(fmt, ...) 54ea026b2fSblueswir1 #endif 55ea026b2fSblueswir1 5628ce5ce6Saurel32 /* 5728ce5ce6Saurel32 */ 583cbee15bSj_mayer 59d2f0ce21SAlexander Graf static DBDMAState *dbdma_from_ch(DBDMA_channel *ch) 60d2f0ce21SAlexander Graf { 61d2f0ce21SAlexander Graf return container_of(ch, DBDMAState, channels[ch->channel]); 62d2f0ce21SAlexander Graf } 63d2f0ce21SAlexander Graf 6428ce5ce6Saurel32 #ifdef DEBUG_DBDMA 6528ce5ce6Saurel32 static void dump_dbdma_cmd(dbdma_cmd *cmd) 663cbee15bSj_mayer { 6728ce5ce6Saurel32 printf("dbdma_cmd %p\n", cmd); 6828ce5ce6Saurel32 printf(" req_count 0x%04x\n", le16_to_cpu(cmd->req_count)); 6928ce5ce6Saurel32 printf(" command 0x%04x\n", le16_to_cpu(cmd->command)); 7028ce5ce6Saurel32 printf(" phy_addr 0x%08x\n", le32_to_cpu(cmd->phy_addr)); 7128ce5ce6Saurel32 printf(" cmd_dep 0x%08x\n", le32_to_cpu(cmd->cmd_dep)); 7228ce5ce6Saurel32 printf(" res_count 0x%04x\n", le16_to_cpu(cmd->res_count)); 7328ce5ce6Saurel32 printf(" xfer_status 0x%04x\n", le16_to_cpu(cmd->xfer_status)); 7428ce5ce6Saurel32 } 7528ce5ce6Saurel32 #else 7628ce5ce6Saurel32 static void dump_dbdma_cmd(dbdma_cmd *cmd) 7728ce5ce6Saurel32 { 7828ce5ce6Saurel32 } 7928ce5ce6Saurel32 #endif 8028ce5ce6Saurel32 static void dbdma_cmdptr_load(DBDMA_channel *ch) 8128ce5ce6Saurel32 { 8228ce5ce6Saurel32 DBDMA_DPRINTF("dbdma_cmdptr_load 0x%08x\n", 83ad674e53SAurelien Jarno ch->regs[DBDMA_CMDPTR_LO]); 84ad674e53SAurelien Jarno cpu_physical_memory_read(ch->regs[DBDMA_CMDPTR_LO], 85e1fe50dcSStefan Weil &ch->current, sizeof(dbdma_cmd)); 863cbee15bSj_mayer } 873cbee15bSj_mayer 8828ce5ce6Saurel32 static void dbdma_cmdptr_save(DBDMA_channel *ch) 893cbee15bSj_mayer { 9028ce5ce6Saurel32 DBDMA_DPRINTF("dbdma_cmdptr_save 0x%08x\n", 91ad674e53SAurelien Jarno ch->regs[DBDMA_CMDPTR_LO]); 9228ce5ce6Saurel32 DBDMA_DPRINTF("xfer_status 0x%08x res_count 0x%04x\n", 9328ce5ce6Saurel32 le16_to_cpu(ch->current.xfer_status), 9428ce5ce6Saurel32 le16_to_cpu(ch->current.res_count)); 95ad674e53SAurelien Jarno cpu_physical_memory_write(ch->regs[DBDMA_CMDPTR_LO], 96e1fe50dcSStefan Weil &ch->current, sizeof(dbdma_cmd)); 9728ce5ce6Saurel32 } 9828ce5ce6Saurel32 9928ce5ce6Saurel32 static void kill_channel(DBDMA_channel *ch) 10028ce5ce6Saurel32 { 10128ce5ce6Saurel32 DBDMA_DPRINTF("kill_channel\n"); 10228ce5ce6Saurel32 103ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] |= DEAD; 104ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] &= ~ACTIVE; 10528ce5ce6Saurel32 10628ce5ce6Saurel32 qemu_irq_raise(ch->irq); 10728ce5ce6Saurel32 } 10828ce5ce6Saurel32 10928ce5ce6Saurel32 static void conditional_interrupt(DBDMA_channel *ch) 11028ce5ce6Saurel32 { 11128ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 11228ce5ce6Saurel32 uint16_t intr; 11328ce5ce6Saurel32 uint16_t sel_mask, sel_value; 11428ce5ce6Saurel32 uint32_t status; 11528ce5ce6Saurel32 int cond; 11628ce5ce6Saurel32 11733ce36bbSAlexander Graf DBDMA_DPRINTF("%s\n", __func__); 11828ce5ce6Saurel32 119b42ec42dSaurel32 intr = le16_to_cpu(current->command) & INTR_MASK; 12028ce5ce6Saurel32 12128ce5ce6Saurel32 switch(intr) { 12228ce5ce6Saurel32 case INTR_NEVER: /* don't interrupt */ 12328ce5ce6Saurel32 return; 12428ce5ce6Saurel32 case INTR_ALWAYS: /* always interrupt */ 12528ce5ce6Saurel32 qemu_irq_raise(ch->irq); 12633ce36bbSAlexander Graf DBDMA_DPRINTF("%s: raise\n", __func__); 12728ce5ce6Saurel32 return; 12828ce5ce6Saurel32 } 12928ce5ce6Saurel32 130ad674e53SAurelien Jarno status = ch->regs[DBDMA_STATUS] & DEVSTAT; 13128ce5ce6Saurel32 132ad674e53SAurelien Jarno sel_mask = (ch->regs[DBDMA_INTR_SEL] >> 16) & 0x0f; 133ad674e53SAurelien Jarno sel_value = ch->regs[DBDMA_INTR_SEL] & 0x0f; 13428ce5ce6Saurel32 13528ce5ce6Saurel32 cond = (status & sel_mask) == (sel_value & sel_mask); 13628ce5ce6Saurel32 13728ce5ce6Saurel32 switch(intr) { 13828ce5ce6Saurel32 case INTR_IFSET: /* intr if condition bit is 1 */ 13933ce36bbSAlexander Graf if (cond) { 14028ce5ce6Saurel32 qemu_irq_raise(ch->irq); 14133ce36bbSAlexander Graf DBDMA_DPRINTF("%s: raise\n", __func__); 14233ce36bbSAlexander Graf } 14328ce5ce6Saurel32 return; 14428ce5ce6Saurel32 case INTR_IFCLR: /* intr if condition bit is 0 */ 14533ce36bbSAlexander Graf if (!cond) { 14628ce5ce6Saurel32 qemu_irq_raise(ch->irq); 14733ce36bbSAlexander Graf DBDMA_DPRINTF("%s: raise\n", __func__); 14833ce36bbSAlexander Graf } 14928ce5ce6Saurel32 return; 15028ce5ce6Saurel32 } 15128ce5ce6Saurel32 } 15228ce5ce6Saurel32 15328ce5ce6Saurel32 static int conditional_wait(DBDMA_channel *ch) 15428ce5ce6Saurel32 { 15528ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 15628ce5ce6Saurel32 uint16_t wait; 15728ce5ce6Saurel32 uint16_t sel_mask, sel_value; 15828ce5ce6Saurel32 uint32_t status; 15928ce5ce6Saurel32 int cond; 16028ce5ce6Saurel32 16128ce5ce6Saurel32 DBDMA_DPRINTF("conditional_wait\n"); 16228ce5ce6Saurel32 163b42ec42dSaurel32 wait = le16_to_cpu(current->command) & WAIT_MASK; 16428ce5ce6Saurel32 16528ce5ce6Saurel32 switch(wait) { 16628ce5ce6Saurel32 case WAIT_NEVER: /* don't wait */ 16728ce5ce6Saurel32 return 0; 16828ce5ce6Saurel32 case WAIT_ALWAYS: /* always wait */ 16928ce5ce6Saurel32 return 1; 17028ce5ce6Saurel32 } 17128ce5ce6Saurel32 172ad674e53SAurelien Jarno status = ch->regs[DBDMA_STATUS] & DEVSTAT; 17328ce5ce6Saurel32 174ad674e53SAurelien Jarno sel_mask = (ch->regs[DBDMA_WAIT_SEL] >> 16) & 0x0f; 175ad674e53SAurelien Jarno sel_value = ch->regs[DBDMA_WAIT_SEL] & 0x0f; 17628ce5ce6Saurel32 17728ce5ce6Saurel32 cond = (status & sel_mask) == (sel_value & sel_mask); 17828ce5ce6Saurel32 17928ce5ce6Saurel32 switch(wait) { 18028ce5ce6Saurel32 case WAIT_IFSET: /* wait if condition bit is 1 */ 18128ce5ce6Saurel32 if (cond) 18228ce5ce6Saurel32 return 1; 18328ce5ce6Saurel32 return 0; 18428ce5ce6Saurel32 case WAIT_IFCLR: /* wait if condition bit is 0 */ 18528ce5ce6Saurel32 if (!cond) 18628ce5ce6Saurel32 return 1; 18728ce5ce6Saurel32 return 0; 18828ce5ce6Saurel32 } 18928ce5ce6Saurel32 return 0; 19028ce5ce6Saurel32 } 19128ce5ce6Saurel32 19228ce5ce6Saurel32 static void next(DBDMA_channel *ch) 19328ce5ce6Saurel32 { 19428ce5ce6Saurel32 uint32_t cp; 19528ce5ce6Saurel32 196ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] &= ~BT; 19728ce5ce6Saurel32 198ad674e53SAurelien Jarno cp = ch->regs[DBDMA_CMDPTR_LO]; 199ad674e53SAurelien Jarno ch->regs[DBDMA_CMDPTR_LO] = cp + sizeof(dbdma_cmd); 20028ce5ce6Saurel32 dbdma_cmdptr_load(ch); 20128ce5ce6Saurel32 } 20228ce5ce6Saurel32 20328ce5ce6Saurel32 static void branch(DBDMA_channel *ch) 20428ce5ce6Saurel32 { 20528ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 20628ce5ce6Saurel32 20728ce5ce6Saurel32 ch->regs[DBDMA_CMDPTR_LO] = current->cmd_dep; 208ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] |= BT; 20928ce5ce6Saurel32 dbdma_cmdptr_load(ch); 21028ce5ce6Saurel32 } 21128ce5ce6Saurel32 21228ce5ce6Saurel32 static void conditional_branch(DBDMA_channel *ch) 21328ce5ce6Saurel32 { 21428ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 21528ce5ce6Saurel32 uint16_t br; 21628ce5ce6Saurel32 uint16_t sel_mask, sel_value; 21728ce5ce6Saurel32 uint32_t status; 21828ce5ce6Saurel32 int cond; 21928ce5ce6Saurel32 22028ce5ce6Saurel32 DBDMA_DPRINTF("conditional_branch\n"); 22128ce5ce6Saurel32 22228ce5ce6Saurel32 /* check if we must branch */ 22328ce5ce6Saurel32 224b42ec42dSaurel32 br = le16_to_cpu(current->command) & BR_MASK; 22528ce5ce6Saurel32 22628ce5ce6Saurel32 switch(br) { 22728ce5ce6Saurel32 case BR_NEVER: /* don't branch */ 22828ce5ce6Saurel32 next(ch); 22928ce5ce6Saurel32 return; 23028ce5ce6Saurel32 case BR_ALWAYS: /* always branch */ 23128ce5ce6Saurel32 branch(ch); 23228ce5ce6Saurel32 return; 23328ce5ce6Saurel32 } 23428ce5ce6Saurel32 235ad674e53SAurelien Jarno status = ch->regs[DBDMA_STATUS] & DEVSTAT; 23628ce5ce6Saurel32 237ad674e53SAurelien Jarno sel_mask = (ch->regs[DBDMA_BRANCH_SEL] >> 16) & 0x0f; 238ad674e53SAurelien Jarno sel_value = ch->regs[DBDMA_BRANCH_SEL] & 0x0f; 23928ce5ce6Saurel32 24028ce5ce6Saurel32 cond = (status & sel_mask) == (sel_value & sel_mask); 24128ce5ce6Saurel32 24228ce5ce6Saurel32 switch(br) { 24328ce5ce6Saurel32 case BR_IFSET: /* branch if condition bit is 1 */ 24428ce5ce6Saurel32 if (cond) 24528ce5ce6Saurel32 branch(ch); 24628ce5ce6Saurel32 else 24728ce5ce6Saurel32 next(ch); 24828ce5ce6Saurel32 return; 24928ce5ce6Saurel32 case BR_IFCLR: /* branch if condition bit is 0 */ 25028ce5ce6Saurel32 if (!cond) 25128ce5ce6Saurel32 branch(ch); 25228ce5ce6Saurel32 else 25328ce5ce6Saurel32 next(ch); 25428ce5ce6Saurel32 return; 25528ce5ce6Saurel32 } 25628ce5ce6Saurel32 } 25728ce5ce6Saurel32 258b42ec42dSaurel32 static void channel_run(DBDMA_channel *ch); 259b42ec42dSaurel32 260b42ec42dSaurel32 static void dbdma_end(DBDMA_io *io) 26128ce5ce6Saurel32 { 26228ce5ce6Saurel32 DBDMA_channel *ch = io->channel; 26328ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 26428ce5ce6Saurel32 26533ce36bbSAlexander Graf DBDMA_DPRINTF("%s\n", __func__); 26633ce36bbSAlexander Graf 267b42ec42dSaurel32 if (conditional_wait(ch)) 268b42ec42dSaurel32 goto wait; 26928ce5ce6Saurel32 270ad674e53SAurelien Jarno current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]); 271ad674e53SAurelien Jarno current->res_count = cpu_to_le16(io->len); 272b42ec42dSaurel32 dbdma_cmdptr_save(ch); 273862c9280Saurel32 if (io->is_last) 274ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] &= ~FLUSH; 27528ce5ce6Saurel32 276b42ec42dSaurel32 conditional_interrupt(ch); 277b42ec42dSaurel32 conditional_branch(ch); 278b42ec42dSaurel32 279b42ec42dSaurel32 wait: 28003ee3b1eSAlexander Graf /* Indicate that we're ready for a new DMA round */ 28103ee3b1eSAlexander Graf ch->io.processing = false; 28203ee3b1eSAlexander Graf 283ad674e53SAurelien Jarno if ((ch->regs[DBDMA_STATUS] & RUN) && 284ad674e53SAurelien Jarno (ch->regs[DBDMA_STATUS] & ACTIVE)) 285b42ec42dSaurel32 channel_run(ch); 28628ce5ce6Saurel32 } 28728ce5ce6Saurel32 288b42ec42dSaurel32 static void start_output(DBDMA_channel *ch, int key, uint32_t addr, 28928ce5ce6Saurel32 uint16_t req_count, int is_last) 29028ce5ce6Saurel32 { 29128ce5ce6Saurel32 DBDMA_DPRINTF("start_output\n"); 29228ce5ce6Saurel32 29328ce5ce6Saurel32 /* KEY_REGS, KEY_DEVICE and KEY_STREAM 29428ce5ce6Saurel32 * are not implemented in the mac-io chip 29528ce5ce6Saurel32 */ 29628ce5ce6Saurel32 29728ce5ce6Saurel32 DBDMA_DPRINTF("addr 0x%x key 0x%x\n", addr, key); 29828ce5ce6Saurel32 if (!addr || key > KEY_STREAM3) { 29928ce5ce6Saurel32 kill_channel(ch); 300b42ec42dSaurel32 return; 30128ce5ce6Saurel32 } 30228ce5ce6Saurel32 303b42ec42dSaurel32 ch->io.addr = addr; 30428ce5ce6Saurel32 ch->io.len = req_count; 30528ce5ce6Saurel32 ch->io.is_last = is_last; 306b42ec42dSaurel32 ch->io.dma_end = dbdma_end; 307b42ec42dSaurel32 ch->io.is_dma_out = 1; 30803ee3b1eSAlexander Graf ch->io.processing = true; 309a9ceb76dSAlexander Graf if (ch->rw) { 310b42ec42dSaurel32 ch->rw(&ch->io); 31128ce5ce6Saurel32 } 312a9ceb76dSAlexander Graf } 31328ce5ce6Saurel32 314b42ec42dSaurel32 static void start_input(DBDMA_channel *ch, int key, uint32_t addr, 31528ce5ce6Saurel32 uint16_t req_count, int is_last) 31628ce5ce6Saurel32 { 31728ce5ce6Saurel32 DBDMA_DPRINTF("start_input\n"); 31828ce5ce6Saurel32 31928ce5ce6Saurel32 /* KEY_REGS, KEY_DEVICE and KEY_STREAM 32028ce5ce6Saurel32 * are not implemented in the mac-io chip 32128ce5ce6Saurel32 */ 32228ce5ce6Saurel32 32333ce36bbSAlexander Graf DBDMA_DPRINTF("addr 0x%x key 0x%x\n", addr, key); 32428ce5ce6Saurel32 if (!addr || key > KEY_STREAM3) { 32528ce5ce6Saurel32 kill_channel(ch); 326b42ec42dSaurel32 return; 32728ce5ce6Saurel32 } 32828ce5ce6Saurel32 329b42ec42dSaurel32 ch->io.addr = addr; 33028ce5ce6Saurel32 ch->io.len = req_count; 33128ce5ce6Saurel32 ch->io.is_last = is_last; 332b42ec42dSaurel32 ch->io.dma_end = dbdma_end; 333b42ec42dSaurel32 ch->io.is_dma_out = 0; 33403ee3b1eSAlexander Graf ch->io.processing = true; 335a9ceb76dSAlexander Graf if (ch->rw) { 336b42ec42dSaurel32 ch->rw(&ch->io); 33728ce5ce6Saurel32 } 338a9ceb76dSAlexander Graf } 33928ce5ce6Saurel32 340b42ec42dSaurel32 static void load_word(DBDMA_channel *ch, int key, uint32_t addr, 34128ce5ce6Saurel32 uint16_t len) 34228ce5ce6Saurel32 { 34328ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 34428ce5ce6Saurel32 uint32_t val; 34528ce5ce6Saurel32 34628ce5ce6Saurel32 DBDMA_DPRINTF("load_word\n"); 34728ce5ce6Saurel32 34828ce5ce6Saurel32 /* only implements KEY_SYSTEM */ 34928ce5ce6Saurel32 35028ce5ce6Saurel32 if (key != KEY_SYSTEM) { 35128ce5ce6Saurel32 printf("DBDMA: LOAD_WORD, unimplemented key %x\n", key); 35228ce5ce6Saurel32 kill_channel(ch); 353b42ec42dSaurel32 return; 35428ce5ce6Saurel32 } 35528ce5ce6Saurel32 356e1fe50dcSStefan Weil cpu_physical_memory_read(addr, &val, len); 35728ce5ce6Saurel32 35828ce5ce6Saurel32 if (len == 2) 35928ce5ce6Saurel32 val = (val << 16) | (current->cmd_dep & 0x0000ffff); 36028ce5ce6Saurel32 else if (len == 1) 36128ce5ce6Saurel32 val = (val << 24) | (current->cmd_dep & 0x00ffffff); 36228ce5ce6Saurel32 36328ce5ce6Saurel32 current->cmd_dep = val; 36428ce5ce6Saurel32 36528ce5ce6Saurel32 if (conditional_wait(ch)) 366b42ec42dSaurel32 goto wait; 36728ce5ce6Saurel32 368ad674e53SAurelien Jarno current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]); 36928ce5ce6Saurel32 dbdma_cmdptr_save(ch); 370ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] &= ~FLUSH; 37128ce5ce6Saurel32 37228ce5ce6Saurel32 conditional_interrupt(ch); 37328ce5ce6Saurel32 next(ch); 37428ce5ce6Saurel32 375b42ec42dSaurel32 wait: 376d2f0ce21SAlexander Graf DBDMA_kick(dbdma_from_ch(ch)); 37728ce5ce6Saurel32 } 37828ce5ce6Saurel32 379b42ec42dSaurel32 static void store_word(DBDMA_channel *ch, int key, uint32_t addr, 38028ce5ce6Saurel32 uint16_t len) 38128ce5ce6Saurel32 { 38228ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 38328ce5ce6Saurel32 uint32_t val; 38428ce5ce6Saurel32 38528ce5ce6Saurel32 DBDMA_DPRINTF("store_word\n"); 38628ce5ce6Saurel32 38728ce5ce6Saurel32 /* only implements KEY_SYSTEM */ 38828ce5ce6Saurel32 38928ce5ce6Saurel32 if (key != KEY_SYSTEM) { 39028ce5ce6Saurel32 printf("DBDMA: STORE_WORD, unimplemented key %x\n", key); 39128ce5ce6Saurel32 kill_channel(ch); 392b42ec42dSaurel32 return; 39328ce5ce6Saurel32 } 39428ce5ce6Saurel32 39528ce5ce6Saurel32 val = current->cmd_dep; 39628ce5ce6Saurel32 if (len == 2) 39728ce5ce6Saurel32 val >>= 16; 39828ce5ce6Saurel32 else if (len == 1) 39928ce5ce6Saurel32 val >>= 24; 40028ce5ce6Saurel32 401e1fe50dcSStefan Weil cpu_physical_memory_write(addr, &val, len); 40228ce5ce6Saurel32 40328ce5ce6Saurel32 if (conditional_wait(ch)) 404b42ec42dSaurel32 goto wait; 40528ce5ce6Saurel32 406ad674e53SAurelien Jarno current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]); 40728ce5ce6Saurel32 dbdma_cmdptr_save(ch); 408ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] &= ~FLUSH; 40928ce5ce6Saurel32 41028ce5ce6Saurel32 conditional_interrupt(ch); 41128ce5ce6Saurel32 next(ch); 41228ce5ce6Saurel32 413b42ec42dSaurel32 wait: 414d2f0ce21SAlexander Graf DBDMA_kick(dbdma_from_ch(ch)); 41528ce5ce6Saurel32 } 41628ce5ce6Saurel32 417b42ec42dSaurel32 static void nop(DBDMA_channel *ch) 41828ce5ce6Saurel32 { 41928ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 42028ce5ce6Saurel32 42128ce5ce6Saurel32 if (conditional_wait(ch)) 422b42ec42dSaurel32 goto wait; 42328ce5ce6Saurel32 424ad674e53SAurelien Jarno current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]); 42528ce5ce6Saurel32 dbdma_cmdptr_save(ch); 42628ce5ce6Saurel32 42728ce5ce6Saurel32 conditional_interrupt(ch); 42828ce5ce6Saurel32 conditional_branch(ch); 42928ce5ce6Saurel32 430b42ec42dSaurel32 wait: 431d2f0ce21SAlexander Graf DBDMA_kick(dbdma_from_ch(ch)); 43228ce5ce6Saurel32 } 43328ce5ce6Saurel32 434b42ec42dSaurel32 static void stop(DBDMA_channel *ch) 43528ce5ce6Saurel32 { 436ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] &= ~(ACTIVE|DEAD|FLUSH); 43728ce5ce6Saurel32 43828ce5ce6Saurel32 /* the stop command does not increment command pointer */ 43928ce5ce6Saurel32 } 44028ce5ce6Saurel32 441b42ec42dSaurel32 static void channel_run(DBDMA_channel *ch) 44228ce5ce6Saurel32 { 44328ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 44428ce5ce6Saurel32 uint16_t cmd, key; 44528ce5ce6Saurel32 uint16_t req_count; 44628ce5ce6Saurel32 uint32_t phy_addr; 44728ce5ce6Saurel32 44828ce5ce6Saurel32 DBDMA_DPRINTF("channel_run\n"); 44928ce5ce6Saurel32 dump_dbdma_cmd(current); 45028ce5ce6Saurel32 45128ce5ce6Saurel32 /* clear WAKE flag at command fetch */ 45228ce5ce6Saurel32 453ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] &= ~WAKE; 45428ce5ce6Saurel32 45528ce5ce6Saurel32 cmd = le16_to_cpu(current->command) & COMMAND_MASK; 45628ce5ce6Saurel32 45728ce5ce6Saurel32 switch (cmd) { 45828ce5ce6Saurel32 case DBDMA_NOP: 459b42ec42dSaurel32 nop(ch); 460b42ec42dSaurel32 return; 46128ce5ce6Saurel32 46228ce5ce6Saurel32 case DBDMA_STOP: 463b42ec42dSaurel32 stop(ch); 464b42ec42dSaurel32 return; 46528ce5ce6Saurel32 } 46628ce5ce6Saurel32 46728ce5ce6Saurel32 key = le16_to_cpu(current->command) & 0x0700; 46828ce5ce6Saurel32 req_count = le16_to_cpu(current->req_count); 46928ce5ce6Saurel32 phy_addr = le32_to_cpu(current->phy_addr); 47028ce5ce6Saurel32 47128ce5ce6Saurel32 if (key == KEY_STREAM4) { 47228ce5ce6Saurel32 printf("command %x, invalid key 4\n", cmd); 47328ce5ce6Saurel32 kill_channel(ch); 474b42ec42dSaurel32 return; 47528ce5ce6Saurel32 } 47628ce5ce6Saurel32 47728ce5ce6Saurel32 switch (cmd) { 47828ce5ce6Saurel32 case OUTPUT_MORE: 479b42ec42dSaurel32 start_output(ch, key, phy_addr, req_count, 0); 480b42ec42dSaurel32 return; 48128ce5ce6Saurel32 48228ce5ce6Saurel32 case OUTPUT_LAST: 483b42ec42dSaurel32 start_output(ch, key, phy_addr, req_count, 1); 484b42ec42dSaurel32 return; 48528ce5ce6Saurel32 48628ce5ce6Saurel32 case INPUT_MORE: 487b42ec42dSaurel32 start_input(ch, key, phy_addr, req_count, 0); 488b42ec42dSaurel32 return; 48928ce5ce6Saurel32 49028ce5ce6Saurel32 case INPUT_LAST: 491b42ec42dSaurel32 start_input(ch, key, phy_addr, req_count, 1); 492b42ec42dSaurel32 return; 49328ce5ce6Saurel32 } 49428ce5ce6Saurel32 49528ce5ce6Saurel32 if (key < KEY_REGS) { 49628ce5ce6Saurel32 printf("command %x, invalid key %x\n", cmd, key); 49728ce5ce6Saurel32 key = KEY_SYSTEM; 49828ce5ce6Saurel32 } 49928ce5ce6Saurel32 50028ce5ce6Saurel32 /* for LOAD_WORD and STORE_WORD, req_count is on 3 bits 50128ce5ce6Saurel32 * and BRANCH is invalid 50228ce5ce6Saurel32 */ 50328ce5ce6Saurel32 50428ce5ce6Saurel32 req_count = req_count & 0x0007; 50528ce5ce6Saurel32 if (req_count & 0x4) { 50628ce5ce6Saurel32 req_count = 4; 50728ce5ce6Saurel32 phy_addr &= ~3; 50828ce5ce6Saurel32 } else if (req_count & 0x2) { 50928ce5ce6Saurel32 req_count = 2; 51028ce5ce6Saurel32 phy_addr &= ~1; 51128ce5ce6Saurel32 } else 51228ce5ce6Saurel32 req_count = 1; 51328ce5ce6Saurel32 51428ce5ce6Saurel32 switch (cmd) { 51528ce5ce6Saurel32 case LOAD_WORD: 516b42ec42dSaurel32 load_word(ch, key, phy_addr, req_count); 517b42ec42dSaurel32 return; 51828ce5ce6Saurel32 51928ce5ce6Saurel32 case STORE_WORD: 520b42ec42dSaurel32 store_word(ch, key, phy_addr, req_count); 521b42ec42dSaurel32 return; 52228ce5ce6Saurel32 } 52328ce5ce6Saurel32 } 52428ce5ce6Saurel32 525c20df14bSJuan Quintela static void DBDMA_run(DBDMAState *s) 52628ce5ce6Saurel32 { 52728ce5ce6Saurel32 int channel; 52828ce5ce6Saurel32 529c20df14bSJuan Quintela for (channel = 0; channel < DBDMA_CHANNELS; channel++) { 530c20df14bSJuan Quintela DBDMA_channel *ch = &s->channels[channel]; 531ad674e53SAurelien Jarno uint32_t status = ch->regs[DBDMA_STATUS]; 53203ee3b1eSAlexander Graf if (!ch->io.processing && (status & RUN) && (status & ACTIVE)) { 533b42ec42dSaurel32 channel_run(ch); 53428ce5ce6Saurel32 } 53528ce5ce6Saurel32 } 536c20df14bSJuan Quintela } 53728ce5ce6Saurel32 53828ce5ce6Saurel32 static void DBDMA_run_bh(void *opaque) 53928ce5ce6Saurel32 { 540c20df14bSJuan Quintela DBDMAState *s = opaque; 54128ce5ce6Saurel32 54228ce5ce6Saurel32 DBDMA_DPRINTF("DBDMA_run_bh\n"); 54328ce5ce6Saurel32 544c20df14bSJuan Quintela DBDMA_run(s); 54528ce5ce6Saurel32 } 54628ce5ce6Saurel32 547d1e562deSAlexander Graf void DBDMA_kick(DBDMAState *dbdma) 548d1e562deSAlexander Graf { 549d2f0ce21SAlexander Graf qemu_bh_schedule(dbdma->bh); 550d1e562deSAlexander Graf } 551d1e562deSAlexander Graf 55228ce5ce6Saurel32 void DBDMA_register_channel(void *dbdma, int nchan, qemu_irq irq, 553862c9280Saurel32 DBDMA_rw rw, DBDMA_flush flush, 55428ce5ce6Saurel32 void *opaque) 55528ce5ce6Saurel32 { 556c20df14bSJuan Quintela DBDMAState *s = dbdma; 557c20df14bSJuan Quintela DBDMA_channel *ch = &s->channels[nchan]; 55828ce5ce6Saurel32 55928ce5ce6Saurel32 DBDMA_DPRINTF("DBDMA_register_channel 0x%x\n", nchan); 56028ce5ce6Saurel32 5612d7d06d8SHervé Poussineau assert(rw); 5622d7d06d8SHervé Poussineau assert(flush); 5632d7d06d8SHervé Poussineau 56428ce5ce6Saurel32 ch->irq = irq; 565b42ec42dSaurel32 ch->rw = rw; 566862c9280Saurel32 ch->flush = flush; 56728ce5ce6Saurel32 ch->io.opaque = opaque; 56828ce5ce6Saurel32 } 56928ce5ce6Saurel32 57028ce5ce6Saurel32 static void 57128ce5ce6Saurel32 dbdma_control_write(DBDMA_channel *ch) 57228ce5ce6Saurel32 { 57328ce5ce6Saurel32 uint16_t mask, value; 57428ce5ce6Saurel32 uint32_t status; 57528ce5ce6Saurel32 576ad674e53SAurelien Jarno mask = (ch->regs[DBDMA_CONTROL] >> 16) & 0xffff; 577ad674e53SAurelien Jarno value = ch->regs[DBDMA_CONTROL] & 0xffff; 57828ce5ce6Saurel32 57928ce5ce6Saurel32 value &= (RUN | PAUSE | FLUSH | WAKE | DEVSTAT); 58028ce5ce6Saurel32 581ad674e53SAurelien Jarno status = ch->regs[DBDMA_STATUS]; 58228ce5ce6Saurel32 58328ce5ce6Saurel32 status = (value & mask) | (status & ~mask); 58428ce5ce6Saurel32 58528ce5ce6Saurel32 if (status & WAKE) 58628ce5ce6Saurel32 status |= ACTIVE; 58728ce5ce6Saurel32 if (status & RUN) { 58828ce5ce6Saurel32 status |= ACTIVE; 58928ce5ce6Saurel32 status &= ~DEAD; 59028ce5ce6Saurel32 } 59128ce5ce6Saurel32 if (status & PAUSE) 59228ce5ce6Saurel32 status &= ~ACTIVE; 593ad674e53SAurelien Jarno if ((ch->regs[DBDMA_STATUS] & RUN) && !(status & RUN)) { 59428ce5ce6Saurel32 /* RUN is cleared */ 59528ce5ce6Saurel32 status &= ~(ACTIVE|DEAD); 5961cde732dSMark Cave-Ayland } 5971cde732dSMark Cave-Ayland 598987422bcSAmadeusz Sławiński if ((status & FLUSH) && ch->flush) { 599987422bcSAmadeusz Sławiński ch->flush(&ch->io); 600987422bcSAmadeusz Sławiński status &= ~FLUSH; 601987422bcSAmadeusz Sławiński } 60228ce5ce6Saurel32 60328ce5ce6Saurel32 DBDMA_DPRINTF(" status 0x%08x\n", status); 60428ce5ce6Saurel32 605ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] = status; 60628ce5ce6Saurel32 607d2f0ce21SAlexander Graf if (status & ACTIVE) { 608d2f0ce21SAlexander Graf DBDMA_kick(dbdma_from_ch(ch)); 609d2f0ce21SAlexander Graf } 610d2f0ce21SAlexander Graf } 6113cbee15bSj_mayer 612a8170e5eSAvi Kivity static void dbdma_write(void *opaque, hwaddr addr, 61323c5e4caSAvi Kivity uint64_t value, unsigned size) 6143cbee15bSj_mayer { 61528ce5ce6Saurel32 int channel = addr >> DBDMA_CHANNEL_SHIFT; 616c20df14bSJuan Quintela DBDMAState *s = opaque; 617c20df14bSJuan Quintela DBDMA_channel *ch = &s->channels[channel]; 61828ce5ce6Saurel32 int reg = (addr - (channel << DBDMA_CHANNEL_SHIFT)) >> 2; 61928ce5ce6Saurel32 62058c0c311SAlexander Graf DBDMA_DPRINTF("writel 0x" TARGET_FMT_plx " <= 0x%08"PRIx64"\n", 62158c0c311SAlexander Graf addr, value); 62228ce5ce6Saurel32 DBDMA_DPRINTF("channel 0x%x reg 0x%x\n", 62328ce5ce6Saurel32 (uint32_t)addr >> DBDMA_CHANNEL_SHIFT, reg); 62428ce5ce6Saurel32 6257eaba824SAlexander Graf /* cmdptr cannot be modified if channel is ACTIVE */ 62628ce5ce6Saurel32 6277eaba824SAlexander Graf if (reg == DBDMA_CMDPTR_LO && (ch->regs[DBDMA_STATUS] & ACTIVE)) { 62828ce5ce6Saurel32 return; 6297eaba824SAlexander Graf } 63028ce5ce6Saurel32 63128ce5ce6Saurel32 ch->regs[reg] = value; 63228ce5ce6Saurel32 63328ce5ce6Saurel32 switch(reg) { 63428ce5ce6Saurel32 case DBDMA_CONTROL: 63528ce5ce6Saurel32 dbdma_control_write(ch); 63628ce5ce6Saurel32 break; 63728ce5ce6Saurel32 case DBDMA_CMDPTR_LO: 63828ce5ce6Saurel32 /* 16-byte aligned */ 639ad674e53SAurelien Jarno ch->regs[DBDMA_CMDPTR_LO] &= ~0xf; 64028ce5ce6Saurel32 dbdma_cmdptr_load(ch); 64128ce5ce6Saurel32 break; 64228ce5ce6Saurel32 case DBDMA_STATUS: 64328ce5ce6Saurel32 case DBDMA_INTR_SEL: 64428ce5ce6Saurel32 case DBDMA_BRANCH_SEL: 64528ce5ce6Saurel32 case DBDMA_WAIT_SEL: 64628ce5ce6Saurel32 /* nothing to do */ 64728ce5ce6Saurel32 break; 64828ce5ce6Saurel32 case DBDMA_XFER_MODE: 64928ce5ce6Saurel32 case DBDMA_CMDPTR_HI: 65028ce5ce6Saurel32 case DBDMA_DATA2PTR_HI: 65128ce5ce6Saurel32 case DBDMA_DATA2PTR_LO: 65228ce5ce6Saurel32 case DBDMA_ADDRESS_HI: 65328ce5ce6Saurel32 case DBDMA_BRANCH_ADDR_HI: 65428ce5ce6Saurel32 case DBDMA_RES1: 65528ce5ce6Saurel32 case DBDMA_RES2: 65628ce5ce6Saurel32 case DBDMA_RES3: 65728ce5ce6Saurel32 case DBDMA_RES4: 65828ce5ce6Saurel32 /* unused */ 65928ce5ce6Saurel32 break; 6603cbee15bSj_mayer } 6613cbee15bSj_mayer } 6623cbee15bSj_mayer 663a8170e5eSAvi Kivity static uint64_t dbdma_read(void *opaque, hwaddr addr, 66423c5e4caSAvi Kivity unsigned size) 6653cbee15bSj_mayer { 66628ce5ce6Saurel32 uint32_t value; 66728ce5ce6Saurel32 int channel = addr >> DBDMA_CHANNEL_SHIFT; 668c20df14bSJuan Quintela DBDMAState *s = opaque; 669c20df14bSJuan Quintela DBDMA_channel *ch = &s->channels[channel]; 67028ce5ce6Saurel32 int reg = (addr - (channel << DBDMA_CHANNEL_SHIFT)) >> 2; 671ea026b2fSblueswir1 67228ce5ce6Saurel32 value = ch->regs[reg]; 67328ce5ce6Saurel32 67428ce5ce6Saurel32 DBDMA_DPRINTF("readl 0x" TARGET_FMT_plx " => 0x%08x\n", addr, value); 67528ce5ce6Saurel32 DBDMA_DPRINTF("channel 0x%x reg 0x%x\n", 67628ce5ce6Saurel32 (uint32_t)addr >> DBDMA_CHANNEL_SHIFT, reg); 67728ce5ce6Saurel32 67828ce5ce6Saurel32 switch(reg) { 67928ce5ce6Saurel32 case DBDMA_CONTROL: 68028ce5ce6Saurel32 value = 0; 68128ce5ce6Saurel32 break; 68228ce5ce6Saurel32 case DBDMA_STATUS: 68328ce5ce6Saurel32 case DBDMA_CMDPTR_LO: 68428ce5ce6Saurel32 case DBDMA_INTR_SEL: 68528ce5ce6Saurel32 case DBDMA_BRANCH_SEL: 68628ce5ce6Saurel32 case DBDMA_WAIT_SEL: 68728ce5ce6Saurel32 /* nothing to do */ 68828ce5ce6Saurel32 break; 68928ce5ce6Saurel32 case DBDMA_XFER_MODE: 69028ce5ce6Saurel32 case DBDMA_CMDPTR_HI: 69128ce5ce6Saurel32 case DBDMA_DATA2PTR_HI: 69228ce5ce6Saurel32 case DBDMA_DATA2PTR_LO: 69328ce5ce6Saurel32 case DBDMA_ADDRESS_HI: 69428ce5ce6Saurel32 case DBDMA_BRANCH_ADDR_HI: 69528ce5ce6Saurel32 /* unused */ 69628ce5ce6Saurel32 value = 0; 69728ce5ce6Saurel32 break; 69828ce5ce6Saurel32 case DBDMA_RES1: 69928ce5ce6Saurel32 case DBDMA_RES2: 70028ce5ce6Saurel32 case DBDMA_RES3: 70128ce5ce6Saurel32 case DBDMA_RES4: 70228ce5ce6Saurel32 /* reserved */ 70328ce5ce6Saurel32 break; 70428ce5ce6Saurel32 } 70528ce5ce6Saurel32 70628ce5ce6Saurel32 return value; 7073cbee15bSj_mayer } 7083cbee15bSj_mayer 70923c5e4caSAvi Kivity static const MemoryRegionOps dbdma_ops = { 71023c5e4caSAvi Kivity .read = dbdma_read, 71123c5e4caSAvi Kivity .write = dbdma_write, 71223c5e4caSAvi Kivity .endianness = DEVICE_LITTLE_ENDIAN, 71323c5e4caSAvi Kivity .valid = { 71423c5e4caSAvi Kivity .min_access_size = 4, 71523c5e4caSAvi Kivity .max_access_size = 4, 71623c5e4caSAvi Kivity }, 7173cbee15bSj_mayer }; 7183cbee15bSj_mayer 719627be2f2SMark Cave-Ayland static const VMStateDescription vmstate_dbdma_io = { 720627be2f2SMark Cave-Ayland .name = "dbdma_io", 721da26fdc3SJuan Quintela .version_id = 0, 722da26fdc3SJuan Quintela .minimum_version_id = 0, 723da26fdc3SJuan Quintela .fields = (VMStateField[]) { 724627be2f2SMark Cave-Ayland VMSTATE_UINT64(addr, struct DBDMA_io), 725627be2f2SMark Cave-Ayland VMSTATE_INT32(len, struct DBDMA_io), 726627be2f2SMark Cave-Ayland VMSTATE_INT32(is_last, struct DBDMA_io), 727627be2f2SMark Cave-Ayland VMSTATE_INT32(is_dma_out, struct DBDMA_io), 728627be2f2SMark Cave-Ayland VMSTATE_BOOL(processing, struct DBDMA_io), 729627be2f2SMark Cave-Ayland VMSTATE_END_OF_LIST() 730627be2f2SMark Cave-Ayland } 731627be2f2SMark Cave-Ayland }; 732627be2f2SMark Cave-Ayland 733627be2f2SMark Cave-Ayland static const VMStateDescription vmstate_dbdma_cmd = { 734627be2f2SMark Cave-Ayland .name = "dbdma_cmd", 735627be2f2SMark Cave-Ayland .version_id = 0, 736627be2f2SMark Cave-Ayland .minimum_version_id = 0, 737627be2f2SMark Cave-Ayland .fields = (VMStateField[]) { 738627be2f2SMark Cave-Ayland VMSTATE_UINT16(req_count, dbdma_cmd), 739627be2f2SMark Cave-Ayland VMSTATE_UINT16(command, dbdma_cmd), 740627be2f2SMark Cave-Ayland VMSTATE_UINT32(phy_addr, dbdma_cmd), 741627be2f2SMark Cave-Ayland VMSTATE_UINT32(cmd_dep, dbdma_cmd), 742627be2f2SMark Cave-Ayland VMSTATE_UINT16(res_count, dbdma_cmd), 743627be2f2SMark Cave-Ayland VMSTATE_UINT16(xfer_status, dbdma_cmd), 744627be2f2SMark Cave-Ayland VMSTATE_END_OF_LIST() 745627be2f2SMark Cave-Ayland } 746627be2f2SMark Cave-Ayland }; 747627be2f2SMark Cave-Ayland 748627be2f2SMark Cave-Ayland static const VMStateDescription vmstate_dbdma_channel = { 749627be2f2SMark Cave-Ayland .name = "dbdma_channel", 750627be2f2SMark Cave-Ayland .version_id = 1, 751627be2f2SMark Cave-Ayland .minimum_version_id = 1, 752627be2f2SMark Cave-Ayland .fields = (VMStateField[]) { 753da26fdc3SJuan Quintela VMSTATE_UINT32_ARRAY(regs, struct DBDMA_channel, DBDMA_REGS), 754627be2f2SMark Cave-Ayland VMSTATE_STRUCT(io, struct DBDMA_channel, 0, vmstate_dbdma_io, DBDMA_io), 755627be2f2SMark Cave-Ayland VMSTATE_STRUCT(current, struct DBDMA_channel, 0, vmstate_dbdma_cmd, 756627be2f2SMark Cave-Ayland dbdma_cmd), 757da26fdc3SJuan Quintela VMSTATE_END_OF_LIST() 7589b64997fSblueswir1 } 759da26fdc3SJuan Quintela }; 7609b64997fSblueswir1 761da26fdc3SJuan Quintela static const VMStateDescription vmstate_dbdma = { 762da26fdc3SJuan Quintela .name = "dbdma", 763627be2f2SMark Cave-Ayland .version_id = 3, 764627be2f2SMark Cave-Ayland .minimum_version_id = 3, 765da26fdc3SJuan Quintela .fields = (VMStateField[]) { 766da26fdc3SJuan Quintela VMSTATE_STRUCT_ARRAY(channels, DBDMAState, DBDMA_CHANNELS, 1, 767da26fdc3SJuan Quintela vmstate_dbdma_channel, DBDMA_channel), 768da26fdc3SJuan Quintela VMSTATE_END_OF_LIST() 7699b64997fSblueswir1 } 770da26fdc3SJuan Quintela }; 7719b64997fSblueswir1 7726e6b7363Sblueswir1 static void dbdma_reset(void *opaque) 7736e6b7363Sblueswir1 { 774c20df14bSJuan Quintela DBDMAState *s = opaque; 77528ce5ce6Saurel32 int i; 77628ce5ce6Saurel32 77728ce5ce6Saurel32 for (i = 0; i < DBDMA_CHANNELS; i++) 778c20df14bSJuan Quintela memset(s->channels[i].regs, 0, DBDMA_SIZE); 7796e6b7363Sblueswir1 } 7806e6b7363Sblueswir1 7812d7d06d8SHervé Poussineau static void dbdma_unassigned_rw(DBDMA_io *io) 7822d7d06d8SHervé Poussineau { 7832d7d06d8SHervé Poussineau DBDMA_channel *ch = io->channel; 7842d7d06d8SHervé Poussineau qemu_log_mask(LOG_GUEST_ERROR, "%s: use of unassigned channel %d\n", 7852d7d06d8SHervé Poussineau __func__, ch->channel); 7862d7d06d8SHervé Poussineau } 7872d7d06d8SHervé Poussineau 7882d7d06d8SHervé Poussineau static void dbdma_unassigned_flush(DBDMA_io *io) 7892d7d06d8SHervé Poussineau { 7902d7d06d8SHervé Poussineau DBDMA_channel *ch = io->channel; 7912d7d06d8SHervé Poussineau qemu_log_mask(LOG_GUEST_ERROR, "%s: use of unassigned channel %d\n", 7922d7d06d8SHervé Poussineau __func__, ch->channel); 7932d7d06d8SHervé Poussineau } 7942d7d06d8SHervé Poussineau 79523c5e4caSAvi Kivity void* DBDMA_init (MemoryRegion **dbdma_mem) 7963cbee15bSj_mayer { 797c20df14bSJuan Quintela DBDMAState *s; 7983e300fa6SAlexander Graf int i; 79928ce5ce6Saurel32 8007267c094SAnthony Liguori s = g_malloc0(sizeof(DBDMAState)); 80128ce5ce6Saurel32 8023e300fa6SAlexander Graf for (i = 0; i < DBDMA_CHANNELS; i++) { 8033e300fa6SAlexander Graf DBDMA_io *io = &s->channels[i].io; 8042d7d06d8SHervé Poussineau DBDMA_channel *ch = &s->channels[i]; 8053e300fa6SAlexander Graf qemu_iovec_init(&io->iov, 1); 8062d7d06d8SHervé Poussineau 8072d7d06d8SHervé Poussineau ch->rw = dbdma_unassigned_rw; 8082d7d06d8SHervé Poussineau ch->flush = dbdma_unassigned_flush; 8092d7d06d8SHervé Poussineau ch->channel = i; 8102d7d06d8SHervé Poussineau ch->io.channel = ch; 8113e300fa6SAlexander Graf } 8123e300fa6SAlexander Graf 8132c9b15caSPaolo Bonzini memory_region_init_io(&s->mem, NULL, &dbdma_ops, s, "dbdma", 0x1000); 81423c5e4caSAvi Kivity *dbdma_mem = &s->mem; 815da26fdc3SJuan Quintela vmstate_register(NULL, -1, &vmstate_dbdma, s); 816a08d4367SJan Kiszka qemu_register_reset(dbdma_reset, s); 81728ce5ce6Saurel32 818d2f0ce21SAlexander Graf s->bh = qemu_bh_new(DBDMA_run_bh, s); 81928ce5ce6Saurel32 82028ce5ce6Saurel32 return s; 8213cbee15bSj_mayer } 822