[SeaBIOS] [PATCH 1/6] Introduce floppy_dor_mask()
Nikolay Nikolov
nickysn at users.sourceforge.net
Sat Feb 3 18:32:50 CET 2018
Signed-off-by: Nikolay Nikolov <nickysn at users.sourceforge.net>
---
src/hw/floppy.c | 8 +++++++-
1 file changed, 7 insertions(+), 1 deletion(-)
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);
}
}
--
2.14.3
More information about the SeaBIOS
mailing list