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 } \ 552562755eSEric Blake } 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 } \ 632562755eSEric Blake } 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 74*b7d67813SMark Cave-Ayland static void dump_dbdma_cmd(DBDMA_channel *ch, dbdma_cmd *cmd) 753cbee15bSj_mayer { 76*b7d67813SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "dbdma_cmd %p\n", cmd); 77*b7d67813SMark Cave-Ayland DBDMA_DPRINTFCH(ch, " req_count 0x%04x\n", le16_to_cpu(cmd->req_count)); 78*b7d67813SMark Cave-Ayland DBDMA_DPRINTFCH(ch, " command 0x%04x\n", le16_to_cpu(cmd->command)); 79*b7d67813SMark Cave-Ayland DBDMA_DPRINTFCH(ch, " phy_addr 0x%08x\n", le32_to_cpu(cmd->phy_addr)); 80*b7d67813SMark Cave-Ayland DBDMA_DPRINTFCH(ch, " cmd_dep 0x%08x\n", le32_to_cpu(cmd->cmd_dep)); 81*b7d67813SMark Cave-Ayland DBDMA_DPRINTFCH(ch, " res_count 0x%04x\n", le16_to_cpu(cmd->res_count)); 82*b7d67813SMark Cave-Ayland DBDMA_DPRINTFCH(ch, " xfer_status 0x%04x\n", 83*b7d67813SMark Cave-Ayland le16_to_cpu(cmd->xfer_status)); 8428ce5ce6Saurel32 } 8528ce5ce6Saurel32 #else 86*b7d67813SMark Cave-Ayland static void dump_dbdma_cmd(DBDMA_channel *ch, dbdma_cmd *cmd) 8728ce5ce6Saurel32 { 8828ce5ce6Saurel32 } 8928ce5ce6Saurel32 #endif 9028ce5ce6Saurel32 static void dbdma_cmdptr_load(DBDMA_channel *ch) 9128ce5ce6Saurel32 { 923e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "dbdma_cmdptr_load 0x%08x\n", 93ad674e53SAurelien Jarno ch->regs[DBDMA_CMDPTR_LO]); 9488655881SMark Cave-Ayland dma_memory_read(&address_space_memory, ch->regs[DBDMA_CMDPTR_LO], 95e1fe50dcSStefan Weil &ch->current, sizeof(dbdma_cmd)); 963cbee15bSj_mayer } 973cbee15bSj_mayer 9828ce5ce6Saurel32 static void dbdma_cmdptr_save(DBDMA_channel *ch) 993cbee15bSj_mayer { 10077453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, "-> update 0x%08x stat=0x%08x, res=0x%04x\n", 10177453882SBenjamin Herrenschmidt ch->regs[DBDMA_CMDPTR_LO], 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; 16977453882SBenjamin Herrenschmidt int res = 0; 17028ce5ce6Saurel32 171b42ec42dSaurel32 wait = le16_to_cpu(current->command) & WAIT_MASK; 17228ce5ce6Saurel32 switch(wait) { 17328ce5ce6Saurel32 case WAIT_NEVER: /* don't wait */ 17428ce5ce6Saurel32 return 0; 17528ce5ce6Saurel32 case WAIT_ALWAYS: /* always wait */ 17677453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " [WAIT_ALWAYS]\n"); 17728ce5ce6Saurel32 return 1; 17828ce5ce6Saurel32 } 17928ce5ce6Saurel32 180ad674e53SAurelien Jarno status = ch->regs[DBDMA_STATUS] & DEVSTAT; 18128ce5ce6Saurel32 182ad674e53SAurelien Jarno sel_mask = (ch->regs[DBDMA_WAIT_SEL] >> 16) & 0x0f; 183ad674e53SAurelien Jarno sel_value = ch->regs[DBDMA_WAIT_SEL] & 0x0f; 18428ce5ce6Saurel32 18528ce5ce6Saurel32 cond = (status & sel_mask) == (sel_value & sel_mask); 18628ce5ce6Saurel32 18728ce5ce6Saurel32 switch(wait) { 18828ce5ce6Saurel32 case WAIT_IFSET: /* wait if condition bit is 1 */ 18977453882SBenjamin Herrenschmidt if (cond) { 19077453882SBenjamin Herrenschmidt res = 1; 19128ce5ce6Saurel32 } 19277453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " [WAIT_IFSET=%d]\n", res); 19377453882SBenjamin Herrenschmidt break; 19477453882SBenjamin Herrenschmidt case WAIT_IFCLR: /* wait if condition bit is 0 */ 19577453882SBenjamin Herrenschmidt if (!cond) { 19677453882SBenjamin Herrenschmidt res = 1; 19777453882SBenjamin Herrenschmidt } 19877453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " [WAIT_IFCLR=%d]\n", res); 19977453882SBenjamin Herrenschmidt break; 20077453882SBenjamin Herrenschmidt } 20177453882SBenjamin Herrenschmidt return res; 20228ce5ce6Saurel32 } 20328ce5ce6Saurel32 20428ce5ce6Saurel32 static void next(DBDMA_channel *ch) 20528ce5ce6Saurel32 { 20628ce5ce6Saurel32 uint32_t cp; 20728ce5ce6Saurel32 208ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] &= ~BT; 20928ce5ce6Saurel32 210ad674e53SAurelien Jarno cp = ch->regs[DBDMA_CMDPTR_LO]; 211ad674e53SAurelien Jarno ch->regs[DBDMA_CMDPTR_LO] = cp + sizeof(dbdma_cmd); 21228ce5ce6Saurel32 dbdma_cmdptr_load(ch); 21328ce5ce6Saurel32 } 21428ce5ce6Saurel32 21528ce5ce6Saurel32 static void branch(DBDMA_channel *ch) 21628ce5ce6Saurel32 { 21728ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 21828ce5ce6Saurel32 2193f0d4128SMark Cave-Ayland ch->regs[DBDMA_CMDPTR_LO] = le32_to_cpu(current->cmd_dep); 220ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] |= BT; 22128ce5ce6Saurel32 dbdma_cmdptr_load(ch); 22228ce5ce6Saurel32 } 22328ce5ce6Saurel32 22428ce5ce6Saurel32 static void conditional_branch(DBDMA_channel *ch) 22528ce5ce6Saurel32 { 22628ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 22728ce5ce6Saurel32 uint16_t br; 22828ce5ce6Saurel32 uint16_t sel_mask, sel_value; 22928ce5ce6Saurel32 uint32_t status; 23028ce5ce6Saurel32 int cond; 23128ce5ce6Saurel32 23228ce5ce6Saurel32 /* check if we must branch */ 23328ce5ce6Saurel32 234b42ec42dSaurel32 br = le16_to_cpu(current->command) & BR_MASK; 23528ce5ce6Saurel32 23628ce5ce6Saurel32 switch(br) { 23728ce5ce6Saurel32 case BR_NEVER: /* don't branch */ 23828ce5ce6Saurel32 next(ch); 23928ce5ce6Saurel32 return; 24028ce5ce6Saurel32 case BR_ALWAYS: /* always branch */ 24177453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " [BR_ALWAYS]\n"); 24228ce5ce6Saurel32 branch(ch); 24328ce5ce6Saurel32 return; 24428ce5ce6Saurel32 } 24528ce5ce6Saurel32 246ad674e53SAurelien Jarno status = ch->regs[DBDMA_STATUS] & DEVSTAT; 24728ce5ce6Saurel32 248ad674e53SAurelien Jarno sel_mask = (ch->regs[DBDMA_BRANCH_SEL] >> 16) & 0x0f; 249ad674e53SAurelien Jarno sel_value = ch->regs[DBDMA_BRANCH_SEL] & 0x0f; 25028ce5ce6Saurel32 25128ce5ce6Saurel32 cond = (status & sel_mask) == (sel_value & sel_mask); 25228ce5ce6Saurel32 25328ce5ce6Saurel32 switch(br) { 25428ce5ce6Saurel32 case BR_IFSET: /* branch if condition bit is 1 */ 25577453882SBenjamin Herrenschmidt if (cond) { 25677453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " [BR_IFSET = 1]\n"); 25728ce5ce6Saurel32 branch(ch); 25877453882SBenjamin Herrenschmidt } else { 25977453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " [BR_IFSET = 0]\n"); 26028ce5ce6Saurel32 next(ch); 26177453882SBenjamin Herrenschmidt } 26228ce5ce6Saurel32 return; 26328ce5ce6Saurel32 case BR_IFCLR: /* branch if condition bit is 0 */ 26477453882SBenjamin Herrenschmidt if (!cond) { 26577453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " [BR_IFCLR = 1]\n"); 26628ce5ce6Saurel32 branch(ch); 26777453882SBenjamin Herrenschmidt } else { 26877453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " [BR_IFCLR = 0]\n"); 26928ce5ce6Saurel32 next(ch); 27077453882SBenjamin Herrenschmidt } 27128ce5ce6Saurel32 return; 27228ce5ce6Saurel32 } 27328ce5ce6Saurel32 } 27428ce5ce6Saurel32 275b42ec42dSaurel32 static void channel_run(DBDMA_channel *ch); 276b42ec42dSaurel32 277b42ec42dSaurel32 static void dbdma_end(DBDMA_io *io) 27828ce5ce6Saurel32 { 27928ce5ce6Saurel32 DBDMA_channel *ch = io->channel; 28028ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 28128ce5ce6Saurel32 2823e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "%s\n", __func__); 28333ce36bbSAlexander Graf 284b42ec42dSaurel32 if (conditional_wait(ch)) 285b42ec42dSaurel32 goto wait; 28628ce5ce6Saurel32 287ad674e53SAurelien Jarno current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]); 288ad674e53SAurelien Jarno current->res_count = cpu_to_le16(io->len); 289b42ec42dSaurel32 dbdma_cmdptr_save(ch); 290862c9280Saurel32 if (io->is_last) 291ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] &= ~FLUSH; 29228ce5ce6Saurel32 293b42ec42dSaurel32 conditional_interrupt(ch); 294b42ec42dSaurel32 conditional_branch(ch); 295b42ec42dSaurel32 296b42ec42dSaurel32 wait: 29703ee3b1eSAlexander Graf /* Indicate that we're ready for a new DMA round */ 29803ee3b1eSAlexander Graf ch->io.processing = false; 29903ee3b1eSAlexander Graf 300ad674e53SAurelien Jarno if ((ch->regs[DBDMA_STATUS] & RUN) && 301ad674e53SAurelien Jarno (ch->regs[DBDMA_STATUS] & ACTIVE)) 302b42ec42dSaurel32 channel_run(ch); 30328ce5ce6Saurel32 } 30428ce5ce6Saurel32 305b42ec42dSaurel32 static void start_output(DBDMA_channel *ch, int key, uint32_t addr, 30628ce5ce6Saurel32 uint16_t req_count, int is_last) 30728ce5ce6Saurel32 { 3083e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "start_output\n"); 30928ce5ce6Saurel32 31028ce5ce6Saurel32 /* KEY_REGS, KEY_DEVICE and KEY_STREAM 31128ce5ce6Saurel32 * are not implemented in the mac-io chip 31228ce5ce6Saurel32 */ 31328ce5ce6Saurel32 3143e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "addr 0x%x key 0x%x\n", addr, key); 31528ce5ce6Saurel32 if (!addr || key > KEY_STREAM3) { 31628ce5ce6Saurel32 kill_channel(ch); 317b42ec42dSaurel32 return; 31828ce5ce6Saurel32 } 31928ce5ce6Saurel32 320b42ec42dSaurel32 ch->io.addr = addr; 32128ce5ce6Saurel32 ch->io.len = req_count; 32228ce5ce6Saurel32 ch->io.is_last = is_last; 323b42ec42dSaurel32 ch->io.dma_end = dbdma_end; 324b42ec42dSaurel32 ch->io.is_dma_out = 1; 32503ee3b1eSAlexander Graf ch->io.processing = true; 326a9ceb76dSAlexander Graf if (ch->rw) { 327b42ec42dSaurel32 ch->rw(&ch->io); 32828ce5ce6Saurel32 } 329a9ceb76dSAlexander Graf } 33028ce5ce6Saurel32 331b42ec42dSaurel32 static void start_input(DBDMA_channel *ch, int key, uint32_t addr, 33228ce5ce6Saurel32 uint16_t req_count, int is_last) 33328ce5ce6Saurel32 { 3343e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "start_input\n"); 33528ce5ce6Saurel32 33628ce5ce6Saurel32 /* KEY_REGS, KEY_DEVICE and KEY_STREAM 33728ce5ce6Saurel32 * are not implemented in the mac-io chip 33828ce5ce6Saurel32 */ 33928ce5ce6Saurel32 3403e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "addr 0x%x key 0x%x\n", addr, key); 34128ce5ce6Saurel32 if (!addr || key > KEY_STREAM3) { 34228ce5ce6Saurel32 kill_channel(ch); 343b42ec42dSaurel32 return; 34428ce5ce6Saurel32 } 34528ce5ce6Saurel32 346b42ec42dSaurel32 ch->io.addr = addr; 34728ce5ce6Saurel32 ch->io.len = req_count; 34828ce5ce6Saurel32 ch->io.is_last = is_last; 349b42ec42dSaurel32 ch->io.dma_end = dbdma_end; 350b42ec42dSaurel32 ch->io.is_dma_out = 0; 35103ee3b1eSAlexander Graf ch->io.processing = true; 352a9ceb76dSAlexander Graf if (ch->rw) { 353b42ec42dSaurel32 ch->rw(&ch->io); 35428ce5ce6Saurel32 } 355a9ceb76dSAlexander Graf } 35628ce5ce6Saurel32 357b42ec42dSaurel32 static void load_word(DBDMA_channel *ch, int key, uint32_t addr, 35828ce5ce6Saurel32 uint16_t len) 35928ce5ce6Saurel32 { 36028ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 36128ce5ce6Saurel32 362e12f50b9SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "load_word %d bytes, addr=%08x\n", len, addr); 36328ce5ce6Saurel32 36428ce5ce6Saurel32 /* only implements KEY_SYSTEM */ 36528ce5ce6Saurel32 36628ce5ce6Saurel32 if (key != KEY_SYSTEM) { 36728ce5ce6Saurel32 printf("DBDMA: LOAD_WORD, unimplemented key %x\n", key); 36828ce5ce6Saurel32 kill_channel(ch); 369b42ec42dSaurel32 return; 37028ce5ce6Saurel32 } 37128ce5ce6Saurel32 372e12f50b9SMark Cave-Ayland dma_memory_read(&address_space_memory, addr, ¤t->cmd_dep, len); 37328ce5ce6Saurel32 37428ce5ce6Saurel32 if (conditional_wait(ch)) 375b42ec42dSaurel32 goto wait; 37628ce5ce6Saurel32 377ad674e53SAurelien Jarno current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]); 37828ce5ce6Saurel32 dbdma_cmdptr_save(ch); 379ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] &= ~FLUSH; 38028ce5ce6Saurel32 38128ce5ce6Saurel32 conditional_interrupt(ch); 38228ce5ce6Saurel32 next(ch); 38328ce5ce6Saurel32 384b42ec42dSaurel32 wait: 385d2f0ce21SAlexander Graf DBDMA_kick(dbdma_from_ch(ch)); 38628ce5ce6Saurel32 } 38728ce5ce6Saurel32 388b42ec42dSaurel32 static void store_word(DBDMA_channel *ch, int key, uint32_t addr, 38928ce5ce6Saurel32 uint16_t len) 39028ce5ce6Saurel32 { 39128ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 39228ce5ce6Saurel32 393e12f50b9SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "store_word %d bytes, addr=%08x pa=%x\n", 394e12f50b9SMark Cave-Ayland len, addr, le32_to_cpu(current->cmd_dep)); 39528ce5ce6Saurel32 39628ce5ce6Saurel32 /* only implements KEY_SYSTEM */ 39728ce5ce6Saurel32 39828ce5ce6Saurel32 if (key != KEY_SYSTEM) { 39928ce5ce6Saurel32 printf("DBDMA: STORE_WORD, unimplemented key %x\n", key); 40028ce5ce6Saurel32 kill_channel(ch); 401b42ec42dSaurel32 return; 40228ce5ce6Saurel32 } 40328ce5ce6Saurel32 404e12f50b9SMark Cave-Ayland dma_memory_write(&address_space_memory, addr, ¤t->cmd_dep, len); 40528ce5ce6Saurel32 40628ce5ce6Saurel32 if (conditional_wait(ch)) 407b42ec42dSaurel32 goto wait; 40828ce5ce6Saurel32 409ad674e53SAurelien Jarno current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]); 41028ce5ce6Saurel32 dbdma_cmdptr_save(ch); 411ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] &= ~FLUSH; 41228ce5ce6Saurel32 41328ce5ce6Saurel32 conditional_interrupt(ch); 41428ce5ce6Saurel32 next(ch); 41528ce5ce6Saurel32 416b42ec42dSaurel32 wait: 417d2f0ce21SAlexander Graf DBDMA_kick(dbdma_from_ch(ch)); 41828ce5ce6Saurel32 } 41928ce5ce6Saurel32 420b42ec42dSaurel32 static void nop(DBDMA_channel *ch) 42128ce5ce6Saurel32 { 42228ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 42328ce5ce6Saurel32 42428ce5ce6Saurel32 if (conditional_wait(ch)) 425b42ec42dSaurel32 goto wait; 42628ce5ce6Saurel32 427ad674e53SAurelien Jarno current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]); 42828ce5ce6Saurel32 dbdma_cmdptr_save(ch); 42928ce5ce6Saurel32 43028ce5ce6Saurel32 conditional_interrupt(ch); 43128ce5ce6Saurel32 conditional_branch(ch); 43228ce5ce6Saurel32 433b42ec42dSaurel32 wait: 434d2f0ce21SAlexander Graf DBDMA_kick(dbdma_from_ch(ch)); 43528ce5ce6Saurel32 } 43628ce5ce6Saurel32 437b42ec42dSaurel32 static void stop(DBDMA_channel *ch) 43828ce5ce6Saurel32 { 43977453882SBenjamin Herrenschmidt ch->regs[DBDMA_STATUS] &= ~(ACTIVE); 44028ce5ce6Saurel32 44128ce5ce6Saurel32 /* the stop command does not increment command pointer */ 44228ce5ce6Saurel32 } 44328ce5ce6Saurel32 444b42ec42dSaurel32 static void channel_run(DBDMA_channel *ch) 44528ce5ce6Saurel32 { 44628ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 44728ce5ce6Saurel32 uint16_t cmd, key; 44828ce5ce6Saurel32 uint16_t req_count; 44928ce5ce6Saurel32 uint32_t phy_addr; 45028ce5ce6Saurel32 4513e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "channel_run\n"); 452*b7d67813SMark Cave-Ayland dump_dbdma_cmd(ch, current); 45328ce5ce6Saurel32 45428ce5ce6Saurel32 /* clear WAKE flag at command fetch */ 45528ce5ce6Saurel32 456ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] &= ~WAKE; 45728ce5ce6Saurel32 45828ce5ce6Saurel32 cmd = le16_to_cpu(current->command) & COMMAND_MASK; 45928ce5ce6Saurel32 46028ce5ce6Saurel32 switch (cmd) { 46128ce5ce6Saurel32 case DBDMA_NOP: 462b42ec42dSaurel32 nop(ch); 463b42ec42dSaurel32 return; 46428ce5ce6Saurel32 46528ce5ce6Saurel32 case DBDMA_STOP: 466b42ec42dSaurel32 stop(ch); 467b42ec42dSaurel32 return; 46828ce5ce6Saurel32 } 46928ce5ce6Saurel32 47028ce5ce6Saurel32 key = le16_to_cpu(current->command) & 0x0700; 47128ce5ce6Saurel32 req_count = le16_to_cpu(current->req_count); 47228ce5ce6Saurel32 phy_addr = le32_to_cpu(current->phy_addr); 47328ce5ce6Saurel32 47428ce5ce6Saurel32 if (key == KEY_STREAM4) { 47528ce5ce6Saurel32 printf("command %x, invalid key 4\n", cmd); 47628ce5ce6Saurel32 kill_channel(ch); 477b42ec42dSaurel32 return; 47828ce5ce6Saurel32 } 47928ce5ce6Saurel32 48028ce5ce6Saurel32 switch (cmd) { 48128ce5ce6Saurel32 case OUTPUT_MORE: 48277453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, "* OUTPUT_MORE *\n"); 483b42ec42dSaurel32 start_output(ch, key, phy_addr, req_count, 0); 484b42ec42dSaurel32 return; 48528ce5ce6Saurel32 48628ce5ce6Saurel32 case OUTPUT_LAST: 48777453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, "* OUTPUT_LAST *\n"); 488b42ec42dSaurel32 start_output(ch, key, phy_addr, req_count, 1); 489b42ec42dSaurel32 return; 49028ce5ce6Saurel32 49128ce5ce6Saurel32 case INPUT_MORE: 49277453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, "* INPUT_MORE *\n"); 493b42ec42dSaurel32 start_input(ch, key, phy_addr, req_count, 0); 494b42ec42dSaurel32 return; 49528ce5ce6Saurel32 49628ce5ce6Saurel32 case INPUT_LAST: 49777453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, "* INPUT_LAST *\n"); 498b42ec42dSaurel32 start_input(ch, key, phy_addr, req_count, 1); 499b42ec42dSaurel32 return; 50028ce5ce6Saurel32 } 50128ce5ce6Saurel32 50228ce5ce6Saurel32 if (key < KEY_REGS) { 50328ce5ce6Saurel32 printf("command %x, invalid key %x\n", cmd, key); 50428ce5ce6Saurel32 key = KEY_SYSTEM; 50528ce5ce6Saurel32 } 50628ce5ce6Saurel32 50728ce5ce6Saurel32 /* for LOAD_WORD and STORE_WORD, req_count is on 3 bits 50828ce5ce6Saurel32 * and BRANCH is invalid 50928ce5ce6Saurel32 */ 51028ce5ce6Saurel32 51128ce5ce6Saurel32 req_count = req_count & 0x0007; 51228ce5ce6Saurel32 if (req_count & 0x4) { 51328ce5ce6Saurel32 req_count = 4; 51428ce5ce6Saurel32 phy_addr &= ~3; 51528ce5ce6Saurel32 } else if (req_count & 0x2) { 51628ce5ce6Saurel32 req_count = 2; 51728ce5ce6Saurel32 phy_addr &= ~1; 51828ce5ce6Saurel32 } else 51928ce5ce6Saurel32 req_count = 1; 52028ce5ce6Saurel32 52128ce5ce6Saurel32 switch (cmd) { 52228ce5ce6Saurel32 case LOAD_WORD: 52377453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, "* LOAD_WORD *\n"); 524b42ec42dSaurel32 load_word(ch, key, phy_addr, req_count); 525b42ec42dSaurel32 return; 52628ce5ce6Saurel32 52728ce5ce6Saurel32 case STORE_WORD: 52877453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, "* STORE_WORD *\n"); 529b42ec42dSaurel32 store_word(ch, key, phy_addr, req_count); 530b42ec42dSaurel32 return; 53128ce5ce6Saurel32 } 53228ce5ce6Saurel32 } 53328ce5ce6Saurel32 534c20df14bSJuan Quintela static void DBDMA_run(DBDMAState *s) 53528ce5ce6Saurel32 { 53628ce5ce6Saurel32 int channel; 53728ce5ce6Saurel32 538c20df14bSJuan Quintela for (channel = 0; channel < DBDMA_CHANNELS; channel++) { 539c20df14bSJuan Quintela DBDMA_channel *ch = &s->channels[channel]; 540ad674e53SAurelien Jarno uint32_t status = ch->regs[DBDMA_STATUS]; 54103ee3b1eSAlexander Graf if (!ch->io.processing && (status & RUN) && (status & ACTIVE)) { 542b42ec42dSaurel32 channel_run(ch); 54328ce5ce6Saurel32 } 54428ce5ce6Saurel32 } 545c20df14bSJuan Quintela } 54628ce5ce6Saurel32 54728ce5ce6Saurel32 static void DBDMA_run_bh(void *opaque) 54828ce5ce6Saurel32 { 549c20df14bSJuan Quintela DBDMAState *s = opaque; 55028ce5ce6Saurel32 5513e49c439SMark Cave-Ayland DBDMA_DPRINTF("-> DBDMA_run_bh\n"); 552c20df14bSJuan Quintela DBDMA_run(s); 5533e49c439SMark Cave-Ayland DBDMA_DPRINTF("<- DBDMA_run_bh\n"); 55428ce5ce6Saurel32 } 55528ce5ce6Saurel32 556d1e562deSAlexander Graf void DBDMA_kick(DBDMAState *dbdma) 557d1e562deSAlexander Graf { 558d2f0ce21SAlexander Graf qemu_bh_schedule(dbdma->bh); 559d1e562deSAlexander Graf } 560d1e562deSAlexander Graf 56128ce5ce6Saurel32 void DBDMA_register_channel(void *dbdma, int nchan, qemu_irq irq, 562862c9280Saurel32 DBDMA_rw rw, DBDMA_flush flush, 56328ce5ce6Saurel32 void *opaque) 56428ce5ce6Saurel32 { 565c20df14bSJuan Quintela DBDMAState *s = dbdma; 566c20df14bSJuan Quintela DBDMA_channel *ch = &s->channels[nchan]; 56728ce5ce6Saurel32 5683e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "DBDMA_register_channel 0x%x\n", nchan); 56928ce5ce6Saurel32 5702d7d06d8SHervé Poussineau assert(rw); 5712d7d06d8SHervé Poussineau assert(flush); 5722d7d06d8SHervé Poussineau 57328ce5ce6Saurel32 ch->irq = irq; 574b42ec42dSaurel32 ch->rw = rw; 575862c9280Saurel32 ch->flush = flush; 57628ce5ce6Saurel32 ch->io.opaque = opaque; 57728ce5ce6Saurel32 } 57828ce5ce6Saurel32 57977453882SBenjamin Herrenschmidt static void dbdma_control_write(DBDMA_channel *ch) 58028ce5ce6Saurel32 { 58128ce5ce6Saurel32 uint16_t mask, value; 58228ce5ce6Saurel32 uint32_t status; 58377453882SBenjamin Herrenschmidt bool do_flush = false; 58428ce5ce6Saurel32 585ad674e53SAurelien Jarno mask = (ch->regs[DBDMA_CONTROL] >> 16) & 0xffff; 586ad674e53SAurelien Jarno value = ch->regs[DBDMA_CONTROL] & 0xffff; 58728ce5ce6Saurel32 58877453882SBenjamin Herrenschmidt /* This is the status register which we'll update 58977453882SBenjamin Herrenschmidt * appropriately and store back 59077453882SBenjamin Herrenschmidt */ 591ad674e53SAurelien Jarno status = ch->regs[DBDMA_STATUS]; 59228ce5ce6Saurel32 59377453882SBenjamin Herrenschmidt /* RUN and PAUSE are bits under SW control only 59477453882SBenjamin Herrenschmidt * FLUSH and WAKE are set by SW and cleared by HW 59577453882SBenjamin Herrenschmidt * DEAD, ACTIVE and BT are only under HW control 59677453882SBenjamin Herrenschmidt * 59777453882SBenjamin Herrenschmidt * We handle ACTIVE separately at the end of the 59877453882SBenjamin Herrenschmidt * logic to ensure all cases are covered. 59977453882SBenjamin Herrenschmidt */ 60028ce5ce6Saurel32 60177453882SBenjamin Herrenschmidt /* Setting RUN will tentatively activate the channel 60277453882SBenjamin Herrenschmidt */ 60377453882SBenjamin Herrenschmidt if ((mask & RUN) && (value & RUN)) { 60477453882SBenjamin Herrenschmidt status |= RUN; 60577453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " Setting RUN !\n"); 60628ce5ce6Saurel32 } 60777453882SBenjamin Herrenschmidt 60877453882SBenjamin Herrenschmidt /* Clearing RUN 1->0 will stop the channel */ 60977453882SBenjamin Herrenschmidt if ((mask & RUN) && !(value & RUN)) { 61077453882SBenjamin Herrenschmidt /* This has the side effect of clearing the DEAD bit */ 61177453882SBenjamin Herrenschmidt status &= ~(DEAD | RUN); 61277453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " Clearing RUN !\n"); 61377453882SBenjamin Herrenschmidt } 61477453882SBenjamin Herrenschmidt 61577453882SBenjamin Herrenschmidt /* Setting WAKE wakes up an idle channel if it's running 61677453882SBenjamin Herrenschmidt * 61777453882SBenjamin Herrenschmidt * Note: The doc doesn't say so but assume that only works 61877453882SBenjamin Herrenschmidt * on a channel whose RUN bit is set. 61977453882SBenjamin Herrenschmidt * 62077453882SBenjamin Herrenschmidt * We set WAKE in status, it's not terribly useful as it will 62177453882SBenjamin Herrenschmidt * be cleared on the next command fetch but it seems to mimmic 62277453882SBenjamin Herrenschmidt * the HW behaviour and is useful for the way we handle 62377453882SBenjamin Herrenschmidt * ACTIVE further down. 62477453882SBenjamin Herrenschmidt */ 62577453882SBenjamin Herrenschmidt if ((mask & WAKE) && (value & WAKE) && (status & RUN)) { 62677453882SBenjamin Herrenschmidt status |= WAKE; 62777453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " Setting WAKE !\n"); 62877453882SBenjamin Herrenschmidt } 62977453882SBenjamin Herrenschmidt 63077453882SBenjamin Herrenschmidt /* PAUSE being set will deactivate (or prevent activation) 63177453882SBenjamin Herrenschmidt * of the channel. We just copy it over for now, ACTIVE will 63277453882SBenjamin Herrenschmidt * be re-evaluated later. 63377453882SBenjamin Herrenschmidt */ 63477453882SBenjamin Herrenschmidt if (mask & PAUSE) { 63577453882SBenjamin Herrenschmidt status = (status & ~PAUSE) | (value & PAUSE); 63677453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " %sing PAUSE !\n", 63777453882SBenjamin Herrenschmidt (value & PAUSE) ? "sett" : "clear"); 63877453882SBenjamin Herrenschmidt } 63977453882SBenjamin Herrenschmidt 64077453882SBenjamin Herrenschmidt /* FLUSH is its own thing */ 64177453882SBenjamin Herrenschmidt if ((mask & FLUSH) && (value & FLUSH)) { 64277453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " Setting FLUSH !\n"); 64377453882SBenjamin Herrenschmidt /* We set flush directly in the status register, we do *NOT* 64477453882SBenjamin Herrenschmidt * set it in "status" so that it gets naturally cleared when 64577453882SBenjamin Herrenschmidt * we update the status register further down. That way it 64677453882SBenjamin Herrenschmidt * will be set only during the HW flush operation so it is 64777453882SBenjamin Herrenschmidt * visible to any completions happening during that time. 64877453882SBenjamin Herrenschmidt */ 64977453882SBenjamin Herrenschmidt ch->regs[DBDMA_STATUS] |= FLUSH; 65077453882SBenjamin Herrenschmidt do_flush = true; 65177453882SBenjamin Herrenschmidt } 65277453882SBenjamin Herrenschmidt 65377453882SBenjamin Herrenschmidt /* If either RUN or PAUSE is clear, so should ACTIVE be, 65477453882SBenjamin Herrenschmidt * otherwise, ACTIVE will be set if we modified RUN, PAUSE or 65577453882SBenjamin Herrenschmidt * set WAKE. That means that PAUSE was just cleared, RUN was 65677453882SBenjamin Herrenschmidt * just set or WAKE was just set. 65777453882SBenjamin Herrenschmidt */ 65877453882SBenjamin Herrenschmidt if ((status & PAUSE) || !(status & RUN)) { 65928ce5ce6Saurel32 status &= ~ACTIVE; 66077453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " -> ACTIVE down !\n"); 66177453882SBenjamin Herrenschmidt 66277453882SBenjamin Herrenschmidt /* We stopped processing, we want the underlying HW command 66377453882SBenjamin Herrenschmidt * to complete *before* we clear the ACTIVE bit. Otherwise 66477453882SBenjamin Herrenschmidt * we can get into a situation where the command status will 66577453882SBenjamin Herrenschmidt * have RUN or ACTIVE not set which is going to confuse the 66677453882SBenjamin Herrenschmidt * MacOS driver. 66777453882SBenjamin Herrenschmidt */ 66877453882SBenjamin Herrenschmidt do_flush = true; 66977453882SBenjamin Herrenschmidt } else if (mask & (RUN | PAUSE)) { 67077453882SBenjamin Herrenschmidt status |= ACTIVE; 67177453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " -> ACTIVE up !\n"); 67277453882SBenjamin Herrenschmidt } else if ((mask & WAKE) && (value & WAKE)) { 67377453882SBenjamin Herrenschmidt status |= ACTIVE; 67477453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " -> ACTIVE up !\n"); 6751cde732dSMark Cave-Ayland } 6761cde732dSMark Cave-Ayland 67777453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " new status=0x%08x\n", status); 67877453882SBenjamin Herrenschmidt 67977453882SBenjamin Herrenschmidt /* If we need to flush the underlying HW, do it now, this happens 68077453882SBenjamin Herrenschmidt * both on FLUSH commands and when stopping the channel for safety. 68177453882SBenjamin Herrenschmidt */ 68277453882SBenjamin Herrenschmidt if (do_flush && ch->flush) { 683987422bcSAmadeusz Sławiński ch->flush(&ch->io); 684987422bcSAmadeusz Sławiński } 68528ce5ce6Saurel32 68677453882SBenjamin Herrenschmidt /* Finally update the status register image */ 687ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] = status; 68828ce5ce6Saurel32 68977453882SBenjamin Herrenschmidt /* If active, make sure the BH gets to run */ 690d2f0ce21SAlexander Graf if (status & ACTIVE) { 691d2f0ce21SAlexander Graf DBDMA_kick(dbdma_from_ch(ch)); 692d2f0ce21SAlexander Graf } 693d2f0ce21SAlexander Graf } 6943cbee15bSj_mayer 695a8170e5eSAvi Kivity static void dbdma_write(void *opaque, hwaddr addr, 69623c5e4caSAvi Kivity uint64_t value, unsigned size) 6973cbee15bSj_mayer { 69828ce5ce6Saurel32 int channel = addr >> DBDMA_CHANNEL_SHIFT; 699c20df14bSJuan Quintela DBDMAState *s = opaque; 700c20df14bSJuan Quintela DBDMA_channel *ch = &s->channels[channel]; 70128ce5ce6Saurel32 int reg = (addr - (channel << DBDMA_CHANNEL_SHIFT)) >> 2; 70228ce5ce6Saurel32 7033e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "writel 0x" TARGET_FMT_plx " <= 0x%08"PRIx64"\n", 70458c0c311SAlexander Graf addr, value); 7053e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "channel 0x%x reg 0x%x\n", 70628ce5ce6Saurel32 (uint32_t)addr >> DBDMA_CHANNEL_SHIFT, reg); 70728ce5ce6Saurel32 7087eaba824SAlexander Graf /* cmdptr cannot be modified if channel is ACTIVE */ 70928ce5ce6Saurel32 7107eaba824SAlexander Graf if (reg == DBDMA_CMDPTR_LO && (ch->regs[DBDMA_STATUS] & ACTIVE)) { 71128ce5ce6Saurel32 return; 7127eaba824SAlexander Graf } 71328ce5ce6Saurel32 71428ce5ce6Saurel32 ch->regs[reg] = value; 71528ce5ce6Saurel32 71628ce5ce6Saurel32 switch(reg) { 71728ce5ce6Saurel32 case DBDMA_CONTROL: 71828ce5ce6Saurel32 dbdma_control_write(ch); 71928ce5ce6Saurel32 break; 72028ce5ce6Saurel32 case DBDMA_CMDPTR_LO: 72128ce5ce6Saurel32 /* 16-byte aligned */ 722ad674e53SAurelien Jarno ch->regs[DBDMA_CMDPTR_LO] &= ~0xf; 72328ce5ce6Saurel32 dbdma_cmdptr_load(ch); 72428ce5ce6Saurel32 break; 72528ce5ce6Saurel32 case DBDMA_STATUS: 72628ce5ce6Saurel32 case DBDMA_INTR_SEL: 72728ce5ce6Saurel32 case DBDMA_BRANCH_SEL: 72828ce5ce6Saurel32 case DBDMA_WAIT_SEL: 72928ce5ce6Saurel32 /* nothing to do */ 73028ce5ce6Saurel32 break; 73128ce5ce6Saurel32 case DBDMA_XFER_MODE: 73228ce5ce6Saurel32 case DBDMA_CMDPTR_HI: 73328ce5ce6Saurel32 case DBDMA_DATA2PTR_HI: 73428ce5ce6Saurel32 case DBDMA_DATA2PTR_LO: 73528ce5ce6Saurel32 case DBDMA_ADDRESS_HI: 73628ce5ce6Saurel32 case DBDMA_BRANCH_ADDR_HI: 73728ce5ce6Saurel32 case DBDMA_RES1: 73828ce5ce6Saurel32 case DBDMA_RES2: 73928ce5ce6Saurel32 case DBDMA_RES3: 74028ce5ce6Saurel32 case DBDMA_RES4: 74128ce5ce6Saurel32 /* unused */ 74228ce5ce6Saurel32 break; 7433cbee15bSj_mayer } 7443cbee15bSj_mayer } 7453cbee15bSj_mayer 746a8170e5eSAvi Kivity static uint64_t dbdma_read(void *opaque, hwaddr addr, 74723c5e4caSAvi Kivity unsigned size) 7483cbee15bSj_mayer { 74928ce5ce6Saurel32 uint32_t value; 75028ce5ce6Saurel32 int channel = addr >> DBDMA_CHANNEL_SHIFT; 751c20df14bSJuan Quintela DBDMAState *s = opaque; 752c20df14bSJuan Quintela DBDMA_channel *ch = &s->channels[channel]; 75328ce5ce6Saurel32 int reg = (addr - (channel << DBDMA_CHANNEL_SHIFT)) >> 2; 754ea026b2fSblueswir1 75528ce5ce6Saurel32 value = ch->regs[reg]; 75628ce5ce6Saurel32 75728ce5ce6Saurel32 switch(reg) { 75828ce5ce6Saurel32 case DBDMA_CONTROL: 75977453882SBenjamin Herrenschmidt value = ch->regs[DBDMA_STATUS]; 76028ce5ce6Saurel32 break; 76128ce5ce6Saurel32 case DBDMA_STATUS: 76228ce5ce6Saurel32 case DBDMA_CMDPTR_LO: 76328ce5ce6Saurel32 case DBDMA_INTR_SEL: 76428ce5ce6Saurel32 case DBDMA_BRANCH_SEL: 76528ce5ce6Saurel32 case DBDMA_WAIT_SEL: 76628ce5ce6Saurel32 /* nothing to do */ 76728ce5ce6Saurel32 break; 76828ce5ce6Saurel32 case DBDMA_XFER_MODE: 76928ce5ce6Saurel32 case DBDMA_CMDPTR_HI: 77028ce5ce6Saurel32 case DBDMA_DATA2PTR_HI: 77128ce5ce6Saurel32 case DBDMA_DATA2PTR_LO: 77228ce5ce6Saurel32 case DBDMA_ADDRESS_HI: 77328ce5ce6Saurel32 case DBDMA_BRANCH_ADDR_HI: 77428ce5ce6Saurel32 /* unused */ 77528ce5ce6Saurel32 value = 0; 77628ce5ce6Saurel32 break; 77728ce5ce6Saurel32 case DBDMA_RES1: 77828ce5ce6Saurel32 case DBDMA_RES2: 77928ce5ce6Saurel32 case DBDMA_RES3: 78028ce5ce6Saurel32 case DBDMA_RES4: 78128ce5ce6Saurel32 /* reserved */ 78228ce5ce6Saurel32 break; 78328ce5ce6Saurel32 } 78428ce5ce6Saurel32 78577453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, "readl 0x" TARGET_FMT_plx " => 0x%08x\n", addr, value); 78677453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, "channel 0x%x reg 0x%x\n", 78777453882SBenjamin Herrenschmidt (uint32_t)addr >> DBDMA_CHANNEL_SHIFT, reg); 78877453882SBenjamin Herrenschmidt 78928ce5ce6Saurel32 return value; 7903cbee15bSj_mayer } 7913cbee15bSj_mayer 79223c5e4caSAvi Kivity static const MemoryRegionOps dbdma_ops = { 79323c5e4caSAvi Kivity .read = dbdma_read, 79423c5e4caSAvi Kivity .write = dbdma_write, 79523c5e4caSAvi Kivity .endianness = DEVICE_LITTLE_ENDIAN, 79623c5e4caSAvi Kivity .valid = { 79723c5e4caSAvi Kivity .min_access_size = 4, 79823c5e4caSAvi Kivity .max_access_size = 4, 79923c5e4caSAvi Kivity }, 8003cbee15bSj_mayer }; 8013cbee15bSj_mayer 802627be2f2SMark Cave-Ayland static const VMStateDescription vmstate_dbdma_io = { 803627be2f2SMark Cave-Ayland .name = "dbdma_io", 804da26fdc3SJuan Quintela .version_id = 0, 805da26fdc3SJuan Quintela .minimum_version_id = 0, 806da26fdc3SJuan Quintela .fields = (VMStateField[]) { 807627be2f2SMark Cave-Ayland VMSTATE_UINT64(addr, struct DBDMA_io), 808627be2f2SMark Cave-Ayland VMSTATE_INT32(len, struct DBDMA_io), 809627be2f2SMark Cave-Ayland VMSTATE_INT32(is_last, struct DBDMA_io), 810627be2f2SMark Cave-Ayland VMSTATE_INT32(is_dma_out, struct DBDMA_io), 811627be2f2SMark Cave-Ayland VMSTATE_BOOL(processing, struct DBDMA_io), 812627be2f2SMark Cave-Ayland VMSTATE_END_OF_LIST() 813627be2f2SMark Cave-Ayland } 814627be2f2SMark Cave-Ayland }; 815627be2f2SMark Cave-Ayland 816627be2f2SMark Cave-Ayland static const VMStateDescription vmstate_dbdma_cmd = { 817627be2f2SMark Cave-Ayland .name = "dbdma_cmd", 818627be2f2SMark Cave-Ayland .version_id = 0, 819627be2f2SMark Cave-Ayland .minimum_version_id = 0, 820627be2f2SMark Cave-Ayland .fields = (VMStateField[]) { 821627be2f2SMark Cave-Ayland VMSTATE_UINT16(req_count, dbdma_cmd), 822627be2f2SMark Cave-Ayland VMSTATE_UINT16(command, dbdma_cmd), 823627be2f2SMark Cave-Ayland VMSTATE_UINT32(phy_addr, dbdma_cmd), 824627be2f2SMark Cave-Ayland VMSTATE_UINT32(cmd_dep, dbdma_cmd), 825627be2f2SMark Cave-Ayland VMSTATE_UINT16(res_count, dbdma_cmd), 826627be2f2SMark Cave-Ayland VMSTATE_UINT16(xfer_status, dbdma_cmd), 827627be2f2SMark Cave-Ayland VMSTATE_END_OF_LIST() 828627be2f2SMark Cave-Ayland } 829627be2f2SMark Cave-Ayland }; 830627be2f2SMark Cave-Ayland 831627be2f2SMark Cave-Ayland static const VMStateDescription vmstate_dbdma_channel = { 832627be2f2SMark Cave-Ayland .name = "dbdma_channel", 833627be2f2SMark Cave-Ayland .version_id = 1, 834627be2f2SMark Cave-Ayland .minimum_version_id = 1, 835627be2f2SMark Cave-Ayland .fields = (VMStateField[]) { 836da26fdc3SJuan Quintela VMSTATE_UINT32_ARRAY(regs, struct DBDMA_channel, DBDMA_REGS), 837627be2f2SMark Cave-Ayland VMSTATE_STRUCT(io, struct DBDMA_channel, 0, vmstate_dbdma_io, DBDMA_io), 838627be2f2SMark Cave-Ayland VMSTATE_STRUCT(current, struct DBDMA_channel, 0, vmstate_dbdma_cmd, 839627be2f2SMark Cave-Ayland dbdma_cmd), 840da26fdc3SJuan Quintela VMSTATE_END_OF_LIST() 8419b64997fSblueswir1 } 842da26fdc3SJuan Quintela }; 8439b64997fSblueswir1 844da26fdc3SJuan Quintela static const VMStateDescription vmstate_dbdma = { 845da26fdc3SJuan Quintela .name = "dbdma", 846627be2f2SMark Cave-Ayland .version_id = 3, 847627be2f2SMark Cave-Ayland .minimum_version_id = 3, 848da26fdc3SJuan Quintela .fields = (VMStateField[]) { 849da26fdc3SJuan Quintela VMSTATE_STRUCT_ARRAY(channels, DBDMAState, DBDMA_CHANNELS, 1, 850da26fdc3SJuan Quintela vmstate_dbdma_channel, DBDMA_channel), 851da26fdc3SJuan Quintela VMSTATE_END_OF_LIST() 8529b64997fSblueswir1 } 853da26fdc3SJuan Quintela }; 8549b64997fSblueswir1 8551d27f351SMark Cave-Ayland static void mac_dbdma_reset(DeviceState *d) 8566e6b7363Sblueswir1 { 8571d27f351SMark Cave-Ayland DBDMAState *s = MAC_DBDMA(d); 85828ce5ce6Saurel32 int i; 85928ce5ce6Saurel32 8601d27f351SMark Cave-Ayland for (i = 0; i < DBDMA_CHANNELS; i++) { 861c20df14bSJuan Quintela memset(s->channels[i].regs, 0, DBDMA_SIZE); 8626e6b7363Sblueswir1 } 8631d27f351SMark Cave-Ayland } 8646e6b7363Sblueswir1 8652d7d06d8SHervé Poussineau static void dbdma_unassigned_rw(DBDMA_io *io) 8662d7d06d8SHervé Poussineau { 8672d7d06d8SHervé Poussineau DBDMA_channel *ch = io->channel; 86877453882SBenjamin Herrenschmidt dbdma_cmd *current = &ch->current; 86977453882SBenjamin Herrenschmidt uint16_t cmd; 8702d7d06d8SHervé Poussineau qemu_log_mask(LOG_GUEST_ERROR, "%s: use of unassigned channel %d\n", 8712d7d06d8SHervé Poussineau __func__, ch->channel); 8722df77896SMark Cave-Ayland ch->io.processing = false; 87377453882SBenjamin Herrenschmidt 87477453882SBenjamin Herrenschmidt cmd = le16_to_cpu(current->command) & COMMAND_MASK; 87577453882SBenjamin Herrenschmidt if (cmd == OUTPUT_MORE || cmd == OUTPUT_LAST || 87677453882SBenjamin Herrenschmidt cmd == INPUT_MORE || cmd == INPUT_LAST) { 87777453882SBenjamin Herrenschmidt current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]); 87877453882SBenjamin Herrenschmidt current->res_count = cpu_to_le16(io->len); 87977453882SBenjamin Herrenschmidt dbdma_cmdptr_save(ch); 88077453882SBenjamin Herrenschmidt } 8812d7d06d8SHervé Poussineau } 8822d7d06d8SHervé Poussineau 8832d7d06d8SHervé Poussineau static void dbdma_unassigned_flush(DBDMA_io *io) 8842d7d06d8SHervé Poussineau { 8852d7d06d8SHervé Poussineau DBDMA_channel *ch = io->channel; 8862d7d06d8SHervé Poussineau qemu_log_mask(LOG_GUEST_ERROR, "%s: use of unassigned channel %d\n", 8872d7d06d8SHervé Poussineau __func__, ch->channel); 8882d7d06d8SHervé Poussineau } 8892d7d06d8SHervé Poussineau 8901d27f351SMark Cave-Ayland static void mac_dbdma_init(Object *obj) 8911d27f351SMark Cave-Ayland { 8921d27f351SMark Cave-Ayland SysBusDevice *sbd = SYS_BUS_DEVICE(obj); 8931d27f351SMark Cave-Ayland DBDMAState *s = MAC_DBDMA(obj); 8941d27f351SMark Cave-Ayland int i; 89528ce5ce6Saurel32 8963e300fa6SAlexander Graf for (i = 0; i < DBDMA_CHANNELS; i++) { 8972d7d06d8SHervé Poussineau DBDMA_channel *ch = &s->channels[i]; 8982d7d06d8SHervé Poussineau 8992d7d06d8SHervé Poussineau ch->rw = dbdma_unassigned_rw; 9002d7d06d8SHervé Poussineau ch->flush = dbdma_unassigned_flush; 9012d7d06d8SHervé Poussineau ch->channel = i; 9022d7d06d8SHervé Poussineau ch->io.channel = ch; 9033e300fa6SAlexander Graf } 9043e300fa6SAlexander Graf 9051d27f351SMark Cave-Ayland memory_region_init_io(&s->mem, obj, &dbdma_ops, s, "dbdma", 0x1000); 9061d27f351SMark Cave-Ayland sysbus_init_mmio(sbd, &s->mem); 9071d27f351SMark Cave-Ayland } 9081d27f351SMark Cave-Ayland 9091d27f351SMark Cave-Ayland static void mac_dbdma_realize(DeviceState *dev, Error **errp) 9101d27f351SMark Cave-Ayland { 9111d27f351SMark Cave-Ayland DBDMAState *s = MAC_DBDMA(dev); 91228ce5ce6Saurel32 913d2f0ce21SAlexander Graf s->bh = qemu_bh_new(DBDMA_run_bh, s); 9143cbee15bSj_mayer } 9151d27f351SMark Cave-Ayland 9161d27f351SMark Cave-Ayland static void mac_dbdma_class_init(ObjectClass *oc, void *data) 9171d27f351SMark Cave-Ayland { 9181d27f351SMark Cave-Ayland DeviceClass *dc = DEVICE_CLASS(oc); 9191d27f351SMark Cave-Ayland 9201d27f351SMark Cave-Ayland dc->realize = mac_dbdma_realize; 9211d27f351SMark Cave-Ayland dc->reset = mac_dbdma_reset; 9221d27f351SMark Cave-Ayland dc->vmsd = &vmstate_dbdma; 9231d27f351SMark Cave-Ayland } 9241d27f351SMark Cave-Ayland 9251d27f351SMark Cave-Ayland static const TypeInfo mac_dbdma_type_info = { 9261d27f351SMark Cave-Ayland .name = TYPE_MAC_DBDMA, 9271d27f351SMark Cave-Ayland .parent = TYPE_SYS_BUS_DEVICE, 9281d27f351SMark Cave-Ayland .instance_size = sizeof(DBDMAState), 9291d27f351SMark Cave-Ayland .instance_init = mac_dbdma_init, 9301d27f351SMark Cave-Ayland .class_init = mac_dbdma_class_init 9311d27f351SMark Cave-Ayland }; 9321d27f351SMark Cave-Ayland 9331d27f351SMark Cave-Ayland static void mac_dbdma_register_types(void) 9341d27f351SMark Cave-Ayland { 9351d27f351SMark Cave-Ayland type_register_static(&mac_dbdma_type_info); 9361d27f351SMark Cave-Ayland } 9371d27f351SMark Cave-Ayland 9381d27f351SMark Cave-Ayland type_init(mac_dbdma_register_types) 939