From 997aa1eee4199a69e44a3734d00e680b530d57f1 Mon Sep 17 00:00:00 2001
From: OBattler <oubattler@gmail.com>
Date: Sun, 21 Jun 2020 03:18:25 +0200
Subject: [PATCH] More minor FDC changes.

---
 src/floppy/fdc.c | 6 ++----
 1 file changed, 2 insertions(+), 4 deletions(-)

diff --git a/src/floppy/fdc.c b/src/floppy/fdc.c
index b6f068bc5..64e1735cd 100644
--- a/src/floppy/fdc.c
+++ b/src/floppy/fdc.c
@@ -787,11 +787,9 @@ fdc_write(uint16_t addr, uint8_t val, void *priv)
 			}
 			drive_num = real_drive(fdc, val & 0x03);
 			current_drive = drive_num;
-			fdc->st0 &= ~0x07;
-			fdc->st0 |= real_drive(fdc, drive_num);
-			fdc->st0 |= (fdd_get_head(drive_num) ? 4 : 0);
+			fdc->st0 = (fdc->st0 & 0xf8) | (val & 0x03) | (fdd_get_head(drive_num) ? 4 : 0);
 		}
-		fdc->dor=val;
+		fdc->dor = val;
 		return;
 	case 3:	/* TDR */
 		if (fdc->enh_mode) {