Code fixed to operate correctly.
[people/lynusvaz/gpxe.git] / src / arch / i386 / drivers / bus / bios_disks.c
1 #include "realmode.h"
2
3 #define CF ( 1 << 0 )
4
5 struct disk_sector {
6         char data[512];
7 };
8
9 /*
10  * Reset the disk system using INT 13,0.  Forces both hard disks and
11  * floppy disks to seek back to track 0.
12  *
13  */
14 static void disk_init ( void ) {
15         REAL_EXEC ( rm_disk_init,
16                     "sti\n\t"
17                     "xorw %%ax,%%ax\n\t"
18                     "movb $0x80,%%dl\n\t"
19                     "int $0x13\n\t"
20                     "cli\n\t",
21                     0,
22                     OUT_CONSTRAINTS (),
23                     IN_CONSTRAINTS (),
24                     CLOBBER ( "eax", "ebx", "ecx", "edx",
25                               "ebp", "esi", "edi" ) );
26 }
27
28 /*
29  * Read a single sector from a disk using INT 13,2.
30  *
31  * Returns the BIOS status code (%ah) - 0 indicates success
32  *
33  */
34 static unsigned int pcbios_disk_read ( int drive, int cylinder, int head,
35                                        int sector, struct disk_sector *buf ) {
36         uint16_t basemem_buf, status, flags;
37         int discard_c, discard_d;
38
39         basemem_buf = BASEMEM_PARAMETER_INIT ( *buf );
40         REAL_EXEC ( rm_pcbios_disk_read,
41                     "sti\n\t"
42                     "movw $0x0201, %%ax\n\t" /* Read a single sector */
43                     "int $0x13\n\t"
44                     "pushfw\n\t"
45                     "popw %%bx\n\t"
46                     "cli\n\t",
47                     4,
48                     OUT_CONSTRAINTS ( "=a" ( status ), "=b" ( flags ),
49                                       "=c" ( discard_c ), "=d" ( discard_d ) ),
50                     IN_CONSTRAINTS ( "c" ( ( ( cylinder & 0xff ) << 8 ) |
51                                            ( ( cylinder >> 8 ) & 0x3 ) |
52                                            sector ),
53                                      "d" ( ( head << 8 ) | drive ),
54                                      "b" ( basemem_buf ) ),
55                     CLOBBER ( "ebp", "esi", "edi" ) );
56         BASEMEM_PARAMETER_DONE ( *buf );
57
58         return ( flags & CF ) ? ( status >> 8 ) : 0;
59 }