commit 3ddb42f38f5054aa6eed7971f10da0adc076c74e
author Nikolay Nikolov <nickysn@users.sourceforge.net> Sun Feb 04 17:26:56 2018 +0200
committer Kevin O'Connor <kevin@koconnor.net> Wed Feb 07 21:16:06 2018 -0500
tree 172260f11103ad42e16ddd4fc9b9e5b64d87735a
parent 14d91c353e19b7085fdbb7b2dcc43f3355665670

floppy: Introduce the floppy_dor_read() function

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

src/hw/floppy.c

diff --git a/src/hw/floppy.c b/src/hw/floppy.c
index f2577c5..9c44a58 100644
--- a/src/hw/floppy.c
+++ b/src/hw/floppy.c
@@ -180,6 +180,12 @@
 
 u8 FloppyDOR VARLOW;
 
+static inline u8
+floppy_dor_read(void)
+{
+    return GET_LOW(FloppyDOR);
+}
+
 static inline void
 floppy_dor_write(u8 val)
 {
@@ -318,7 +324,7 @@
 floppy_drive_pio(u8 floppyid, int command, u8 *param)
 {
     // Enable controller if it isn't running.
-    if (!(GET_LOW(FloppyDOR) & 0x04)) {
+    if (!(floppy_dor_read() & 0x04)) {
         int ret = floppy_enable_controller();
         if (ret)
             return ret;
@@ -668,6 +674,6 @@
         SET_BDA(floppy_motor_counter, fcount);
         if (fcount == 0)
             // turn motor(s) off
-            floppy_dor_write(GET_LOW(FloppyDOR) & ~0xf0);
+            floppy_dor_write(floppy_dor_read() & ~0xf0);
     }
 }