From: Kevin O'Connor <kevin@koconnor.net>
Date: Sun, 3 Mar 2013 20:32:31 +0000 (-0500)
Subject: floppy: Actually do controller reset in floppy_reset().
X-Git-Tag: rel-1.7.3~47
X-Git-Url: http://xenbits.xensource.com/gitweb?a=commitdiff_plain;h=5bb7552a911d9952591e433ab8e36a5cd7a419e8;p=seabios.git

floppy: Actually do controller reset in floppy_reset().

Signed-off-by: Kevin O'Connor <kevin@koconnor.net>
---

diff --git a/src/floppy.c b/src/floppy.c
index e335e86..74336bc 100644
--- a/src/floppy.c
+++ b/src/floppy.c
@@ -529,8 +529,14 @@ static int
 floppy_reset(struct disk_op_s *op)
 {
     u8 floppyid = GET_GLOBAL(op->drive_g->cntl_id);
-    set_diskette_current_cyl(floppyid, 0); // current cylinder
-    return DISK_RET_SUCCESS;
+    SET_BDA(floppy_recalibration_status, 0);
+    SET_BDA(floppy_media_state[0], 0);
+    SET_BDA(floppy_media_state[1], 0);
+    SET_BDA(floppy_track[0], 0);
+    SET_BDA(floppy_track[1], 0);
+    SET_BDA(floppy_last_data_rate, 0);
+    floppy_disable_controller();
+    return floppy_select_drive(floppyid);
 }
 
 // Read Diskette Sectors