BIOS floppy handling code moved to where it will really live.

2 files changed, 87 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 );
diff --git a/src/arch/i386/include/bios_disks.h b/src/arch/i386/include/bios_disks.h
new file mode 100644
index 00000000..1a2c31aa
--- /dev/null
+++ b/src/arch/i386/include/bios_disks.h
@@ -0,0 +1,68 @@
+#ifndef BIOS_DISKS_H
+#define BIOS_DISKS_H
+
+#include "dev.h"
+
+/*
+ * Constants
+ *
+ */
+
+#define	BIOS_DISK_MAX_NAME_LEN	6
+
+struct bios_disk_sector {
+	char data[512];
+};
+
+/*
+ * The location of a BIOS disk
+ *
+ */
+struct bios_disk_loc {
+	uint8_t drive;
+};
+
+/*
+ * A physical BIOS disk device
+ *
+ */
+struct bios_disk_device {
+	char name[BIOS_DISK_MAX_NAME_LEN];
+	uint8_t drive;
+	uint8_t type;
+};
+
+/*
+ * A BIOS disk driver, with a valid device ID range and naming
+ * function.
+ *
+ */
+struct bios_disk_driver {
+	void ( *fill_drive_name ) ( char *buf, uint8_t drive );
+	uint8_t min_drive;
+	uint8_t max_drive;
+};
+
+/*
+ * Define a BIOS disk driver
+ *
+ */
+#define BIOS_DISK_DRIVER( _fill_drive_name, _min_drive, _max_drive ) {	      \
+	.fill_drive_name = _fill_drive_name,				      \
+	.min_drive = _min_drive,					      \
+	.max_drive = _max_drive,					      \
+}
+
+/*
+ * Functions in bios_disks.c
+ *
+ */
+
+
+/*
+ * bios_disk bus global definition
+ *
+ */
+extern struct bus_driver bios_disk_driver;
+
+#endif /* BIOS_DISKS_H */