Lines Matching +full:dma +full:- +full:requests
2 * QEMU IDE disk and CD/DVD-ROM Emulator
30 #include "qemu/error-report.h"
31 #include "qemu/main-loop.h"
33 #include "qemu/hw-version.h"
37 #include "system/dma.h"
39 #include "system/block-backend.h"
44 #include "ide-internal.h"
63 /* airflow-temperature-celsius */
68 [IDE_DMA_READ] = "DMA READ",
69 [IDE_DMA_WRITE] = "DMA WRITE",
70 [IDE_DMA_TRIM] = "DMA TRIM",
71 [IDE_DMA_ATAPI] = "DMA ATAPI"
79 return "DMA UNKNOWN CMD"; in IDE_DMA_CMD_str()
115 uint16_t *p = (uint16_t *)s->identify_data; in ide_identify_size()
116 int64_t nb_sectors_lba28 = s->nb_sectors; in ide_identify_size()
118 nb_sectors_lba28 = (1 << 28) - 1; in ide_identify_size()
122 put_le16(p + 100, s->nb_sectors); in ide_identify_size()
123 put_le16(p + 101, s->nb_sectors >> 16); in ide_identify_size()
124 put_le16(p + 102, s->nb_sectors >> 32); in ide_identify_size()
125 put_le16(p + 103, s->nb_sectors >> 48); in ide_identify_size()
132 IDEDevice *dev = s->unit ? s->bus->slave : s->bus->master; in ide_identify()
134 p = (uint16_t *)s->identify_data; in ide_identify()
135 if (s->identify_set) { in ide_identify()
138 memset(p, 0, sizeof(s->identify_data)); in ide_identify()
141 put_le16(p + 1, s->cylinders); in ide_identify()
142 put_le16(p + 3, s->heads); in ide_identify()
143 put_le16(p + 4, 512 * s->sectors); /* XXX: retired, remove ? */ in ide_identify()
145 put_le16(p + 6, s->sectors); in ide_identify()
146 padstr((char *)(p + 10), s->drive_serial_str, 20); /* serial number */ in ide_identify()
150 padstr((char *)(p + 23), s->version, 8); /* firmware version */ in ide_identify()
151 padstr((char *)(p + 27), s->drive_model_str, 40); /* model */ in ide_identify()
156 put_le16(p + 49, (1 << 11) | (1 << 9) | (1 << 8)); /* DMA and LBA supported */ in ide_identify()
158 put_le16(p + 52, 0x200); /* DMA transfer cycle */ in ide_identify()
159 put_le16(p + 53, 1 | (1 << 1) | (1 << 2)); /* words 54-58,64-70,88 are valid */ in ide_identify()
160 put_le16(p + 54, s->cylinders); in ide_identify()
161 put_le16(p + 55, s->heads); in ide_identify()
162 put_le16(p + 56, s->sectors); in ide_identify()
163 oldsize = s->cylinders * s->heads * s->sectors; in ide_identify()
166 if (s->mult_sectors) in ide_identify()
167 put_le16(p + 59, 0x100 | s->mult_sectors); in ide_identify()
168 /* *(p + 60) := nb_sectors -- see ide_identify_size */ in ide_identify()
169 /* *(p + 61) := nb_sectors >> 16 -- see ide_identify_size */ in ide_identify()
170 put_le16(p + 62, 0x07); /* single word dma0-2 supported */ in ide_identify()
171 put_le16(p + 63, 0x07); /* mdma0-2 supported */ in ide_identify()
172 put_le16(p + 64, 0x03); /* pio3-4 supported */ in ide_identify()
177 if (dev && dev->conf.discard_granularity) { in ide_identify()
181 if (s->ncq_queues) { in ide_identify()
182 put_le16(p + 75, s->ncq_queues - 1); in ide_identify()
187 put_le16(p + 80, 0xf0); /* ata3 -> ata6 supported */ in ide_identify()
194 if (s->wwn) { in ide_identify()
200 if (blk_enable_write_cache(s->blk)) { in ide_identify()
208 if (s->wwn) { in ide_identify()
215 /* *(p + 100) := nb_sectors -- see ide_identify_size */ in ide_identify()
216 /* *(p + 101) := nb_sectors >> 16 -- see ide_identify_size */ in ide_identify()
217 /* *(p + 102) := nb_sectors >> 32 -- see ide_identify_size */ in ide_identify()
218 /* *(p + 103) := nb_sectors >> 48 -- see ide_identify_size */ in ide_identify()
220 if (dev && dev->conf.physical_block_size) in ide_identify()
221 put_le16(p + 106, 0x6000 | get_physical_block_exp(&dev->conf)); in ide_identify()
222 if (s->wwn) { in ide_identify()
223 /* LE 16-bit words 111-108 contain 64-bit World Wide Name */ in ide_identify()
224 put_le16(p + 108, s->wwn >> 48); in ide_identify()
225 put_le16(p + 109, s->wwn >> 32); in ide_identify()
226 put_le16(p + 110, s->wwn >> 16); in ide_identify()
227 put_le16(p + 111, s->wwn); in ide_identify()
229 if (dev && dev->conf.discard_granularity) { in ide_identify()
233 put_le16(p + 217, dev->rotation_rate); /* Nominal media rotation rate */ in ide_identify()
237 s->identify_set = 1; in ide_identify()
240 memcpy(s->io_buffer, p, sizeof(s->identify_data)); in ide_identify()
247 p = (uint16_t *)s->identify_data; in ide_atapi_identify()
248 if (s->identify_set) { in ide_atapi_identify()
251 memset(p, 0, sizeof(s->identify_data)); in ide_atapi_identify()
255 padstr((char *)(p + 10), s->drive_serial_str, 20); /* serial number */ in ide_atapi_identify()
259 padstr((char *)(p + 23), s->version, 8); /* firmware version */ in ide_atapi_identify()
260 padstr((char *)(p + 27), s->drive_model_str, 40); /* model */ in ide_atapi_identify()
263 put_le16(p + 49, 1 << 9 | 1 << 8); /* DMA and LBA supported */ in ide_atapi_identify()
264 put_le16(p + 53, 7); /* words 64-70, 54-58, 88 valid */ in ide_atapi_identify()
265 put_le16(p + 62, 7); /* single word dma0-2 supported */ in ide_atapi_identify()
266 put_le16(p + 63, 7); /* mdma0-2 supported */ in ide_atapi_identify()
268 put_le16(p + 49, 1 << 9); /* LBA supported, no DMA */ in ide_atapi_identify()
269 put_le16(p + 53, 3); /* words 64-70, 54-58 valid */ in ide_atapi_identify()
270 put_le16(p + 63, 0x103); /* DMA modes XXX: may be incorrect */ in ide_atapi_identify()
272 put_le16(p + 64, 3); /* pio3-4 supported */ in ide_atapi_identify()
273 put_le16(p + 65, 0xb4); /* minimum DMA multiword tx cycle time */ in ide_atapi_identify()
274 put_le16(p + 66, 0xb4); /* recommended DMA multiword tx cycle time */ in ide_atapi_identify()
281 if (s->ncq_queues) { in ide_atapi_identify()
282 put_le16(p + 75, s->ncq_queues - 1); in ide_atapi_identify()
287 put_le16(p + 80, 0x1e); /* support up to ATA/ATAPI-4 */ in ide_atapi_identify()
288 if (s->wwn) { in ide_atapi_identify()
289 put_le16(p + 84, (1 << 8)); /* supports WWN for words 108-111 */ in ide_atapi_identify()
297 if (s->wwn) { in ide_atapi_identify()
298 /* LE 16-bit words 111-108 contain 64-bit World Wide Name */ in ide_atapi_identify()
299 put_le16(p + 108, s->wwn >> 48); in ide_atapi_identify()
300 put_le16(p + 109, s->wwn >> 32); in ide_atapi_identify()
301 put_le16(p + 110, s->wwn >> 16); in ide_atapi_identify()
302 put_le16(p + 111, s->wwn); in ide_atapi_identify()
305 s->identify_set = 1; in ide_atapi_identify()
308 memcpy(s->io_buffer, p, sizeof(s->identify_data)); in ide_atapi_identify()
313 uint16_t *p = (uint16_t *)s->identify_data; in ide_cfata_identify_size()
314 put_le16(p + 7, s->nb_sectors >> 16); /* Sectors per card */ in ide_cfata_identify_size()
315 put_le16(p + 8, s->nb_sectors); /* Sectors per card */ in ide_cfata_identify_size()
316 put_le16(p + 60, s->nb_sectors); /* Total LBA sectors */ in ide_cfata_identify_size()
317 put_le16(p + 61, s->nb_sectors >> 16); /* Total LBA sectors */ in ide_cfata_identify_size()
325 p = (uint16_t *)s->identify_data; in ide_cfata_identify()
326 if (s->identify_set) { in ide_cfata_identify()
329 memset(p, 0, sizeof(s->identify_data)); in ide_cfata_identify()
331 cur_sec = s->cylinders * s->heads * s->sectors; in ide_cfata_identify()
334 put_le16(p + 1, s->cylinders); /* Default cylinders */ in ide_cfata_identify()
335 put_le16(p + 3, s->heads); /* Default heads */ in ide_cfata_identify()
336 put_le16(p + 6, s->sectors); /* Default sectors per track */ in ide_cfata_identify()
337 /* *(p + 7) := nb_sectors >> 16 -- see ide_cfata_identify_size */ in ide_cfata_identify()
338 /* *(p + 8) := nb_sectors -- see ide_cfata_identify_size */ in ide_cfata_identify()
339 padstr((char *)(p + 10), s->drive_serial_str, 20); /* serial number */ in ide_cfata_identify()
341 padstr((char *) (p + 23), s->version, 8); /* Firmware Revision */ in ide_cfata_identify()
342 padstr((char *) (p + 27), s->drive_model_str, 40);/* Model number */ in ide_cfata_identify()
350 put_le16(p + 52, 0x0001); /* DMA cycle timing mode */ in ide_cfata_identify()
352 put_le16(p + 54, s->cylinders); /* Current cylinders */ in ide_cfata_identify()
353 put_le16(p + 55, s->heads); /* Current heads */ in ide_cfata_identify()
354 put_le16(p + 56, s->sectors); /* Current sectors */ in ide_cfata_identify()
357 if (s->mult_sectors) /* Multiple sector setting */ in ide_cfata_identify()
358 put_le16(p + 59, 0x100 | s->mult_sectors); in ide_cfata_identify()
359 /* *(p + 60) := nb_sectors -- see ide_cfata_identify_size */ in ide_cfata_identify()
360 /* *(p + 61) := nb_sectors >> 16 -- see ide_cfata_identify_size */ in ide_cfata_identify()
361 put_le16(p + 63, 0x0203); /* Multiword DMA capability */ in ide_cfata_identify()
363 put_le16(p + 65, 0x0096); /* Min. Multiword DMA cycle */ in ide_cfata_identify()
364 put_le16(p + 66, 0x0096); /* Rec. Multiword DMA cycle */ in ide_cfata_identify()
381 s->identify_set = 1; in ide_cfata_identify()
384 memcpy(s->io_buffer, p, sizeof(s->identify_data)); in ide_cfata_identify()
389 s->select &= ~(ATA_DEV_HS); /* clear head */ in ide_set_signature()
391 s->nsector = 1; in ide_set_signature()
392 s->sector = 1; in ide_set_signature()
393 if (s->drive_kind == IDE_CD) { in ide_set_signature()
394 s->lcyl = 0x14; in ide_set_signature()
395 s->hcyl = 0xeb; in ide_set_signature()
396 } else if (s->blk) { in ide_set_signature()
397 s->lcyl = 0; in ide_set_signature()
398 s->hcyl = 0; in ide_set_signature()
400 s->lcyl = 0xff; in ide_set_signature()
401 s->hcyl = 0xff; in ide_set_signature()
410 blk_get_geometry(s->blk, &total_sectors); in ide_sect_range_ok()
411 if (sector > total_sectors || nb_sectors > total_sectors - sector) { in ide_sect_range_ok()
432 iocb->j = iocb->qiov->niov - 1; in trim_aio_cancel()
433 iocb->i = (iocb->qiov->iov[iocb->j].iov_len / 8) - 1; in trim_aio_cancel()
435 iocb->ret = -ECANCELED; in trim_aio_cancel()
437 if (iocb->aiocb) { in trim_aio_cancel()
438 blk_aio_cancel_async(iocb->aiocb); in trim_aio_cancel()
439 iocb->aiocb = NULL; in trim_aio_cancel()
451 BlockBackend *blk = iocb->s->blk; in ide_trim_bh_cb()
453 iocb->common.cb(iocb->common.opaque, iocb->ret); in ide_trim_bh_cb()
455 qemu_bh_delete(iocb->bh); in ide_trim_bh_cb()
456 iocb->bh = NULL; in ide_trim_bh_cb()
466 IDEState *s = iocb->s; in ide_issue_trim_cb()
468 if (iocb->i >= 0) { in ide_issue_trim_cb()
470 block_acct_done(blk_get_stats(s->blk), &s->acct); in ide_issue_trim_cb()
472 block_acct_failed(blk_get_stats(s->blk), &s->acct); in ide_issue_trim_cb()
477 while (iocb->j < iocb->qiov->niov) { in ide_issue_trim_cb()
478 int j = iocb->j; in ide_issue_trim_cb()
479 while (++iocb->i < iocb->qiov->iov[j].iov_len / 8) { in ide_issue_trim_cb()
480 int i = iocb->i; in ide_issue_trim_cb()
481 uint64_t *buffer = iocb->qiov->iov[j].iov_base; in ide_issue_trim_cb()
483 /* 6-byte LBA + 2-byte range per entry */ in ide_issue_trim_cb()
493 block_acct_invalid(blk_get_stats(s->blk), BLOCK_ACCT_UNMAP); in ide_issue_trim_cb()
494 iocb->ret = -EINVAL; in ide_issue_trim_cb()
498 block_acct_start(blk_get_stats(s->blk), &s->acct, in ide_issue_trim_cb()
502 iocb->aiocb = blk_aio_pdiscard(s->blk, in ide_issue_trim_cb()
509 iocb->j++; in ide_issue_trim_cb()
510 iocb->i = -1; in ide_issue_trim_cb()
513 iocb->ret = ret; in ide_issue_trim_cb()
517 iocb->aiocb = NULL; in ide_issue_trim_cb()
518 if (iocb->bh) { in ide_issue_trim_cb()
519 replay_bh_schedule_event(iocb->bh); in ide_issue_trim_cb()
528 IDEDevice *dev = s->unit ? s->bus->slave : s->bus->master; in ide_issue_trim()
532 blk_inc_in_flight(s->blk); in ide_issue_trim()
534 iocb = blk_aio_get(&trim_aiocb_info, s->blk, cb, cb_opaque); in ide_issue_trim()
535 iocb->s = s; in ide_issue_trim()
536 iocb->bh = qemu_bh_new_guarded(ide_trim_bh_cb, iocb, in ide_issue_trim()
537 &DEVICE(dev)->mem_reentrancy_guard); in ide_issue_trim()
538 iocb->ret = 0; in ide_issue_trim()
539 iocb->qiov = qiov; in ide_issue_trim()
540 iocb->i = -1; in ide_issue_trim()
541 iocb->j = 0; in ide_issue_trim()
543 return &iocb->common; in ide_issue_trim()
548 s->status = READY_STAT | ERR_STAT; in ide_abort_command()
549 s->error = ABRT_ERR; in ide_abort_command()
555 s->bus->retry_unit = s->unit; in ide_set_retry()
556 s->bus->retry_sector_num = ide_get_sector(s); in ide_set_retry()
557 s->bus->retry_nsector = s->nsector; in ide_set_retry()
562 s->bus->retry_unit = -1; in ide_clear_retry()
563 s->bus->retry_sector_num = 0; in ide_clear_retry()
564 s->bus->retry_nsector = 0; in ide_clear_retry()
571 s->data_ptr = buf; in ide_transfer_start_norecurse()
572 s->data_end = buf + size; in ide_transfer_start_norecurse()
574 if (!(s->status & ERR_STAT)) { in ide_transfer_start_norecurse()
575 s->status |= DRQ_STAT; in ide_transfer_start_norecurse()
577 if (!s->bus->dma->ops->pio_transfer) { in ide_transfer_start_norecurse()
578 s->end_transfer_func = end_transfer_func; in ide_transfer_start_norecurse()
581 s->bus->dma->ops->pio_transfer(s->bus->dma); in ide_transfer_start_norecurse()
595 if (s->bus->dma->ops->cmd_done) { in ide_cmd_done()
596 s->bus->dma->ops->cmd_done(s->bus->dma); in ide_cmd_done()
602 s->end_transfer_func = ide_transfer_stop; in ide_transfer_halt()
603 s->data_ptr = s->io_buffer; in ide_transfer_halt()
604 s->data_end = s->io_buffer; in ide_transfer_halt()
605 s->status &= ~DRQ_STAT; in ide_transfer_halt()
617 if (s->select & (ATA_DEV_LBA)) { in ide_get_sector()
618 if (s->lba48) { in ide_get_sector()
619 sector_num = ((int64_t)s->hob_hcyl << 40) | in ide_get_sector()
620 ((int64_t) s->hob_lcyl << 32) | in ide_get_sector()
621 ((int64_t) s->hob_sector << 24) | in ide_get_sector()
622 ((int64_t) s->hcyl << 16) | in ide_get_sector()
623 ((int64_t) s->lcyl << 8) | s->sector; in ide_get_sector()
626 sector_num = ((s->select & (ATA_DEV_LBA_MSB)) << 24) | in ide_get_sector()
627 (s->hcyl << 16) | (s->lcyl << 8) | s->sector; in ide_get_sector()
631 sector_num = ((s->hcyl << 8) | s->lcyl) * s->heads * s->sectors + in ide_get_sector()
632 (s->select & (ATA_DEV_HS)) * s->sectors + (s->sector - 1); in ide_get_sector()
641 if (s->select & (ATA_DEV_LBA)) { in ide_set_sector()
642 if (s->lba48) { in ide_set_sector()
643 s->sector = sector_num; in ide_set_sector()
644 s->lcyl = sector_num >> 8; in ide_set_sector()
645 s->hcyl = sector_num >> 16; in ide_set_sector()
646 s->hob_sector = sector_num >> 24; in ide_set_sector()
647 s->hob_lcyl = sector_num >> 32; in ide_set_sector()
648 s->hob_hcyl = sector_num >> 40; in ide_set_sector()
651 s->select = (s->select & ~(ATA_DEV_LBA_MSB)) | in ide_set_sector()
653 s->hcyl = (sector_num >> 16); in ide_set_sector()
654 s->lcyl = (sector_num >> 8); in ide_set_sector()
655 s->sector = (sector_num); in ide_set_sector()
659 cyl = sector_num / (s->heads * s->sectors); in ide_set_sector()
660 r = sector_num % (s->heads * s->sectors); in ide_set_sector()
661 s->hcyl = cyl >> 8; in ide_set_sector()
662 s->lcyl = cyl; in ide_set_sector()
663 s->select = (s->select & ~(ATA_DEV_HS)) | in ide_set_sector()
664 ((r / s->sectors) & (ATA_DEV_HS)); in ide_set_sector()
665 s->sector = (r % s->sectors) + 1; in ide_set_sector()
671 ide_bus_set_irq(s->bus); in ide_rw_error()
677 if (!req->orphaned) { in ide_buffered_readv_cb()
679 assert(req->qiov.size == req->original_qiov->size); in ide_buffered_readv_cb()
680 qemu_iovec_from_buf(req->original_qiov, 0, in ide_buffered_readv_cb()
681 req->qiov.local_iov.iov_base, in ide_buffered_readv_cb()
682 req->original_qiov->size); in ide_buffered_readv_cb()
684 req->original_cb(req->original_opaque, ret); in ide_buffered_readv_cb()
687 qemu_vfree(qemu_iovec_buf(&req->qiov)); in ide_buffered_readv_cb()
701 QLIST_FOREACH(req, &s->buffered_requests, list) { in ide_buffered_readv()
705 return blk_abort_aio_request(s->blk, cb, opaque, -EIO); in ide_buffered_readv()
709 req->original_qiov = iov; in ide_buffered_readv()
710 req->original_cb = cb; in ide_buffered_readv()
711 req->original_opaque = opaque; in ide_buffered_readv()
712 qemu_iovec_init_buf(&req->qiov, blk_blockalign(s->blk, iov->size), in ide_buffered_readv()
713 iov->size); in ide_buffered_readv()
715 aioreq = blk_aio_preadv(s->blk, sector_num << BDRV_SECTOR_BITS, in ide_buffered_readv()
716 &req->qiov, 0, ide_buffered_readv_cb, req); in ide_buffered_readv()
718 QLIST_INSERT_HEAD(&s->buffered_requests, req, list); in ide_buffered_readv()
723 * Cancel all pending DMA requests.
724 * Any buffered DMA requests are instantly canceled,
725 * but any pending unbuffered DMA requests must be waited on.
731 /* First invoke the callbacks of all buffered requests in ide_cancel_dma_sync()
732 * and flag those requests as orphaned. Ideally there in ide_cancel_dma_sync()
733 * are no unbuffered (Scatter Gather DMA Requests or in ide_cancel_dma_sync()
734 * write requests) pending and we can avoid to drain. */ in ide_cancel_dma_sync()
735 QLIST_FOREACH(req, &s->buffered_requests, list) { in ide_cancel_dma_sync()
736 if (!req->orphaned) { in ide_cancel_dma_sync()
737 trace_ide_cancel_dma_sync_buffered(req->original_cb, req); in ide_cancel_dma_sync()
738 req->original_cb(req->original_opaque, -ECANCELED); in ide_cancel_dma_sync()
740 req->orphaned = true; in ide_cancel_dma_sync()
744 * We can't cancel Scatter Gather DMA in the middle of the in ide_cancel_dma_sync()
745 * operation or a partial (not full) DMA transfer would reach in ide_cancel_dma_sync()
747 * like if the DMA was completed by the time the guest trying in ide_cancel_dma_sync()
748 * to cancel dma with bmdma_cmd_writeb with BM_CMD_START not in ide_cancel_dma_sync()
752 * whole DMA operation will be submitted to disk with a single in ide_cancel_dma_sync()
755 if (s->bus->dma->aiocb) { in ide_cancel_dma_sync()
757 blk_drain(s->blk); in ide_cancel_dma_sync()
758 assert(s->bus->dma->aiocb == NULL); in ide_cancel_dma_sync()
769 s->pio_aiocb = NULL; in ide_sector_read_cb()
770 s->status &= ~BUSY_STAT; in ide_sector_read_cb()
773 if (ide_handle_rw_error(s, -ret, IDE_RETRY_PIO | in ide_sector_read_cb()
779 block_acct_done(blk_get_stats(s->blk), &s->acct); in ide_sector_read_cb()
781 n = s->nsector; in ide_sector_read_cb()
782 if (n > s->req_nb_sectors) { in ide_sector_read_cb()
783 n = s->req_nb_sectors; in ide_sector_read_cb()
787 s->nsector -= n; in ide_sector_read_cb()
789 ide_transfer_start(s, s->io_buffer, n * BDRV_SECTOR_SIZE, ide_sector_read); in ide_sector_read_cb()
790 ide_bus_set_irq(s->bus); in ide_sector_read_cb()
798 s->status = READY_STAT | SEEK_STAT; in ide_sector_read()
799 s->error = 0; /* not needed by IDE spec, but needed by Windows */ in ide_sector_read()
801 n = s->nsector; in ide_sector_read()
808 s->status |= BUSY_STAT; in ide_sector_read()
810 if (n > s->req_nb_sectors) { in ide_sector_read()
811 n = s->req_nb_sectors; in ide_sector_read()
818 block_acct_invalid(blk_get_stats(s->blk), BLOCK_ACCT_READ); in ide_sector_read()
822 qemu_iovec_init_buf(&s->qiov, s->io_buffer, n * BDRV_SECTOR_SIZE); in ide_sector_read()
824 block_acct_start(blk_get_stats(s->blk), &s->acct, in ide_sector_read()
826 s->pio_aiocb = ide_buffered_readv(s, sector_num, &s->qiov, n, in ide_sector_read()
832 if (s->bus->dma->ops->commit_buf) { in dma_buf_commit()
833 s->bus->dma->ops->commit_buf(s->bus->dma, tx_bytes); in dma_buf_commit()
835 s->io_buffer_offset += tx_bytes; in dma_buf_commit()
836 qemu_sglist_destroy(&s->sg); in dma_buf_commit()
841 s->bus->dma->aiocb = NULL; in ide_set_inactive()
843 if (s->bus->dma->ops->set_inactive) { in ide_set_inactive()
844 s->bus->dma->ops->set_inactive(s->bus->dma, more); in ide_set_inactive()
854 ide_bus_set_irq(s->bus); in ide_dma_error()
860 BlockErrorAction action = blk_get_error_action(s->blk, is_read, error); in ide_handle_rw_error()
863 assert(s->bus->retry_unit == s->unit); in ide_handle_rw_error()
864 s->bus->error_status = op; in ide_handle_rw_error()
866 block_acct_failed(blk_get_stats(s->blk), &s->acct); in ide_handle_rw_error()
870 ide_atapi_io_error(s, -error); in ide_handle_rw_error()
875 blk_error_action(s->blk, action, is_read, error); in ide_handle_rw_error()
888 if (ret == -EINVAL) { in ide_dma_cb()
894 if (ide_handle_rw_error(s, -ret, ide_dma_cmd_to_retry(s->dma_cmd))) { in ide_dma_cb()
895 s->bus->dma->aiocb = NULL; in ide_dma_cb()
901 if (s->io_buffer_size > s->nsector * 512) { in ide_dma_cb()
906 n = s->nsector; in ide_dma_cb()
909 n = s->io_buffer_size >> 9; in ide_dma_cb()
914 assert(n * 512 == s->sg.size); in ide_dma_cb()
915 dma_buf_commit(s, s->sg.size); in ide_dma_cb()
918 s->nsector -= n; in ide_dma_cb()
922 if (s->nsector == 0) { in ide_dma_cb()
923 s->status = READY_STAT | SEEK_STAT; in ide_dma_cb()
924 ide_bus_set_irq(s->bus); in ide_dma_cb()
929 n = s->nsector; in ide_dma_cb()
930 s->io_buffer_index = 0; in ide_dma_cb()
931 s->io_buffer_size = n * 512; in ide_dma_cb()
932 prep_size = s->bus->dma->ops->prepare_buf(s->bus->dma, s->io_buffer_size); in ide_dma_cb()
938 * s->io_buffer_size stores the number of bytes described by the PRDs. in ide_dma_cb()
946 s->status = READY_STAT | SEEK_STAT; in ide_dma_cb()
951 trace_ide_dma_cb(s, sector_num, n, IDE_DMA_CMD_str(s->dma_cmd)); in ide_dma_cb()
953 if ((s->dma_cmd == IDE_DMA_READ || s->dma_cmd == IDE_DMA_WRITE) && in ide_dma_cb()
956 block_acct_invalid(blk_get_stats(s->blk), s->acct.type); in ide_dma_cb()
961 switch (s->dma_cmd) { in ide_dma_cb()
963 s->bus->dma->aiocb = dma_blk_read(s->blk, &s->sg, offset, in ide_dma_cb()
967 s->bus->dma->aiocb = dma_blk_write(s->blk, &s->sg, offset, in ide_dma_cb()
971 s->bus->dma->aiocb = dma_blk_io(&s->sg, offset, BDRV_SECTOR_SIZE, in ide_dma_cb()
981 if (s->dma_cmd == IDE_DMA_READ || s->dma_cmd == IDE_DMA_WRITE) { in ide_dma_cb()
982 block_acct_done(blk_get_stats(s->blk), &s->acct); in ide_dma_cb()
989 s->status = READY_STAT | SEEK_STAT | DRQ_STAT; in ide_sector_start_dma()
990 s->io_buffer_size = 0; in ide_sector_start_dma()
991 s->dma_cmd = dma_cmd; in ide_sector_start_dma()
995 block_acct_start(blk_get_stats(s->blk), &s->acct, in ide_sector_start_dma()
996 s->nsector * BDRV_SECTOR_SIZE, BLOCK_ACCT_READ); in ide_sector_start_dma()
999 block_acct_start(blk_get_stats(s->blk), &s->acct, in ide_sector_start_dma()
1000 s->nsector * BDRV_SECTOR_SIZE, BLOCK_ACCT_WRITE); in ide_sector_start_dma()
1011 s->io_buffer_index = 0; in ide_start_dma()
1013 if (s->bus->dma->ops->start_dma) { in ide_start_dma()
1014 s->bus->dma->ops->start_dma(s->bus->dma, s, cb); in ide_start_dma()
1023 ide_bus_set_irq(s->bus); in ide_sector_write_timer_cb()
1031 s->pio_aiocb = NULL; in ide_sector_write_cb()
1032 s->status &= ~BUSY_STAT; in ide_sector_write_cb()
1035 if (ide_handle_rw_error(s, -ret, IDE_RETRY_PIO)) { in ide_sector_write_cb()
1040 block_acct_done(blk_get_stats(s->blk), &s->acct); in ide_sector_write_cb()
1042 n = s->nsector; in ide_sector_write_cb()
1043 if (n > s->req_nb_sectors) { in ide_sector_write_cb()
1044 n = s->req_nb_sectors; in ide_sector_write_cb()
1046 s->nsector -= n; in ide_sector_write_cb()
1049 if (s->nsector == 0) { in ide_sector_write_cb()
1053 int n1 = s->nsector; in ide_sector_write_cb()
1054 if (n1 > s->req_nb_sectors) { in ide_sector_write_cb()
1055 n1 = s->req_nb_sectors; in ide_sector_write_cb()
1057 ide_transfer_start(s, s->io_buffer, n1 * BDRV_SECTOR_SIZE, in ide_sector_write_cb()
1061 if (s->win2k_install_hack && ((++s->irq_count % 16) == 0)) { in ide_sector_write_cb()
1068 timer_mod(s->sector_write_timer, qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) + in ide_sector_write_cb()
1071 ide_bus_set_irq(s->bus); in ide_sector_write_cb()
1080 s->status = READY_STAT | SEEK_STAT | BUSY_STAT; in ide_sector_write()
1083 n = s->nsector; in ide_sector_write()
1084 if (n > s->req_nb_sectors) { in ide_sector_write()
1085 n = s->req_nb_sectors; in ide_sector_write()
1092 block_acct_invalid(blk_get_stats(s->blk), BLOCK_ACCT_WRITE); in ide_sector_write()
1096 qemu_iovec_init_buf(&s->qiov, s->io_buffer, n * BDRV_SECTOR_SIZE); in ide_sector_write()
1098 block_acct_start(blk_get_stats(s->blk), &s->acct, in ide_sector_write()
1100 s->pio_aiocb = blk_aio_pwritev(s->blk, sector_num << BDRV_SECTOR_BITS, in ide_sector_write()
1101 &s->qiov, 0, ide_sector_write_cb, s); in ide_sector_write()
1108 s->pio_aiocb = NULL; in ide_flush_cb()
1112 if (ide_handle_rw_error(s, -ret, IDE_RETRY_FLUSH)) { in ide_flush_cb()
1117 if (s->blk) { in ide_flush_cb()
1118 block_acct_done(blk_get_stats(s->blk), &s->acct); in ide_flush_cb()
1120 s->status = READY_STAT | SEEK_STAT; in ide_flush_cb()
1122 ide_bus_set_irq(s->bus); in ide_flush_cb()
1127 if (s->blk == NULL) { in ide_flush_cache()
1132 s->status |= BUSY_STAT; in ide_flush_cache()
1134 block_acct_start(blk_get_stats(s->blk), &s->acct, 0, BLOCK_ACCT_FLUSH); in ide_flush_cache()
1135 s->pio_aiocb = blk_aio_flush(s->blk, ide_flush_cb, s); in ide_flush_cache()
1143 p = (uint16_t *) s->io_buffer; in ide_cfata_metadata_inquiry()
1145 spd = ((s->mdata_size - 1) >> 9) + 1; in ide_cfata_metadata_inquiry()
1149 put_le16(p + 2, s->media_changed); /* Media status */ in ide_cfata_metadata_inquiry()
1150 put_le16(p + 3, s->mdata_size & 0xffff); /* Capacity in bytes (low) */ in ide_cfata_metadata_inquiry()
1151 put_le16(p + 4, s->mdata_size >> 16); /* Capacity in bytes (high) */ in ide_cfata_metadata_inquiry()
1160 if (((s->hcyl << 16) | s->lcyl) << 9 > s->mdata_size + 2) { in ide_cfata_metadata_read()
1161 s->status = ERR_STAT; in ide_cfata_metadata_read()
1162 s->error = ABRT_ERR; in ide_cfata_metadata_read()
1166 p = (uint16_t *) s->io_buffer; in ide_cfata_metadata_read()
1169 put_le16(p + 0, s->media_changed); /* Media status */ in ide_cfata_metadata_read()
1170 memcpy(p + 1, s->mdata_storage + (((s->hcyl << 16) | s->lcyl) << 9), in ide_cfata_metadata_read()
1171 MIN(MIN(s->mdata_size - (((s->hcyl << 16) | s->lcyl) << 9), in ide_cfata_metadata_read()
1172 s->nsector << 9), 0x200 - 2)); in ide_cfata_metadata_read()
1177 if (((s->hcyl << 16) | s->lcyl) << 9 > s->mdata_size + 2) { in ide_cfata_metadata_write()
1178 s->status = ERR_STAT; in ide_cfata_metadata_write()
1179 s->error = ABRT_ERR; in ide_cfata_metadata_write()
1183 s->media_changed = 0; in ide_cfata_metadata_write()
1185 memcpy(s->mdata_storage + (((s->hcyl << 16) | s->lcyl) << 9), in ide_cfata_metadata_write()
1186 s->io_buffer + 2, in ide_cfata_metadata_write()
1187 MIN(MIN(s->mdata_size - (((s->hcyl << 16) | s->lcyl) << 9), in ide_cfata_metadata_write()
1188 s->nsector << 9), 0x200 - 2)); in ide_cfata_metadata_write()
1197 s->tray_open = !load; in ide_cd_change_cb()
1198 blk_get_geometry(s->blk, &nb_sectors); in ide_cd_change_cb()
1199 s->nb_sectors = nb_sectors; in ide_cd_change_cb()
1208 s->cdrom_changed = 1; in ide_cd_change_cb()
1209 s->events.new_media = true; in ide_cd_change_cb()
1210 s->events.eject_request = false; in ide_cd_change_cb()
1211 ide_bus_set_irq(s->bus); in ide_cd_change_cb()
1218 s->events.eject_request = true; in ide_cd_eject_request_cb()
1220 s->tray_locked = false; in ide_cd_eject_request_cb()
1222 ide_bus_set_irq(s->bus); in ide_cd_eject_request_cb()
1227 s->lba48 = lba48; in ide_cmd_lba48_transform()
1231 * full sector count in ->nsector and ignore ->hob_nsector from now in ide_cmd_lba48_transform()
1233 if (!s->lba48) { in ide_cmd_lba48_transform()
1234 if (!s->nsector) in ide_cmd_lba48_transform()
1235 s->nsector = 256; in ide_cmd_lba48_transform()
1237 if (!s->nsector && !s->hob_nsector) in ide_cmd_lba48_transform()
1238 s->nsector = 65536; in ide_cmd_lba48_transform()
1240 int lo = s->nsector; in ide_cmd_lba48_transform()
1241 int hi = s->hob_nsector; in ide_cmd_lba48_transform()
1243 s->nsector = (hi << 8) | lo; in ide_cmd_lba48_transform()
1251 bus->cmd &= ~(IDE_CTRL_HOB); in ide_clear_hob()
1287 if (reg_num != 7 && (s->status & (BUSY_STAT|DRQ_STAT))) { in ide_ioport_write()
1299 bus->ifs[0].hob_feature = bus->ifs[0].feature; in ide_ioport_write()
1300 bus->ifs[1].hob_feature = bus->ifs[1].feature; in ide_ioport_write()
1301 bus->ifs[0].feature = val; in ide_ioport_write()
1302 bus->ifs[1].feature = val; in ide_ioport_write()
1306 bus->ifs[0].hob_nsector = bus->ifs[0].nsector; in ide_ioport_write()
1307 bus->ifs[1].hob_nsector = bus->ifs[1].nsector; in ide_ioport_write()
1308 bus->ifs[0].nsector = val; in ide_ioport_write()
1309 bus->ifs[1].nsector = val; in ide_ioport_write()
1313 bus->ifs[0].hob_sector = bus->ifs[0].sector; in ide_ioport_write()
1314 bus->ifs[1].hob_sector = bus->ifs[1].sector; in ide_ioport_write()
1315 bus->ifs[0].sector = val; in ide_ioport_write()
1316 bus->ifs[1].sector = val; in ide_ioport_write()
1320 bus->ifs[0].hob_lcyl = bus->ifs[0].lcyl; in ide_ioport_write()
1321 bus->ifs[1].hob_lcyl = bus->ifs[1].lcyl; in ide_ioport_write()
1322 bus->ifs[0].lcyl = val; in ide_ioport_write()
1323 bus->ifs[1].lcyl = val; in ide_ioport_write()
1327 bus->ifs[0].hob_hcyl = bus->ifs[0].hcyl; in ide_ioport_write()
1328 bus->ifs[1].hob_hcyl = bus->ifs[1].hcyl; in ide_ioport_write()
1329 bus->ifs[0].hcyl = val; in ide_ioport_write()
1330 bus->ifs[1].hcyl = val; in ide_ioport_write()
1334 bus->ifs[0].select = val | (ATA_DEV_ALWAYS_ON); in ide_ioport_write()
1335 bus->ifs[1].select = val | (ATA_DEV_ALWAYS_ON); in ide_ioport_write()
1337 bus->unit = (val & (ATA_DEV_SELECT)) ? 1 : 0; in ide_ioport_write()
1342 qemu_irq_lower(bus->irq); in ide_ioport_write()
1352 if (s->pio_aiocb) { in ide_reset()
1353 blk_aio_cancel(s->pio_aiocb); in ide_reset()
1354 s->pio_aiocb = NULL; in ide_reset()
1357 if (s->reset_reverts) { in ide_reset()
1358 s->reset_reverts = false; in ide_reset()
1359 s->heads = s->drive_heads; in ide_reset()
1360 s->sectors = s->drive_sectors; in ide_reset()
1362 if (s->drive_kind == IDE_CFATA) in ide_reset()
1363 s->mult_sectors = 0; in ide_reset()
1365 s->mult_sectors = MAX_MULT_SECTORS; in ide_reset()
1367 s->feature = 0; in ide_reset()
1368 s->error = 0; in ide_reset()
1369 s->nsector = 0; in ide_reset()
1370 s->sector = 0; in ide_reset()
1371 s->lcyl = 0; in ide_reset()
1372 s->hcyl = 0; in ide_reset()
1375 s->hob_feature = 0; in ide_reset()
1376 s->hob_sector = 0; in ide_reset()
1377 s->hob_nsector = 0; in ide_reset()
1378 s->hob_lcyl = 0; in ide_reset()
1379 s->hob_hcyl = 0; in ide_reset()
1381 s->select = (ATA_DEV_ALWAYS_ON); in ide_reset()
1382 s->status = READY_STAT | SEEK_STAT; in ide_reset()
1384 s->lba48 = 0; in ide_reset()
1387 s->sense_key = 0; in ide_reset()
1388 s->asc = 0; in ide_reset()
1389 s->cdrom_changed = 0; in ide_reset()
1390 s->packet_transfer_size = 0; in ide_reset()
1391 s->elementary_transfer_size = 0; in ide_reset()
1392 s->io_buffer_index = 0; in ide_reset()
1393 s->cd_sector_size = 0; in ide_reset()
1394 s->atapi_dma = 0; in ide_reset()
1395 s->tray_locked = 0; in ide_reset()
1396 s->tray_open = 0; in ide_reset()
1397 /* ATA DMA state */ in ide_reset()
1398 s->io_buffer_size = 0; in ide_reset()
1399 s->req_nb_sectors = 0; in ide_reset()
1404 s->end_transfer_func = ide_dummy_transfer_stop; in ide_reset()
1406 s->media_changed = 0; in ide_reset()
1416 /* Halt PIO (in the DRQ phase), then DMA */ in cmd_device_reset()
1423 /* RESET: ATA8-ACS3 7.10.4 "Normal Outputs"; in cmd_device_reset()
1424 * ATA8-ACS3 Table 184 "Device Signatures for Normal Output" */ in cmd_device_reset()
1425 s->status = 0x00; in cmd_device_reset()
1433 switch (s->feature) { in cmd_data_set_management()
1435 if (s->blk) { in cmd_data_set_management()
1448 if (s->blk && s->drive_kind != IDE_CD) { in cmd_identify()
1449 if (s->drive_kind != IDE_CFATA) { in cmd_identify()
1454 s->status = READY_STAT | SEEK_STAT; in cmd_identify()
1455 ide_transfer_start(s, s->io_buffer, 512, ide_transfer_stop); in cmd_identify()
1456 ide_bus_set_irq(s->bus); in cmd_identify()
1459 if (s->drive_kind == IDE_CD) { in cmd_identify()
1480 if (s->drive_kind == IDE_CFATA && s->nsector == 0) { in cmd_set_multiple_mode()
1482 s->mult_sectors = 0; in cmd_set_multiple_mode()
1483 } else if ((s->nsector & 0xff) != 0 && in cmd_set_multiple_mode()
1484 ((s->nsector & 0xff) > MAX_MULT_SECTORS || in cmd_set_multiple_mode()
1485 (s->nsector & (s->nsector - 1)) != 0)) { in cmd_set_multiple_mode()
1488 s->mult_sectors = s->nsector & 0xff; in cmd_set_multiple_mode()
1498 if (!s->blk || !s->mult_sectors) { in cmd_read_multiple()
1504 s->req_nb_sectors = s->mult_sectors; in cmd_read_multiple()
1514 if (!s->blk || !s->mult_sectors) { in cmd_write_multiple()
1521 s->req_nb_sectors = s->mult_sectors; in cmd_write_multiple()
1522 n = MIN(s->nsector, s->req_nb_sectors); in cmd_write_multiple()
1524 s->status = SEEK_STAT | READY_STAT; in cmd_write_multiple()
1525 ide_transfer_start(s, s->io_buffer, 512 * n, ide_sector_write); in cmd_write_multiple()
1527 s->media_changed = 1; in cmd_write_multiple()
1536 if (s->drive_kind == IDE_CD) { in cmd_read_pio()
1542 if (!s->blk) { in cmd_read_pio()
1548 s->req_nb_sectors = 1; in cmd_read_pio()
1558 if (!s->blk) { in cmd_write_pio()
1565 s->req_nb_sectors = 1; in cmd_write_pio()
1566 s->status = SEEK_STAT | READY_STAT; in cmd_write_pio()
1567 ide_transfer_start(s, s->io_buffer, 512, ide_sector_write); in cmd_write_pio()
1569 s->media_changed = 1; in cmd_write_pio()
1578 if (!s->blk) { in cmd_read_dma()
1593 if (!s->blk) { in cmd_write_dma()
1601 s->media_changed = 1; in cmd_write_dma()
1623 if (s->nb_sectors == 0) { in cmd_read_native_max()
1631 const int aheads = s->heads; in cmd_read_native_max()
1632 const int asectors = s->sectors; in cmd_read_native_max()
1634 s->heads = s->drive_heads; in cmd_read_native_max()
1635 s->sectors = s->drive_sectors; in cmd_read_native_max()
1638 ide_set_sector(s, s->nb_sectors - 1); in cmd_read_native_max()
1640 s->heads = aheads; in cmd_read_native_max()
1641 s->sectors = asectors; in cmd_read_native_max()
1649 s->nsector = 0xff; /* device active or idle */ in cmd_check_power_mode()
1656 if (s->blk && s->drive_kind != IDE_CD) { in cmd_specify()
1657 s->heads = (s->select & (ATA_DEV_HS)) + 1; in cmd_specify()
1658 s->sectors = s->nsector; in cmd_specify()
1659 ide_bus_set_irq(s->bus); in cmd_specify()
1671 if (!s->blk) { in cmd_set_features()
1677 switch (s->feature) { in cmd_set_features()
1678 case 0x01: /* 8-bit I/O enable (CompactFlash) */ in cmd_set_features()
1679 case 0x81: /* 8-bit I/O disable (CompactFlash) */ in cmd_set_features()
1680 if (s->drive_kind != IDE_CFATA) { in cmd_set_features()
1683 s->io8 = !(s->feature & 0x80); in cmd_set_features()
1686 blk_set_enable_write_cache(s->blk, true); in cmd_set_features()
1687 identify_data = (uint16_t *)s->identify_data; in cmd_set_features()
1691 blk_set_enable_write_cache(s->blk, false); in cmd_set_features()
1692 identify_data = (uint16_t *)s->identify_data; in cmd_set_features()
1696 case 0xcc: /* reverting to power-on defaults enable */ in cmd_set_features()
1697 s->reset_reverts = true; in cmd_set_features()
1699 case 0x66: /* reverting to power-on defaults disable */ in cmd_set_features()
1700 s->reset_reverts = false; in cmd_set_features()
1702 case 0xaa: /* read look-ahead enable */ in cmd_set_features()
1703 case 0x55: /* read look-ahead disable */ in cmd_set_features()
1715 uint8_t val = s->nsector & 0x07; in cmd_set_features()
1716 identify_data = (uint16_t *)s->identify_data; in cmd_set_features()
1718 switch (s->nsector >> 3) { in cmd_set_features()
1725 case 0x02: /* single word dma mode */ in cmd_set_features()
1758 s->status = READY_STAT | SEEK_STAT; in cmd_identify_packet()
1759 ide_transfer_start(s, s->io_buffer, 512, ide_transfer_stop); in cmd_identify_packet()
1760 ide_bus_set_irq(s->bus); in cmd_identify_packet()
1771 s->select = (ATA_DEV_ALWAYS_ON); in cmd_exec_dev_diagnostic()
1774 if (s->drive_kind == IDE_CD) { in cmd_exec_dev_diagnostic()
1775 s->status = 0; /* ATAPI spec (v6) section 9.10 defines packet in cmd_exec_dev_diagnostic()
1778 s->error = 0x01; in cmd_exec_dev_diagnostic()
1780 s->status = READY_STAT | SEEK_STAT; in cmd_exec_dev_diagnostic()
1784 s->error = 0x01; in cmd_exec_dev_diagnostic()
1785 ide_bus_set_irq(s->bus); in cmd_exec_dev_diagnostic()
1794 if (s->feature & 0x02) { in cmd_packet()
1799 s->status = READY_STAT | SEEK_STAT; in cmd_packet()
1800 s->atapi_dma = s->feature & 1; in cmd_packet()
1801 if (s->atapi_dma) { in cmd_packet()
1802 s->dma_cmd = IDE_DMA_ATAPI; in cmd_packet()
1804 s->nsector = 1; in cmd_packet()
1805 ide_transfer_start(s, s->io_buffer, ATAPI_PACKET_SIZE, in cmd_packet()
1811 /*** CF-ATA commands ***/
1815 s->error = 0x09; /* miscellaneous error */ in cmd_cfa_req_ext_error_code()
1816 s->status = READY_STAT | SEEK_STAT; in cmd_cfa_req_ext_error_code()
1817 ide_bus_set_irq(s->bus); in cmd_cfa_req_ext_error_code()
1828 s->nsector = 0; in cmd_cfa_erase_sectors()
1832 s->media_changed = 1; in cmd_cfa_erase_sectors()
1840 s->status = READY_STAT | SEEK_STAT; in cmd_cfa_translate_sector()
1842 memset(s->io_buffer, 0, 0x200); in cmd_cfa_translate_sector()
1843 s->io_buffer[0x00] = s->hcyl; /* Cyl MSB */ in cmd_cfa_translate_sector()
1844 s->io_buffer[0x01] = s->lcyl; /* Cyl LSB */ in cmd_cfa_translate_sector()
1845 s->io_buffer[0x02] = s->select; /* Head */ in cmd_cfa_translate_sector()
1846 s->io_buffer[0x03] = s->sector; /* Sector */ in cmd_cfa_translate_sector()
1847 s->io_buffer[0x04] = ide_get_sector(s) >> 16; /* LBA MSB */ in cmd_cfa_translate_sector()
1848 s->io_buffer[0x05] = ide_get_sector(s) >> 8; /* LBA */ in cmd_cfa_translate_sector()
1849 s->io_buffer[0x06] = ide_get_sector(s) >> 0; /* LBA LSB */ in cmd_cfa_translate_sector()
1850 s->io_buffer[0x13] = 0x00; /* Erase flag */ in cmd_cfa_translate_sector()
1851 s->io_buffer[0x18] = 0x00; /* Hot count */ in cmd_cfa_translate_sector()
1852 s->io_buffer[0x19] = 0x00; /* Hot count */ in cmd_cfa_translate_sector()
1853 s->io_buffer[0x1a] = 0x01; /* Hot count */ in cmd_cfa_translate_sector()
1855 ide_transfer_start(s, s->io_buffer, 0x200, ide_transfer_stop); in cmd_cfa_translate_sector()
1856 ide_bus_set_irq(s->bus); in cmd_cfa_translate_sector()
1863 switch (s->feature) { in cmd_cfa_access_metadata_storage()
1878 ide_transfer_start(s, s->io_buffer, 0x200, ide_transfer_stop); in cmd_cfa_access_metadata_storage()
1879 s->status = 0x00; /* NOTE: READY is _not_ set */ in cmd_cfa_access_metadata_storage()
1880 ide_bus_set_irq(s->bus); in cmd_cfa_access_metadata_storage()
1887 switch (s->feature) { in cmd_ibm_sense_condition()
1889 s->nsector = 0x50; /* +20 C */ in cmd_ibm_sense_condition()
1906 if (s->hcyl != 0xc2 || s->lcyl != 0x4f) { in cmd_smart()
1910 if (!s->smart_enabled && s->feature != SMART_ENABLE) { in cmd_smart()
1914 switch (s->feature) { in cmd_smart()
1916 s->smart_enabled = 0; in cmd_smart()
1920 s->smart_enabled = 1; in cmd_smart()
1924 switch (s->sector) { in cmd_smart()
1926 s->smart_autosave = 0; in cmd_smart()
1929 s->smart_autosave = 1; in cmd_smart()
1937 if (!s->smart_errors) { in cmd_smart()
1938 s->hcyl = 0xc2; in cmd_smart()
1939 s->lcyl = 0x4f; in cmd_smart()
1941 s->hcyl = 0x2c; in cmd_smart()
1942 s->lcyl = 0xf4; in cmd_smart()
1947 memset(s->io_buffer, 0, 0x200); in cmd_smart()
1948 s->io_buffer[0] = 0x01; /* smart struct version */ in cmd_smart()
1951 s->io_buffer[2 + 0 + (n * 12)] = smart_attributes[n][0]; in cmd_smart()
1952 s->io_buffer[2 + 1 + (n * 12)] = smart_attributes[n][11]; in cmd_smart()
1957 s->io_buffer[511] += s->io_buffer[n]; in cmd_smart()
1959 s->io_buffer[511] = 0x100 - s->io_buffer[511]; in cmd_smart()
1961 s->status = READY_STAT | SEEK_STAT; in cmd_smart()
1962 ide_transfer_start(s, s->io_buffer, 0x200, ide_transfer_stop); in cmd_smart()
1963 ide_bus_set_irq(s->bus); in cmd_smart()
1967 memset(s->io_buffer, 0, 0x200); in cmd_smart()
1968 s->io_buffer[0] = 0x01; /* smart struct version */ in cmd_smart()
1973 s->io_buffer[2 + i + (n * 12)] = smart_attributes[n][i]; in cmd_smart()
1977 s->io_buffer[362] = 0x02 | (s->smart_autosave ? 0x80 : 0x00); in cmd_smart()
1978 if (s->smart_selftest_count == 0) { in cmd_smart()
1979 s->io_buffer[363] = 0; in cmd_smart()
1981 s->io_buffer[363] = in cmd_smart()
1982 s->smart_selftest_data[3 + in cmd_smart()
1983 (s->smart_selftest_count - 1) * in cmd_smart()
1986 s->io_buffer[364] = 0x20; in cmd_smart()
1987 s->io_buffer[365] = 0x01; in cmd_smart()
1988 /* offline data collection capacity: execute + self-test*/ in cmd_smart()
1989 s->io_buffer[367] = (1 << 4 | 1 << 3 | 1); in cmd_smart()
1990 s->io_buffer[368] = 0x03; /* smart capability (1) */ in cmd_smart()
1991 s->io_buffer[369] = 0x00; /* smart capability (2) */ in cmd_smart()
1992 s->io_buffer[370] = 0x01; /* error logging supported */ in cmd_smart()
1993 s->io_buffer[372] = 0x02; /* minutes for poll short test */ in cmd_smart()
1994 s->io_buffer[373] = 0x36; /* minutes for poll ext test */ in cmd_smart()
1995 s->io_buffer[374] = 0x01; /* minutes for poll conveyance */ in cmd_smart()
1998 s->io_buffer[511] += s->io_buffer[n]; in cmd_smart()
2000 s->io_buffer[511] = 0x100 - s->io_buffer[511]; in cmd_smart()
2002 s->status = READY_STAT | SEEK_STAT; in cmd_smart()
2003 ide_transfer_start(s, s->io_buffer, 0x200, ide_transfer_stop); in cmd_smart()
2004 ide_bus_set_irq(s->bus); in cmd_smart()
2008 switch (s->sector) { in cmd_smart()
2010 memset(s->io_buffer, 0, 0x200); in cmd_smart()
2011 s->io_buffer[0] = 0x01; in cmd_smart()
2012 s->io_buffer[1] = 0x00; /* no error entries */ in cmd_smart()
2013 s->io_buffer[452] = s->smart_errors & 0xff; in cmd_smart()
2014 s->io_buffer[453] = (s->smart_errors & 0xff00) >> 8; in cmd_smart()
2017 s->io_buffer[511] += s->io_buffer[n]; in cmd_smart()
2019 s->io_buffer[511] = 0x100 - s->io_buffer[511]; in cmd_smart()
2022 memset(s->io_buffer, 0, 0x200); in cmd_smart()
2023 s->io_buffer[0] = 0x01; in cmd_smart()
2024 if (s->smart_selftest_count == 0) { in cmd_smart()
2025 s->io_buffer[508] = 0; in cmd_smart()
2027 s->io_buffer[508] = s->smart_selftest_count; in cmd_smart()
2029 s->io_buffer[n] = s->smart_selftest_data[n]; in cmd_smart()
2034 s->io_buffer[511] += s->io_buffer[n]; in cmd_smart()
2036 s->io_buffer[511] = 0x100 - s->io_buffer[511]; in cmd_smart()
2041 s->status = READY_STAT | SEEK_STAT; in cmd_smart()
2042 ide_transfer_start(s, s->io_buffer, 0x200, ide_transfer_stop); in cmd_smart()
2043 ide_bus_set_irq(s->bus); in cmd_smart()
2047 switch (s->sector) { in cmd_smart()
2048 case 0: /* off-line routine */ in cmd_smart()
2051 s->smart_selftest_count++; in cmd_smart()
2052 if (s->smart_selftest_count > 21) { in cmd_smart()
2053 s->smart_selftest_count = 1; in cmd_smart()
2055 n = 2 + (s->smart_selftest_count - 1) * 24; in cmd_smart()
2056 s->smart_selftest_data[n] = s->sector; in cmd_smart()
2057 s->smart_selftest_data[n + 1] = 0x00; /* OK and finished */ in cmd_smart()
2058 s->smart_selftest_data[n + 2] = 0x34; /* hour count lsb */ in cmd_smart()
2059 s->smart_selftest_data[n + 3] = 0x12; /* hour count msb */ in cmd_smart()
2081 /* See ACS-2 T13/2015-D Table B.2 Command codes */
2149 && (ide_cmd_table[cmd].flags & (1u << s->drive_kind)); in ide_cmd_permitted()
2161 if (s != bus->ifs && !s->blk) { in ide_bus_exec_cmd()
2167 if (s->status & (BUSY_STAT|DRQ_STAT)) { in ide_bus_exec_cmd()
2168 if (val != WIN_DEVICE_RESET || s->drive_kind != IDE_CD) { in ide_bus_exec_cmd()
2175 ide_bus_set_irq(s->bus); in ide_bus_exec_cmd()
2179 s->status = READY_STAT | BUSY_STAT; in ide_bus_exec_cmd()
2180 s->error = 0; in ide_bus_exec_cmd()
2181 s->io_buffer_offset = 0; in ide_bus_exec_cmd()
2185 s->status &= ~BUSY_STAT; in ide_bus_exec_cmd()
2186 assert(!!s->error == !!(s->status & ERR_STAT)); in ide_bus_exec_cmd()
2188 if ((ide_cmd_table[val].flags & SET_DSC) && !s->error) { in ide_bus_exec_cmd()
2189 s->status |= SEEK_STAT; in ide_bus_exec_cmd()
2193 ide_bus_set_irq(s->bus); in ide_bus_exec_cmd()
2229 hob = bus->cmd & (IDE_CTRL_HOB); in ide_ioport_read()
2233 * The pre-GRUB Solaris x86 bootloader relies upon inb in ide_ioport_read()
2239 if ((!bus->ifs[0].blk && !bus->ifs[1].blk) || in ide_ioport_read()
2240 (s != bus->ifs && !s->blk)) { in ide_ioport_read()
2243 ret = s->error; in ide_ioport_read()
2245 ret = s->hob_feature; in ide_ioport_read()
2249 if (!bus->ifs[0].blk && !bus->ifs[1].blk) { in ide_ioport_read()
2252 ret = s->nsector & 0xff; in ide_ioport_read()
2254 ret = s->hob_nsector; in ide_ioport_read()
2258 if (!bus->ifs[0].blk && !bus->ifs[1].blk) { in ide_ioport_read()
2261 ret = s->sector; in ide_ioport_read()
2263 ret = s->hob_sector; in ide_ioport_read()
2267 if (!bus->ifs[0].blk && !bus->ifs[1].blk) { in ide_ioport_read()
2270 ret = s->lcyl; in ide_ioport_read()
2272 ret = s->hob_lcyl; in ide_ioport_read()
2276 if (!bus->ifs[0].blk && !bus->ifs[1].blk) { in ide_ioport_read()
2279 ret = s->hcyl; in ide_ioport_read()
2281 ret = s->hob_hcyl; in ide_ioport_read()
2285 if (!bus->ifs[0].blk && !bus->ifs[1].blk) { in ide_ioport_read()
2288 ret = s->select; in ide_ioport_read()
2293 if ((!bus->ifs[0].blk && !bus->ifs[1].blk) || in ide_ioport_read()
2294 (s != bus->ifs && !s->blk)) { in ide_ioport_read()
2297 ret = s->status; in ide_ioport_read()
2299 qemu_irq_lower(bus->irq); in ide_ioport_read()
2313 if ((!bus->ifs[0].blk && !bus->ifs[1].blk) || in ide_status_read()
2314 (s != bus->ifs && !s->blk)) { in ide_status_read()
2317 ret = s->status; in ide_status_read()
2326 s->status |= BUSY_STAT; in ide_perform_srst()
2331 /* Cancel DMA -- may drain block device and invoke callbacks */ in ide_perform_srst()
2348 s = &bus->ifs[i]; in ide_bus_perform_srst()
2352 bus->cmd &= ~IDE_CTRL_RESET; in ide_bus_perform_srst()
2365 if (!(bus->cmd & IDE_CTRL_RESET) && (val & IDE_CTRL_RESET)) { in ide_ctrl_write()
2367 s = &bus->ifs[i]; in ide_ctrl_write()
2368 s->status |= BUSY_STAT; in ide_ctrl_write()
2374 bus->cmd = val; in ide_ctrl_write()
2383 if (s->end_transfer_func == ide_sector_write || in ide_is_pio_out()
2384 s->end_transfer_func == ide_atapi_cmd) { in ide_is_pio_out()
2386 } else if (s->end_transfer_func == ide_sector_read || in ide_is_pio_out()
2387 s->end_transfer_func == ide_transfer_stop || in ide_is_pio_out()
2388 s->end_transfer_func == ide_atapi_cmd_reply_end || in ide_is_pio_out()
2389 s->end_transfer_func == ide_dummy_transfer_stop) { in ide_is_pio_out()
2406 if (!(s->status & DRQ_STAT) || ide_is_pio_out(s)) { in ide_data_writew()
2410 p = s->data_ptr; in ide_data_writew()
2411 if (s->io8) { in ide_data_writew()
2412 if (p + 1 > s->data_end) { in ide_data_writew()
2418 if (p + 2 > s->data_end) { in ide_data_writew()
2425 s->data_ptr = p; in ide_data_writew()
2426 if (p >= s->data_end) { in ide_data_writew()
2427 s->status &= ~DRQ_STAT; in ide_data_writew()
2428 s->end_transfer_func(s); in ide_data_writew()
2441 if (!(s->status & DRQ_STAT) || !ide_is_pio_out(s)) { in ide_data_readw()
2445 p = s->data_ptr; in ide_data_readw()
2446 if (s->io8) { in ide_data_readw()
2447 if (p + 1 > s->data_end) { in ide_data_readw()
2453 if (p + 2 > s->data_end) { in ide_data_readw()
2460 s->data_ptr = p; in ide_data_readw()
2461 if (p >= s->data_end) { in ide_data_readw()
2462 s->status &= ~DRQ_STAT; in ide_data_readw()
2463 s->end_transfer_func(s); in ide_data_readw()
2480 if (!(s->status & DRQ_STAT) || ide_is_pio_out(s)) { in ide_data_writel()
2484 p = s->data_ptr; in ide_data_writel()
2485 if (p + 4 > s->data_end) { in ide_data_writel()
2491 s->data_ptr = p; in ide_data_writel()
2492 if (p >= s->data_end) { in ide_data_writel()
2493 s->status &= ~DRQ_STAT; in ide_data_writel()
2494 s->end_transfer_func(s); in ide_data_writel()
2507 if (!(s->status & DRQ_STAT) || !ide_is_pio_out(s)) { in ide_data_readl()
2512 p = s->data_ptr; in ide_data_readl()
2513 if (p + 4 > s->data_end) { in ide_data_readl()
2519 s->data_ptr = p; in ide_data_readl()
2520 if (p >= s->data_end) { in ide_data_readl()
2521 s->status &= ~DRQ_STAT; in ide_data_readl()
2522 s->end_transfer_func(s); in ide_data_readl()
2532 s->data_ptr = s->io_buffer; in ide_dummy_transfer_stop()
2533 s->data_end = s->io_buffer; in ide_dummy_transfer_stop()
2534 s->io_buffer[0] = 0xff; in ide_dummy_transfer_stop()
2535 s->io_buffer[1] = 0xff; in ide_dummy_transfer_stop()
2536 s->io_buffer[2] = 0xff; in ide_dummy_transfer_stop()
2537 s->io_buffer[3] = 0xff; in ide_dummy_transfer_stop()
2542 /* pending async DMA - needs the IDEState before it is reset */ in ide_bus_reset()
2543 if (bus->dma->aiocb) { in ide_bus_reset()
2545 blk_aio_cancel(bus->dma->aiocb); in ide_bus_reset()
2546 bus->dma->aiocb = NULL; in ide_bus_reset()
2549 bus->unit = 0; in ide_bus_reset()
2550 bus->cmd = 0; in ide_bus_reset()
2551 ide_reset(&bus->ifs[0]); in ide_bus_reset()
2552 ide_reset(&bus->ifs[1]); in ide_bus_reset()
2555 /* reset dma provider too */ in ide_bus_reset()
2556 if (bus->dma->ops->reset) { in ide_bus_reset()
2557 bus->dma->ops->reset(bus->dma); in ide_bus_reset()
2563 return ((IDEState *)opaque)->tray_open; in ide_cd_is_tray_open()
2568 return ((IDEState *)opaque)->tray_locked; in ide_cd_is_medium_locked()
2576 if (!s->identify_set) { in ide_resize_cb()
2580 blk_get_geometry(s->blk, &nb_sectors); in ide_resize_cb()
2581 s->nb_sectors = nb_sectors; in ide_resize_cb()
2584 if (s->drive_kind == IDE_CFATA) { in ide_resize_cb()
2588 assert(s->drive_kind != IDE_CD); in ide_resize_cb()
2608 s->blk = dev->conf.blk; in ide_init_drive()
2609 s->drive_kind = kind; in ide_init_drive()
2611 blk_get_geometry(s->blk, &nb_sectors); in ide_init_drive()
2612 s->win2k_install_hack = dev->win2k_install_hack; in ide_init_drive()
2613 s->cylinders = dev->conf.cyls; in ide_init_drive()
2614 s->heads = s->drive_heads = dev->conf.heads; in ide_init_drive()
2615 s->sectors = s->drive_sectors = dev->conf.secs; in ide_init_drive()
2616 s->chs_trans = dev->chs_trans; in ide_init_drive()
2617 s->nb_sectors = nb_sectors; in ide_init_drive()
2618 s->wwn = dev->wwn; in ide_init_drive()
2621 s->smart_enabled = 1; in ide_init_drive()
2622 s->smart_autosave = 1; in ide_init_drive()
2623 s->smart_errors = 0; in ide_init_drive()
2624 s->smart_selftest_count = 0; in ide_init_drive()
2626 blk_set_dev_ops(s->blk, &ide_cd_block_ops, s); in ide_init_drive()
2628 if (!blk_is_inserted(s->blk)) { in ide_init_drive()
2630 return -1; in ide_init_drive()
2632 if (!blk_is_writable(s->blk)) { in ide_init_drive()
2633 error_setg(errp, "Can't use a read-only drive"); in ide_init_drive()
2634 return -1; in ide_init_drive()
2636 blk_set_dev_ops(s->blk, &ide_hd_block_ops, s); in ide_init_drive()
2638 if (dev->serial) { in ide_init_drive()
2639 pstrcpy(s->drive_serial_str, sizeof(s->drive_serial_str), dev->serial); in ide_init_drive()
2641 snprintf(s->drive_serial_str, sizeof(s->drive_serial_str), in ide_init_drive()
2642 "QM%05d", s->drive_serial); in ide_init_drive()
2644 if (dev->model) { in ide_init_drive()
2645 pstrcpy(s->drive_model_str, sizeof(s->drive_model_str), dev->model); in ide_init_drive()
2649 strcpy(s->drive_model_str, "QEMU DVD-ROM"); in ide_init_drive()
2652 strcpy(s->drive_model_str, "QEMU MICRODRIVE"); in ide_init_drive()
2655 strcpy(s->drive_model_str, "QEMU HARDDISK"); in ide_init_drive()
2660 if (dev->version) { in ide_init_drive()
2661 pstrcpy(s->version, sizeof(s->version), dev->version); in ide_init_drive()
2663 pstrcpy(s->version, sizeof(s->version), qemu_hw_version()); in ide_init_drive()
2667 blk_iostatus_enable(s->blk); in ide_init_drive()
2674 IDEState *s = &bus->ifs[unit]; in ide_init1()
2676 s->bus = bus; in ide_init1()
2677 s->unit = unit; in ide_init1()
2678 s->drive_serial = drive_serial++; in ide_init1()
2680 s->io_buffer_total_len = IDE_DMA_BUF_SECTORS*512 + 4; in ide_init1()
2681 s->io_buffer = qemu_memalign(2048, s->io_buffer_total_len); in ide_init1()
2682 memset(s->io_buffer, 0, s->io_buffer_total_len); in ide_init1()
2684 s->smart_selftest_data = blk_blockalign(s->blk, 512); in ide_init1()
2685 memset(s->smart_selftest_data, 0, 512); in ide_init1()
2687 s->sector_write_timer = timer_new_ns(QEMU_CLOCK_VIRTUAL, in ide_init1()
2691 static int ide_nop_int(const IDEDMA *dma, bool is_write) in ide_nop_int() argument
2696 static void ide_nop(const IDEDMA *dma) in ide_nop() argument
2700 static int32_t ide_nop_int32(const IDEDMA *dma, int32_t l) in ide_nop_int32() argument
2713 s->unit = s->bus->retry_unit; in ide_restart_dma()
2714 ide_set_sector(s, s->bus->retry_sector_num); in ide_restart_dma()
2715 s->nsector = s->bus->retry_nsector; in ide_restart_dma()
2716 s->bus->dma->ops->restart_dma(s->bus->dma); in ide_restart_dma()
2717 s->io_buffer_size = 0; in ide_restart_dma()
2718 s->dma_cmd = dma_cmd; in ide_restart_dma()
2729 qemu_bh_delete(bus->bh); in ide_restart_bh()
2730 bus->bh = NULL; in ide_restart_bh()
2732 error_status = bus->error_status; in ide_restart_bh()
2733 if (bus->error_status == 0) { in ide_restart_bh()
2738 is_read = (bus->error_status & IDE_RETRY_READ) != 0; in ide_restart_bh()
2743 bus->error_status = 0; in ide_restart_bh()
2747 if (s->bus->dma->ops->restart) { in ide_restart_bh()
2748 s->bus->dma->ops->restart(s->bus->dma); in ide_restart_bh()
2765 assert(s->end_transfer_func == ide_atapi_cmd); in ide_restart_bh()
2779 if (!bus->bh) { in ide_restart_cb()
2780 bus->bh = qemu_bh_new(ide_restart_bh, bus); in ide_restart_cb()
2781 qemu_bh_schedule(bus->bh); in ide_restart_cb()
2787 if (bus->dma->ops->restart_dma) { in ide_bus_register_restart_cb()
2788 bus->vmstate = qemu_add_vm_change_state_handler(ide_restart_cb, bus); in ide_bus_register_restart_cb()
2803 ide_reset(&bus->ifs[i]); in ide_bus_init_output_irq()
2805 bus->irq = irq_out; in ide_bus_init_output_irq()
2806 bus->dma = &ide_dma_nop; in ide_bus_init_output_irq()
2811 if (!(bus->cmd & IDE_CTRL_DISABLE_IRQ)) { in ide_bus_set_irq()
2812 qemu_irq_raise(bus->irq); in ide_bus_set_irq()
2818 timer_free(s->sector_write_timer); in ide_exit()
2819 qemu_vfree(s->smart_selftest_data); in ide_exit()
2820 qemu_vfree(s->io_buffer); in ide_exit()
2827 return s->identify_set != 0; in is_identify_set()
2847 return -1; in transfer_end_table_idx()
2854 if (s->blk && s->identify_set) { in ide_drive_post_load()
2855 blk_set_enable_write_cache(s->blk, !!(s->identify_data[85] & (1 << 5))); in ide_drive_post_load()
2864 if (s->end_transfer_fn_idx >= ARRAY_SIZE(transfer_end_table)) { in ide_drive_pio_post_load()
2865 return -EINVAL; in ide_drive_pio_post_load()
2867 s->end_transfer_func = transfer_end_table[s->end_transfer_fn_idx]; in ide_drive_pio_post_load()
2868 s->data_ptr = s->io_buffer + s->cur_io_buffer_offset; in ide_drive_pio_post_load()
2869 s->data_end = s->data_ptr + s->cur_io_buffer_len; in ide_drive_pio_post_load()
2870 s->atapi_dma = s->feature & 1; /* as per cmd_packet */ in ide_drive_pio_post_load()
2880 s->cur_io_buffer_offset = s->data_ptr - s->io_buffer; in ide_drive_pio_pre_save()
2881 s->cur_io_buffer_len = s->data_end - s->data_ptr; in ide_drive_pio_pre_save()
2883 idx = transfer_end_table_idx(s->end_transfer_func); in ide_drive_pio_pre_save()
2884 if (idx == -1) { in ide_drive_pio_pre_save()
2887 s->end_transfer_fn_idx = 2; in ide_drive_pio_pre_save()
2889 s->end_transfer_fn_idx = idx; in ide_drive_pio_pre_save()
2899 return ((s->status & DRQ_STAT) != 0) in ide_drive_pio_state_needed()
2900 || (s->bus->error_status & IDE_RETRY_PIO); in ide_drive_pio_state_needed()
2907 return s->tray_open || s->tray_locked; in ide_tray_state_needed()
2914 return s->events.new_media || s->events.eject_request; in ide_atapi_gesn_needed()
2921 return (bus->error_status != 0); in ide_error_needed()