From: Nikolay Nikolov <nickysn@users.sourceforge.net>
Date: Sat, 10 Feb 2018 11:52:15 +0000 (+0200)
Subject: floppy: Support up to 4 floppy drives when turning on the floppy motor
X-Git-Tag: rel-1.12.0~39
X-Git-Url: http://xenbits.xensource.com/gitweb?a=commitdiff_plain;h=81f45a62e8692bd84276d570833fec2a77c25c8e;p=seabios.git

floppy: Support up to 4 floppy drives when turning on the floppy motor

The previous version allowed for only two floppies.

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

diff --git a/src/hw/floppy.c b/src/hw/floppy.c
index 5a7e6b9..730aadc 100644
--- a/src/hw/floppy.c
+++ b/src/hw/floppy.c
@@ -358,7 +358,7 @@ floppy_drive_pio(u8 floppyid, int command, u8 *param)
     SET_BDA(floppy_motor_counter, 255);
 
     // Turn on motor of selected drive, DMA & int enabled, normal operation
-    floppy_dor_write((floppyid ? FLOPPY_DOR_MOTOR_B : FLOPPY_DOR_MOTOR_A) | FLOPPY_DOR_IRQ | FLOPPY_DOR_RESET | floppyid);
+    floppy_dor_write((FLOPPY_DOR_MOTOR_A << floppyid) | FLOPPY_DOR_IRQ | FLOPPY_DOR_RESET | floppyid);
 
     // Send command.
     int ret = floppy_pio(command, param);