13cbee15bSj_mayer /* 23cbee15bSj_mayer * PowerMac descriptor-based DMA emulation 33cbee15bSj_mayer * 43cbee15bSj_mayer * Copyright (c) 2005-2007 Fabrice Bellard 53cbee15bSj_mayer * Copyright (c) 2007 Jocelyn Mayer 628ce5ce6Saurel32 * Copyright (c) 2009 Laurent Vivier 728ce5ce6Saurel32 * 828ce5ce6Saurel32 * some parts from linux-2.6.28, arch/powerpc/include/asm/dbdma.h 928ce5ce6Saurel32 * 1028ce5ce6Saurel32 * Definitions for using the Apple Descriptor-Based DMA controller 1128ce5ce6Saurel32 * in Power Macintosh computers. 1228ce5ce6Saurel32 * 1328ce5ce6Saurel32 * Copyright (C) 1996 Paul Mackerras. 1428ce5ce6Saurel32 * 1528ce5ce6Saurel32 * some parts from mol 0.9.71 1628ce5ce6Saurel32 * 1728ce5ce6Saurel32 * Descriptor based DMA emulation 1828ce5ce6Saurel32 * 1928ce5ce6Saurel32 * Copyright (C) 1998-2004 Samuel Rydh (samuel@ibrium.se) 203cbee15bSj_mayer * 213cbee15bSj_mayer * Permission is hereby granted, free of charge, to any person obtaining a copy 223cbee15bSj_mayer * of this software and associated documentation files (the "Software"), to deal 233cbee15bSj_mayer * in the Software without restriction, including without limitation the rights 243cbee15bSj_mayer * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell 253cbee15bSj_mayer * copies of the Software, and to permit persons to whom the Software is 263cbee15bSj_mayer * furnished to do so, subject to the following conditions: 273cbee15bSj_mayer * 283cbee15bSj_mayer * The above copyright notice and this permission notice shall be included in 293cbee15bSj_mayer * all copies or substantial portions of the Software. 303cbee15bSj_mayer * 313cbee15bSj_mayer * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR 323cbee15bSj_mayer * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, 333cbee15bSj_mayer * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL 343cbee15bSj_mayer * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER 353cbee15bSj_mayer * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, 363cbee15bSj_mayer * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN 373cbee15bSj_mayer * THE SOFTWARE. 383cbee15bSj_mayer */ 390b8fa32fSMarkus Armbruster 400d75590dSPeter Maydell #include "qemu/osdep.h" 4164552b6bSMarkus Armbruster #include "hw/irq.h" 420d09e41aSPaolo Bonzini #include "hw/ppc/mac_dbdma.h" 43d6454270SMarkus Armbruster #include "migration/vmstate.h" 441de7afc9SPaolo Bonzini #include "qemu/main-loop.h" 450b8fa32fSMarkus Armbruster #include "qemu/module.h" 4603dd024fSPaolo Bonzini #include "qemu/log.h" 4788655881SMark Cave-Ayland #include "sysemu/dma.h" 483cbee15bSj_mayer 49ea026b2fSblueswir1 /* debug DBDMA */ 50ba0b17ddSMark Cave-Ayland #define DEBUG_DBDMA 0 513e49c439SMark Cave-Ayland #define DEBUG_DBDMA_CHANMASK ((1ull << DBDMA_CHANNELS) - 1) 52ea026b2fSblueswir1 53ba0b17ddSMark Cave-Ayland #define DBDMA_DPRINTF(fmt, ...) do { \ 54ba0b17ddSMark Cave-Ayland if (DEBUG_DBDMA) { \ 55ba0b17ddSMark Cave-Ayland printf("DBDMA: " fmt , ## __VA_ARGS__); \ 56ba0b17ddSMark Cave-Ayland } \ 572562755eSEric Blake } while (0) 58ea026b2fSblueswir1 593e49c439SMark Cave-Ayland #define DBDMA_DPRINTFCH(ch, fmt, ...) do { \ 603e49c439SMark Cave-Ayland if (DEBUG_DBDMA) { \ 613e49c439SMark Cave-Ayland if ((1ul << (ch)->channel) & DEBUG_DBDMA_CHANMASK) { \ 623e49c439SMark Cave-Ayland printf("DBDMA[%02x]: " fmt , (ch)->channel, ## __VA_ARGS__); \ 633e49c439SMark Cave-Ayland } \ 643e49c439SMark Cave-Ayland } \ 652562755eSEric Blake } while (0) 663e49c439SMark Cave-Ayland 6728ce5ce6Saurel32 /* 6828ce5ce6Saurel32 */ 693cbee15bSj_mayer 70d2f0ce21SAlexander Graf static DBDMAState *dbdma_from_ch(DBDMA_channel *ch) 71d2f0ce21SAlexander Graf { 72d2f0ce21SAlexander Graf return container_of(ch, DBDMAState, channels[ch->channel]); 73d2f0ce21SAlexander Graf } 74d2f0ce21SAlexander Graf 75ba0b17ddSMark Cave-Ayland #if DEBUG_DBDMA 76b7d67813SMark Cave-Ayland static void dump_dbdma_cmd(DBDMA_channel *ch, dbdma_cmd *cmd) 773cbee15bSj_mayer { 78b7d67813SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "dbdma_cmd %p\n", cmd); 79b7d67813SMark Cave-Ayland DBDMA_DPRINTFCH(ch, " req_count 0x%04x\n", le16_to_cpu(cmd->req_count)); 80b7d67813SMark Cave-Ayland DBDMA_DPRINTFCH(ch, " command 0x%04x\n", le16_to_cpu(cmd->command)); 81b7d67813SMark Cave-Ayland DBDMA_DPRINTFCH(ch, " phy_addr 0x%08x\n", le32_to_cpu(cmd->phy_addr)); 82b7d67813SMark Cave-Ayland DBDMA_DPRINTFCH(ch, " cmd_dep 0x%08x\n", le32_to_cpu(cmd->cmd_dep)); 83b7d67813SMark Cave-Ayland DBDMA_DPRINTFCH(ch, " res_count 0x%04x\n", le16_to_cpu(cmd->res_count)); 84b7d67813SMark Cave-Ayland DBDMA_DPRINTFCH(ch, " xfer_status 0x%04x\n", 85b7d67813SMark Cave-Ayland le16_to_cpu(cmd->xfer_status)); 8628ce5ce6Saurel32 } 8728ce5ce6Saurel32 #else 88b7d67813SMark Cave-Ayland static void dump_dbdma_cmd(DBDMA_channel *ch, dbdma_cmd *cmd) 8928ce5ce6Saurel32 { 9028ce5ce6Saurel32 } 9128ce5ce6Saurel32 #endif 9228ce5ce6Saurel32 static void dbdma_cmdptr_load(DBDMA_channel *ch) 9328ce5ce6Saurel32 { 943e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "dbdma_cmdptr_load 0x%08x\n", 95ad674e53SAurelien Jarno ch->regs[DBDMA_CMDPTR_LO]); 9688655881SMark Cave-Ayland dma_memory_read(&address_space_memory, ch->regs[DBDMA_CMDPTR_LO], 97*ba06fe8aSPhilippe Mathieu-Daudé &ch->current, sizeof(dbdma_cmd), MEMTXATTRS_UNSPECIFIED); 983cbee15bSj_mayer } 993cbee15bSj_mayer 10028ce5ce6Saurel32 static void dbdma_cmdptr_save(DBDMA_channel *ch) 1013cbee15bSj_mayer { 10277453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, "-> update 0x%08x stat=0x%08x, res=0x%04x\n", 10377453882SBenjamin Herrenschmidt ch->regs[DBDMA_CMDPTR_LO], 10428ce5ce6Saurel32 le16_to_cpu(ch->current.xfer_status), 10528ce5ce6Saurel32 le16_to_cpu(ch->current.res_count)); 10688655881SMark Cave-Ayland dma_memory_write(&address_space_memory, ch->regs[DBDMA_CMDPTR_LO], 107*ba06fe8aSPhilippe Mathieu-Daudé &ch->current, sizeof(dbdma_cmd), MEMTXATTRS_UNSPECIFIED); 10828ce5ce6Saurel32 } 10928ce5ce6Saurel32 11028ce5ce6Saurel32 static void kill_channel(DBDMA_channel *ch) 11128ce5ce6Saurel32 { 1123e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "kill_channel\n"); 11328ce5ce6Saurel32 114ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] |= DEAD; 115ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] &= ~ACTIVE; 11628ce5ce6Saurel32 11728ce5ce6Saurel32 qemu_irq_raise(ch->irq); 11828ce5ce6Saurel32 } 11928ce5ce6Saurel32 12028ce5ce6Saurel32 static void conditional_interrupt(DBDMA_channel *ch) 12128ce5ce6Saurel32 { 12228ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 12328ce5ce6Saurel32 uint16_t intr; 12428ce5ce6Saurel32 uint16_t sel_mask, sel_value; 12528ce5ce6Saurel32 uint32_t status; 12628ce5ce6Saurel32 int cond; 12728ce5ce6Saurel32 1283e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "%s\n", __func__); 12928ce5ce6Saurel32 130b42ec42dSaurel32 intr = le16_to_cpu(current->command) & INTR_MASK; 13128ce5ce6Saurel32 13228ce5ce6Saurel32 switch(intr) { 13328ce5ce6Saurel32 case INTR_NEVER: /* don't interrupt */ 13428ce5ce6Saurel32 return; 13528ce5ce6Saurel32 case INTR_ALWAYS: /* always interrupt */ 13628ce5ce6Saurel32 qemu_irq_raise(ch->irq); 1373e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "%s: raise\n", __func__); 13828ce5ce6Saurel32 return; 13928ce5ce6Saurel32 } 14028ce5ce6Saurel32 141ad674e53SAurelien Jarno status = ch->regs[DBDMA_STATUS] & DEVSTAT; 14228ce5ce6Saurel32 143ad674e53SAurelien Jarno sel_mask = (ch->regs[DBDMA_INTR_SEL] >> 16) & 0x0f; 144ad674e53SAurelien Jarno sel_value = ch->regs[DBDMA_INTR_SEL] & 0x0f; 14528ce5ce6Saurel32 14628ce5ce6Saurel32 cond = (status & sel_mask) == (sel_value & sel_mask); 14728ce5ce6Saurel32 14828ce5ce6Saurel32 switch(intr) { 14928ce5ce6Saurel32 case INTR_IFSET: /* intr if condition bit is 1 */ 15033ce36bbSAlexander Graf if (cond) { 15128ce5ce6Saurel32 qemu_irq_raise(ch->irq); 1523e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "%s: raise\n", __func__); 15333ce36bbSAlexander Graf } 15428ce5ce6Saurel32 return; 15528ce5ce6Saurel32 case INTR_IFCLR: /* intr if condition bit is 0 */ 15633ce36bbSAlexander Graf if (!cond) { 15728ce5ce6Saurel32 qemu_irq_raise(ch->irq); 1583e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "%s: raise\n", __func__); 15933ce36bbSAlexander Graf } 16028ce5ce6Saurel32 return; 16128ce5ce6Saurel32 } 16228ce5ce6Saurel32 } 16328ce5ce6Saurel32 16428ce5ce6Saurel32 static int conditional_wait(DBDMA_channel *ch) 16528ce5ce6Saurel32 { 16628ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 16728ce5ce6Saurel32 uint16_t wait; 16828ce5ce6Saurel32 uint16_t sel_mask, sel_value; 16928ce5ce6Saurel32 uint32_t status; 17028ce5ce6Saurel32 int cond; 17177453882SBenjamin Herrenschmidt int res = 0; 17228ce5ce6Saurel32 173b42ec42dSaurel32 wait = le16_to_cpu(current->command) & WAIT_MASK; 17428ce5ce6Saurel32 switch(wait) { 17528ce5ce6Saurel32 case WAIT_NEVER: /* don't wait */ 17628ce5ce6Saurel32 return 0; 17728ce5ce6Saurel32 case WAIT_ALWAYS: /* always wait */ 17877453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " [WAIT_ALWAYS]\n"); 17928ce5ce6Saurel32 return 1; 18028ce5ce6Saurel32 } 18128ce5ce6Saurel32 182ad674e53SAurelien Jarno status = ch->regs[DBDMA_STATUS] & DEVSTAT; 18328ce5ce6Saurel32 184ad674e53SAurelien Jarno sel_mask = (ch->regs[DBDMA_WAIT_SEL] >> 16) & 0x0f; 185ad674e53SAurelien Jarno sel_value = ch->regs[DBDMA_WAIT_SEL] & 0x0f; 18628ce5ce6Saurel32 18728ce5ce6Saurel32 cond = (status & sel_mask) == (sel_value & sel_mask); 18828ce5ce6Saurel32 18928ce5ce6Saurel32 switch(wait) { 19028ce5ce6Saurel32 case WAIT_IFSET: /* wait if condition bit is 1 */ 19177453882SBenjamin Herrenschmidt if (cond) { 19277453882SBenjamin Herrenschmidt res = 1; 19328ce5ce6Saurel32 } 19477453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " [WAIT_IFSET=%d]\n", res); 19577453882SBenjamin Herrenschmidt break; 19677453882SBenjamin Herrenschmidt case WAIT_IFCLR: /* wait if condition bit is 0 */ 19777453882SBenjamin Herrenschmidt if (!cond) { 19877453882SBenjamin Herrenschmidt res = 1; 19977453882SBenjamin Herrenschmidt } 20077453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " [WAIT_IFCLR=%d]\n", res); 20177453882SBenjamin Herrenschmidt break; 20277453882SBenjamin Herrenschmidt } 20377453882SBenjamin Herrenschmidt return res; 20428ce5ce6Saurel32 } 20528ce5ce6Saurel32 20628ce5ce6Saurel32 static void next(DBDMA_channel *ch) 20728ce5ce6Saurel32 { 20828ce5ce6Saurel32 uint32_t cp; 20928ce5ce6Saurel32 210ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] &= ~BT; 21128ce5ce6Saurel32 212ad674e53SAurelien Jarno cp = ch->regs[DBDMA_CMDPTR_LO]; 213ad674e53SAurelien Jarno ch->regs[DBDMA_CMDPTR_LO] = cp + sizeof(dbdma_cmd); 21428ce5ce6Saurel32 dbdma_cmdptr_load(ch); 21528ce5ce6Saurel32 } 21628ce5ce6Saurel32 21728ce5ce6Saurel32 static void branch(DBDMA_channel *ch) 21828ce5ce6Saurel32 { 21928ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 22028ce5ce6Saurel32 2213f0d4128SMark Cave-Ayland ch->regs[DBDMA_CMDPTR_LO] = le32_to_cpu(current->cmd_dep); 222ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] |= BT; 22328ce5ce6Saurel32 dbdma_cmdptr_load(ch); 22428ce5ce6Saurel32 } 22528ce5ce6Saurel32 22628ce5ce6Saurel32 static void conditional_branch(DBDMA_channel *ch) 22728ce5ce6Saurel32 { 22828ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 22928ce5ce6Saurel32 uint16_t br; 23028ce5ce6Saurel32 uint16_t sel_mask, sel_value; 23128ce5ce6Saurel32 uint32_t status; 23228ce5ce6Saurel32 int cond; 23328ce5ce6Saurel32 23428ce5ce6Saurel32 /* check if we must branch */ 23528ce5ce6Saurel32 236b42ec42dSaurel32 br = le16_to_cpu(current->command) & BR_MASK; 23728ce5ce6Saurel32 23828ce5ce6Saurel32 switch(br) { 23928ce5ce6Saurel32 case BR_NEVER: /* don't branch */ 24028ce5ce6Saurel32 next(ch); 24128ce5ce6Saurel32 return; 24228ce5ce6Saurel32 case BR_ALWAYS: /* always branch */ 24377453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " [BR_ALWAYS]\n"); 24428ce5ce6Saurel32 branch(ch); 24528ce5ce6Saurel32 return; 24628ce5ce6Saurel32 } 24728ce5ce6Saurel32 248ad674e53SAurelien Jarno status = ch->regs[DBDMA_STATUS] & DEVSTAT; 24928ce5ce6Saurel32 250ad674e53SAurelien Jarno sel_mask = (ch->regs[DBDMA_BRANCH_SEL] >> 16) & 0x0f; 251ad674e53SAurelien Jarno sel_value = ch->regs[DBDMA_BRANCH_SEL] & 0x0f; 25228ce5ce6Saurel32 25328ce5ce6Saurel32 cond = (status & sel_mask) == (sel_value & sel_mask); 25428ce5ce6Saurel32 25528ce5ce6Saurel32 switch(br) { 25628ce5ce6Saurel32 case BR_IFSET: /* branch if condition bit is 1 */ 25777453882SBenjamin Herrenschmidt if (cond) { 25877453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " [BR_IFSET = 1]\n"); 25928ce5ce6Saurel32 branch(ch); 26077453882SBenjamin Herrenschmidt } else { 26177453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " [BR_IFSET = 0]\n"); 26228ce5ce6Saurel32 next(ch); 26377453882SBenjamin Herrenschmidt } 26428ce5ce6Saurel32 return; 26528ce5ce6Saurel32 case BR_IFCLR: /* branch if condition bit is 0 */ 26677453882SBenjamin Herrenschmidt if (!cond) { 26777453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " [BR_IFCLR = 1]\n"); 26828ce5ce6Saurel32 branch(ch); 26977453882SBenjamin Herrenschmidt } else { 27077453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " [BR_IFCLR = 0]\n"); 27128ce5ce6Saurel32 next(ch); 27277453882SBenjamin Herrenschmidt } 27328ce5ce6Saurel32 return; 27428ce5ce6Saurel32 } 27528ce5ce6Saurel32 } 27628ce5ce6Saurel32 277b42ec42dSaurel32 static void channel_run(DBDMA_channel *ch); 278b42ec42dSaurel32 279b42ec42dSaurel32 static void dbdma_end(DBDMA_io *io) 28028ce5ce6Saurel32 { 28128ce5ce6Saurel32 DBDMA_channel *ch = io->channel; 28228ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 28328ce5ce6Saurel32 2843e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "%s\n", __func__); 28533ce36bbSAlexander Graf 286b42ec42dSaurel32 if (conditional_wait(ch)) 287b42ec42dSaurel32 goto wait; 28828ce5ce6Saurel32 289ad674e53SAurelien Jarno current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]); 290ad674e53SAurelien Jarno current->res_count = cpu_to_le16(io->len); 291b42ec42dSaurel32 dbdma_cmdptr_save(ch); 292862c9280Saurel32 if (io->is_last) 293ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] &= ~FLUSH; 29428ce5ce6Saurel32 295b42ec42dSaurel32 conditional_interrupt(ch); 296b42ec42dSaurel32 conditional_branch(ch); 297b42ec42dSaurel32 298b42ec42dSaurel32 wait: 29903ee3b1eSAlexander Graf /* Indicate that we're ready for a new DMA round */ 30003ee3b1eSAlexander Graf ch->io.processing = false; 30103ee3b1eSAlexander Graf 302ad674e53SAurelien Jarno if ((ch->regs[DBDMA_STATUS] & RUN) && 303ad674e53SAurelien Jarno (ch->regs[DBDMA_STATUS] & ACTIVE)) 304b42ec42dSaurel32 channel_run(ch); 30528ce5ce6Saurel32 } 30628ce5ce6Saurel32 307b42ec42dSaurel32 static void start_output(DBDMA_channel *ch, int key, uint32_t addr, 30828ce5ce6Saurel32 uint16_t req_count, int is_last) 30928ce5ce6Saurel32 { 3103e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "start_output\n"); 31128ce5ce6Saurel32 31228ce5ce6Saurel32 /* KEY_REGS, KEY_DEVICE and KEY_STREAM 31328ce5ce6Saurel32 * are not implemented in the mac-io chip 31428ce5ce6Saurel32 */ 31528ce5ce6Saurel32 3163e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "addr 0x%x key 0x%x\n", addr, key); 31728ce5ce6Saurel32 if (!addr || key > KEY_STREAM3) { 31828ce5ce6Saurel32 kill_channel(ch); 319b42ec42dSaurel32 return; 32028ce5ce6Saurel32 } 32128ce5ce6Saurel32 322b42ec42dSaurel32 ch->io.addr = addr; 32328ce5ce6Saurel32 ch->io.len = req_count; 32428ce5ce6Saurel32 ch->io.is_last = is_last; 325b42ec42dSaurel32 ch->io.dma_end = dbdma_end; 326b42ec42dSaurel32 ch->io.is_dma_out = 1; 32703ee3b1eSAlexander Graf ch->io.processing = true; 328a9ceb76dSAlexander Graf if (ch->rw) { 329b42ec42dSaurel32 ch->rw(&ch->io); 33028ce5ce6Saurel32 } 331a9ceb76dSAlexander Graf } 33228ce5ce6Saurel32 333b42ec42dSaurel32 static void start_input(DBDMA_channel *ch, int key, uint32_t addr, 33428ce5ce6Saurel32 uint16_t req_count, int is_last) 33528ce5ce6Saurel32 { 3363e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "start_input\n"); 33728ce5ce6Saurel32 33828ce5ce6Saurel32 /* KEY_REGS, KEY_DEVICE and KEY_STREAM 33928ce5ce6Saurel32 * are not implemented in the mac-io chip 34028ce5ce6Saurel32 */ 34128ce5ce6Saurel32 3423e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "addr 0x%x key 0x%x\n", addr, key); 34328ce5ce6Saurel32 if (!addr || key > KEY_STREAM3) { 34428ce5ce6Saurel32 kill_channel(ch); 345b42ec42dSaurel32 return; 34628ce5ce6Saurel32 } 34728ce5ce6Saurel32 348b42ec42dSaurel32 ch->io.addr = addr; 34928ce5ce6Saurel32 ch->io.len = req_count; 35028ce5ce6Saurel32 ch->io.is_last = is_last; 351b42ec42dSaurel32 ch->io.dma_end = dbdma_end; 352b42ec42dSaurel32 ch->io.is_dma_out = 0; 35303ee3b1eSAlexander Graf ch->io.processing = true; 354a9ceb76dSAlexander Graf if (ch->rw) { 355b42ec42dSaurel32 ch->rw(&ch->io); 35628ce5ce6Saurel32 } 357a9ceb76dSAlexander Graf } 35828ce5ce6Saurel32 359b42ec42dSaurel32 static void load_word(DBDMA_channel *ch, int key, uint32_t addr, 36028ce5ce6Saurel32 uint16_t len) 36128ce5ce6Saurel32 { 36228ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 36328ce5ce6Saurel32 364e12f50b9SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "load_word %d bytes, addr=%08x\n", len, addr); 36528ce5ce6Saurel32 36628ce5ce6Saurel32 /* only implements KEY_SYSTEM */ 36728ce5ce6Saurel32 36828ce5ce6Saurel32 if (key != KEY_SYSTEM) { 36928ce5ce6Saurel32 printf("DBDMA: LOAD_WORD, unimplemented key %x\n", key); 37028ce5ce6Saurel32 kill_channel(ch); 371b42ec42dSaurel32 return; 37228ce5ce6Saurel32 } 37328ce5ce6Saurel32 374*ba06fe8aSPhilippe Mathieu-Daudé dma_memory_read(&address_space_memory, addr, ¤t->cmd_dep, len, 375*ba06fe8aSPhilippe Mathieu-Daudé MEMTXATTRS_UNSPECIFIED); 37628ce5ce6Saurel32 37728ce5ce6Saurel32 if (conditional_wait(ch)) 378b42ec42dSaurel32 goto wait; 37928ce5ce6Saurel32 380ad674e53SAurelien Jarno current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]); 38128ce5ce6Saurel32 dbdma_cmdptr_save(ch); 382ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] &= ~FLUSH; 38328ce5ce6Saurel32 38428ce5ce6Saurel32 conditional_interrupt(ch); 38528ce5ce6Saurel32 next(ch); 38628ce5ce6Saurel32 387b42ec42dSaurel32 wait: 388d2f0ce21SAlexander Graf DBDMA_kick(dbdma_from_ch(ch)); 38928ce5ce6Saurel32 } 39028ce5ce6Saurel32 391b42ec42dSaurel32 static void store_word(DBDMA_channel *ch, int key, uint32_t addr, 39228ce5ce6Saurel32 uint16_t len) 39328ce5ce6Saurel32 { 39428ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 39528ce5ce6Saurel32 396e12f50b9SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "store_word %d bytes, addr=%08x pa=%x\n", 397e12f50b9SMark Cave-Ayland len, addr, le32_to_cpu(current->cmd_dep)); 39828ce5ce6Saurel32 39928ce5ce6Saurel32 /* only implements KEY_SYSTEM */ 40028ce5ce6Saurel32 40128ce5ce6Saurel32 if (key != KEY_SYSTEM) { 40228ce5ce6Saurel32 printf("DBDMA: STORE_WORD, unimplemented key %x\n", key); 40328ce5ce6Saurel32 kill_channel(ch); 404b42ec42dSaurel32 return; 40528ce5ce6Saurel32 } 40628ce5ce6Saurel32 407*ba06fe8aSPhilippe Mathieu-Daudé dma_memory_write(&address_space_memory, addr, ¤t->cmd_dep, len, 408*ba06fe8aSPhilippe Mathieu-Daudé MEMTXATTRS_UNSPECIFIED); 40928ce5ce6Saurel32 41028ce5ce6Saurel32 if (conditional_wait(ch)) 411b42ec42dSaurel32 goto wait; 41228ce5ce6Saurel32 413ad674e53SAurelien Jarno current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]); 41428ce5ce6Saurel32 dbdma_cmdptr_save(ch); 415ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] &= ~FLUSH; 41628ce5ce6Saurel32 41728ce5ce6Saurel32 conditional_interrupt(ch); 41828ce5ce6Saurel32 next(ch); 41928ce5ce6Saurel32 420b42ec42dSaurel32 wait: 421d2f0ce21SAlexander Graf DBDMA_kick(dbdma_from_ch(ch)); 42228ce5ce6Saurel32 } 42328ce5ce6Saurel32 424b42ec42dSaurel32 static void nop(DBDMA_channel *ch) 42528ce5ce6Saurel32 { 42628ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 42728ce5ce6Saurel32 42828ce5ce6Saurel32 if (conditional_wait(ch)) 429b42ec42dSaurel32 goto wait; 43028ce5ce6Saurel32 431ad674e53SAurelien Jarno current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]); 43228ce5ce6Saurel32 dbdma_cmdptr_save(ch); 43328ce5ce6Saurel32 43428ce5ce6Saurel32 conditional_interrupt(ch); 43528ce5ce6Saurel32 conditional_branch(ch); 43628ce5ce6Saurel32 437b42ec42dSaurel32 wait: 438d2f0ce21SAlexander Graf DBDMA_kick(dbdma_from_ch(ch)); 43928ce5ce6Saurel32 } 44028ce5ce6Saurel32 441b42ec42dSaurel32 static void stop(DBDMA_channel *ch) 44228ce5ce6Saurel32 { 44377453882SBenjamin Herrenschmidt ch->regs[DBDMA_STATUS] &= ~(ACTIVE); 44428ce5ce6Saurel32 44528ce5ce6Saurel32 /* the stop command does not increment command pointer */ 44628ce5ce6Saurel32 } 44728ce5ce6Saurel32 448b42ec42dSaurel32 static void channel_run(DBDMA_channel *ch) 44928ce5ce6Saurel32 { 45028ce5ce6Saurel32 dbdma_cmd *current = &ch->current; 45128ce5ce6Saurel32 uint16_t cmd, key; 45228ce5ce6Saurel32 uint16_t req_count; 45328ce5ce6Saurel32 uint32_t phy_addr; 45428ce5ce6Saurel32 4553e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "channel_run\n"); 456b7d67813SMark Cave-Ayland dump_dbdma_cmd(ch, current); 45728ce5ce6Saurel32 45828ce5ce6Saurel32 /* clear WAKE flag at command fetch */ 45928ce5ce6Saurel32 460ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] &= ~WAKE; 46128ce5ce6Saurel32 46228ce5ce6Saurel32 cmd = le16_to_cpu(current->command) & COMMAND_MASK; 46328ce5ce6Saurel32 46428ce5ce6Saurel32 switch (cmd) { 46528ce5ce6Saurel32 case DBDMA_NOP: 466b42ec42dSaurel32 nop(ch); 467b42ec42dSaurel32 return; 46828ce5ce6Saurel32 46928ce5ce6Saurel32 case DBDMA_STOP: 470b42ec42dSaurel32 stop(ch); 471b42ec42dSaurel32 return; 47228ce5ce6Saurel32 } 47328ce5ce6Saurel32 47428ce5ce6Saurel32 key = le16_to_cpu(current->command) & 0x0700; 47528ce5ce6Saurel32 req_count = le16_to_cpu(current->req_count); 47628ce5ce6Saurel32 phy_addr = le32_to_cpu(current->phy_addr); 47728ce5ce6Saurel32 47828ce5ce6Saurel32 if (key == KEY_STREAM4) { 47928ce5ce6Saurel32 printf("command %x, invalid key 4\n", cmd); 48028ce5ce6Saurel32 kill_channel(ch); 481b42ec42dSaurel32 return; 48228ce5ce6Saurel32 } 48328ce5ce6Saurel32 48428ce5ce6Saurel32 switch (cmd) { 48528ce5ce6Saurel32 case OUTPUT_MORE: 48677453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, "* OUTPUT_MORE *\n"); 487b42ec42dSaurel32 start_output(ch, key, phy_addr, req_count, 0); 488b42ec42dSaurel32 return; 48928ce5ce6Saurel32 49028ce5ce6Saurel32 case OUTPUT_LAST: 49177453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, "* OUTPUT_LAST *\n"); 492b42ec42dSaurel32 start_output(ch, key, phy_addr, req_count, 1); 493b42ec42dSaurel32 return; 49428ce5ce6Saurel32 49528ce5ce6Saurel32 case INPUT_MORE: 49677453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, "* INPUT_MORE *\n"); 497b42ec42dSaurel32 start_input(ch, key, phy_addr, req_count, 0); 498b42ec42dSaurel32 return; 49928ce5ce6Saurel32 50028ce5ce6Saurel32 case INPUT_LAST: 50177453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, "* INPUT_LAST *\n"); 502b42ec42dSaurel32 start_input(ch, key, phy_addr, req_count, 1); 503b42ec42dSaurel32 return; 50428ce5ce6Saurel32 } 50528ce5ce6Saurel32 50628ce5ce6Saurel32 if (key < KEY_REGS) { 50728ce5ce6Saurel32 printf("command %x, invalid key %x\n", cmd, key); 50828ce5ce6Saurel32 key = KEY_SYSTEM; 50928ce5ce6Saurel32 } 51028ce5ce6Saurel32 51128ce5ce6Saurel32 /* for LOAD_WORD and STORE_WORD, req_count is on 3 bits 51228ce5ce6Saurel32 * and BRANCH is invalid 51328ce5ce6Saurel32 */ 51428ce5ce6Saurel32 51528ce5ce6Saurel32 req_count = req_count & 0x0007; 51628ce5ce6Saurel32 if (req_count & 0x4) { 51728ce5ce6Saurel32 req_count = 4; 51828ce5ce6Saurel32 phy_addr &= ~3; 51928ce5ce6Saurel32 } else if (req_count & 0x2) { 52028ce5ce6Saurel32 req_count = 2; 52128ce5ce6Saurel32 phy_addr &= ~1; 52228ce5ce6Saurel32 } else 52328ce5ce6Saurel32 req_count = 1; 52428ce5ce6Saurel32 52528ce5ce6Saurel32 switch (cmd) { 52628ce5ce6Saurel32 case LOAD_WORD: 52777453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, "* LOAD_WORD *\n"); 528b42ec42dSaurel32 load_word(ch, key, phy_addr, req_count); 529b42ec42dSaurel32 return; 53028ce5ce6Saurel32 53128ce5ce6Saurel32 case STORE_WORD: 53277453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, "* STORE_WORD *\n"); 533b42ec42dSaurel32 store_word(ch, key, phy_addr, req_count); 534b42ec42dSaurel32 return; 53528ce5ce6Saurel32 } 53628ce5ce6Saurel32 } 53728ce5ce6Saurel32 538c20df14bSJuan Quintela static void DBDMA_run(DBDMAState *s) 53928ce5ce6Saurel32 { 54028ce5ce6Saurel32 int channel; 54128ce5ce6Saurel32 542c20df14bSJuan Quintela for (channel = 0; channel < DBDMA_CHANNELS; channel++) { 543c20df14bSJuan Quintela DBDMA_channel *ch = &s->channels[channel]; 544ad674e53SAurelien Jarno uint32_t status = ch->regs[DBDMA_STATUS]; 54503ee3b1eSAlexander Graf if (!ch->io.processing && (status & RUN) && (status & ACTIVE)) { 546b42ec42dSaurel32 channel_run(ch); 54728ce5ce6Saurel32 } 54828ce5ce6Saurel32 } 549c20df14bSJuan Quintela } 55028ce5ce6Saurel32 55128ce5ce6Saurel32 static void DBDMA_run_bh(void *opaque) 55228ce5ce6Saurel32 { 553c20df14bSJuan Quintela DBDMAState *s = opaque; 55428ce5ce6Saurel32 5553e49c439SMark Cave-Ayland DBDMA_DPRINTF("-> DBDMA_run_bh\n"); 556c20df14bSJuan Quintela DBDMA_run(s); 5573e49c439SMark Cave-Ayland DBDMA_DPRINTF("<- DBDMA_run_bh\n"); 55828ce5ce6Saurel32 } 55928ce5ce6Saurel32 560d1e562deSAlexander Graf void DBDMA_kick(DBDMAState *dbdma) 561d1e562deSAlexander Graf { 562d2f0ce21SAlexander Graf qemu_bh_schedule(dbdma->bh); 563d1e562deSAlexander Graf } 564d1e562deSAlexander Graf 56528ce5ce6Saurel32 void DBDMA_register_channel(void *dbdma, int nchan, qemu_irq irq, 566862c9280Saurel32 DBDMA_rw rw, DBDMA_flush flush, 56728ce5ce6Saurel32 void *opaque) 56828ce5ce6Saurel32 { 569c20df14bSJuan Quintela DBDMAState *s = dbdma; 570c20df14bSJuan Quintela DBDMA_channel *ch = &s->channels[nchan]; 57128ce5ce6Saurel32 5723e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "DBDMA_register_channel 0x%x\n", nchan); 57328ce5ce6Saurel32 5742d7d06d8SHervé Poussineau assert(rw); 5752d7d06d8SHervé Poussineau assert(flush); 5762d7d06d8SHervé Poussineau 57728ce5ce6Saurel32 ch->irq = irq; 578b42ec42dSaurel32 ch->rw = rw; 579862c9280Saurel32 ch->flush = flush; 58028ce5ce6Saurel32 ch->io.opaque = opaque; 58128ce5ce6Saurel32 } 58228ce5ce6Saurel32 58377453882SBenjamin Herrenschmidt static void dbdma_control_write(DBDMA_channel *ch) 58428ce5ce6Saurel32 { 58528ce5ce6Saurel32 uint16_t mask, value; 58628ce5ce6Saurel32 uint32_t status; 58777453882SBenjamin Herrenschmidt bool do_flush = false; 58828ce5ce6Saurel32 589ad674e53SAurelien Jarno mask = (ch->regs[DBDMA_CONTROL] >> 16) & 0xffff; 590ad674e53SAurelien Jarno value = ch->regs[DBDMA_CONTROL] & 0xffff; 59128ce5ce6Saurel32 59277453882SBenjamin Herrenschmidt /* This is the status register which we'll update 59377453882SBenjamin Herrenschmidt * appropriately and store back 59477453882SBenjamin Herrenschmidt */ 595ad674e53SAurelien Jarno status = ch->regs[DBDMA_STATUS]; 59628ce5ce6Saurel32 59777453882SBenjamin Herrenschmidt /* RUN and PAUSE are bits under SW control only 59877453882SBenjamin Herrenschmidt * FLUSH and WAKE are set by SW and cleared by HW 59977453882SBenjamin Herrenschmidt * DEAD, ACTIVE and BT are only under HW control 60077453882SBenjamin Herrenschmidt * 60177453882SBenjamin Herrenschmidt * We handle ACTIVE separately at the end of the 60277453882SBenjamin Herrenschmidt * logic to ensure all cases are covered. 60377453882SBenjamin Herrenschmidt */ 60428ce5ce6Saurel32 60577453882SBenjamin Herrenschmidt /* Setting RUN will tentatively activate the channel 60677453882SBenjamin Herrenschmidt */ 60777453882SBenjamin Herrenschmidt if ((mask & RUN) && (value & RUN)) { 60877453882SBenjamin Herrenschmidt status |= RUN; 60977453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " Setting RUN !\n"); 61028ce5ce6Saurel32 } 61177453882SBenjamin Herrenschmidt 61277453882SBenjamin Herrenschmidt /* Clearing RUN 1->0 will stop the channel */ 61377453882SBenjamin Herrenschmidt if ((mask & RUN) && !(value & RUN)) { 61477453882SBenjamin Herrenschmidt /* This has the side effect of clearing the DEAD bit */ 61577453882SBenjamin Herrenschmidt status &= ~(DEAD | RUN); 61677453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " Clearing RUN !\n"); 61777453882SBenjamin Herrenschmidt } 61877453882SBenjamin Herrenschmidt 61977453882SBenjamin Herrenschmidt /* Setting WAKE wakes up an idle channel if it's running 62077453882SBenjamin Herrenschmidt * 62177453882SBenjamin Herrenschmidt * Note: The doc doesn't say so but assume that only works 62277453882SBenjamin Herrenschmidt * on a channel whose RUN bit is set. 62377453882SBenjamin Herrenschmidt * 62477453882SBenjamin Herrenschmidt * We set WAKE in status, it's not terribly useful as it will 62577453882SBenjamin Herrenschmidt * be cleared on the next command fetch but it seems to mimmic 62677453882SBenjamin Herrenschmidt * the HW behaviour and is useful for the way we handle 62777453882SBenjamin Herrenschmidt * ACTIVE further down. 62877453882SBenjamin Herrenschmidt */ 62977453882SBenjamin Herrenschmidt if ((mask & WAKE) && (value & WAKE) && (status & RUN)) { 63077453882SBenjamin Herrenschmidt status |= WAKE; 63177453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " Setting WAKE !\n"); 63277453882SBenjamin Herrenschmidt } 63377453882SBenjamin Herrenschmidt 63477453882SBenjamin Herrenschmidt /* PAUSE being set will deactivate (or prevent activation) 63577453882SBenjamin Herrenschmidt * of the channel. We just copy it over for now, ACTIVE will 63677453882SBenjamin Herrenschmidt * be re-evaluated later. 63777453882SBenjamin Herrenschmidt */ 63877453882SBenjamin Herrenschmidt if (mask & PAUSE) { 63977453882SBenjamin Herrenschmidt status = (status & ~PAUSE) | (value & PAUSE); 64077453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " %sing PAUSE !\n", 64177453882SBenjamin Herrenschmidt (value & PAUSE) ? "sett" : "clear"); 64277453882SBenjamin Herrenschmidt } 64377453882SBenjamin Herrenschmidt 64477453882SBenjamin Herrenschmidt /* FLUSH is its own thing */ 64577453882SBenjamin Herrenschmidt if ((mask & FLUSH) && (value & FLUSH)) { 64677453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " Setting FLUSH !\n"); 64777453882SBenjamin Herrenschmidt /* We set flush directly in the status register, we do *NOT* 64877453882SBenjamin Herrenschmidt * set it in "status" so that it gets naturally cleared when 64977453882SBenjamin Herrenschmidt * we update the status register further down. That way it 65077453882SBenjamin Herrenschmidt * will be set only during the HW flush operation so it is 65177453882SBenjamin Herrenschmidt * visible to any completions happening during that time. 65277453882SBenjamin Herrenschmidt */ 65377453882SBenjamin Herrenschmidt ch->regs[DBDMA_STATUS] |= FLUSH; 65477453882SBenjamin Herrenschmidt do_flush = true; 65577453882SBenjamin Herrenschmidt } 65677453882SBenjamin Herrenschmidt 65777453882SBenjamin Herrenschmidt /* If either RUN or PAUSE is clear, so should ACTIVE be, 65877453882SBenjamin Herrenschmidt * otherwise, ACTIVE will be set if we modified RUN, PAUSE or 65977453882SBenjamin Herrenschmidt * set WAKE. That means that PAUSE was just cleared, RUN was 66077453882SBenjamin Herrenschmidt * just set or WAKE was just set. 66177453882SBenjamin Herrenschmidt */ 66277453882SBenjamin Herrenschmidt if ((status & PAUSE) || !(status & RUN)) { 66328ce5ce6Saurel32 status &= ~ACTIVE; 66477453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " -> ACTIVE down !\n"); 66577453882SBenjamin Herrenschmidt 66677453882SBenjamin Herrenschmidt /* We stopped processing, we want the underlying HW command 66777453882SBenjamin Herrenschmidt * to complete *before* we clear the ACTIVE bit. Otherwise 66877453882SBenjamin Herrenschmidt * we can get into a situation where the command status will 66977453882SBenjamin Herrenschmidt * have RUN or ACTIVE not set which is going to confuse the 67077453882SBenjamin Herrenschmidt * MacOS driver. 67177453882SBenjamin Herrenschmidt */ 67277453882SBenjamin Herrenschmidt do_flush = true; 67377453882SBenjamin Herrenschmidt } else if (mask & (RUN | PAUSE)) { 67477453882SBenjamin Herrenschmidt status |= ACTIVE; 67577453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " -> ACTIVE up !\n"); 67677453882SBenjamin Herrenschmidt } else if ((mask & WAKE) && (value & WAKE)) { 67777453882SBenjamin Herrenschmidt status |= ACTIVE; 67877453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " -> ACTIVE up !\n"); 6791cde732dSMark Cave-Ayland } 6801cde732dSMark Cave-Ayland 68177453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, " new status=0x%08x\n", status); 68277453882SBenjamin Herrenschmidt 68377453882SBenjamin Herrenschmidt /* If we need to flush the underlying HW, do it now, this happens 68477453882SBenjamin Herrenschmidt * both on FLUSH commands and when stopping the channel for safety. 68577453882SBenjamin Herrenschmidt */ 68677453882SBenjamin Herrenschmidt if (do_flush && ch->flush) { 687987422bcSAmadeusz Sławiński ch->flush(&ch->io); 688987422bcSAmadeusz Sławiński } 68928ce5ce6Saurel32 69077453882SBenjamin Herrenschmidt /* Finally update the status register image */ 691ad674e53SAurelien Jarno ch->regs[DBDMA_STATUS] = status; 69228ce5ce6Saurel32 69377453882SBenjamin Herrenschmidt /* If active, make sure the BH gets to run */ 694d2f0ce21SAlexander Graf if (status & ACTIVE) { 695d2f0ce21SAlexander Graf DBDMA_kick(dbdma_from_ch(ch)); 696d2f0ce21SAlexander Graf } 697d2f0ce21SAlexander Graf } 6983cbee15bSj_mayer 699a8170e5eSAvi Kivity static void dbdma_write(void *opaque, hwaddr addr, 70023c5e4caSAvi Kivity uint64_t value, unsigned size) 7013cbee15bSj_mayer { 70228ce5ce6Saurel32 int channel = addr >> DBDMA_CHANNEL_SHIFT; 703c20df14bSJuan Quintela DBDMAState *s = opaque; 704c20df14bSJuan Quintela DBDMA_channel *ch = &s->channels[channel]; 70528ce5ce6Saurel32 int reg = (addr - (channel << DBDMA_CHANNEL_SHIFT)) >> 2; 70628ce5ce6Saurel32 7073e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "writel 0x" TARGET_FMT_plx " <= 0x%08"PRIx64"\n", 70858c0c311SAlexander Graf addr, value); 7093e49c439SMark Cave-Ayland DBDMA_DPRINTFCH(ch, "channel 0x%x reg 0x%x\n", 71028ce5ce6Saurel32 (uint32_t)addr >> DBDMA_CHANNEL_SHIFT, reg); 71128ce5ce6Saurel32 7127eaba824SAlexander Graf /* cmdptr cannot be modified if channel is ACTIVE */ 71328ce5ce6Saurel32 7147eaba824SAlexander Graf if (reg == DBDMA_CMDPTR_LO && (ch->regs[DBDMA_STATUS] & ACTIVE)) { 71528ce5ce6Saurel32 return; 7167eaba824SAlexander Graf } 71728ce5ce6Saurel32 71828ce5ce6Saurel32 ch->regs[reg] = value; 71928ce5ce6Saurel32 72028ce5ce6Saurel32 switch(reg) { 72128ce5ce6Saurel32 case DBDMA_CONTROL: 72228ce5ce6Saurel32 dbdma_control_write(ch); 72328ce5ce6Saurel32 break; 72428ce5ce6Saurel32 case DBDMA_CMDPTR_LO: 72528ce5ce6Saurel32 /* 16-byte aligned */ 726ad674e53SAurelien Jarno ch->regs[DBDMA_CMDPTR_LO] &= ~0xf; 72728ce5ce6Saurel32 dbdma_cmdptr_load(ch); 72828ce5ce6Saurel32 break; 72928ce5ce6Saurel32 case DBDMA_STATUS: 73028ce5ce6Saurel32 case DBDMA_INTR_SEL: 73128ce5ce6Saurel32 case DBDMA_BRANCH_SEL: 73228ce5ce6Saurel32 case DBDMA_WAIT_SEL: 73328ce5ce6Saurel32 /* nothing to do */ 73428ce5ce6Saurel32 break; 73528ce5ce6Saurel32 case DBDMA_XFER_MODE: 73628ce5ce6Saurel32 case DBDMA_CMDPTR_HI: 73728ce5ce6Saurel32 case DBDMA_DATA2PTR_HI: 73828ce5ce6Saurel32 case DBDMA_DATA2PTR_LO: 73928ce5ce6Saurel32 case DBDMA_ADDRESS_HI: 74028ce5ce6Saurel32 case DBDMA_BRANCH_ADDR_HI: 74128ce5ce6Saurel32 case DBDMA_RES1: 74228ce5ce6Saurel32 case DBDMA_RES2: 74328ce5ce6Saurel32 case DBDMA_RES3: 74428ce5ce6Saurel32 case DBDMA_RES4: 74528ce5ce6Saurel32 /* unused */ 74628ce5ce6Saurel32 break; 7473cbee15bSj_mayer } 7483cbee15bSj_mayer } 7493cbee15bSj_mayer 750a8170e5eSAvi Kivity static uint64_t dbdma_read(void *opaque, hwaddr addr, 75123c5e4caSAvi Kivity unsigned size) 7523cbee15bSj_mayer { 75328ce5ce6Saurel32 uint32_t value; 75428ce5ce6Saurel32 int channel = addr >> DBDMA_CHANNEL_SHIFT; 755c20df14bSJuan Quintela DBDMAState *s = opaque; 756c20df14bSJuan Quintela DBDMA_channel *ch = &s->channels[channel]; 75728ce5ce6Saurel32 int reg = (addr - (channel << DBDMA_CHANNEL_SHIFT)) >> 2; 758ea026b2fSblueswir1 75928ce5ce6Saurel32 value = ch->regs[reg]; 76028ce5ce6Saurel32 76128ce5ce6Saurel32 switch(reg) { 76228ce5ce6Saurel32 case DBDMA_CONTROL: 76377453882SBenjamin Herrenschmidt value = ch->regs[DBDMA_STATUS]; 76428ce5ce6Saurel32 break; 76528ce5ce6Saurel32 case DBDMA_STATUS: 76628ce5ce6Saurel32 case DBDMA_CMDPTR_LO: 76728ce5ce6Saurel32 case DBDMA_INTR_SEL: 76828ce5ce6Saurel32 case DBDMA_BRANCH_SEL: 76928ce5ce6Saurel32 case DBDMA_WAIT_SEL: 77028ce5ce6Saurel32 /* nothing to do */ 77128ce5ce6Saurel32 break; 77228ce5ce6Saurel32 case DBDMA_XFER_MODE: 77328ce5ce6Saurel32 case DBDMA_CMDPTR_HI: 77428ce5ce6Saurel32 case DBDMA_DATA2PTR_HI: 77528ce5ce6Saurel32 case DBDMA_DATA2PTR_LO: 77628ce5ce6Saurel32 case DBDMA_ADDRESS_HI: 77728ce5ce6Saurel32 case DBDMA_BRANCH_ADDR_HI: 77828ce5ce6Saurel32 /* unused */ 77928ce5ce6Saurel32 value = 0; 78028ce5ce6Saurel32 break; 78128ce5ce6Saurel32 case DBDMA_RES1: 78228ce5ce6Saurel32 case DBDMA_RES2: 78328ce5ce6Saurel32 case DBDMA_RES3: 78428ce5ce6Saurel32 case DBDMA_RES4: 78528ce5ce6Saurel32 /* reserved */ 78628ce5ce6Saurel32 break; 78728ce5ce6Saurel32 } 78828ce5ce6Saurel32 78977453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, "readl 0x" TARGET_FMT_plx " => 0x%08x\n", addr, value); 79077453882SBenjamin Herrenschmidt DBDMA_DPRINTFCH(ch, "channel 0x%x reg 0x%x\n", 79177453882SBenjamin Herrenschmidt (uint32_t)addr >> DBDMA_CHANNEL_SHIFT, reg); 79277453882SBenjamin Herrenschmidt 79328ce5ce6Saurel32 return value; 7943cbee15bSj_mayer } 7953cbee15bSj_mayer 79623c5e4caSAvi Kivity static const MemoryRegionOps dbdma_ops = { 79723c5e4caSAvi Kivity .read = dbdma_read, 79823c5e4caSAvi Kivity .write = dbdma_write, 79923c5e4caSAvi Kivity .endianness = DEVICE_LITTLE_ENDIAN, 80023c5e4caSAvi Kivity .valid = { 80123c5e4caSAvi Kivity .min_access_size = 4, 80223c5e4caSAvi Kivity .max_access_size = 4, 80323c5e4caSAvi Kivity }, 8043cbee15bSj_mayer }; 8053cbee15bSj_mayer 806627be2f2SMark Cave-Ayland static const VMStateDescription vmstate_dbdma_io = { 807627be2f2SMark Cave-Ayland .name = "dbdma_io", 808da26fdc3SJuan Quintela .version_id = 0, 809da26fdc3SJuan Quintela .minimum_version_id = 0, 810da26fdc3SJuan Quintela .fields = (VMStateField[]) { 811627be2f2SMark Cave-Ayland VMSTATE_UINT64(addr, struct DBDMA_io), 812627be2f2SMark Cave-Ayland VMSTATE_INT32(len, struct DBDMA_io), 813627be2f2SMark Cave-Ayland VMSTATE_INT32(is_last, struct DBDMA_io), 814627be2f2SMark Cave-Ayland VMSTATE_INT32(is_dma_out, struct DBDMA_io), 815627be2f2SMark Cave-Ayland VMSTATE_BOOL(processing, struct DBDMA_io), 816627be2f2SMark Cave-Ayland VMSTATE_END_OF_LIST() 817627be2f2SMark Cave-Ayland } 818627be2f2SMark Cave-Ayland }; 819627be2f2SMark Cave-Ayland 820627be2f2SMark Cave-Ayland static const VMStateDescription vmstate_dbdma_cmd = { 821627be2f2SMark Cave-Ayland .name = "dbdma_cmd", 822627be2f2SMark Cave-Ayland .version_id = 0, 823627be2f2SMark Cave-Ayland .minimum_version_id = 0, 824627be2f2SMark Cave-Ayland .fields = (VMStateField[]) { 825627be2f2SMark Cave-Ayland VMSTATE_UINT16(req_count, dbdma_cmd), 826627be2f2SMark Cave-Ayland VMSTATE_UINT16(command, dbdma_cmd), 827627be2f2SMark Cave-Ayland VMSTATE_UINT32(phy_addr, dbdma_cmd), 828627be2f2SMark Cave-Ayland VMSTATE_UINT32(cmd_dep, dbdma_cmd), 829627be2f2SMark Cave-Ayland VMSTATE_UINT16(res_count, dbdma_cmd), 830627be2f2SMark Cave-Ayland VMSTATE_UINT16(xfer_status, dbdma_cmd), 831627be2f2SMark Cave-Ayland VMSTATE_END_OF_LIST() 832627be2f2SMark Cave-Ayland } 833627be2f2SMark Cave-Ayland }; 834627be2f2SMark Cave-Ayland 835627be2f2SMark Cave-Ayland static const VMStateDescription vmstate_dbdma_channel = { 836627be2f2SMark Cave-Ayland .name = "dbdma_channel", 837627be2f2SMark Cave-Ayland .version_id = 1, 838627be2f2SMark Cave-Ayland .minimum_version_id = 1, 839627be2f2SMark Cave-Ayland .fields = (VMStateField[]) { 840da26fdc3SJuan Quintela VMSTATE_UINT32_ARRAY(regs, struct DBDMA_channel, DBDMA_REGS), 841627be2f2SMark Cave-Ayland VMSTATE_STRUCT(io, struct DBDMA_channel, 0, vmstate_dbdma_io, DBDMA_io), 842627be2f2SMark Cave-Ayland VMSTATE_STRUCT(current, struct DBDMA_channel, 0, vmstate_dbdma_cmd, 843627be2f2SMark Cave-Ayland dbdma_cmd), 844da26fdc3SJuan Quintela VMSTATE_END_OF_LIST() 8459b64997fSblueswir1 } 846da26fdc3SJuan Quintela }; 8479b64997fSblueswir1 848da26fdc3SJuan Quintela static const VMStateDescription vmstate_dbdma = { 849da26fdc3SJuan Quintela .name = "dbdma", 850627be2f2SMark Cave-Ayland .version_id = 3, 851627be2f2SMark Cave-Ayland .minimum_version_id = 3, 852da26fdc3SJuan Quintela .fields = (VMStateField[]) { 853da26fdc3SJuan Quintela VMSTATE_STRUCT_ARRAY(channels, DBDMAState, DBDMA_CHANNELS, 1, 854da26fdc3SJuan Quintela vmstate_dbdma_channel, DBDMA_channel), 855da26fdc3SJuan Quintela VMSTATE_END_OF_LIST() 8569b64997fSblueswir1 } 857da26fdc3SJuan Quintela }; 8589b64997fSblueswir1 8591d27f351SMark Cave-Ayland static void mac_dbdma_reset(DeviceState *d) 8606e6b7363Sblueswir1 { 8611d27f351SMark Cave-Ayland DBDMAState *s = MAC_DBDMA(d); 86228ce5ce6Saurel32 int i; 86328ce5ce6Saurel32 8641d27f351SMark Cave-Ayland for (i = 0; i < DBDMA_CHANNELS; i++) { 865c20df14bSJuan Quintela memset(s->channels[i].regs, 0, DBDMA_SIZE); 8666e6b7363Sblueswir1 } 8671d27f351SMark Cave-Ayland } 8686e6b7363Sblueswir1 8692d7d06d8SHervé Poussineau static void dbdma_unassigned_rw(DBDMA_io *io) 8702d7d06d8SHervé Poussineau { 8712d7d06d8SHervé Poussineau DBDMA_channel *ch = io->channel; 87277453882SBenjamin Herrenschmidt dbdma_cmd *current = &ch->current; 87377453882SBenjamin Herrenschmidt uint16_t cmd; 8742d7d06d8SHervé Poussineau qemu_log_mask(LOG_GUEST_ERROR, "%s: use of unassigned channel %d\n", 8752d7d06d8SHervé Poussineau __func__, ch->channel); 8762df77896SMark Cave-Ayland ch->io.processing = false; 87777453882SBenjamin Herrenschmidt 87877453882SBenjamin Herrenschmidt cmd = le16_to_cpu(current->command) & COMMAND_MASK; 87977453882SBenjamin Herrenschmidt if (cmd == OUTPUT_MORE || cmd == OUTPUT_LAST || 88077453882SBenjamin Herrenschmidt cmd == INPUT_MORE || cmd == INPUT_LAST) { 88177453882SBenjamin Herrenschmidt current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]); 88277453882SBenjamin Herrenschmidt current->res_count = cpu_to_le16(io->len); 88377453882SBenjamin Herrenschmidt dbdma_cmdptr_save(ch); 88477453882SBenjamin Herrenschmidt } 8852d7d06d8SHervé Poussineau } 8862d7d06d8SHervé Poussineau 8872d7d06d8SHervé Poussineau static void dbdma_unassigned_flush(DBDMA_io *io) 8882d7d06d8SHervé Poussineau { 8892d7d06d8SHervé Poussineau DBDMA_channel *ch = io->channel; 8902d7d06d8SHervé Poussineau qemu_log_mask(LOG_GUEST_ERROR, "%s: use of unassigned channel %d\n", 8912d7d06d8SHervé Poussineau __func__, ch->channel); 8922d7d06d8SHervé Poussineau } 8932d7d06d8SHervé Poussineau 8941d27f351SMark Cave-Ayland static void mac_dbdma_init(Object *obj) 8951d27f351SMark Cave-Ayland { 8961d27f351SMark Cave-Ayland SysBusDevice *sbd = SYS_BUS_DEVICE(obj); 8971d27f351SMark Cave-Ayland DBDMAState *s = MAC_DBDMA(obj); 8981d27f351SMark Cave-Ayland int i; 89928ce5ce6Saurel32 9003e300fa6SAlexander Graf for (i = 0; i < DBDMA_CHANNELS; i++) { 9012d7d06d8SHervé Poussineau DBDMA_channel *ch = &s->channels[i]; 9022d7d06d8SHervé Poussineau 9032d7d06d8SHervé Poussineau ch->rw = dbdma_unassigned_rw; 9042d7d06d8SHervé Poussineau ch->flush = dbdma_unassigned_flush; 9052d7d06d8SHervé Poussineau ch->channel = i; 9062d7d06d8SHervé Poussineau ch->io.channel = ch; 9073e300fa6SAlexander Graf } 9083e300fa6SAlexander Graf 9091d27f351SMark Cave-Ayland memory_region_init_io(&s->mem, obj, &dbdma_ops, s, "dbdma", 0x1000); 9101d27f351SMark Cave-Ayland sysbus_init_mmio(sbd, &s->mem); 9111d27f351SMark Cave-Ayland } 9121d27f351SMark Cave-Ayland 9131d27f351SMark Cave-Ayland static void mac_dbdma_realize(DeviceState *dev, Error **errp) 9141d27f351SMark Cave-Ayland { 9151d27f351SMark Cave-Ayland DBDMAState *s = MAC_DBDMA(dev); 91628ce5ce6Saurel32 917d2f0ce21SAlexander Graf s->bh = qemu_bh_new(DBDMA_run_bh, s); 9183cbee15bSj_mayer } 9191d27f351SMark Cave-Ayland 9201d27f351SMark Cave-Ayland static void mac_dbdma_class_init(ObjectClass *oc, void *data) 9211d27f351SMark Cave-Ayland { 9221d27f351SMark Cave-Ayland DeviceClass *dc = DEVICE_CLASS(oc); 9231d27f351SMark Cave-Ayland 9241d27f351SMark Cave-Ayland dc->realize = mac_dbdma_realize; 9251d27f351SMark Cave-Ayland dc->reset = mac_dbdma_reset; 9261d27f351SMark Cave-Ayland dc->vmsd = &vmstate_dbdma; 9271d27f351SMark Cave-Ayland } 9281d27f351SMark Cave-Ayland 9291d27f351SMark Cave-Ayland static const TypeInfo mac_dbdma_type_info = { 9301d27f351SMark Cave-Ayland .name = TYPE_MAC_DBDMA, 9311d27f351SMark Cave-Ayland .parent = TYPE_SYS_BUS_DEVICE, 9321d27f351SMark Cave-Ayland .instance_size = sizeof(DBDMAState), 9331d27f351SMark Cave-Ayland .instance_init = mac_dbdma_init, 9341d27f351SMark Cave-Ayland .class_init = mac_dbdma_class_init 9351d27f351SMark Cave-Ayland }; 9361d27f351SMark Cave-Ayland 9371d27f351SMark Cave-Ayland static void mac_dbdma_register_types(void) 9381d27f351SMark Cave-Ayland { 9391d27f351SMark Cave-Ayland type_register_static(&mac_dbdma_type_info); 9401d27f351SMark Cave-Ayland } 9411d27f351SMark Cave-Ayland 9421d27f351SMark Cave-Ayland type_init(mac_dbdma_register_types) 943