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

This commit is contained in:
Michael Brown
2005-04-25 19:29:55 +00:00
parent 10b7b1a61f
commit fcee25024f
3 changed files with 93 additions and 80 deletions

View File

@@ -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))
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 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 void fill_floppy_name ( char *buf, uint8_t drive ) {
sprintf ( buf, "fd%d", drive );
}
int bootdisk(int dev,int part)
{
int rc;
static struct disk_operations floppy_operations = {
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 int floppy_probe ( struct disk *disk,
struct bios_disk_device *bios_disk ) {
return 1;
}
#endif
static void floppy_disable ( struct disk *disk,
struct bios_disk_device *bios_disk ) {
}
/*
* Local variables:
* c-basic-offset: 8
* End:
*/
static struct bios_disk_driver floppy_driver =
BIOS_DISK_DRIVER ( fill_floppy_name, 0x00, 0x7f );
DRIVER ( "floppy", disk_driver, bios_disk_driver, floppy_driver,
floppy_probe, floppy_disable );