[Top][All Lists]
[Date Prev][Date Next][Thread Prev][Thread Next][Date Index][Thread Index]
[Qemu-devel] [PATCH 07/10] fdc: check if media rate is correct before do
From: |
Hervé Poussineau |
Subject: |
[Qemu-devel] [PATCH 07/10] fdc: check if media rate is correct before doing any transfer |
Date: |
Sun, 8 Jan 2012 21:27:45 +0100 |
Signed-off-by: Hervé Poussineau <address@hidden>
---
hw/fdc.c | 24 +++++++++++++++++++++++-
1 files changed, 23 insertions(+), 1 deletions(-)
diff --git a/hw/fdc.c b/hw/fdc.c
index aec1e5e..ddfa91f 100644
--- a/hw/fdc.c
+++ b/hw/fdc.c
@@ -83,6 +83,7 @@ typedef struct FDrive {
uint16_t bps; /* Bytes per sector */
uint8_t ro; /* Is read-only */
uint8_t media_changed; /* Is media changed */
+ uint8_t media_rate; /* Data rate of medium */
} FDrive;
static void fd_init(FDrive *drv)
@@ -195,6 +196,7 @@ static void fd_revalidate(FDrive *drv)
drv->last_sect = last_sect;
drv->ro = ro;
drv->drive = drive;
+ drv->media_rate = rate;
} else {
FLOPPY_DPRINTF("No disk in drive\n");
drv->last_sect = 0;
@@ -301,6 +303,7 @@ enum {
};
enum {
+ FD_SR1_MA = 0x01, /* Missing address mark */
FD_SR1_NW = 0x02, /* Not writable */
FD_SR1_EC = 0x80, /* End of cylinder */
};
@@ -1055,6 +1058,18 @@ static void fdctrl_start_transfer(FDCtrl *fdctrl, int
direction)
break;
}
+ /* Check the data rate. If the programmed data rate does not match
+ * the currently inserted medium, the operation has to fail. */
+ if ((fdctrl->dsr & FD_DSR_DRATEMASK) != cur_drv->media_rate) {
+ FLOPPY_DPRINTF("data rate mismatch (fdc=%d, media=%d)\n",
+ fdctrl->dsr & FD_DSR_DRATEMASK, cur_drv->media_rate);
+ fdctrl_stop_transfer(fdctrl, FD_SR0_ABNTERM, FD_SR1_MA, 0x00);
+ fdctrl->fifo[3] = kt;
+ fdctrl->fifo[4] = kh;
+ fdctrl->fifo[5] = ks;
+ return;
+ }
+
/* Set the FIFO state */
fdctrl->data_dir = direction;
fdctrl->data_pos = 0;
@@ -1777,7 +1792,14 @@ static void fdctrl_result_timer(void *opaque)
if (cur_drv->last_sect != 0) {
cur_drv->sect = (cur_drv->sect % cur_drv->last_sect) + 1;
}
- fdctrl_stop_transfer(fdctrl, 0x00, 0x00, 0x00);
+ /* READ_ID can't automatically succeed! */
+ if ((fdctrl->dsr & FD_DSR_DRATEMASK) != cur_drv->media_rate) {
+ FLOPPY_DPRINTF("read id rate mismatch (fdc=%d, media=%d)\n",
+ fdctrl->dsr & FD_DSR_DRATEMASK, cur_drv->media_rate);
+ fdctrl_stop_transfer(fdctrl, FD_SR0_ABNTERM, FD_SR1_MA, 0x00);
+ } else {
+ fdctrl_stop_transfer(fdctrl, 0x00, 0x00, 0x00);
+ }
}
static void fdctrl_change_cb(void *opaque, bool load)
--
1.7.7.3
- [Qemu-devel] [PATCH 00/10] Misc fixes for floppy emulation, Hervé Poussineau, 2012/01/08
- [Qemu-devel] [PATCH 02/10] fdc: set busy bit when starting a command, Hervé Poussineau, 2012/01/08
- [Qemu-devel] [PATCH 03/10] fdc: most control commands do not generate interrupts, Hervé Poussineau, 2012/01/08
- [Qemu-devel] [PATCH 04/10] fdc: emulate stepping 0, Hervé Poussineau, 2012/01/08
- [Qemu-devel] [PATCH 01/10] fdc: take head count into account, Hervé Poussineau, 2012/01/08
- [Qemu-devel] [PATCH 05/10] fdc: handle read-only floppies (abort early on write commands), Hervé Poussineau, 2012/01/08
- [Qemu-devel] [PATCH 06/10] block: add a transfer rate for floppy types, Hervé Poussineau, 2012/01/08
- [Qemu-devel] [PATCH 07/10] fdc: check if media rate is correct before doing any transfer,
Hervé Poussineau <=
- [Qemu-devel] [PATCH 08/10] fdc: add CCR (Configuration Control Register) write register, Hervé Poussineau, 2012/01/08
- [Qemu-devel] [PATCH 10/10] fdc: DIR (Digital Input Register) should return status of current drive..., Hervé Poussineau, 2012/01/08
- [Qemu-devel] [PATCH 09/10] fdc: fix seek command, which shouldn't check tracks, Hervé Poussineau, 2012/01/08