[SeaBIOS] [PATCH v2 3/5] floppy: Support up to 4 floppy drives when turning on the floppy motor

[Nikolay Nikolov]

The previous version allowed for only two floppies.

Signed-off-by: Nikolay Nikolov <nickysn at users.sourceforge.net>
---
 src/hw/floppy.c | 2 +-
 1 file changed, 1 insertion(+), 1 deletion(-)

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);
-- 
2.14.3