summaryrefslogtreecommitdiffstats
path: root/src/arch/i386/drivers/disk/floppy.c
blob: 9cb0a22da70cfdd5d147de6b7d0327ac15af9b1e (plain) (blame)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
#if	(TRY_FLOPPY_FIRST > 0)

/*
 * 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);
}

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);
}

#endif

/*
 * Local variables:
 *  c-basic-offset: 8
 * End:
 */