1 files changed, 19 insertions, 79 deletions
diff --git a/src/arch/i386/drivers/disk/floppy.c b/src/arch/i386/drivers/disk/floppy.c
index 9cb0a22d..86527339 100644
--- a/src/arch/i386/drivers/disk/floppy.c
+++ b/src/arch/i386/drivers/disk/floppy.c
@@ -1,88 +1,28 @@
-#if	(TRY_FLOPPY_FIRST > 0)
+#include "console.h"
+#include "disk.h"
+#include "bios_disks.h"
 
-/*
- * This program is free software; you can redistribute it and/or
- * modify it under the terms of the GNU General Public License as
- * published by the Free Software Foundation; either version 2, or (at
- * your option) any later version.
- */
-
-#include "etherboot.h"
-
-#define BOOTSECT ((char *)0x7C00)
-#define BOOTSIG  ((unsigned short *)BOOTSECT)[0xFF]
-#define PARTTAB  ((partentry *)(BOOTSECT+0x1BE))
+static void fill_floppy_name ( char *buf, uint8_t drive ) {
+	sprintf ( buf, "fd%d", drive );
+}
 
-typedef struct partentry {
-	unsigned char flags;
-	unsigned char start_head;
-	unsigned char start_sector;
-	unsigned char start_cylinder;
-	unsigned char type;
-	unsigned char end_head;
-	unsigned char end_sector;
-	unsigned char end_cylinder;
-	unsigned long offset;
-	unsigned long length;
-} partentry;
+static struct disk_operations floppy_operations = {
 
-static unsigned int disk_read_retry(int dev,int c,int h,int s)
-{
-	int retry = 3,rc;
+};
 
-	while (retry-- && (rc = pcbios_disk_read(dev,c,h,s,BOOTSECT)) != 0);
-	if (BOOTSIG != 0xAA55) {
-		printf("not a boot sector");
-		return(0xFFFF); }
-	return(rc);
+static int floppy_probe ( struct disk *disk,
+			  struct bios_disk_device *bios_disk ) {
+	
+	return 1;
 }
 
-int bootdisk(int dev,int part)
-{
-	int rc;
-
-	disk_init();
-	if ((rc = disk_read_retry(dev,0,0,1)) != 0) {
-	readerr:
-		if (rc != 0xFFFF)
-			printf("read error (%#hhX)",rc/256);
-		return(0); }
-	if (part) {
-		partentry *ptr;
-
-		if (part >= 5) {
-			int i;
-			for (i = 0, ptr = PARTTAB; ptr->type != 5; ptr++)
-				if (++i == 4) {
-					printf("partition not found");
-					return(0); }
-			if ((rc = disk_read_retry(dev,
-						  ptr->start_cylinder,
-						  ptr->start_head,
-						  ptr->start_sector)) != 0)
-				goto readerr;
-			part -= 4; }
-		if (!(ptr = PARTTAB-1+part)->type) {
-			printf("empty partition");
-			return(0); }
-		if ((rc = disk_read_retry(dev,
-					  ptr->start_cylinder,
-					  ptr->start_head,
-					  ptr->start_sector)) != 0)
-			goto readerr; }
-	cleanup();
-	gateA20_unset();
-	/* Set %edx to device number to emulate BIOS
-	   Fortunately %edx is not used after this */
-	__asm__("movl %0,%%edx" : : "g" (dev));
-	xstart((unsigned long)BOOTSECT, 0, 0);
-	return(0);
+static void floppy_disable ( struct disk *disk,
+			     struct bios_disk_device *bios_disk ) {
+	
 }
 
-#endif
+static struct bios_disk_driver floppy_driver =
+	BIOS_DISK_DRIVER ( fill_floppy_name, 0x00, 0x7f );
 
-/*
- * Local variables:
- *  c-basic-offset: 8
- * End:
- */
+DRIVER ( "floppy", disk_driver, bios_disk_driver, floppy_driver,
+	 floppy_probe, floppy_disable );