2009-08-20 17:22:21 +04:00
|
|
|
/*
|
|
|
|
* QEMU IDE Emulation: MacIO support.
|
|
|
|
*
|
|
|
|
* Copyright (c) 2003 Fabrice Bellard
|
|
|
|
* Copyright (c) 2006 Openedhand Ltd.
|
|
|
|
*
|
|
|
|
* Permission is hereby granted, free of charge, to any person obtaining a copy
|
|
|
|
* of this software and associated documentation files (the "Software"), to deal
|
|
|
|
* in the Software without restriction, including without limitation the rights
|
|
|
|
* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
|
|
|
|
* copies of the Software, and to permit persons to whom the Software is
|
|
|
|
* furnished to do so, subject to the following conditions:
|
|
|
|
*
|
|
|
|
* The above copyright notice and this permission notice shall be included in
|
|
|
|
* all copies or substantial portions of the Software.
|
|
|
|
*
|
|
|
|
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
|
|
|
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
|
|
|
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
|
|
|
|
* THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
|
|
|
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
|
|
|
|
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
|
|
|
|
* THE SOFTWARE.
|
|
|
|
*/
|
2013-01-24 03:03:54 +04:00
|
|
|
#include "hw/hw.h"
|
|
|
|
#include "hw/ppc/mac.h"
|
2013-02-05 20:06:20 +04:00
|
|
|
#include "hw/ppc/mac_dbdma.h"
|
2014-10-07 15:59:18 +04:00
|
|
|
#include "sysemu/block-backend.h"
|
2012-12-17 21:20:04 +04:00
|
|
|
#include "sysemu/dma.h"
|
2009-08-20 17:22:26 +04:00
|
|
|
|
|
|
|
#include <hw/ide/internal.h>
|
2009-08-20 17:22:21 +04:00
|
|
|
|
2013-06-30 03:23:45 +04:00
|
|
|
/* debug MACIO */
|
|
|
|
// #define DEBUG_MACIO
|
|
|
|
|
|
|
|
#ifdef DEBUG_MACIO
|
|
|
|
static const int debug_macio = 1;
|
|
|
|
#else
|
|
|
|
static const int debug_macio = 0;
|
|
|
|
#endif
|
|
|
|
|
|
|
|
#define MACIO_DPRINTF(fmt, ...) do { \
|
|
|
|
if (debug_macio) { \
|
|
|
|
printf(fmt , ## __VA_ARGS__); \
|
|
|
|
} \
|
|
|
|
} while (0)
|
|
|
|
|
|
|
|
|
2009-08-20 17:22:21 +04:00
|
|
|
/***********************************************************/
|
|
|
|
/* MacIO based PowerPC IDE */
|
|
|
|
|
2010-03-29 23:23:57 +04:00
|
|
|
#define MACIO_PAGE_SIZE 4096
|
|
|
|
|
2015-05-22 21:13:44 +03:00
|
|
|
static void pmac_dma_read(BlockBackend *blk,
|
|
|
|
int64_t sector_num, int nb_sectors,
|
|
|
|
void (*cb)(void *opaque, int ret), void *opaque)
|
2009-08-20 17:22:21 +04:00
|
|
|
{
|
|
|
|
DBDMA_io *io = opaque;
|
|
|
|
MACIOIDEState *m = io->opaque;
|
|
|
|
IDEState *s = idebus_active_if(&m->bus);
|
2015-05-22 21:13:44 +03:00
|
|
|
dma_addr_t dma_addr, dma_len;
|
|
|
|
void *mem;
|
|
|
|
int nsector, remainder;
|
2009-08-20 17:22:21 +04:00
|
|
|
|
2015-05-22 21:13:44 +03:00
|
|
|
qemu_iovec_destroy(&io->iov);
|
|
|
|
qemu_iovec_init(&io->iov, io->len / MACIO_PAGE_SIZE + 1);
|
|
|
|
|
|
|
|
if (io->remainder_len > 0) {
|
|
|
|
/* Return remainder of request */
|
|
|
|
int transfer = MIN(io->remainder_len, io->len);
|
|
|
|
|
|
|
|
MACIO_DPRINTF("--- DMA read pop - bounce addr: %p addr: %"
|
|
|
|
HWADDR_PRIx " remainder_len: %x\n",
|
|
|
|
&io->remainder + (0x200 - transfer), io->addr,
|
|
|
|
io->remainder_len);
|
|
|
|
|
|
|
|
cpu_physical_memory_write(io->addr,
|
|
|
|
&io->remainder + (0x200 - transfer),
|
|
|
|
transfer);
|
|
|
|
|
|
|
|
io->remainder_len -= transfer;
|
|
|
|
io->len -= transfer;
|
|
|
|
io->addr += transfer;
|
|
|
|
|
|
|
|
s->io_buffer_index += transfer;
|
|
|
|
s->io_buffer_size -= transfer;
|
|
|
|
|
|
|
|
if (io->remainder_len != 0) {
|
|
|
|
/* Still waiting for remainder */
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (io->len == 0) {
|
|
|
|
MACIO_DPRINTF("--- finished all read processing; go and finish\n");
|
|
|
|
cb(opaque, 0);
|
|
|
|
return;
|
|
|
|
}
|
2009-08-20 17:22:21 +04:00
|
|
|
}
|
|
|
|
|
2015-05-22 21:13:44 +03:00
|
|
|
if (s->drive_kind == IDE_CD) {
|
|
|
|
sector_num = (int64_t)(s->lba << 2) + (s->io_buffer_index >> 9);
|
|
|
|
} else {
|
|
|
|
sector_num = ide_get_sector(s) + (s->io_buffer_index >> 9);
|
2013-06-30 04:54:35 +04:00
|
|
|
}
|
|
|
|
|
2015-05-22 21:13:44 +03:00
|
|
|
nsector = ((io->len + 0x1ff) >> 9);
|
|
|
|
remainder = (nsector << 9) - io->len;
|
2013-06-30 03:23:45 +04:00
|
|
|
|
2015-05-22 21:13:44 +03:00
|
|
|
MACIO_DPRINTF("--- DMA read transfer - addr: %" HWADDR_PRIx " len: %x\n",
|
|
|
|
io->addr, io->len);
|
|
|
|
|
|
|
|
dma_addr = io->addr;
|
|
|
|
dma_len = io->len;
|
|
|
|
mem = dma_memory_map(&address_space_memory, dma_addr, &dma_len,
|
|
|
|
DMA_DIRECTION_FROM_DEVICE);
|
|
|
|
|
|
|
|
if (!remainder) {
|
|
|
|
MACIO_DPRINTF("--- DMA read aligned - addr: %" HWADDR_PRIx
|
|
|
|
" len: %x\n", io->addr, io->len);
|
|
|
|
qemu_iovec_add(&io->iov, mem, io->len);
|
|
|
|
} else {
|
|
|
|
MACIO_DPRINTF("--- DMA read unaligned - addr: %" HWADDR_PRIx
|
|
|
|
" len: %x\n", io->addr, io->len);
|
|
|
|
qemu_iovec_add(&io->iov, mem, io->len);
|
2009-08-20 17:22:21 +04:00
|
|
|
|
2015-05-22 21:13:44 +03:00
|
|
|
MACIO_DPRINTF("--- DMA read push - bounce addr: %p "
|
|
|
|
"remainder_len: %x\n",
|
|
|
|
&io->remainder + 0x200 - remainder, remainder);
|
|
|
|
qemu_iovec_add(&io->iov, &io->remainder + 0x200 - remainder,
|
|
|
|
remainder);
|
2009-08-20 17:22:21 +04:00
|
|
|
|
2015-05-22 21:13:44 +03:00
|
|
|
io->remainder_len = remainder;
|
2009-08-20 17:22:21 +04:00
|
|
|
}
|
|
|
|
|
2015-05-22 21:13:44 +03:00
|
|
|
s->io_buffer_size -= io->len;
|
|
|
|
s->io_buffer_index += io->len;
|
2013-06-28 15:30:01 +04:00
|
|
|
|
2015-05-22 21:13:44 +03:00
|
|
|
io->len = 0;
|
2013-06-28 15:30:01 +04:00
|
|
|
|
2015-05-22 21:13:44 +03:00
|
|
|
MACIO_DPRINTF("--- Block read transfer - sector_num: %"PRIx64" "
|
|
|
|
"nsector: %x\n",
|
|
|
|
sector_num, nsector);
|
2013-06-28 15:30:01 +04:00
|
|
|
|
2015-05-22 21:13:44 +03:00
|
|
|
m->aiocb = blk_aio_readv(blk, sector_num, &io->iov, nsector, cb, io);
|
|
|
|
}
|
2013-06-28 15:30:01 +04:00
|
|
|
|
2015-05-22 21:13:44 +03:00
|
|
|
static void pmac_dma_write(BlockBackend *blk,
|
|
|
|
int64_t sector_num, int nb_sectors,
|
|
|
|
void (*cb)(void *opaque, int ret), void *opaque)
|
|
|
|
{
|
|
|
|
DBDMA_io *io = opaque;
|
|
|
|
MACIOIDEState *m = io->opaque;
|
|
|
|
IDEState *s = idebus_active_if(&m->bus);
|
|
|
|
dma_addr_t dma_addr, dma_len;
|
|
|
|
void *mem;
|
|
|
|
int nsector, remainder;
|
|
|
|
int extra = 0;
|
|
|
|
|
|
|
|
qemu_iovec_destroy(&io->iov);
|
|
|
|
qemu_iovec_init(&io->iov, io->len / MACIO_PAGE_SIZE + 1);
|
|
|
|
|
|
|
|
if (io->remainder_len > 0) {
|
|
|
|
/* Return remainder of request */
|
|
|
|
int transfer = MIN(io->remainder_len, io->len);
|
|
|
|
|
|
|
|
MACIO_DPRINTF("--- processing write remainder %x\n", transfer);
|
|
|
|
cpu_physical_memory_read(io->addr,
|
|
|
|
&io->remainder + (0x200 - transfer),
|
|
|
|
transfer);
|
|
|
|
|
|
|
|
io->remainder_len -= transfer;
|
|
|
|
io->len -= transfer;
|
|
|
|
io->addr += transfer;
|
|
|
|
|
|
|
|
s->io_buffer_index += transfer;
|
|
|
|
s->io_buffer_size -= transfer;
|
|
|
|
|
|
|
|
if (io->remainder_len != 0) {
|
|
|
|
/* Still waiting for remainder */
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
MACIO_DPRINTF("--> prepending bounce buffer with size 0x200\n");
|
|
|
|
|
|
|
|
/* Sector transfer complete - prepend to request */
|
|
|
|
qemu_iovec_add(&io->iov, &io->remainder, 0x200);
|
|
|
|
extra = 1;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (s->drive_kind == IDE_CD) {
|
|
|
|
sector_num = (int64_t)(s->lba << 2) + (s->io_buffer_index >> 9);
|
|
|
|
} else {
|
|
|
|
sector_num = ide_get_sector(s) + (s->io_buffer_index >> 9);
|
|
|
|
}
|
|
|
|
|
|
|
|
nsector = (io->len >> 9);
|
|
|
|
remainder = io->len - (nsector << 9);
|
|
|
|
|
|
|
|
MACIO_DPRINTF("--- DMA write transfer - addr: %" HWADDR_PRIx " len: %x\n",
|
|
|
|
io->addr, io->len);
|
|
|
|
MACIO_DPRINTF("xxx remainder: %x\n", remainder);
|
|
|
|
MACIO_DPRINTF("xxx sector_num: %"PRIx64" nsector: %x\n",
|
|
|
|
sector_num, nsector);
|
|
|
|
|
|
|
|
dma_addr = io->addr;
|
|
|
|
dma_len = io->len;
|
|
|
|
mem = dma_memory_map(&address_space_memory, dma_addr, &dma_len,
|
|
|
|
DMA_DIRECTION_TO_DEVICE);
|
|
|
|
|
|
|
|
if (!remainder) {
|
|
|
|
MACIO_DPRINTF("--- DMA write aligned - addr: %" HWADDR_PRIx
|
|
|
|
" len: %x\n", io->addr, io->len);
|
|
|
|
qemu_iovec_add(&io->iov, mem, io->len);
|
|
|
|
} else {
|
|
|
|
/* Write up to last complete sector */
|
|
|
|
MACIO_DPRINTF("--- DMA write unaligned - addr: %" HWADDR_PRIx
|
|
|
|
" len: %x\n", io->addr, (nsector << 9));
|
|
|
|
qemu_iovec_add(&io->iov, mem, (nsector << 9));
|
|
|
|
|
|
|
|
MACIO_DPRINTF("--- DMA write read - bounce addr: %p "
|
|
|
|
"remainder_len: %x\n", &io->remainder, remainder);
|
|
|
|
cpu_physical_memory_read(io->addr + (nsector << 9), &io->remainder,
|
|
|
|
remainder);
|
|
|
|
|
|
|
|
io->remainder_len = 0x200 - remainder;
|
|
|
|
|
|
|
|
MACIO_DPRINTF("xxx remainder_len: %x\n", io->remainder_len);
|
|
|
|
}
|
|
|
|
|
|
|
|
s->io_buffer_size -= ((nsector + extra) << 9);
|
|
|
|
s->io_buffer_index += ((nsector + extra) << 9);
|
|
|
|
|
|
|
|
io->len = 0;
|
|
|
|
|
|
|
|
MACIO_DPRINTF("--- Block write transfer - sector_num: %"PRIx64" "
|
|
|
|
"nsector: %x\n", sector_num, nsector + extra);
|
|
|
|
|
|
|
|
m->aiocb = blk_aio_writev(blk, sector_num, &io->iov, nsector + extra, cb,
|
|
|
|
io);
|
|
|
|
}
|
|
|
|
|
2015-05-22 21:13:44 +03:00
|
|
|
static void pmac_ide_atapi_transfer_cb(void *opaque, int ret)
|
|
|
|
{
|
|
|
|
DBDMA_io *io = opaque;
|
|
|
|
MACIOIDEState *m = io->opaque;
|
|
|
|
IDEState *s = idebus_active_if(&m->bus);
|
|
|
|
int64_t sector_num;
|
|
|
|
int nsector, remainder;
|
|
|
|
|
|
|
|
MACIO_DPRINTF("\ns is %p\n", s);
|
|
|
|
MACIO_DPRINTF("io_buffer_index: %x\n", s->io_buffer_index);
|
|
|
|
MACIO_DPRINTF("io_buffer_size: %x packet_transfer_size: %x\n",
|
|
|
|
s->io_buffer_size, s->packet_transfer_size);
|
|
|
|
MACIO_DPRINTF("lba: %x\n", s->lba);
|
|
|
|
MACIO_DPRINTF("io_addr: %" HWADDR_PRIx " io_len: %x\n", io->addr,
|
|
|
|
io->len);
|
|
|
|
|
|
|
|
if (ret < 0) {
|
|
|
|
MACIO_DPRINTF("THERE WAS AN ERROR! %d\n", ret);
|
|
|
|
ide_atapi_io_error(s, ret);
|
|
|
|
goto done;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (!m->dma_active) {
|
|
|
|
MACIO_DPRINTF("waiting for data (%#x - %#x - %x)\n",
|
|
|
|
s->nsector, io->len, s->status);
|
|
|
|
/* data not ready yet, wait for the channel to get restarted */
|
|
|
|
io->processing = false;
|
2013-06-28 15:30:01 +04:00
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
2015-05-22 21:13:44 +03:00
|
|
|
if (s->io_buffer_size <= 0) {
|
2009-08-20 17:22:21 +04:00
|
|
|
ide_atapi_cmd_ok(s);
|
2013-06-30 04:54:35 +04:00
|
|
|
m->dma_active = false;
|
2015-05-22 21:13:44 +03:00
|
|
|
goto done;
|
2013-06-30 03:23:45 +04:00
|
|
|
}
|
2009-08-20 17:22:21 +04:00
|
|
|
|
|
|
|
if (io->len == 0) {
|
2015-05-22 21:13:44 +03:00
|
|
|
MACIO_DPRINTF("End of DMA transfer\n");
|
2011-08-25 10:26:01 +04:00
|
|
|
goto done;
|
2009-08-20 17:22:21 +04:00
|
|
|
}
|
|
|
|
|
2015-05-22 21:13:44 +03:00
|
|
|
if (s->lba == -1) {
|
|
|
|
/* Non-block ATAPI transfer - just copy to RAM */
|
|
|
|
s->io_buffer_size = MIN(s->io_buffer_size, io->len);
|
|
|
|
cpu_physical_memory_write(io->addr, s->io_buffer, s->io_buffer_size);
|
|
|
|
ide_atapi_cmd_ok(s);
|
|
|
|
m->dma_active = false;
|
|
|
|
goto done;
|
2013-06-28 15:30:01 +04:00
|
|
|
}
|
|
|
|
|
2015-05-22 21:13:44 +03:00
|
|
|
/* Calculate number of sectors */
|
|
|
|
sector_num = (int64_t)(s->lba << 2) + (s->io_buffer_index >> 9);
|
|
|
|
nsector = (io->len + 0x1ff) >> 9;
|
|
|
|
remainder = io->len & 0x1ff;
|
2009-08-20 17:22:21 +04:00
|
|
|
|
2015-05-22 21:13:44 +03:00
|
|
|
MACIO_DPRINTF("nsector: %d remainder: %x\n", nsector, remainder);
|
|
|
|
MACIO_DPRINTF("sector: %"PRIx64" %zx\n", sector_num, io->iov.size / 512);
|
2013-06-30 03:23:45 +04:00
|
|
|
|
2015-05-22 21:13:44 +03:00
|
|
|
pmac_dma_read(s->blk, sector_num, nsector, pmac_ide_atapi_transfer_cb, io);
|
2011-08-25 10:26:01 +04:00
|
|
|
return;
|
|
|
|
|
|
|
|
done:
|
2015-05-22 21:13:44 +03:00
|
|
|
MACIO_DPRINTF("done DMA\n\n");
|
2014-10-07 15:59:18 +04:00
|
|
|
block_acct_done(blk_get_stats(s->blk), &s->acct);
|
2011-08-25 10:26:01 +04:00
|
|
|
io->dma_end(opaque);
|
2015-05-22 21:13:44 +03:00
|
|
|
|
|
|
|
return;
|
2009-08-20 17:22:21 +04:00
|
|
|
}
|
|
|
|
|
|
|
|
static void pmac_ide_transfer_cb(void *opaque, int ret)
|
|
|
|
{
|
|
|
|
DBDMA_io *io = opaque;
|
|
|
|
MACIOIDEState *m = io->opaque;
|
|
|
|
IDEState *s = idebus_active_if(&m->bus);
|
|
|
|
int64_t sector_num;
|
2015-05-22 21:13:44 +03:00
|
|
|
int nsector, remainder;
|
|
|
|
|
|
|
|
MACIO_DPRINTF("pmac_ide_transfer_cb\n");
|
2009-08-20 17:22:21 +04:00
|
|
|
|
|
|
|
if (ret < 0) {
|
2013-06-30 03:23:45 +04:00
|
|
|
MACIO_DPRINTF("DMA error\n");
|
2009-08-20 17:22:21 +04:00
|
|
|
m->aiocb = NULL;
|
2013-06-30 03:43:17 +04:00
|
|
|
ide_dma_error(s);
|
2013-06-28 15:30:01 +04:00
|
|
|
io->remainder_len = 0;
|
2011-08-25 10:26:01 +04:00
|
|
|
goto done;
|
2009-08-20 17:22:21 +04:00
|
|
|
}
|
|
|
|
|
2013-06-30 04:54:35 +04:00
|
|
|
if (!m->dma_active) {
|
|
|
|
MACIO_DPRINTF("waiting for data (%#x - %#x - %x)\n",
|
|
|
|
s->nsector, io->len, s->status);
|
|
|
|
/* data not ready yet, wait for the channel to get restarted */
|
|
|
|
io->processing = false;
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
2015-05-22 21:13:44 +03:00
|
|
|
if (s->io_buffer_size <= 0) {
|
2013-06-30 03:23:45 +04:00
|
|
|
MACIO_DPRINTF("end of transfer\n");
|
2009-08-20 17:22:21 +04:00
|
|
|
s->status = READY_STAT | SEEK_STAT;
|
2009-08-28 18:37:42 +04:00
|
|
|
ide_set_irq(s->bus);
|
2013-06-30 04:54:35 +04:00
|
|
|
m->dma_active = false;
|
2015-05-22 21:13:44 +03:00
|
|
|
goto done;
|
2009-08-20 17:22:21 +04:00
|
|
|
}
|
|
|
|
|
|
|
|
if (io->len == 0) {
|
2015-05-22 21:13:44 +03:00
|
|
|
MACIO_DPRINTF("End of DMA transfer\n");
|
2011-08-25 10:26:01 +04:00
|
|
|
goto done;
|
2009-08-20 17:22:21 +04:00
|
|
|
}
|
|
|
|
|
2015-05-22 21:13:44 +03:00
|
|
|
/* Calculate number of sectors */
|
|
|
|
sector_num = ide_get_sector(s) + (s->io_buffer_index >> 9);
|
|
|
|
nsector = (io->len + 0x1ff) >> 9;
|
|
|
|
remainder = io->len & 0x1ff;
|
2013-06-28 15:30:01 +04:00
|
|
|
|
2015-05-22 21:13:44 +03:00
|
|
|
s->nsector -= nsector;
|
2009-08-20 17:22:21 +04:00
|
|
|
|
2015-05-22 21:13:44 +03:00
|
|
|
MACIO_DPRINTF("nsector: %d remainder: %x\n", nsector, remainder);
|
|
|
|
MACIO_DPRINTF("sector: %"PRIx64" %x\n", sector_num, nsector);
|
2013-06-30 03:23:45 +04:00
|
|
|
|
2011-05-19 12:58:09 +04:00
|
|
|
switch (s->dma_cmd) {
|
|
|
|
case IDE_DMA_READ:
|
2015-05-22 21:13:44 +03:00
|
|
|
pmac_dma_read(s->blk, sector_num, nsector, pmac_ide_transfer_cb, io);
|
2011-05-19 12:58:09 +04:00
|
|
|
break;
|
|
|
|
case IDE_DMA_WRITE:
|
2015-05-22 21:13:44 +03:00
|
|
|
pmac_dma_write(s->blk, sector_num, nsector, pmac_ide_transfer_cb, io);
|
2011-05-19 12:58:09 +04:00
|
|
|
break;
|
2011-05-19 12:58:19 +04:00
|
|
|
case IDE_DMA_TRIM:
|
2015-05-22 21:13:44 +03:00
|
|
|
MACIO_DPRINTF("TRIM command issued!");
|
2011-05-19 12:58:19 +04:00
|
|
|
break;
|
2011-05-19 12:58:09 +04:00
|
|
|
}
|
2014-05-26 12:27:58 +04:00
|
|
|
|
2011-08-25 10:26:01 +04:00
|
|
|
return;
|
2011-11-14 20:50:53 +04:00
|
|
|
|
2011-08-25 10:26:01 +04:00
|
|
|
done:
|
|
|
|
if (s->dma_cmd == IDE_DMA_READ || s->dma_cmd == IDE_DMA_WRITE) {
|
2014-10-07 15:59:18 +04:00
|
|
|
block_acct_done(blk_get_stats(s->blk), &s->acct);
|
2011-08-25 10:26:01 +04:00
|
|
|
}
|
2015-05-22 21:13:44 +03:00
|
|
|
io->dma_end(opaque);
|
2009-08-20 17:22:21 +04:00
|
|
|
}
|
|
|
|
|
|
|
|
static void pmac_ide_transfer(DBDMA_io *io)
|
|
|
|
{
|
|
|
|
MACIOIDEState *m = io->opaque;
|
|
|
|
IDEState *s = idebus_active_if(&m->bus);
|
|
|
|
|
2013-06-30 03:23:45 +04:00
|
|
|
MACIO_DPRINTF("\n");
|
|
|
|
|
2010-05-28 15:32:45 +04:00
|
|
|
if (s->drive_kind == IDE_CD) {
|
2014-10-07 15:59:18 +04:00
|
|
|
block_acct_start(blk_get_stats(s->blk), &s->acct, io->len,
|
2014-09-05 17:46:18 +04:00
|
|
|
BLOCK_ACCT_READ);
|
2015-05-22 21:13:44 +03:00
|
|
|
|
2009-08-20 17:22:21 +04:00
|
|
|
pmac_ide_atapi_transfer_cb(io, 0);
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
2011-08-25 10:26:01 +04:00
|
|
|
switch (s->dma_cmd) {
|
|
|
|
case IDE_DMA_READ:
|
2014-10-07 15:59:18 +04:00
|
|
|
block_acct_start(blk_get_stats(s->blk), &s->acct, io->len,
|
2014-09-05 17:46:18 +04:00
|
|
|
BLOCK_ACCT_READ);
|
2011-08-25 10:26:01 +04:00
|
|
|
break;
|
|
|
|
case IDE_DMA_WRITE:
|
2014-10-07 15:59:18 +04:00
|
|
|
block_acct_start(blk_get_stats(s->blk), &s->acct, io->len,
|
2014-09-05 17:46:18 +04:00
|
|
|
BLOCK_ACCT_WRITE);
|
2011-08-25 10:26:01 +04:00
|
|
|
break;
|
|
|
|
default:
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
2009-08-20 17:22:21 +04:00
|
|
|
pmac_ide_transfer_cb(io, 0);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void pmac_ide_flush(DBDMA_io *io)
|
|
|
|
{
|
|
|
|
MACIOIDEState *m = io->opaque;
|
|
|
|
|
2011-11-30 16:23:43 +04:00
|
|
|
if (m->aiocb) {
|
2014-10-07 15:59:18 +04:00
|
|
|
blk_drain_all();
|
2011-11-30 16:23:43 +04:00
|
|
|
}
|
2009-08-20 17:22:21 +04:00
|
|
|
}
|
|
|
|
|
|
|
|
/* PowerMac IDE memory IO */
|
|
|
|
static void pmac_ide_writeb (void *opaque,
|
2012-10-23 14:30:10 +04:00
|
|
|
hwaddr addr, uint32_t val)
|
2009-08-20 17:22:21 +04:00
|
|
|
{
|
|
|
|
MACIOIDEState *d = opaque;
|
|
|
|
|
|
|
|
addr = (addr & 0xFFF) >> 4;
|
|
|
|
switch (addr) {
|
|
|
|
case 1 ... 7:
|
|
|
|
ide_ioport_write(&d->bus, addr, val);
|
|
|
|
break;
|
|
|
|
case 8:
|
|
|
|
case 22:
|
|
|
|
ide_cmd_write(&d->bus, 0, val);
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2012-10-23 14:30:10 +04:00
|
|
|
static uint32_t pmac_ide_readb (void *opaque,hwaddr addr)
|
2009-08-20 17:22:21 +04:00
|
|
|
{
|
|
|
|
uint8_t retval;
|
|
|
|
MACIOIDEState *d = opaque;
|
|
|
|
|
|
|
|
addr = (addr & 0xFFF) >> 4;
|
|
|
|
switch (addr) {
|
|
|
|
case 1 ... 7:
|
|
|
|
retval = ide_ioport_read(&d->bus, addr);
|
|
|
|
break;
|
|
|
|
case 8:
|
|
|
|
case 22:
|
|
|
|
retval = ide_status_read(&d->bus, 0);
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
retval = 0xFF;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
return retval;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void pmac_ide_writew (void *opaque,
|
2012-10-23 14:30:10 +04:00
|
|
|
hwaddr addr, uint32_t val)
|
2009-08-20 17:22:21 +04:00
|
|
|
{
|
|
|
|
MACIOIDEState *d = opaque;
|
|
|
|
|
|
|
|
addr = (addr & 0xFFF) >> 4;
|
|
|
|
val = bswap16(val);
|
|
|
|
if (addr == 0) {
|
|
|
|
ide_data_writew(&d->bus, 0, val);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2012-10-23 14:30:10 +04:00
|
|
|
static uint32_t pmac_ide_readw (void *opaque,hwaddr addr)
|
2009-08-20 17:22:21 +04:00
|
|
|
{
|
|
|
|
uint16_t retval;
|
|
|
|
MACIOIDEState *d = opaque;
|
|
|
|
|
|
|
|
addr = (addr & 0xFFF) >> 4;
|
|
|
|
if (addr == 0) {
|
|
|
|
retval = ide_data_readw(&d->bus, 0);
|
|
|
|
} else {
|
|
|
|
retval = 0xFFFF;
|
|
|
|
}
|
|
|
|
retval = bswap16(retval);
|
|
|
|
return retval;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void pmac_ide_writel (void *opaque,
|
2012-10-23 14:30:10 +04:00
|
|
|
hwaddr addr, uint32_t val)
|
2009-08-20 17:22:21 +04:00
|
|
|
{
|
|
|
|
MACIOIDEState *d = opaque;
|
|
|
|
|
|
|
|
addr = (addr & 0xFFF) >> 4;
|
|
|
|
val = bswap32(val);
|
|
|
|
if (addr == 0) {
|
|
|
|
ide_data_writel(&d->bus, 0, val);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2012-10-23 14:30:10 +04:00
|
|
|
static uint32_t pmac_ide_readl (void *opaque,hwaddr addr)
|
2009-08-20 17:22:21 +04:00
|
|
|
{
|
|
|
|
uint32_t retval;
|
|
|
|
MACIOIDEState *d = opaque;
|
|
|
|
|
|
|
|
addr = (addr & 0xFFF) >> 4;
|
|
|
|
if (addr == 0) {
|
|
|
|
retval = ide_data_readl(&d->bus, 0);
|
|
|
|
} else {
|
|
|
|
retval = 0xFFFFFFFF;
|
|
|
|
}
|
|
|
|
retval = bswap32(retval);
|
|
|
|
return retval;
|
|
|
|
}
|
|
|
|
|
2012-02-05 14:19:07 +04:00
|
|
|
static const MemoryRegionOps pmac_ide_ops = {
|
2011-08-08 17:09:17 +04:00
|
|
|
.old_mmio = {
|
|
|
|
.write = {
|
|
|
|
pmac_ide_writeb,
|
|
|
|
pmac_ide_writew,
|
|
|
|
pmac_ide_writel,
|
|
|
|
},
|
|
|
|
.read = {
|
|
|
|
pmac_ide_readb,
|
|
|
|
pmac_ide_readw,
|
|
|
|
pmac_ide_readl,
|
|
|
|
},
|
|
|
|
},
|
|
|
|
.endianness = DEVICE_NATIVE_ENDIAN,
|
2009-08-20 17:22:21 +04:00
|
|
|
};
|
|
|
|
|
2009-10-07 21:04:46 +04:00
|
|
|
static const VMStateDescription vmstate_pmac = {
|
|
|
|
.name = "ide",
|
|
|
|
.version_id = 3,
|
|
|
|
.minimum_version_id = 0,
|
2014-04-16 18:01:33 +04:00
|
|
|
.fields = (VMStateField[]) {
|
2009-10-07 21:04:46 +04:00
|
|
|
VMSTATE_IDE_BUS(bus, MACIOIDEState),
|
|
|
|
VMSTATE_IDE_DRIVES(bus.ifs, MACIOIDEState),
|
|
|
|
VMSTATE_END_OF_LIST()
|
2009-08-20 17:22:21 +04:00
|
|
|
}
|
2009-10-07 21:04:46 +04:00
|
|
|
};
|
2009-08-20 17:22:21 +04:00
|
|
|
|
2013-01-24 03:04:01 +04:00
|
|
|
static void macio_ide_reset(DeviceState *dev)
|
2009-08-20 17:22:21 +04:00
|
|
|
{
|
2013-01-24 03:04:01 +04:00
|
|
|
MACIOIDEState *d = MACIO_IDE(dev);
|
2009-08-20 17:22:21 +04:00
|
|
|
|
2009-11-07 17:13:05 +03:00
|
|
|
ide_bus_reset(&d->bus);
|
2009-08-20 17:22:21 +04:00
|
|
|
}
|
|
|
|
|
2013-06-30 04:36:14 +04:00
|
|
|
static int ide_nop_int(IDEDMA *dma, int x)
|
|
|
|
{
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
ide: Correct handling of malformed/short PRDTs
This impacts both BMDMA and AHCI HBA interfaces for IDE.
Currently, we confuse the difference between a PRDT having
"0 bytes" and a PRDT having "0 complete sectors."
When we receive an incomplete sector, inconsistent error checking
leads to an infinite loop wherein the call succeeds, but it
didn't give us enough bytes -- leading us to re-call the
DMA chain over and over again. This leads to, in the BMDMA case,
leaked memory for short PRDTs, and infinite loops and resource
usage in the AHCI case.
The .prepare_buf() callback is reworked to return the number of
bytes that it successfully prepared. 0 is a valid, non-error
answer that means the table was empty and described no bytes.
-1 indicates an error.
Our current implementation uses the io_buffer in IDEState to
ultimately describe the size of a prepared scatter-gather list.
Even though the AHCI PRDT/SGList can be as large as 256GiB, the
AHCI command header limits transactions to just 4GiB. ATA8-ACS3,
however, defines the largest transaction to be an LBA48 command
that transfers 65,536 sectors. With a 512 byte sector size, this
is just 32MiB.
Since our current state structures use the int type to describe
the size of the buffer, and this state is migrated as int32, we
are limited to describing 2GiB buffer sizes unless we change the
migration protocol.
For this reason, this patch begins to unify the assertions in the
IDE pathways that the scatter-gather list provided by either the
AHCI PRDT or the PCI BMDMA PRDs can only describe, at a maximum,
2GiB. This should be resilient enough unless we need a sector
size that exceeds 32KiB.
Further, the likelihood of any guest operating system actually
attempting to transfer this much data in a single operation is
very slim.
To this end, the IDEState variables have been updated to more
explicitly clarify our maximum supported size. Callers to the
prepare_buf callback have been reworked to understand the new
return code, and all versions of the prepare_buf callback have
been adjusted accordingly.
Lastly, the ahci_populate_sglist helper, relied upon by the
AHCI implementation of .prepare_buf() as well as the PCI
implementation of the callback have had overflow assertions
added to help make clear the reasonings behind the various
type changes.
[Added %d -> %"PRId64" fix John sent because off_pos changed from int to
int64_t.
--Stefan]
Signed-off-by: John Snow <jsnow@redhat.com>
Reviewed-by: Paolo Bonzini <pbonzini@redhat.com>
Message-id: 1414785819-26209-4-git-send-email-jsnow@redhat.com
Signed-off-by: Stefan Hajnoczi <stefanha@redhat.com>
2014-10-31 23:03:39 +03:00
|
|
|
static int32_t ide_nop_int32(IDEDMA *dma, int x)
|
|
|
|
{
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2013-06-30 04:36:14 +04:00
|
|
|
static void ide_dbdma_start(IDEDMA *dma, IDEState *s,
|
2014-10-07 15:59:15 +04:00
|
|
|
BlockCompletionFunc *cb)
|
2013-06-30 04:36:14 +04:00
|
|
|
{
|
|
|
|
MACIOIDEState *m = container_of(dma, MACIOIDEState, dma);
|
2015-05-22 21:13:44 +03:00
|
|
|
DBDMAState *dbdma = m->dbdma;
|
|
|
|
DBDMA_io *io;
|
|
|
|
int i;
|
|
|
|
|
2015-05-22 21:13:44 +03:00
|
|
|
s->io_buffer_index = 0;
|
2015-05-22 21:13:44 +03:00
|
|
|
if (s->drive_kind == IDE_CD) {
|
|
|
|
s->io_buffer_size = s->packet_transfer_size;
|
2015-05-22 21:13:44 +03:00
|
|
|
} else {
|
|
|
|
s->io_buffer_size = s->nsector * 0x200;
|
|
|
|
}
|
2015-05-22 21:13:44 +03:00
|
|
|
|
2015-05-22 21:13:44 +03:00
|
|
|
MACIO_DPRINTF("\n\n------------ IDE transfer\n");
|
|
|
|
MACIO_DPRINTF("buffer_size: %x buffer_index: %x\n",
|
|
|
|
s->io_buffer_size, s->io_buffer_index);
|
|
|
|
MACIO_DPRINTF("lba: %x size: %x\n", s->lba, s->io_buffer_size);
|
|
|
|
MACIO_DPRINTF("-------------------------\n");
|
2015-05-22 21:13:44 +03:00
|
|
|
|
2015-05-22 21:13:44 +03:00
|
|
|
for (i = 0; i < DBDMA_CHANNELS; i++) {
|
|
|
|
io = &dbdma->channels[i].io;
|
2015-05-22 21:13:44 +03:00
|
|
|
|
2015-05-22 21:13:44 +03:00
|
|
|
if (io->opaque == m) {
|
|
|
|
io->remainder_len = 0;
|
2015-05-22 21:13:44 +03:00
|
|
|
}
|
|
|
|
}
|
2013-06-30 04:36:14 +04:00
|
|
|
|
|
|
|
MACIO_DPRINTF("\n");
|
2013-06-30 04:54:35 +04:00
|
|
|
m->dma_active = true;
|
2013-06-30 04:36:14 +04:00
|
|
|
DBDMA_kick(m->dbdma);
|
|
|
|
}
|
|
|
|
|
|
|
|
static const IDEDMAOps dbdma_ops = {
|
|
|
|
.start_dma = ide_dbdma_start,
|
ide: Correct handling of malformed/short PRDTs
This impacts both BMDMA and AHCI HBA interfaces for IDE.
Currently, we confuse the difference between a PRDT having
"0 bytes" and a PRDT having "0 complete sectors."
When we receive an incomplete sector, inconsistent error checking
leads to an infinite loop wherein the call succeeds, but it
didn't give us enough bytes -- leading us to re-call the
DMA chain over and over again. This leads to, in the BMDMA case,
leaked memory for short PRDTs, and infinite loops and resource
usage in the AHCI case.
The .prepare_buf() callback is reworked to return the number of
bytes that it successfully prepared. 0 is a valid, non-error
answer that means the table was empty and described no bytes.
-1 indicates an error.
Our current implementation uses the io_buffer in IDEState to
ultimately describe the size of a prepared scatter-gather list.
Even though the AHCI PRDT/SGList can be as large as 256GiB, the
AHCI command header limits transactions to just 4GiB. ATA8-ACS3,
however, defines the largest transaction to be an LBA48 command
that transfers 65,536 sectors. With a 512 byte sector size, this
is just 32MiB.
Since our current state structures use the int type to describe
the size of the buffer, and this state is migrated as int32, we
are limited to describing 2GiB buffer sizes unless we change the
migration protocol.
For this reason, this patch begins to unify the assertions in the
IDE pathways that the scatter-gather list provided by either the
AHCI PRDT or the PCI BMDMA PRDs can only describe, at a maximum,
2GiB. This should be resilient enough unless we need a sector
size that exceeds 32KiB.
Further, the likelihood of any guest operating system actually
attempting to transfer this much data in a single operation is
very slim.
To this end, the IDEState variables have been updated to more
explicitly clarify our maximum supported size. Callers to the
prepare_buf callback have been reworked to understand the new
return code, and all versions of the prepare_buf callback have
been adjusted accordingly.
Lastly, the ahci_populate_sglist helper, relied upon by the
AHCI implementation of .prepare_buf() as well as the PCI
implementation of the callback have had overflow assertions
added to help make clear the reasonings behind the various
type changes.
[Added %d -> %"PRId64" fix John sent because off_pos changed from int to
int64_t.
--Stefan]
Signed-off-by: John Snow <jsnow@redhat.com>
Reviewed-by: Paolo Bonzini <pbonzini@redhat.com>
Message-id: 1414785819-26209-4-git-send-email-jsnow@redhat.com
Signed-off-by: Stefan Hajnoczi <stefanha@redhat.com>
2014-10-31 23:03:39 +03:00
|
|
|
.prepare_buf = ide_nop_int32,
|
2013-06-30 04:36:14 +04:00
|
|
|
.rw_buf = ide_nop_int,
|
|
|
|
};
|
|
|
|
|
2013-01-24 03:04:01 +04:00
|
|
|
static void macio_ide_realizefn(DeviceState *dev, Error **errp)
|
2009-08-20 17:22:21 +04:00
|
|
|
{
|
2013-01-24 03:04:01 +04:00
|
|
|
MACIOIDEState *s = MACIO_IDE(dev);
|
|
|
|
|
|
|
|
ide_init2(&s->bus, s->irq);
|
2013-06-30 04:36:14 +04:00
|
|
|
|
|
|
|
/* Register DMA callbacks */
|
|
|
|
s->dma.ops = &dbdma_ops;
|
|
|
|
s->bus.dma = &s->dma;
|
2013-01-24 03:04:01 +04:00
|
|
|
}
|
|
|
|
|
|
|
|
static void macio_ide_initfn(Object *obj)
|
|
|
|
{
|
|
|
|
SysBusDevice *d = SYS_BUS_DEVICE(obj);
|
|
|
|
MACIOIDEState *s = MACIO_IDE(obj);
|
|
|
|
|
2013-08-23 22:18:50 +04:00
|
|
|
ide_bus_new(&s->bus, sizeof(s->bus), DEVICE(obj), 0, 2);
|
2013-06-07 05:25:08 +04:00
|
|
|
memory_region_init_io(&s->mem, obj, &pmac_ide_ops, s, "pmac-ide", 0x1000);
|
2013-01-24 03:04:01 +04:00
|
|
|
sysbus_init_mmio(d, &s->mem);
|
|
|
|
sysbus_init_irq(d, &s->irq);
|
|
|
|
sysbus_init_irq(d, &s->dma_irq);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void macio_ide_class_init(ObjectClass *oc, void *data)
|
|
|
|
{
|
|
|
|
DeviceClass *dc = DEVICE_CLASS(oc);
|
|
|
|
|
|
|
|
dc->realize = macio_ide_realizefn;
|
|
|
|
dc->reset = macio_ide_reset;
|
|
|
|
dc->vmsd = &vmstate_pmac;
|
|
|
|
}
|
2009-08-20 17:22:21 +04:00
|
|
|
|
2013-01-24 03:04:01 +04:00
|
|
|
static const TypeInfo macio_ide_type_info = {
|
|
|
|
.name = TYPE_MACIO_IDE,
|
|
|
|
.parent = TYPE_SYS_BUS_DEVICE,
|
|
|
|
.instance_size = sizeof(MACIOIDEState),
|
|
|
|
.instance_init = macio_ide_initfn,
|
|
|
|
.class_init = macio_ide_class_init,
|
|
|
|
};
|
2009-08-20 17:22:21 +04:00
|
|
|
|
2013-01-24 03:04:01 +04:00
|
|
|
static void macio_ide_register_types(void)
|
|
|
|
{
|
|
|
|
type_register_static(&macio_ide_type_info);
|
|
|
|
}
|
2009-08-20 17:22:21 +04:00
|
|
|
|
2013-06-24 23:40:50 +04:00
|
|
|
/* hd_table must contain 2 block drivers */
|
2013-01-24 03:04:01 +04:00
|
|
|
void macio_ide_init_drives(MACIOIDEState *s, DriveInfo **hd_table)
|
|
|
|
{
|
|
|
|
int i;
|
2009-08-20 17:22:21 +04:00
|
|
|
|
2013-01-24 03:04:01 +04:00
|
|
|
for (i = 0; i < 2; i++) {
|
|
|
|
if (hd_table[i]) {
|
|
|
|
ide_create_drive(&s->bus, i, hd_table[i]);
|
|
|
|
}
|
|
|
|
}
|
2009-08-20 17:22:21 +04:00
|
|
|
}
|
2013-01-24 03:04:01 +04:00
|
|
|
|
|
|
|
void macio_ide_register_dma(MACIOIDEState *s, void *dbdma, int channel)
|
|
|
|
{
|
2013-06-30 04:36:14 +04:00
|
|
|
s->dbdma = dbdma;
|
2013-01-24 03:04:01 +04:00
|
|
|
DBDMA_register_channel(dbdma, channel, s->dma_irq,
|
|
|
|
pmac_ide_transfer, pmac_ide_flush, s);
|
|
|
|
}
|
|
|
|
|
|
|
|
type_init(macio_ide_register_types)
|