floppy: Reset the floppy motor count in floppy_drive_pio()

Reset the floppy motor count, so the motor keeps spinning 2 seconds
after a floppy operation, performed by floppy_drive_pio().

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

diff --git a/src/hw/floppy.c b/src/hw/floppy.c
index 573c45f50b4d0aa7f0b10345375322ae9fc441db..77dbade3153dfc0933300423256f210539bb6cb4 100644 (file)
--- a/src/hw/floppy.c
+++ b/src/hw/floppy.c
@@ -356,6 +356,7 @@ floppy_drive_pio(u8 floppyid, int command, u8 *param)
 
     // Send command.
     int ret = floppy_pio(command, param);
+    SET_BDA(floppy_motor_counter, FLOPPY_MOTOR_TICKS); // reset motor timeout
     if (ret)
         return ret;