提交 4e1e0051 编写于 作者: C Christoph Hellwig 提交者: Kevin Wolf

ide: allow other dma comands than read and write

Replace the is_read flag with a dma_cmd flag to allow the dma and
restart logic to handler other commands like TRIM.
Signed-off-by: NChristoph Hellwig <hch@lst.de>
Signed-off-by: NKevin Wolf <kwolf@redhat.com>
上级 cb144ccb
...@@ -472,7 +472,7 @@ handle_rw_error: ...@@ -472,7 +472,7 @@ handle_rw_error:
if (ret < 0) { if (ret < 0) {
int op = BM_STATUS_DMA_RETRY; int op = BM_STATUS_DMA_RETRY;
if (s->is_read) if (s->dma_cmd == IDE_DMA_READ)
op |= BM_STATUS_RETRY_READ; op |= BM_STATUS_RETRY_READ;
if (ide_handle_rw_error(s, -ret, op)) { if (ide_handle_rw_error(s, -ret, op)) {
return; return;
...@@ -482,7 +482,7 @@ handle_rw_error: ...@@ -482,7 +482,7 @@ handle_rw_error:
n = s->io_buffer_size >> 9; n = s->io_buffer_size >> 9;
sector_num = ide_get_sector(s); sector_num = ide_get_sector(s);
if (n > 0) { if (n > 0) {
dma_buf_commit(s, s->is_read); dma_buf_commit(s, ide_cmd_is_read(s));
sector_num += n; sector_num += n;
ide_set_sector(s, sector_num); ide_set_sector(s, sector_num);
s->nsector -= n; s->nsector -= n;
...@@ -499,23 +499,26 @@ handle_rw_error: ...@@ -499,23 +499,26 @@ handle_rw_error:
n = s->nsector; n = s->nsector;
s->io_buffer_index = 0; s->io_buffer_index = 0;
s->io_buffer_size = n * 512; s->io_buffer_size = n * 512;
if (s->bus->dma->ops->prepare_buf(s->bus->dma, s->is_read) == 0) { if (s->bus->dma->ops->prepare_buf(s->bus->dma, ide_cmd_is_read(s)) == 0) {
/* The PRDs were too short. Reset the Active bit, but don't raise an /* The PRDs were too short. Reset the Active bit, but don't raise an
* interrupt. */ * interrupt. */
goto eot; goto eot;
} }
#ifdef DEBUG_AIO #ifdef DEBUG_AIO
printf("ide_dma_cb: sector_num=%" PRId64 " n=%d, is_read=%d\n", printf("ide_dma_cb: sector_num=%" PRId64 " n=%d, cmd_cmd=%d\n",
sector_num, n, s->is_read); sector_num, n, s->dma_cmd);
#endif #endif
if (s->is_read) { switch (s->dma_cmd) {
case IDE_DMA_READ:
s->bus->dma->aiocb = dma_bdrv_read(s->bs, &s->sg, sector_num, s->bus->dma->aiocb = dma_bdrv_read(s->bs, &s->sg, sector_num,
ide_dma_cb, s); ide_dma_cb, s);
} else { break;
case IDE_DMA_WRITE:
s->bus->dma->aiocb = dma_bdrv_write(s->bs, &s->sg, sector_num, s->bus->dma->aiocb = dma_bdrv_write(s->bs, &s->sg, sector_num,
ide_dma_cb, s); ide_dma_cb, s);
break;
} }
if (!s->bus->dma->aiocb) { if (!s->bus->dma->aiocb) {
...@@ -528,12 +531,12 @@ eot: ...@@ -528,12 +531,12 @@ eot:
ide_set_inactive(s); ide_set_inactive(s);
} }
static void ide_sector_start_dma(IDEState *s, int is_read) static void ide_sector_start_dma(IDEState *s, enum ide_dma_cmd dma_cmd)
{ {
s->status = READY_STAT | SEEK_STAT | DRQ_STAT | BUSY_STAT; s->status = READY_STAT | SEEK_STAT | DRQ_STAT | BUSY_STAT;
s->io_buffer_index = 0; s->io_buffer_index = 0;
s->io_buffer_size = 0; s->io_buffer_size = 0;
s->is_read = is_read; s->dma_cmd = dma_cmd;
s->bus->dma->ops->start_dma(s->bus->dma, s, ide_dma_cb); s->bus->dma->ops->start_dma(s->bus->dma, s, ide_dma_cb);
} }
...@@ -916,7 +919,7 @@ void ide_exec_cmd(IDEBus *bus, uint32_t val) ...@@ -916,7 +919,7 @@ void ide_exec_cmd(IDEBus *bus, uint32_t val)
if (!s->bs) if (!s->bs)
goto abort_cmd; goto abort_cmd;
ide_cmd_lba48_transform(s, lba48); ide_cmd_lba48_transform(s, lba48);
ide_sector_start_dma(s, 1); ide_sector_start_dma(s, IDE_DMA_READ);
break; break;
case WIN_WRITEDMA_EXT: case WIN_WRITEDMA_EXT:
lba48 = 1; lba48 = 1;
...@@ -925,7 +928,7 @@ void ide_exec_cmd(IDEBus *bus, uint32_t val) ...@@ -925,7 +928,7 @@ void ide_exec_cmd(IDEBus *bus, uint32_t val)
if (!s->bs) if (!s->bs)
goto abort_cmd; goto abort_cmd;
ide_cmd_lba48_transform(s, lba48); ide_cmd_lba48_transform(s, lba48);
ide_sector_start_dma(s, 0); ide_sector_start_dma(s, IDE_DMA_WRITE);
s->media_changed = 1; s->media_changed = 1;
break; break;
case WIN_READ_NATIVE_MAX_EXT: case WIN_READ_NATIVE_MAX_EXT:
......
...@@ -379,6 +379,14 @@ struct unreported_events { ...@@ -379,6 +379,14 @@ struct unreported_events {
bool new_media; bool new_media;
}; };
enum ide_dma_cmd {
IDE_DMA_READ,
IDE_DMA_WRITE,
};
#define ide_cmd_is_read(s) \
((s)->dma_cmd == IDE_DMA_READ)
/* NOTE: IDEState represents in fact one drive */ /* NOTE: IDEState represents in fact one drive */
struct IDEState { struct IDEState {
IDEBus *bus; IDEBus *bus;
...@@ -446,7 +454,7 @@ struct IDEState { ...@@ -446,7 +454,7 @@ struct IDEState {
uint32_t mdata_size; uint32_t mdata_size;
uint8_t *mdata_storage; uint8_t *mdata_storage;
int media_changed; int media_changed;
int is_read; enum ide_dma_cmd dma_cmd;
/* SMART */ /* SMART */
uint8_t smart_enabled; uint8_t smart_enabled;
uint8_t smart_autosave; uint8_t smart_autosave;
......
...@@ -145,12 +145,17 @@ static void pmac_ide_transfer_cb(void *opaque, int ret) ...@@ -145,12 +145,17 @@ static void pmac_ide_transfer_cb(void *opaque, int ret)
io->addr += io->len; io->addr += io->len;
io->len = 0; io->len = 0;
if (s->is_read) switch (s->dma_cmd) {
case IDE_DMA_READ:
m->aiocb = dma_bdrv_read(s->bs, &s->sg, sector_num, m->aiocb = dma_bdrv_read(s->bs, &s->sg, sector_num,
pmac_ide_transfer_cb, io); pmac_ide_transfer_cb, io);
else break;
case IDE_DMA_WRITE:
m->aiocb = dma_bdrv_write(s->bs, &s->sg, sector_num, m->aiocb = dma_bdrv_write(s->bs, &s->sg, sector_num,
pmac_ide_transfer_cb, io); pmac_ide_transfer_cb, io);
break;
}
if (!m->aiocb) if (!m->aiocb)
pmac_ide_transfer_cb(io, -1); pmac_ide_transfer_cb(io, -1);
} }
......
...@@ -169,7 +169,7 @@ static int bmdma_set_inactive(IDEDMA *dma) ...@@ -169,7 +169,7 @@ static int bmdma_set_inactive(IDEDMA *dma)
return 0; return 0;
} }
static void bmdma_restart_dma(BMDMAState *bm, int is_read) static void bmdma_restart_dma(BMDMAState *bm, enum ide_dma_cmd dma_cmd)
{ {
IDEState *s = bmdma_active_if(bm); IDEState *s = bmdma_active_if(bm);
...@@ -177,7 +177,7 @@ static void bmdma_restart_dma(BMDMAState *bm, int is_read) ...@@ -177,7 +177,7 @@ static void bmdma_restart_dma(BMDMAState *bm, int is_read)
s->io_buffer_index = 0; s->io_buffer_index = 0;
s->io_buffer_size = 0; s->io_buffer_size = 0;
s->nsector = bm->nsector; s->nsector = bm->nsector;
s->is_read = is_read; s->dma_cmd = dma_cmd;
bm->cur_addr = bm->addr; bm->cur_addr = bm->addr;
bm->dma_cb = ide_dma_cb; bm->dma_cb = ide_dma_cb;
bmdma_start_dma(&bm->dma, s, bm->dma_cb); bmdma_start_dma(&bm->dma, s, bm->dma_cb);
...@@ -201,7 +201,7 @@ static void bmdma_restart_bh(void *opaque) ...@@ -201,7 +201,7 @@ static void bmdma_restart_bh(void *opaque)
if (bus->error_status & BM_STATUS_DMA_RETRY) { if (bus->error_status & BM_STATUS_DMA_RETRY) {
bus->error_status &= ~(BM_STATUS_DMA_RETRY | BM_STATUS_RETRY_READ); bus->error_status &= ~(BM_STATUS_DMA_RETRY | BM_STATUS_RETRY_READ);
bmdma_restart_dma(bm, is_read); bmdma_restart_dma(bm, is_read ? IDE_DMA_READ : IDE_DMA_WRITE);
} else if (bus->error_status & BM_STATUS_PIO_RETRY) { } else if (bus->error_status & BM_STATUS_PIO_RETRY) {
bus->error_status &= ~(BM_STATUS_PIO_RETRY | BM_STATUS_RETRY_READ); bus->error_status &= ~(BM_STATUS_PIO_RETRY | BM_STATUS_RETRY_READ);
if (is_read) { if (is_read) {
......
Markdown is supported
0% .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑!
想要评论请 注册