From: Nikolay Nikolov <nickysn@users.sourceforge.net>
Date: Sun, 4 Feb 2018 15:26:57 +0000 (+0200)
Subject: floppy: Introduce floppy_dor_mask()
X-Git-Tag: rel-1.12.0~46
X-Git-Url: http://xenbits.xensource.com/gitweb?a=commitdiff_plain;h=5157a7882de8b50c2365fd9166c5d91861a478a2;p=seabios.git

floppy: Introduce floppy_dor_mask()

Signed-off-by: Nikolay Nikolov <nickysn@users.sourceforge.net>
---

diff --git a/src/hw/floppy.c b/src/hw/floppy.c
index 9c44a58..f45676e 100644
--- a/src/hw/floppy.c
+++ b/src/hw/floppy.c
@@ -193,6 +193,12 @@ floppy_dor_write(u8 val)
     SET_LOW(FloppyDOR, val);
 }
 
+static inline void
+floppy_dor_mask(u8 off, u8 on)
+{
+    floppy_dor_write((floppy_dor_read() & ~off) | on);
+}
+
 static void
 floppy_disable_controller(void)
 {
@@ -674,6 +680,6 @@ floppy_tick(void)
         SET_BDA(floppy_motor_counter, fcount);
         if (fcount == 0)
             // turn motor(s) off
-            floppy_dor_write(floppy_dor_read() & ~0xf0);
+            floppy_dor_mask(0xf0, 0);
     }
 }