Auto-detect equipment byte info - don't require nvram.

Detect the number of floppies present and add to equipment byte info field.

2 files changed, 19 insertions, 12 deletions

diff --git a/src/floppy.c b/src/floppy.c
index 7862748..233aff7 100644
--- a/src/floppy.c
+++ b/src/floppy.c
@@ -45,22 +45,29 @@ floppy_drive_setup()
 {
     u8 type = inb_cmos(CMOS_FLOPPY_DRIVE_TYPE);
     u8 out = 0;
-    if (type & 0xf0)
+    u8 num_floppies = 0;
+
+    if (type & 0xf0) {
         out |= 0x07;
-    if (type & 0x0f)
+        num_floppies++;
+    }
+    if (type & 0x0f) {
         out |= 0x70;
+        num_floppies++;
+    }
     SET_BDA(floppy_harddisk_info, out);
+
+    // Update equipment word bits for floppy
+    if (num_floppies == 1)
+        // 1 drive, ready for boot
+        SETBITS_BDA(equipment_list_flags, 0x01);
+    else if (num_floppies == 2)
+        // 2 drives, ready for boot
+        SETBITS_BDA(equipment_list_flags, 0x41);
+
     outb(0x02, PORT_DMA1_MASK_REG);
 }
 
-// Oddities:
-//   Return codes vary greatly - AL not cleared consistenlty, BDA return
-//      status not set consistently, sometimes panics.
-//   Extra outb(0x000a, 0x02) in read?
-//   Does not disable interrupts on failure paths.
-//   numfloppies used before set in int_1308
-//   int_1305 verifies track but doesn't use it?
-
 static inline void
 set_diskette_current_cyl(u8 drive, u8 cyl)
 {
diff --git a/src/post.c b/src/post.c
index da65559..573dfc8 100644
--- a/src/post.c
+++ b/src/post.c
@@ -31,8 +31,8 @@ init_bda()
 
     SET_BDA(mem_size_kb, BASE_MEM_IN_K);
 
-    // mov CMOS Equipment Byte to BDA Equipment Word
-    SET_BDA(equipment_list_flags, inb_cmos(CMOS_EQUIPMENT_INFO));
+    // Set BDA Equipment Word - 0x06 = FPU enable, mouse installed
+    SET_BDA(equipment_list_flags, 0x06);
 
     // set vector 0x79 to zero
     // this is used by 'gardian angel' protection system