[pcbios] Don't use "lret $2" to return from an interrupt
[people/lynusvaz/gpxe.git] / src / arch / i386 / firmware / pcbios / fakee820.c
1 /* Copyright (C) 2008 Michael Brown <mbrown@fensystems.co.uk>.
2  *
3  * This program is free software; you can redistribute it and/or
4  * modify it under the terms of the GNU General Public License as
5  * published by the Free Software Foundation; either version 2 of the
6  * License, or any later version.
7  *
8  * This program is distributed in the hope that it will be useful, but
9  * WITHOUT ANY WARRANTY; without even the implied warranty of
10  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
11  * General Public License for more details.
12  *
13  * You should have received a copy of the GNU General Public License
14  * along with this program; if not, write to the Free Software
15  * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
16  */
17
18 #include <realmode.h>
19 #include <biosint.h>
20
21 /** Assembly routine in inline asm */
22 extern void int15_fakee820();
23
24 /** Original INT 15 handler */
25 static struct segoff __text16 ( real_int15_vector );
26 #define real_int15_vector __use_text16 ( real_int15_vector )
27
28 /** An INT 15,e820 memory map entry */
29 struct e820_entry {
30         /** Start of region */
31         uint64_t start;
32         /** Length of region */
33         uint64_t len;
34         /** Type of region */
35         uint32_t type;
36 } __attribute__ (( packed ));
37
38 #define E820_TYPE_RAM           1 /**< Normal memory */
39 #define E820_TYPE_RSVD          2 /**< Reserved and unavailable */
40 #define E820_TYPE_ACPI          3 /**< ACPI reclaim memory */
41 #define E820_TYPE_NVS           4 /**< ACPI NVS memory */
42
43 /** Fake e820 map */
44 static struct e820_entry __text16_array ( e820map, [] ) __used = {
45         { 0x00000000ULL, ( 0x000a0000ULL - 0x00000000ULL ), E820_TYPE_RAM },
46         { 0x00100000ULL, ( 0xcfb50000ULL - 0x00100000ULL ), E820_TYPE_RAM },
47         { 0xcfb50000ULL, ( 0xcfb64000ULL - 0xcfb50000ULL ), E820_TYPE_RSVD },
48         { 0xcfb64000ULL, ( 0xcfb66000ULL - 0xcfb64000ULL ), E820_TYPE_RSVD },
49         { 0xcfb66000ULL, ( 0xcfb85c00ULL - 0xcfb66000ULL ), E820_TYPE_ACPI },
50         { 0xcfb85c00ULL, ( 0xd0000000ULL - 0xcfb85c00ULL ), E820_TYPE_RSVD },
51         { 0xe0000000ULL, ( 0xf0000000ULL - 0xe0000000ULL ), E820_TYPE_RSVD },
52         { 0xfe000000ULL, (0x100000000ULL - 0xfe000000ULL ), E820_TYPE_RSVD },
53         {0x100000000ULL, (0x230000000ULL -0x100000000ULL ), E820_TYPE_RAM },
54 };
55 #define e820map __use_text16 ( e820map )
56
57 void fake_e820 ( void ) {
58         __asm__ __volatile__ (
59                 TEXT16_CODE ( "\nint15_fakee820:\n\t"
60                               "pushfw\n\t"
61                               "cmpl $0xe820, %%eax\n\t"
62                               "jne 99f\n\t"
63                               "cmpl $0x534d4150, %%edx\n\t"
64                               "jne 99f\n\t"
65                               "pushaw\n\t"
66                               "movw %%sp, %%bp\n\t"
67                               "andb $~0x01, 22(%%bp)\n\t" /* Clear return CF */
68                               "leaw e820map(%%bx), %%si\n\t"
69                               "cs rep movsb\n\t"
70                               "popaw\n\t"
71                               "movl %%edx, %%eax\n\t"
72                               "addl $20, %%ebx\n\t"
73                               "cmpl %0, %%ebx\n\t"
74                               "jne 1f\n\t"
75                               "xorl %%ebx,%%ebx\n\t"
76                               "\n1:\n\t"
77                               "popfw\n\t"
78                               "iret\n\t"
79                               "\n99:\n\t"
80                               "popfw\n\t"
81                               "ljmp *%%cs:real_int15_vector\n\t" )
82                 : : "i" ( sizeof ( e820map ) ) );
83
84         hook_bios_interrupt ( 0x15, ( unsigned int ) int15_fakee820,
85                               &real_int15_vector );
86 }
87
88 void unfake_e820 ( void ) {
89         unhook_bios_interrupt ( 0x15, ( unsigned int ) int15_fakee820,
90                                 &real_int15_vector );
91 }