diff options
Diffstat (limited to 'arch/i386')
44 files changed, 4291 insertions, 3663 deletions
diff --git a/arch/i386/Kconfig.cpu b/arch/i386/Kconfig.cpu index 5c95ceb7f122..9cbe76c3aa35 100644 --- a/arch/i386/Kconfig.cpu +++ b/arch/i386/Kconfig.cpu | |||
@@ -344,8 +344,8 @@ config X86_CMOV | |||
344 | depends on (MK7 || MPENTIUM4 || MPENTIUMM || MPENTIUMIII || MPENTIUMII || M686 || MVIAC3_2 || MVIAC7) | 344 | depends on (MK7 || MPENTIUM4 || MPENTIUMM || MPENTIUMIII || MPENTIUMII || M686 || MVIAC3_2 || MVIAC7) |
345 | default y | 345 | default y |
346 | 346 | ||
347 | config X86_MINIMUM_CPU_MODEL | 347 | config X86_MINIMUM_CPU_FAMILY |
348 | int | 348 | int |
349 | default "4" if X86_XADD || X86_CMPXCHG || X86_BSWAP | 349 | default "4" if X86_XADD || X86_CMPXCHG || X86_BSWAP || X86_WP_WORKS_OK |
350 | default "0" | 350 | default "3" |
351 | 351 | ||
diff --git a/arch/i386/boot/Makefile b/arch/i386/boot/Makefile index bfbc32098a4a..08678a0a3d19 100644 --- a/arch/i386/boot/Makefile +++ b/arch/i386/boot/Makefile | |||
@@ -25,27 +25,56 @@ SVGA_MODE := -DSVGA_MODE=NORMAL_VGA | |||
25 | 25 | ||
26 | #RAMDISK := -DRAMDISK=512 | 26 | #RAMDISK := -DRAMDISK=512 |
27 | 27 | ||
28 | targets := vmlinux.bin bootsect bootsect.o \ | 28 | targets := vmlinux.bin setup.bin setup.elf zImage bzImage |
29 | setup setup.o zImage bzImage | ||
30 | subdir- := compressed | 29 | subdir- := compressed |
31 | 30 | ||
31 | setup-y += a20.o apm.o cmdline.o copy.o cpu.o cpucheck.o edd.o | ||
32 | setup-y += header.o main.o mca.o memory.o pm.o pmjump.o | ||
33 | setup-y += printf.o string.o tty.o video.o version.o voyager.o | ||
34 | |||
35 | # The link order of the video-*.o modules can matter. In particular, | ||
36 | # video-vga.o *must* be listed first, followed by video-vesa.o. | ||
37 | # Hardware-specific drivers should follow in the order they should be | ||
38 | # probed, and video-bios.o should typically be last. | ||
39 | setup-y += video-vga.o | ||
40 | setup-y += video-vesa.o | ||
41 | setup-y += video-bios.o | ||
42 | |||
32 | hostprogs-y := tools/build | 43 | hostprogs-y := tools/build |
33 | 44 | ||
34 | HOSTCFLAGS_build.o := $(LINUXINCLUDE) | 45 | HOSTCFLAGS_build.o := $(LINUXINCLUDE) |
35 | 46 | ||
36 | # --------------------------------------------------------------------------- | 47 | # --------------------------------------------------------------------------- |
37 | 48 | ||
49 | # How to compile the 16-bit code. Note we always compile for -march=i386, | ||
50 | # that way we can complain to the user if the CPU is insufficient. | ||
51 | cflags-i386 := | ||
52 | cflags-x86_64 := -m32 | ||
53 | CFLAGS := $(LINUXINCLUDE) -g -Os -D_SETUP -D__KERNEL__ \ | ||
54 | $(cflags-$(ARCH)) \ | ||
55 | -Wall -Wstrict-prototypes \ | ||
56 | -march=i386 -mregparm=3 \ | ||
57 | -include $(srctree)/$(src)/code16gcc.h \ | ||
58 | -fno-strict-aliasing -fomit-frame-pointer \ | ||
59 | $(call cc-option, -ffreestanding) \ | ||
60 | $(call cc-option, -fno-toplevel-reorder,\ | ||
61 | $(call cc-option, -fno-unit-at-a-time)) \ | ||
62 | $(call cc-option, -fno-stack-protector) \ | ||
63 | $(call cc-option, -mpreferred-stack-boundary=2) | ||
64 | AFLAGS := $(CFLAGS) -D__ASSEMBLY__ | ||
65 | |||
38 | $(obj)/zImage: IMAGE_OFFSET := 0x1000 | 66 | $(obj)/zImage: IMAGE_OFFSET := 0x1000 |
39 | $(obj)/zImage: EXTRA_AFLAGS := $(SVGA_MODE) $(RAMDISK) | 67 | $(obj)/zImage: EXTRA_AFLAGS := $(SVGA_MODE) $(RAMDISK) |
40 | $(obj)/bzImage: IMAGE_OFFSET := 0x100000 | 68 | $(obj)/bzImage: IMAGE_OFFSET := 0x100000 |
69 | $(obj)/bzImage: EXTRA_CFLAGS := -D__BIG_KERNEL__ | ||
41 | $(obj)/bzImage: EXTRA_AFLAGS := $(SVGA_MODE) $(RAMDISK) -D__BIG_KERNEL__ | 70 | $(obj)/bzImage: EXTRA_AFLAGS := $(SVGA_MODE) $(RAMDISK) -D__BIG_KERNEL__ |
42 | $(obj)/bzImage: BUILDFLAGS := -b | 71 | $(obj)/bzImage: BUILDFLAGS := -b |
43 | 72 | ||
44 | quiet_cmd_image = BUILD $@ | 73 | quiet_cmd_image = BUILD $@ |
45 | cmd_image = $(obj)/tools/build $(BUILDFLAGS) $(obj)/bootsect $(obj)/setup \ | 74 | cmd_image = $(obj)/tools/build $(BUILDFLAGS) $(obj)/setup.bin \ |
46 | $(obj)/vmlinux.bin $(ROOT_DEV) > $@ | 75 | $(obj)/vmlinux.bin $(ROOT_DEV) > $@ |
47 | 76 | ||
48 | $(obj)/zImage $(obj)/bzImage: $(obj)/bootsect $(obj)/setup \ | 77 | $(obj)/zImage $(obj)/bzImage: $(obj)/setup.bin \ |
49 | $(obj)/vmlinux.bin $(obj)/tools/build FORCE | 78 | $(obj)/vmlinux.bin $(obj)/tools/build FORCE |
50 | $(call if_changed,image) | 79 | $(call if_changed,image) |
51 | @echo 'Kernel: $@ is ready' ' (#'`cat .version`')' | 80 | @echo 'Kernel: $@ is ready' ' (#'`cat .version`')' |
@@ -53,12 +82,17 @@ $(obj)/zImage $(obj)/bzImage: $(obj)/bootsect $(obj)/setup \ | |||
53 | $(obj)/vmlinux.bin: $(obj)/compressed/vmlinux FORCE | 82 | $(obj)/vmlinux.bin: $(obj)/compressed/vmlinux FORCE |
54 | $(call if_changed,objcopy) | 83 | $(call if_changed,objcopy) |
55 | 84 | ||
56 | LDFLAGS_bootsect := -Ttext 0x0 -s --oformat binary | 85 | SETUP_OBJS = $(addprefix $(obj)/,$(setup-y)) |
57 | LDFLAGS_setup := -Ttext 0x0 -s --oformat binary -e begtext | ||
58 | 86 | ||
59 | $(obj)/setup $(obj)/bootsect: %: %.o FORCE | 87 | LDFLAGS_setup.elf := -T |
88 | $(obj)/setup.elf: $(src)/setup.ld $(SETUP_OBJS) FORCE | ||
60 | $(call if_changed,ld) | 89 | $(call if_changed,ld) |
61 | 90 | ||
91 | OBJCOPYFLAGS_setup.bin := -O binary | ||
92 | |||
93 | $(obj)/setup.bin: $(obj)/setup.elf FORCE | ||
94 | $(call if_changed,objcopy) | ||
95 | |||
62 | $(obj)/compressed/vmlinux: FORCE | 96 | $(obj)/compressed/vmlinux: FORCE |
63 | $(Q)$(MAKE) $(build)=$(obj)/compressed IMAGE_OFFSET=$(IMAGE_OFFSET) $@ | 97 | $(Q)$(MAKE) $(build)=$(obj)/compressed IMAGE_OFFSET=$(IMAGE_OFFSET) $@ |
64 | 98 | ||
diff --git a/arch/i386/boot/a20.c b/arch/i386/boot/a20.c new file mode 100644 index 000000000000..31348d054fca --- /dev/null +++ b/arch/i386/boot/a20.c | |||
@@ -0,0 +1,161 @@ | |||
1 | /* -*- linux-c -*- ------------------------------------------------------- * | ||
2 | * | ||
3 | * Copyright (C) 1991, 1992 Linus Torvalds | ||
4 | * Copyright 2007 rPath, Inc. - All Rights Reserved | ||
5 | * | ||
6 | * This file is part of the Linux kernel, and is made available under | ||
7 | * the terms of the GNU General Public License version 2. | ||
8 | * | ||
9 | * ----------------------------------------------------------------------- */ | ||
10 | |||
11 | /* | ||
12 | * arch/i386/boot/a20.c | ||
13 | * | ||
14 | * Enable A20 gate (return -1 on failure) | ||
15 | */ | ||
16 | |||
17 | #include "boot.h" | ||
18 | |||
19 | #define MAX_8042_LOOPS 100000 | ||
20 | |||
21 | static int empty_8042(void) | ||
22 | { | ||
23 | u8 status; | ||
24 | int loops = MAX_8042_LOOPS; | ||
25 | |||
26 | while (loops--) { | ||
27 | io_delay(); | ||
28 | |||
29 | status = inb(0x64); | ||
30 | if (status & 1) { | ||
31 | /* Read and discard input data */ | ||
32 | io_delay(); | ||
33 | (void)inb(0x60); | ||
34 | } else if (!(status & 2)) { | ||
35 | /* Buffers empty, finished! */ | ||
36 | return 0; | ||
37 | } | ||
38 | } | ||
39 | |||
40 | return -1; | ||
41 | } | ||
42 | |||
43 | /* Returns nonzero if the A20 line is enabled. The memory address | ||
44 | used as a test is the int $0x80 vector, which should be safe. */ | ||
45 | |||
46 | #define A20_TEST_ADDR (4*0x80) | ||
47 | #define A20_TEST_SHORT 32 | ||
48 | #define A20_TEST_LONG 2097152 /* 2^21 */ | ||
49 | |||
50 | static int a20_test(int loops) | ||
51 | { | ||
52 | int ok = 0; | ||
53 | int saved, ctr; | ||
54 | |||
55 | set_fs(0x0000); | ||
56 | set_gs(0xffff); | ||
57 | |||
58 | saved = ctr = rdfs32(A20_TEST_ADDR); | ||
59 | |||
60 | while (loops--) { | ||
61 | wrfs32(++ctr, A20_TEST_ADDR); | ||
62 | io_delay(); /* Serialize and make delay constant */ | ||
63 | ok = rdgs32(A20_TEST_ADDR+0x10) ^ ctr; | ||
64 | if (ok) | ||
65 | break; | ||
66 | } | ||
67 | |||
68 | wrfs32(saved, A20_TEST_ADDR); | ||
69 | return ok; | ||
70 | } | ||
71 | |||
72 | /* Quick test to see if A20 is already enabled */ | ||
73 | static int a20_test_short(void) | ||
74 | { | ||
75 | return a20_test(A20_TEST_SHORT); | ||
76 | } | ||
77 | |||
78 | /* Longer test that actually waits for A20 to come on line; this | ||
79 | is useful when dealing with the KBC or other slow external circuitry. */ | ||
80 | static int a20_test_long(void) | ||
81 | { | ||
82 | return a20_test(A20_TEST_LONG); | ||
83 | } | ||
84 | |||
85 | static void enable_a20_bios(void) | ||
86 | { | ||
87 | asm volatile("pushfl; int $0x15; popfl" | ||
88 | : : "a" ((u16)0x2401)); | ||
89 | } | ||
90 | |||
91 | static void enable_a20_kbc(void) | ||
92 | { | ||
93 | empty_8042(); | ||
94 | |||
95 | outb(0xd1, 0x64); /* Command write */ | ||
96 | empty_8042(); | ||
97 | |||
98 | outb(0xdf, 0x60); /* A20 on */ | ||
99 | empty_8042(); | ||
100 | } | ||
101 | |||
102 | static void enable_a20_fast(void) | ||
103 | { | ||
104 | u8 port_a; | ||
105 | |||
106 | port_a = inb(0x92); /* Configuration port A */ | ||
107 | port_a |= 0x02; /* Enable A20 */ | ||
108 | port_a &= ~0x01; /* Do not reset machine */ | ||
109 | outb(port_a, 0x92); | ||
110 | } | ||
111 | |||
112 | /* | ||
113 | * Actual routine to enable A20; return 0 on ok, -1 on failure | ||
114 | */ | ||
115 | |||
116 | #define A20_ENABLE_LOOPS 255 /* Number of times to try */ | ||
117 | |||
118 | int enable_a20(void) | ||
119 | { | ||
120 | int loops = A20_ENABLE_LOOPS; | ||
121 | |||
122 | #if defined(CONFIG_X86_ELAN) | ||
123 | /* Elan croaks if we try to touch the KBC */ | ||
124 | enable_a20_fast(); | ||
125 | while (!a20_test_long()) | ||
126 | ; | ||
127 | return 0; | ||
128 | #elif defined(CONFIG_X86_VOYAGER) | ||
129 | /* On Voyager, a20_test() is unsafe? */ | ||
130 | enable_a20_kbc(); | ||
131 | return 0; | ||
132 | #else | ||
133 | while (loops--) { | ||
134 | /* First, check to see if A20 is already enabled | ||
135 | (legacy free, etc.) */ | ||
136 | if (a20_test_short()) | ||
137 | return 0; | ||
138 | |||
139 | /* Next, try the BIOS (INT 0x15, AX=0x2401) */ | ||
140 | enable_a20_bios(); | ||
141 | if (a20_test_short()) | ||
142 | return 0; | ||
143 | |||
144 | /* Try enabling A20 through the keyboard controller */ | ||
145 | empty_8042(); | ||
146 | if (a20_test_short()) | ||
147 | return 0; /* BIOS worked, but with delayed reaction */ | ||
148 | |||
149 | enable_a20_kbc(); | ||
150 | if (a20_test_long()) | ||
151 | return 0; | ||
152 | |||
153 | /* Finally, try enabling the "fast A20 gate" */ | ||
154 | enable_a20_fast(); | ||
155 | if (a20_test_long()) | ||
156 | return 0; | ||
157 | } | ||
158 | |||
159 | return -1; | ||
160 | #endif | ||
161 | } | ||
diff --git a/arch/i386/boot/apm.c b/arch/i386/boot/apm.c new file mode 100644 index 000000000000..a34087c370c0 --- /dev/null +++ b/arch/i386/boot/apm.c | |||
@@ -0,0 +1,97 @@ | |||
1 | /* -*- linux-c -*- ------------------------------------------------------- * | ||
2 | * | ||
3 | * Copyright (C) 1991, 1992 Linus Torvalds | ||
4 | * Copyright 2007 rPath, Inc. - All Rights Reserved | ||
5 | * | ||
6 | * Original APM BIOS checking by Stephen Rothwell, May 1994 | ||
7 | * (sfr@canb.auug.org.au) | ||
8 | * | ||
9 | * This file is part of the Linux kernel, and is made available under | ||
10 | * the terms of the GNU General Public License version 2. | ||
11 | * | ||
12 | * ----------------------------------------------------------------------- */ | ||
13 | |||
14 | /* | ||
15 | * arch/i386/boot/apm.c | ||
16 | * | ||
17 | * Get APM BIOS information | ||
18 | */ | ||
19 | |||
20 | #include "boot.h" | ||
21 | |||
22 | #if defined(CONFIG_APM) || defined(CONFIG_APM_MODULE) | ||
23 | |||
24 | int query_apm_bios(void) | ||
25 | { | ||
26 | u16 ax, bx, cx, dx, di; | ||
27 | u32 ebx, esi; | ||
28 | u8 err; | ||
29 | |||
30 | /* APM BIOS installation check */ | ||
31 | ax = 0x5300; | ||
32 | bx = cx = 0; | ||
33 | asm volatile("pushl %%ebp ; int $0x15 ; popl %%ebp ; setc %0" | ||
34 | : "=d" (err), "+a" (ax), "+b" (bx), "+c" (cx) | ||
35 | : : "esi", "edi"); | ||
36 | |||
37 | if (err) | ||
38 | return -1; /* No APM BIOS */ | ||
39 | |||
40 | if (bx != 0x504d) /* "PM" signature */ | ||
41 | return -1; | ||
42 | |||
43 | if (cx & 0x02) /* 32 bits supported? */ | ||
44 | return -1; | ||
45 | |||
46 | /* Disconnect first, just in case */ | ||
47 | ax = 0x5304; | ||
48 | asm volatile("pushl %%ebp ; int $0x15 ; popl %%ebp" | ||
49 | : "+a" (ax) | ||
50 | : : "ebx", "ecx", "edx", "esi", "edi"); | ||
51 | |||
52 | /* Paranoia */ | ||
53 | ebx = esi = 0; | ||
54 | cx = dx = di = 0; | ||
55 | |||
56 | /* 32-bit connect */ | ||
57 | asm volatile("pushl %%ebp ; int $0x15 ; popl %%ebp ; setc %6" | ||
58 | : "=a" (ax), "+b" (ebx), "+c" (cx), "+d" (dx), | ||
59 | "+S" (esi), "+D" (di), "=m" (err) | ||
60 | : "a" (0x5303)); | ||
61 | |||
62 | boot_params.apm_bios_info.cseg = ax; | ||
63 | boot_params.apm_bios_info.offset = ebx; | ||
64 | boot_params.apm_bios_info.cseg_16 = cx; | ||
65 | boot_params.apm_bios_info.dseg = dx; | ||
66 | boot_params.apm_bios_info.cseg_len = (u16)esi; | ||
67 | boot_params.apm_bios_info.cseg_16_len = esi >> 16; | ||
68 | boot_params.apm_bios_info.dseg_len = di; | ||
69 | |||
70 | if (err) | ||
71 | return -1; | ||
72 | |||
73 | /* Redo the installation check as the 32-bit connect; | ||
74 | some BIOSes return different flags this way... */ | ||
75 | |||
76 | ax = 0x5300; | ||
77 | bx = cx = 0; | ||
78 | asm volatile("pushl %%ebp ; int $0x15 ; popl %%ebp ; setc %0" | ||
79 | : "=d" (err), "+a" (ax), "+b" (bx), "+c" (cx) | ||
80 | : : "esi", "edi"); | ||
81 | |||
82 | if (err || bx != 0x504d) { | ||
83 | /* Failure with 32-bit connect, try to disconect and ignore */ | ||
84 | ax = 0x5304; | ||
85 | bx = 0; | ||
86 | asm volatile("pushl %%ebp ; int $0x15 ; popl %%ebp" | ||
87 | : "+a" (ax), "+b" (bx) | ||
88 | : : "ecx", "edx", "esi", "edi"); | ||
89 | return -1; | ||
90 | } | ||
91 | |||
92 | boot_params.apm_bios_info.version = ax; | ||
93 | boot_params.apm_bios_info.flags = cx; | ||
94 | return 0; | ||
95 | } | ||
96 | |||
97 | #endif | ||
diff --git a/arch/i386/boot/bitops.h b/arch/i386/boot/bitops.h new file mode 100644 index 000000000000..8dcc8dc7db88 --- /dev/null +++ b/arch/i386/boot/bitops.h | |||
@@ -0,0 +1,45 @@ | |||
1 | /* -*- linux-c -*- ------------------------------------------------------- * | ||
2 | * | ||
3 | * Copyright (C) 1991, 1992 Linus Torvalds | ||
4 | * Copyright 2007 rPath, Inc. - All Rights Reserved | ||
5 | * | ||
6 | * This file is part of the Linux kernel, and is made available under | ||
7 | * the terms of the GNU General Public License version 2. | ||
8 | * | ||
9 | * ----------------------------------------------------------------------- */ | ||
10 | |||
11 | /* | ||
12 | * arch/i386/boot/bitops.h | ||
13 | * | ||
14 | * Very simple bitops for the boot code. | ||
15 | */ | ||
16 | |||
17 | #ifndef BOOT_BITOPS_H | ||
18 | #define BOOT_BITOPS_H | ||
19 | #define _LINUX_BITOPS_H /* Inhibit inclusion of <linux/bitops.h> */ | ||
20 | |||
21 | static inline int constant_test_bit(int nr, const void *addr) | ||
22 | { | ||
23 | const u32 *p = (const u32 *)addr; | ||
24 | return ((1UL << (nr & 31)) & (p[nr >> 5])) != 0; | ||
25 | } | ||
26 | static inline int variable_test_bit(int nr, const void *addr) | ||
27 | { | ||
28 | u8 v; | ||
29 | const u32 *p = (const u32 *)addr; | ||
30 | |||
31 | asm("btl %2,%1; setc %0" : "=qm" (v) : "m" (*p), "Ir" (nr)); | ||
32 | return v; | ||
33 | } | ||
34 | |||
35 | #define test_bit(nr,addr) \ | ||
36 | (__builtin_constant_p(nr) ? \ | ||
37 | constant_test_bit((nr),(addr)) : \ | ||
38 | variable_test_bit((nr),(addr))) | ||
39 | |||
40 | static inline void set_bit(int nr, void *addr) | ||
41 | { | ||
42 | asm("btsl %1,%0" : "+m" (*(u32 *)addr) : "Ir" (nr)); | ||
43 | } | ||
44 | |||
45 | #endif /* BOOT_BITOPS_H */ | ||
diff --git a/arch/i386/boot/boot.h b/arch/i386/boot/boot.h new file mode 100644 index 000000000000..0329c4fe4f88 --- /dev/null +++ b/arch/i386/boot/boot.h | |||
@@ -0,0 +1,296 @@ | |||
1 | /* -*- linux-c -*- ------------------------------------------------------- * | ||
2 | * | ||
3 | * Copyright (C) 1991, 1992 Linus Torvalds | ||
4 | * Copyright 2007 rPath, Inc. - All Rights Reserved | ||
5 | * | ||
6 | * This file is part of the Linux kernel, and is made available under | ||
7 | * the terms of the GNU General Public License version 2. | ||
8 | * | ||
9 | * ----------------------------------------------------------------------- */ | ||
10 | |||
11 | /* | ||
12 | * arch/i386/boot/boot.h | ||
13 | * | ||
14 | * Header file for the real-mode kernel code | ||
15 | */ | ||
16 | |||
17 | #ifndef BOOT_BOOT_H | ||
18 | #define BOOT_BOOT_H | ||
19 | |||
20 | #ifndef __ASSEMBLY__ | ||
21 | |||
22 | #include <stdarg.h> | ||
23 | #include <linux/types.h> | ||
24 | #include <linux/edd.h> | ||
25 | #include <asm/boot.h> | ||
26 | #include <asm/bootparam.h> | ||
27 | |||
28 | /* Useful macros */ | ||
29 | #define BUILD_BUG_ON(condition) ((void)sizeof(char[1 - 2*!!(condition)])) | ||
30 | |||
31 | extern struct setup_header hdr; | ||
32 | extern struct boot_params boot_params; | ||
33 | |||
34 | /* Basic port I/O */ | ||
35 | static inline void outb(u8 v, u16 port) | ||
36 | { | ||
37 | asm volatile("outb %0,%1" : : "a" (v), "dN" (port)); | ||
38 | } | ||
39 | static inline u8 inb(u16 port) | ||
40 | { | ||
41 | u8 v; | ||
42 | asm volatile("inb %1,%0" : "=a" (v) : "dN" (port)); | ||
43 | return v; | ||
44 | } | ||
45 | |||
46 | static inline void outw(u16 v, u16 port) | ||
47 | { | ||
48 | asm volatile("outw %0,%1" : : "a" (v), "dN" (port)); | ||
49 | } | ||
50 | static inline u16 inw(u16 port) | ||
51 | { | ||
52 | u16 v; | ||
53 | asm volatile("inw %1,%0" : "=a" (v) : "dN" (port)); | ||
54 | return v; | ||
55 | } | ||
56 | |||
57 | static inline void outl(u32 v, u16 port) | ||
58 | { | ||
59 | asm volatile("outl %0,%1" : : "a" (v), "dn" (port)); | ||
60 | } | ||
61 | static inline u32 inl(u32 port) | ||
62 | { | ||
63 | u32 v; | ||
64 | asm volatile("inl %1,%0" : "=a" (v) : "dN" (port)); | ||
65 | return v; | ||
66 | } | ||
67 | |||
68 | static inline void io_delay(void) | ||
69 | { | ||
70 | const u16 DELAY_PORT = 0x80; | ||
71 | asm volatile("outb %%al,%0" : : "dN" (DELAY_PORT)); | ||
72 | } | ||
73 | |||
74 | /* These functions are used to reference data in other segments. */ | ||
75 | |||
76 | static inline u16 ds(void) | ||
77 | { | ||
78 | u16 seg; | ||
79 | asm("movw %%ds,%0" : "=rm" (seg)); | ||
80 | return seg; | ||
81 | } | ||
82 | |||
83 | static inline void set_fs(u16 seg) | ||
84 | { | ||
85 | asm volatile("movw %0,%%fs" : : "rm" (seg)); | ||
86 | } | ||
87 | static inline u16 fs(void) | ||
88 | { | ||
89 | u16 seg; | ||
90 | asm("movw %%fs,%0" : "=rm" (seg)); | ||
91 | return seg; | ||
92 | } | ||
93 | |||
94 | static inline void set_gs(u16 seg) | ||
95 | { | ||
96 | asm volatile("movw %0,%%gs" : : "rm" (seg)); | ||
97 | } | ||
98 | static inline u16 gs(void) | ||
99 | { | ||
100 | u16 seg; | ||
101 | asm("movw %%gs,%0" : "=rm" (seg)); | ||
102 | return seg; | ||
103 | } | ||
104 | |||
105 | typedef unsigned int addr_t; | ||
106 | |||
107 | static inline u8 rdfs8(addr_t addr) | ||
108 | { | ||
109 | u8 v; | ||
110 | asm("movb %%fs:%1,%0" : "=r" (v) : "m" (*(u8 *)addr)); | ||
111 | return v; | ||
112 | } | ||
113 | static inline u16 rdfs16(addr_t addr) | ||
114 | { | ||
115 | u16 v; | ||
116 | asm("movw %%fs:%1,%0" : "=r" (v) : "m" (*(u16 *)addr)); | ||
117 | return v; | ||
118 | } | ||
119 | static inline u32 rdfs32(addr_t addr) | ||
120 | { | ||
121 | u32 v; | ||
122 | asm("movl %%fs:%1,%0" : "=r" (v) : "m" (*(u32 *)addr)); | ||
123 | return v; | ||
124 | } | ||
125 | |||
126 | static inline void wrfs8(u8 v, addr_t addr) | ||
127 | { | ||
128 | asm volatile("movb %1,%%fs:%0" : "+m" (*(u8 *)addr) : "r" (v)); | ||
129 | } | ||
130 | static inline void wrfs16(u16 v, addr_t addr) | ||
131 | { | ||
132 | asm volatile("movw %1,%%fs:%0" : "+m" (*(u16 *)addr) : "r" (v)); | ||
133 | } | ||
134 | static inline void wrfs32(u32 v, addr_t addr) | ||
135 | { | ||
136 | asm volatile("movl %1,%%fs:%0" : "+m" (*(u32 *)addr) : "r" (v)); | ||
137 | } | ||
138 | |||
139 | static inline u8 rdgs8(addr_t addr) | ||
140 | { | ||
141 | u8 v; | ||
142 | asm("movb %%gs:%1,%0" : "=r" (v) : "m" (*(u8 *)addr)); | ||
143 | return v; | ||
144 | } | ||
145 | static inline u16 rdgs16(addr_t addr) | ||
146 | { | ||
147 | u16 v; | ||
148 | asm("movw %%gs:%1,%0" : "=r" (v) : "m" (*(u16 *)addr)); | ||
149 | return v; | ||
150 | } | ||
151 | static inline u32 rdgs32(addr_t addr) | ||
152 | { | ||
153 | u32 v; | ||
154 | asm("movl %%gs:%1,%0" : "=r" (v) : "m" (*(u32 *)addr)); | ||
155 | return v; | ||
156 | } | ||
157 | |||
158 | static inline void wrgs8(u8 v, addr_t addr) | ||
159 | { | ||
160 | asm volatile("movb %1,%%gs:%0" : "+m" (*(u8 *)addr) : "r" (v)); | ||
161 | } | ||
162 | static inline void wrgs16(u16 v, addr_t addr) | ||
163 | { | ||
164 | asm volatile("movw %1,%%gs:%0" : "+m" (*(u16 *)addr) : "r" (v)); | ||
165 | } | ||
166 | static inline void wrgs32(u32 v, addr_t addr) | ||
167 | { | ||
168 | asm volatile("movl %1,%%gs:%0" : "+m" (*(u32 *)addr) : "r" (v)); | ||
169 | } | ||
170 | |||
171 | /* Note: these only return true/false, not a signed return value! */ | ||
172 | static inline int memcmp(const void *s1, const void *s2, size_t len) | ||
173 | { | ||
174 | u8 diff; | ||
175 | asm("repe; cmpsb; setnz %0" | ||
176 | : "=qm" (diff), "+D" (s1), "+S" (s2), "+c" (len)); | ||
177 | return diff; | ||
178 | } | ||
179 | |||
180 | static inline int memcmp_fs(const void *s1, addr_t s2, size_t len) | ||
181 | { | ||
182 | u8 diff; | ||
183 | asm("fs; repe; cmpsb; setnz %0" | ||
184 | : "=qm" (diff), "+D" (s1), "+S" (s2), "+c" (len)); | ||
185 | return diff; | ||
186 | } | ||
187 | static inline int memcmp_gs(const void *s1, addr_t s2, size_t len) | ||
188 | { | ||
189 | u8 diff; | ||
190 | asm("gs; repe; cmpsb; setnz %0" | ||
191 | : "=qm" (diff), "+D" (s1), "+S" (s2), "+c" (len)); | ||
192 | return diff; | ||
193 | } | ||
194 | |||
195 | static inline int isdigit(int ch) | ||
196 | { | ||
197 | return (ch >= '0') && (ch <= '9'); | ||
198 | } | ||
199 | |||
200 | /* Heap -- available for dynamic lists. */ | ||
201 | #define STACK_SIZE 512 /* Minimum number of bytes for stack */ | ||
202 | |||
203 | extern char _end[]; | ||
204 | extern char *HEAP; | ||
205 | extern char *heap_end; | ||
206 | #define RESET_HEAP() ((void *)( HEAP = _end )) | ||
207 | static inline char *__get_heap(size_t s, size_t a, size_t n) | ||
208 | { | ||
209 | char *tmp; | ||
210 | |||
211 | HEAP = (char *)(((size_t)HEAP+(a-1)) & ~(a-1)); | ||
212 | tmp = HEAP; | ||
213 | HEAP += s*n; | ||
214 | return tmp; | ||
215 | } | ||
216 | #define GET_HEAP(type, n) \ | ||
217 | ((type *)__get_heap(sizeof(type),__alignof__(type),(n))) | ||
218 | |||
219 | static inline int heap_free(void) | ||
220 | { | ||
221 | return heap_end-HEAP; | ||
222 | } | ||
223 | |||
224 | /* copy.S */ | ||
225 | |||
226 | void copy_to_fs(addr_t dst, void *src, size_t len); | ||
227 | void *copy_from_fs(void *dst, addr_t src, size_t len); | ||
228 | void copy_to_gs(addr_t dst, void *src, size_t len); | ||
229 | void *copy_from_gs(void *dst, addr_t src, size_t len); | ||
230 | void *memcpy(void *dst, void *src, size_t len); | ||
231 | void *memset(void *dst, int c, size_t len); | ||
232 | |||
233 | #define memcpy(d,s,l) __builtin_memcpy(d,s,l) | ||
234 | #define memset(d,c,l) __builtin_memset(d,c,l) | ||
235 | |||
236 | /* a20.c */ | ||
237 | int enable_a20(void); | ||
238 | |||
239 | /* apm.c */ | ||
240 | int query_apm_bios(void); | ||
241 | |||
242 | /* cmdline.c */ | ||
243 | int cmdline_find_option(const char *option, char *buffer, int bufsize); | ||
244 | |||
245 | /* cpu.c, cpucheck.c */ | ||
246 | int check_cpu(int *cpu_level_ptr, int *req_level_ptr, u32 **err_flags_ptr); | ||
247 | int validate_cpu(void); | ||
248 | |||
249 | /* edd.c */ | ||
250 | void query_edd(void); | ||
251 | |||
252 | /* header.S */ | ||
253 | void __attribute__((noreturn)) die(void); | ||
254 | |||
255 | /* mca.c */ | ||
256 | int query_mca(void); | ||
257 | |||
258 | /* memory.c */ | ||
259 | int detect_memory(void); | ||
260 | |||
261 | /* pm.c */ | ||
262 | void __attribute__((noreturn)) go_to_protected_mode(void); | ||
263 | |||
264 | /* pmjump.S */ | ||
265 | void __attribute__((noreturn)) | ||
266 | protected_mode_jump(u32 entrypoint, u32 bootparams); | ||
267 | |||
268 | /* printf.c */ | ||
269 | int sprintf(char *buf, const char *fmt, ...); | ||
270 | int vsprintf(char *buf, const char *fmt, va_list args); | ||
271 | int printf(const char *fmt, ...); | ||
272 | |||
273 | /* string.c */ | ||
274 | int strcmp(const char *str1, const char *str2); | ||
275 | size_t strnlen(const char *s, size_t maxlen); | ||
276 | unsigned int atou(const char *s); | ||
277 | |||
278 | /* tty.c */ | ||
279 | void puts(const char *); | ||
280 | void putchar(int); | ||
281 | int getchar(void); | ||
282 | void kbd_flush(void); | ||
283 | int getchar_timeout(void); | ||
284 | |||
285 | /* video.c */ | ||
286 | void set_video(void); | ||
287 | |||
288 | /* video-vesa.c */ | ||
289 | void vesa_store_edid(void); | ||
290 | |||
291 | /* voyager.c */ | ||
292 | int query_voyager(void); | ||
293 | |||
294 | #endif /* __ASSEMBLY__ */ | ||
295 | |||
296 | #endif /* BOOT_BOOT_H */ | ||
diff --git a/arch/i386/boot/bootsect.S b/arch/i386/boot/bootsect.S deleted file mode 100644 index 011b7a4993d4..000000000000 --- a/arch/i386/boot/bootsect.S +++ /dev/null | |||
@@ -1,98 +0,0 @@ | |||
1 | /* | ||
2 | * bootsect.S Copyright (C) 1991, 1992 Linus Torvalds | ||
3 | * | ||
4 | * modified by Drew Eckhardt | ||
5 | * modified by Bruce Evans (bde) | ||
6 | * modified by Chris Noe (May 1999) (as86 -> gas) | ||
7 | * gutted by H. Peter Anvin (Jan 2003) | ||
8 | * | ||
9 | * BIG FAT NOTE: We're in real mode using 64k segments. Therefore segment | ||
10 | * addresses must be multiplied by 16 to obtain their respective linear | ||
11 | * addresses. To avoid confusion, linear addresses are written using leading | ||
12 | * hex while segment addresses are written as segment:offset. | ||
13 | * | ||
14 | */ | ||
15 | |||
16 | #include <asm/boot.h> | ||
17 | |||
18 | SETUPSECTS = 4 /* default nr of setup-sectors */ | ||
19 | BOOTSEG = 0x07C0 /* original address of boot-sector */ | ||
20 | INITSEG = DEF_INITSEG /* we move boot here - out of the way */ | ||
21 | SETUPSEG = DEF_SETUPSEG /* setup starts here */ | ||
22 | SYSSEG = DEF_SYSSEG /* system loaded at 0x10000 (65536) */ | ||
23 | SYSSIZE = DEF_SYSSIZE /* system size: # of 16-byte clicks */ | ||
24 | /* to be loaded */ | ||
25 | ROOT_DEV = 0 /* ROOT_DEV is now written by "build" */ | ||
26 | SWAP_DEV = 0 /* SWAP_DEV is now written by "build" */ | ||
27 | |||
28 | #ifndef SVGA_MODE | ||
29 | #define SVGA_MODE ASK_VGA | ||
30 | #endif | ||
31 | |||
32 | #ifndef RAMDISK | ||
33 | #define RAMDISK 0 | ||
34 | #endif | ||
35 | |||
36 | #ifndef ROOT_RDONLY | ||
37 | #define ROOT_RDONLY 1 | ||
38 | #endif | ||
39 | |||
40 | .code16 | ||
41 | .text | ||
42 | |||
43 | .global _start | ||
44 | _start: | ||
45 | |||
46 | # Normalize the start address | ||
47 | jmpl $BOOTSEG, $start2 | ||
48 | |||
49 | start2: | ||
50 | movw %cs, %ax | ||
51 | movw %ax, %ds | ||
52 | movw %ax, %es | ||
53 | movw %ax, %ss | ||
54 | movw $0x7c00, %sp | ||
55 | sti | ||
56 | cld | ||
57 | |||
58 | movw $bugger_off_msg, %si | ||
59 | |||
60 | msg_loop: | ||
61 | lodsb | ||
62 | andb %al, %al | ||
63 | jz die | ||
64 | movb $0xe, %ah | ||
65 | movw $7, %bx | ||
66 | int $0x10 | ||
67 | jmp msg_loop | ||
68 | |||
69 | die: | ||
70 | # Allow the user to press a key, then reboot | ||
71 | xorw %ax, %ax | ||
72 | int $0x16 | ||
73 | int $0x19 | ||
74 | |||
75 | # int 0x19 should never return. In case it does anyway, | ||
76 | # invoke the BIOS reset code... | ||
77 | ljmp $0xf000,$0xfff0 | ||
78 | |||
79 | |||
80 | bugger_off_msg: | ||
81 | .ascii "Direct booting from floppy is no longer supported.\r\n" | ||
82 | .ascii "Please use a boot loader program instead.\r\n" | ||
83 | .ascii "\n" | ||
84 | .ascii "Remove disk and press any key to reboot . . .\r\n" | ||
85 | .byte 0 | ||
86 | |||
87 | |||
88 | # Kernel attributes; used by setup | ||
89 | |||
90 | .org 497 | ||
91 | setup_sects: .byte SETUPSECTS | ||
92 | root_flags: .word ROOT_RDONLY | ||
93 | syssize: .word SYSSIZE | ||
94 | swap_dev: .word SWAP_DEV | ||
95 | ram_size: .word RAMDISK | ||
96 | vid_mode: .word SVGA_MODE | ||
97 | root_dev: .word ROOT_DEV | ||
98 | boot_flag: .word 0xAA55 | ||
diff --git a/arch/i386/boot/cmdline.c b/arch/i386/boot/cmdline.c new file mode 100644 index 000000000000..34bb778c4357 --- /dev/null +++ b/arch/i386/boot/cmdline.c | |||
@@ -0,0 +1,97 @@ | |||
1 | /* -*- linux-c -*- ------------------------------------------------------- * | ||
2 | * | ||
3 | * Copyright (C) 1991, 1992 Linus Torvalds | ||
4 | * Copyright 2007 rPath, Inc. - All Rights Reserved | ||
5 | * | ||
6 | * This file is part of the Linux kernel, and is made available under | ||
7 | * the terms of the GNU General Public License version 2. | ||
8 | * | ||
9 | * ----------------------------------------------------------------------- */ | ||
10 | |||
11 | /* | ||
12 | * arch/i386/boot/cmdline.c | ||
13 | * | ||
14 | * Simple command-line parser for early boot. | ||
15 | */ | ||
16 | |||
17 | #include "boot.h" | ||
18 | |||
19 | static inline int myisspace(u8 c) | ||
20 | { | ||
21 | return c <= ' '; /* Close enough approximation */ | ||
22 | } | ||
23 | |||
24 | /* | ||
25 | * Find a non-boolean option, that is, "option=argument". In accordance | ||
26 | * with standard Linux practice, if this option is repeated, this returns | ||
27 | * the last instance on the command line. | ||
28 | * | ||
29 | * Returns the length of the argument (regardless of if it was | ||
30 | * truncated to fit in the buffer), or -1 on not found. | ||
31 | */ | ||
32 | int cmdline_find_option(const char *option, char *buffer, int bufsize) | ||
33 | { | ||
34 | u32 cmdline_ptr = boot_params.hdr.cmd_line_ptr; | ||
35 | addr_t cptr; | ||
36 | char c; | ||
37 | int len = -1; | ||
38 | const char *opptr = NULL; | ||
39 | char *bufptr = buffer; | ||
40 | enum { | ||
41 | st_wordstart, /* Start of word/after whitespace */ | ||
42 | st_wordcmp, /* Comparing this word */ | ||
43 | st_wordskip, /* Miscompare, skip */ | ||
44 | st_bufcpy /* Copying this to buffer */ | ||
45 | } state = st_wordstart; | ||
46 | |||
47 | if (!cmdline_ptr || cmdline_ptr >= 0x100000) | ||
48 | return -1; /* No command line, or inaccessible */ | ||
49 | |||
50 | cptr = cmdline_ptr & 0xf; | ||
51 | set_fs(cmdline_ptr >> 4); | ||
52 | |||
53 | while (cptr < 0x10000 && (c = rdfs8(cptr++))) { | ||
54 | switch (state) { | ||
55 | case st_wordstart: | ||
56 | if (myisspace(c)) | ||
57 | break; | ||
58 | |||
59 | /* else */ | ||
60 | state = st_wordcmp; | ||
61 | opptr = option; | ||
62 | /* fall through */ | ||
63 | |||
64 | case st_wordcmp: | ||
65 | if (c == '=' && !*opptr) { | ||
66 | len = 0; | ||
67 | bufptr = buffer; | ||
68 | state = st_bufcpy; | ||
69 | } else if (myisspace(c)) { | ||
70 | state = st_wordstart; | ||
71 | } else if (c != *opptr++) { | ||
72 | state = st_wordskip; | ||
73 | } | ||
74 | break; | ||
75 | |||
76 | case st_wordskip: | ||
77 | if (myisspace(c)) | ||
78 | state = st_wordstart; | ||
79 | break; | ||
80 | |||
81 | case st_bufcpy: | ||
82 | if (myisspace(c)) { | ||
83 | state = st_wordstart; | ||
84 | } else { | ||
85 | if (len < bufsize-1) | ||
86 | *bufptr++ = c; | ||
87 | len++; | ||
88 | } | ||
89 | break; | ||
90 | } | ||
91 | } | ||
92 | |||
93 | if (bufsize) | ||
94 | *bufptr = '\0'; | ||
95 | |||
96 | return len; | ||
97 | } | ||
diff --git a/arch/i386/boot/code16gcc.h b/arch/i386/boot/code16gcc.h new file mode 100644 index 000000000000..3bd848093b9d --- /dev/null +++ b/arch/i386/boot/code16gcc.h | |||
@@ -0,0 +1,15 @@ | |||
1 | /* | ||
2 | * code16gcc.h | ||
3 | * | ||
4 | * This file is -include'd when compiling 16-bit C code. | ||
5 | * Note: this asm() needs to be emitted before gcc omits any code. | ||
6 | * Depending on gcc version, this requires -fno-unit-at-a-time or | ||
7 | * -fno-toplevel-reorder. | ||
8 | * | ||
9 | * Hopefully gcc will eventually have a real -m16 option so we can | ||
10 | * drop this hack long term. | ||
11 | */ | ||
12 | |||
13 | #ifndef __ASSEMBLY__ | ||
14 | asm(".code16gcc"); | ||
15 | #endif | ||
diff --git a/arch/i386/boot/compressed/Makefile b/arch/i386/boot/compressed/Makefile index a661217f33ec..189fa1dbefcc 100644 --- a/arch/i386/boot/compressed/Makefile +++ b/arch/i386/boot/compressed/Makefile | |||
@@ -9,9 +9,14 @@ targets := vmlinux vmlinux.bin vmlinux.bin.gz head.o misc.o piggy.o \ | |||
9 | EXTRA_AFLAGS := -traditional | 9 | EXTRA_AFLAGS := -traditional |
10 | 10 | ||
11 | LDFLAGS_vmlinux := -T | 11 | LDFLAGS_vmlinux := -T |
12 | CFLAGS_misc.o += -fPIC | ||
13 | hostprogs-y := relocs | 12 | hostprogs-y := relocs |
14 | 13 | ||
14 | CFLAGS := -m32 -D__KERNEL__ $(LINUX_INCLUDE) -O2 \ | ||
15 | -fno-strict-aliasing -fPIC \ | ||
16 | $(call cc-option,-ffreestanding) \ | ||
17 | $(call cc-option,-fno-stack-protector) | ||
18 | LDFLAGS := -m elf_i386 | ||
19 | |||
15 | $(obj)/vmlinux: $(src)/vmlinux.lds $(obj)/head.o $(obj)/misc.o $(obj)/piggy.o FORCE | 20 | $(obj)/vmlinux: $(src)/vmlinux.lds $(obj)/head.o $(obj)/misc.o $(obj)/piggy.o FORCE |
16 | $(call if_changed,ld) | 21 | $(call if_changed,ld) |
17 | @: | 22 | @: |
diff --git a/arch/i386/boot/compressed/head.S b/arch/i386/boot/compressed/head.S index 3517a32aaf41..f35ea2237522 100644 --- a/arch/i386/boot/compressed/head.S +++ b/arch/i386/boot/compressed/head.S | |||
@@ -45,10 +45,10 @@ startup_32: | |||
45 | * at and where we were actually loaded at. This can only be done | 45 | * at and where we were actually loaded at. This can only be done |
46 | * with a short local call on x86. Nothing else will tell us what | 46 | * with a short local call on x86. Nothing else will tell us what |
47 | * address we are running at. The reserved chunk of the real-mode | 47 | * address we are running at. The reserved chunk of the real-mode |
48 | * data at 0x34-0x3f are used as the stack for this calculation. | 48 | * data at 0x1e4 (defined as a scratch field) are used as the stack |
49 | * Only 4 bytes are needed. | 49 | * for this calculation. Only 4 bytes are needed. |
50 | */ | 50 | */ |
51 | leal 0x40(%esi), %esp | 51 | leal (0x1e4+4)(%esi), %esp |
52 | call 1f | 52 | call 1f |
53 | 1: popl %ebp | 53 | 1: popl %ebp |
54 | subl $1b, %ebp | 54 | subl $1b, %ebp |
diff --git a/arch/i386/boot/copy.S b/arch/i386/boot/copy.S new file mode 100644 index 000000000000..ef127e56a3cf --- /dev/null +++ b/arch/i386/boot/copy.S | |||
@@ -0,0 +1,101 @@ | |||
1 | /* ----------------------------------------------------------------------- * | ||
2 | * | ||
3 | * Copyright (C) 1991, 1992 Linus Torvalds | ||
4 | * Copyright 2007 rPath, Inc. - All Rights Reserved | ||
5 | * | ||
6 | * This file is part of the Linux kernel, and is made available under | ||
7 | * the terms of the GNU General Public License version 2. | ||
8 | * | ||
9 | * ----------------------------------------------------------------------- */ | ||
10 | |||
11 | /* | ||
12 | * arch/i386/boot/copy.S | ||
13 | * | ||
14 | * Memory copy routines | ||
15 | */ | ||
16 | |||
17 | .code16gcc | ||
18 | .text | ||
19 | |||
20 | .globl memcpy | ||
21 | .type memcpy, @function | ||
22 | memcpy: | ||
23 | pushw %si | ||
24 | pushw %di | ||
25 | movw %ax, %di | ||
26 | movw %dx, %si | ||
27 | pushw %cx | ||
28 | shrw $2, %cx | ||
29 | rep; movsl | ||
30 | popw %cx | ||
31 | andw $3, %cx | ||
32 | rep; movsb | ||
33 | popw %di | ||
34 | popw %si | ||
35 | ret | ||
36 | .size memcpy, .-memcpy | ||
37 | |||
38 | .globl memset | ||
39 | .type memset, @function | ||
40 | memset: | ||
41 | pushw %di | ||
42 | movw %ax, %di | ||
43 | movzbl %dl, %eax | ||
44 | imull $0x01010101,%eax | ||
45 | pushw %cx | ||
46 | shrw $2, %cx | ||
47 | rep; stosl | ||
48 | popw %cx | ||
49 | andw $3, %cx | ||
50 | rep; stosb | ||
51 | popw %di | ||
52 | ret | ||
53 | .size memset, .-memset | ||
54 | |||
55 | .globl copy_from_fs | ||
56 | .type copy_from_fs, @function | ||
57 | copy_from_fs: | ||
58 | pushw %ds | ||
59 | pushw %fs | ||
60 | popw %ds | ||
61 | call memcpy | ||
62 | popw %ds | ||
63 | ret | ||
64 | .size copy_from_fs, .-copy_from_fs | ||
65 | |||
66 | .globl copy_to_fs | ||
67 | .type copy_to_fs, @function | ||
68 | copy_to_fs: | ||
69 | pushw %es | ||
70 | pushw %fs | ||
71 | popw %es | ||
72 | call memcpy | ||
73 | popw %es | ||
74 | ret | ||
75 | .size copy_to_fs, .-copy_to_fs | ||
76 | |||
77 | #if 0 /* Not currently used, but can be enabled as needed */ | ||
78 | |||
79 | .globl copy_from_gs | ||
80 | .type copy_from_gs, @function | ||
81 | copy_from_gs: | ||
82 | pushw %ds | ||
83 | pushw %gs | ||
84 | popw %ds | ||
85 | call memcpy | ||
86 | popw %ds | ||
87 | ret | ||
88 | .size copy_from_gs, .-copy_from_gs | ||
89 | .globl copy_to_gs | ||
90 | |||
91 | .type copy_to_gs, @function | ||
92 | copy_to_gs: | ||
93 | pushw %es | ||
94 | pushw %gs | ||
95 | popw %es | ||
96 | call memcpy | ||
97 | popw %es | ||
98 | ret | ||
99 | .size copy_to_gs, .-copy_to_gs | ||
100 | |||
101 | #endif | ||
diff --git a/arch/i386/boot/cpu.c b/arch/i386/boot/cpu.c new file mode 100644 index 000000000000..2a5c32da5852 --- /dev/null +++ b/arch/i386/boot/cpu.c | |||
@@ -0,0 +1,69 @@ | |||
1 | /* -*- linux-c -*- ------------------------------------------------------- * | ||
2 | * | ||
3 | * Copyright (C) 1991, 1992 Linus Torvalds | ||
4 | * Copyright 2007 rPath, Inc. - All Rights Reserved | ||
5 | * | ||
6 | * This file is part of the Linux kernel, and is made available under | ||
7 | * the terms of the GNU General Public License version 2. | ||
8 | * | ||
9 | * ----------------------------------------------------------------------- */ | ||
10 | |||
11 | /* | ||
12 | * arch/i386/boot/cpu.c | ||
13 | * | ||
14 | * Check for obligatory CPU features and abort if the features are not | ||
15 | * present. | ||
16 | */ | ||
17 | |||
18 | #include "boot.h" | ||
19 | #include "bitops.h" | ||
20 | #include <asm/cpufeature.h> | ||
21 | |||
22 | static char *cpu_name(int level) | ||
23 | { | ||
24 | static char buf[6]; | ||
25 | |||
26 | if (level == 64) { | ||
27 | return "x86-64"; | ||
28 | } else { | ||
29 | sprintf(buf, "i%d86", level); | ||
30 | return buf; | ||
31 | } | ||
32 | } | ||
33 | |||
34 | int validate_cpu(void) | ||
35 | { | ||
36 | u32 *err_flags; | ||
37 | int cpu_level, req_level; | ||
38 | |||
39 | check_cpu(&cpu_level, &req_level, &err_flags); | ||
40 | |||
41 | if (cpu_level < req_level) { | ||
42 | printf("This kernel requires an %s CPU, ", | ||
43 | cpu_name(req_level)); | ||
44 | printf("but only detected an %s CPU.\n", | ||
45 | cpu_name(cpu_level)); | ||
46 | return -1; | ||
47 | } | ||
48 | |||
49 | if (err_flags) { | ||
50 | int i, j; | ||
51 | puts("This kernel requires the following features " | ||
52 | "not present on the CPU:\n"); | ||
53 | |||
54 | for (i = 0; i < NCAPINTS; i++) { | ||
55 | u32 e = err_flags[i]; | ||
56 | |||
57 | for (j = 0; j < 32; j++) { | ||
58 | if (e & 1) | ||
59 | printf("%d:%d ", i, j); | ||
60 | |||
61 | e >>= 1; | ||
62 | } | ||
63 | } | ||
64 | putchar('\n'); | ||
65 | return -1; | ||
66 | } else { | ||
67 | return 0; | ||
68 | } | ||
69 | } | ||
diff --git a/arch/i386/boot/cpucheck.c b/arch/i386/boot/cpucheck.c new file mode 100644 index 000000000000..8b0f4473b083 --- /dev/null +++ b/arch/i386/boot/cpucheck.c | |||
@@ -0,0 +1,267 @@ | |||
1 | /* -*- linux-c -*- ------------------------------------------------------- * | ||
2 | * | ||
3 | * Copyright (C) 1991, 1992 Linus Torvalds | ||
4 | * Copyright 2007 rPath, Inc. - All Rights Reserved | ||
5 | * | ||
6 | * This file is part of the Linux kernel, and is made available under | ||
7 | * the terms of the GNU General Public License version 2. | ||
8 | * | ||
9 | * ----------------------------------------------------------------------- */ | ||
10 | |||
11 | /* | ||
12 | * arch/i386/boot/cpucheck.c | ||
13 | * | ||
14 | * Check for obligatory CPU features and abort if the features are not | ||
15 | * present. This code should be compilable as 16-, 32- or 64-bit | ||
16 | * code, so be very careful with types and inline assembly. | ||
17 | * | ||
18 | * This code should not contain any messages; that requires an | ||
19 | * additional wrapper. | ||
20 | * | ||
21 | * As written, this code is not safe for inclusion into the kernel | ||
22 | * proper (after FPU initialization, in particular). | ||
23 | */ | ||
24 | |||
25 | #ifdef _SETUP | ||
26 | # include "boot.h" | ||
27 | # include "bitops.h" | ||
28 | #endif | ||
29 | #include <linux/types.h> | ||
30 | #include <asm/cpufeature.h> | ||
31 | #include <asm/processor-flags.h> | ||
32 | #include <asm/required-features.h> | ||
33 | #include <asm/msr-index.h> | ||
34 | |||
35 | struct cpu_features { | ||
36 | int level; /* Family, or 64 for x86-64 */ | ||
37 | int model; | ||
38 | u32 flags[NCAPINTS]; | ||
39 | }; | ||
40 | |||
41 | static struct cpu_features cpu; | ||
42 | static u32 cpu_vendor[3]; | ||
43 | static u32 err_flags[NCAPINTS]; | ||
44 | |||
45 | #ifdef CONFIG_X86_64 | ||
46 | static const int req_level = 64; | ||
47 | #elif defined(CONFIG_X86_MINIMUM_CPU_FAMILY) | ||
48 | static const int req_level = CONFIG_X86_MINIMUM_CPU_FAMILY; | ||
49 | #else | ||
50 | static const int req_level = 3; | ||
51 | #endif | ||
52 | |||
53 | static const u32 req_flags[NCAPINTS] = | ||
54 | { | ||
55 | REQUIRED_MASK0, | ||
56 | REQUIRED_MASK1, | ||
57 | REQUIRED_MASK2, | ||
58 | REQUIRED_MASK3, | ||
59 | REQUIRED_MASK4, | ||
60 | REQUIRED_MASK5, | ||
61 | REQUIRED_MASK6, | ||
62 | REQUIRED_MASK7, | ||
63 | }; | ||
64 | |||
65 | #define A32(a,b,c,d) (((d) << 24)+((c) << 16)+((b) << 8)+(a)) | ||
66 | |||
67 | static int is_amd(void) | ||
68 | { | ||
69 | return cpu_vendor[0] == A32('A','u','t','h') && | ||
70 | cpu_vendor[1] == A32('e','n','t','i') && | ||
71 | cpu_vendor[2] == A32('c','A','M','D'); | ||
72 | } | ||
73 | |||
74 | static int is_centaur(void) | ||
75 | { | ||
76 | return cpu_vendor[0] == A32('C','e','n','t') && | ||
77 | cpu_vendor[1] == A32('a','u','r','H') && | ||
78 | cpu_vendor[2] == A32('a','u','l','s'); | ||
79 | } | ||
80 | |||
81 | static int is_transmeta(void) | ||
82 | { | ||
83 | return cpu_vendor[0] == A32('G','e','n','u') && | ||
84 | cpu_vendor[1] == A32('i','n','e','T') && | ||
85 | cpu_vendor[2] == A32('M','x','8','6'); | ||
86 | } | ||
87 | |||
88 | static int has_fpu(void) | ||
89 | { | ||
90 | u16 fcw = -1, fsw = -1; | ||
91 | u32 cr0; | ||
92 | |||
93 | asm("movl %%cr0,%0" : "=r" (cr0)); | ||
94 | if (cr0 & (X86_CR0_EM|X86_CR0_TS)) { | ||
95 | cr0 &= ~(X86_CR0_EM|X86_CR0_TS); | ||
96 | asm volatile("movl %0,%%cr0" : : "r" (cr0)); | ||
97 | } | ||
98 | |||
99 | asm("fninit ; fnstsw %0 ; fnstcw %1" : "+m" (fsw), "+m" (fcw)); | ||
100 | |||
101 | return fsw == 0 && (fcw & 0x103f) == 0x003f; | ||
102 | } | ||
103 | |||
104 | static int has_eflag(u32 mask) | ||
105 | { | ||
106 | u32 f0, f1; | ||
107 | |||
108 | asm("pushfl ; " | ||
109 | "pushfl ; " | ||
110 | "popl %0 ; " | ||
111 | "movl %0,%1 ; " | ||
112 | "xorl %2,%1 ; " | ||
113 | "pushl %1 ; " | ||
114 | "popfl ; " | ||
115 | "pushfl ; " | ||
116 | "popl %1 ; " | ||
117 | "popfl" | ||
118 | : "=r" (f0), "=r" (f1) | ||
119 | : "g" (mask)); | ||
120 | |||
121 | return !!((f0^f1) & mask); | ||
122 | } | ||
123 | |||
124 | static void get_flags(void) | ||
125 | { | ||
126 | u32 max_intel_level, max_amd_level; | ||
127 | u32 tfms; | ||
128 | |||
129 | if (has_fpu()) | ||
130 | set_bit(X86_FEATURE_FPU, cpu.flags); | ||
131 | |||
132 | if (has_eflag(X86_EFLAGS_ID)) { | ||
133 | asm("cpuid" | ||
134 | : "=a" (max_intel_level), | ||
135 | "=b" (cpu_vendor[0]), | ||
136 | "=d" (cpu_vendor[1]), | ||
137 | "=c" (cpu_vendor[2]) | ||
138 | : "a" (0)); | ||
139 | |||
140 | if (max_intel_level >= 0x00000001 && | ||
141 | max_intel_level <= 0x0000ffff) { | ||
142 | asm("cpuid" | ||
143 | : "=a" (tfms), | ||
144 | "=c" (cpu.flags[4]), | ||
145 | "=d" (cpu.flags[0]) | ||
146 | : "a" (0x00000001) | ||
147 | : "ebx"); | ||
148 | cpu.level = (tfms >> 8) & 15; | ||
149 | cpu.model = (tfms >> 4) & 15; | ||
150 | if (cpu.level >= 6) | ||
151 | cpu.model += ((tfms >> 16) & 0xf) << 4; | ||
152 | } | ||
153 | |||
154 | asm("cpuid" | ||
155 | : "=a" (max_amd_level) | ||
156 | : "a" (0x80000000) | ||
157 | : "ebx", "ecx", "edx"); | ||
158 | |||
159 | if (max_amd_level >= 0x80000001 && | ||
160 | max_amd_level <= 0x8000ffff) { | ||
161 | u32 eax = 0x80000001; | ||
162 | asm("cpuid" | ||
163 | : "+a" (eax), | ||
164 | "=c" (cpu.flags[6]), | ||
165 | "=d" (cpu.flags[1]) | ||
166 | : : "ebx"); | ||
167 | } | ||
168 | } | ||
169 | } | ||
170 | |||
171 | /* Returns a bitmask of which words we have error bits in */ | ||
172 | static int check_flags(void) | ||
173 | { | ||
174 | u32 err; | ||
175 | int i; | ||
176 | |||
177 | err = 0; | ||
178 | for (i = 0; i < NCAPINTS; i++) { | ||
179 | err_flags[i] = req_flags[i] & ~cpu.flags[i]; | ||
180 | if (err_flags[i]) | ||
181 | err |= 1 << i; | ||
182 | } | ||
183 | |||
184 | return err; | ||
185 | } | ||
186 | |||
187 | /* | ||
188 | * Returns -1 on error. | ||
189 | * | ||
190 | * *cpu_level is set to the current CPU level; *req_level to the required | ||
191 | * level. x86-64 is considered level 64 for this purpose. | ||
192 | * | ||
193 | * *err_flags_ptr is set to the flags error array if there are flags missing. | ||
194 | */ | ||
195 | int check_cpu(int *cpu_level_ptr, int *req_level_ptr, u32 **err_flags_ptr) | ||
196 | { | ||
197 | int err; | ||
198 | |||
199 | memset(&cpu.flags, 0, sizeof cpu.flags); | ||
200 | cpu.level = 3; | ||
201 | |||
202 | if (has_eflag(X86_EFLAGS_AC)) | ||
203 | cpu.level = 4; | ||
204 | |||
205 | get_flags(); | ||
206 | err = check_flags(); | ||
207 | |||
208 | if (test_bit(X86_FEATURE_LM, cpu.flags)) | ||
209 | cpu.level = 64; | ||
210 | |||
211 | if (err == 0x01 && | ||
212 | !(err_flags[0] & | ||
213 | ~((1 << X86_FEATURE_XMM)|(1 << X86_FEATURE_XMM2))) && | ||
214 | is_amd()) { | ||
215 | /* If this is an AMD and we're only missing SSE+SSE2, try to | ||
216 | turn them on */ | ||
217 | |||
218 | u32 ecx = MSR_K7_HWCR; | ||
219 | u32 eax, edx; | ||
220 | |||
221 | asm("rdmsr" : "=a" (eax), "=d" (edx) : "c" (ecx)); | ||
222 | eax &= ~(1 << 15); | ||
223 | asm("wrmsr" : : "a" (eax), "d" (edx), "c" (ecx)); | ||
224 | |||
225 | get_flags(); /* Make sure it really did something */ | ||
226 | err = check_flags(); | ||
227 | } else if (err == 0x01 && | ||
228 | !(err_flags[0] & ~(1 << X86_FEATURE_CX8)) && | ||
229 | is_centaur() && cpu.model >= 6) { | ||
230 | /* If this is a VIA C3, we might have to enable CX8 | ||
231 | explicitly */ | ||
232 | |||
233 | u32 ecx = MSR_VIA_FCR; | ||
234 | u32 eax, edx; | ||
235 | |||
236 | asm("rdmsr" : "=a" (eax), "=d" (edx) : "c" (ecx)); | ||
237 | eax |= (1<<1)|(1<<7); | ||
238 | asm("wrmsr" : : "a" (eax), "d" (edx), "c" (ecx)); | ||
239 | |||
240 | set_bit(X86_FEATURE_CX8, cpu.flags); | ||
241 | err = check_flags(); | ||
242 | } else if (err == 0x01 && is_transmeta()) { | ||
243 | /* Transmeta might have masked feature bits in word 0 */ | ||
244 | |||
245 | u32 ecx = 0x80860004; | ||
246 | u32 eax, edx; | ||
247 | u32 level = 1; | ||
248 | |||
249 | asm("rdmsr" : "=a" (eax), "=d" (edx) : "c" (ecx)); | ||
250 | asm("wrmsr" : : "a" (~0), "d" (edx), "c" (ecx)); | ||
251 | asm("cpuid" | ||
252 | : "+a" (level), "=d" (cpu.flags[0]) | ||
253 | : : "ecx", "ebx"); | ||
254 | asm("wrmsr" : : "a" (eax), "d" (edx), "c" (ecx)); | ||
255 | |||
256 | err = check_flags(); | ||
257 | } | ||
258 | |||
259 | if (err_flags_ptr) | ||
260 | *err_flags_ptr = err ? err_flags : NULL; | ||
261 | if (cpu_level_ptr) | ||
262 | *cpu_level_ptr = cpu.level; | ||
263 | if (req_level_ptr) | ||
264 | *req_level_ptr = req_level; | ||
265 | |||
266 | return (cpu.level < req_level || err) ? -1 : 0; | ||
267 | } | ||
diff --git a/arch/i386/boot/edd.S b/arch/i386/boot/edd.S deleted file mode 100644 index 34321368011a..000000000000 --- a/arch/i386/boot/edd.S +++ /dev/null | |||
@@ -1,231 +0,0 @@ | |||
1 | /* | ||
2 | * BIOS Enhanced Disk Drive support | ||
3 | * Copyright (C) 2002, 2003, 2004 Dell, Inc. | ||
4 | * by Matt Domsch <Matt_Domsch@dell.com> October 2002 | ||
5 | * conformant to T13 Committee www.t13.org | ||
6 | * projects 1572D, 1484D, 1386D, 1226DT | ||
7 | * disk signature read by Matt Domsch <Matt_Domsch@dell.com> | ||
8 | * and Andrew Wilks <Andrew_Wilks@dell.com> September 2003, June 2004 | ||
9 | * legacy CHS retrieval by Patrick J. LoPresti <patl@users.sourceforge.net> | ||
10 | * March 2004 | ||
11 | * Command line option parsing, Matt Domsch, November 2004 | ||
12 | */ | ||
13 | |||
14 | #include <linux/edd.h> | ||
15 | #include <asm/setup.h> | ||
16 | |||
17 | #if defined(CONFIG_EDD) || defined(CONFIG_EDD_MODULE) | ||
18 | |||
19 | # It is assumed that %ds == INITSEG here | ||
20 | |||
21 | movb $0, (EDD_MBR_SIG_NR_BUF) | ||
22 | movb $0, (EDDNR) | ||
23 | |||
24 | # Check the command line for options: | ||
25 | # edd=of disables EDD completely (edd=off) | ||
26 | # edd=sk skips the MBR test (edd=skipmbr) | ||
27 | # edd=on re-enables EDD (edd=on) | ||
28 | |||
29 | pushl %esi | ||
30 | movw $edd_mbr_sig_start, %di # Default to edd=on | ||
31 | |||
32 | movl %cs:(cmd_line_ptr), %esi | ||
33 | andl %esi, %esi | ||
34 | jz old_cl # Old boot protocol? | ||
35 | |||
36 | # Convert to a real-mode pointer in fs:si | ||
37 | movl %esi, %eax | ||
38 | shrl $4, %eax | ||
39 | movw %ax, %fs | ||
40 | andw $0xf, %si | ||
41 | jmp have_cl_pointer | ||
42 | |||
43 | # Old-style boot protocol? | ||
44 | old_cl: | ||
45 | push %ds # aka INITSEG | ||
46 | pop %fs | ||
47 | |||
48 | cmpw $0xa33f, (0x20) | ||
49 | jne done_cl # No command line at all? | ||
50 | movw (0x22), %si # Pointer relative to INITSEG | ||
51 | |||
52 | # fs:si has the pointer to the command line now | ||
53 | have_cl_pointer: | ||
54 | |||
55 | # Loop through kernel command line one byte at a time. Just in | ||
56 | # case the loader is buggy and failed to null-terminate the command line | ||
57 | # terminate if we get close enough to the end of the segment that we | ||
58 | # cannot fit "edd=XX"... | ||
59 | cl_atspace: | ||
60 | cmpw $-5, %si # Watch for segment wraparound | ||
61 | jae done_cl | ||
62 | movl %fs:(%si), %eax | ||
63 | andb %al, %al # End of line? | ||
64 | jz done_cl | ||
65 | cmpl $EDD_CL_EQUALS, %eax | ||
66 | jz found_edd_equals | ||
67 | cmpb $0x20, %al # <= space consider whitespace | ||
68 | ja cl_skipword | ||
69 | incw %si | ||
70 | jmp cl_atspace | ||
71 | |||
72 | cl_skipword: | ||
73 | cmpw $-5, %si # Watch for segment wraparound | ||
74 | jae done_cl | ||
75 | movb %fs:(%si), %al # End of string? | ||
76 | andb %al, %al | ||
77 | jz done_cl | ||
78 | cmpb $0x20, %al | ||
79 | jbe cl_atspace | ||
80 | incw %si | ||
81 | jmp cl_skipword | ||
82 | |||
83 | found_edd_equals: | ||
84 | # only looking at first two characters after equals | ||
85 | # late overrides early on the command line, so keep going after finding something | ||
86 | movw %fs:4(%si), %ax | ||
87 | cmpw $EDD_CL_OFF, %ax # edd=of | ||
88 | je do_edd_off | ||
89 | cmpw $EDD_CL_SKIP, %ax # edd=sk | ||
90 | je do_edd_skipmbr | ||
91 | cmpw $EDD_CL_ON, %ax # edd=on | ||
92 | je do_edd_on | ||
93 | jmp cl_skipword | ||
94 | do_edd_skipmbr: | ||
95 | movw $edd_start, %di | ||
96 | jmp cl_skipword | ||
97 | do_edd_off: | ||
98 | movw $edd_done, %di | ||
99 | jmp cl_skipword | ||
100 | do_edd_on: | ||
101 | movw $edd_mbr_sig_start, %di | ||
102 | jmp cl_skipword | ||
103 | |||
104 | done_cl: | ||
105 | popl %esi | ||
106 | jmpw *%di | ||
107 | |||
108 | # Read the first sector of each BIOS disk device and store the 4-byte signature | ||
109 | edd_mbr_sig_start: | ||
110 | movb $0x80, %dl # from device 80 | ||
111 | movw $EDD_MBR_SIG_BUF, %bx # store buffer ptr in bx | ||
112 | edd_mbr_sig_read: | ||
113 | movl $0xFFFFFFFF, %eax | ||
114 | movl %eax, (%bx) # assume failure | ||
115 | pushw %bx | ||
116 | movb $READ_SECTORS, %ah | ||
117 | movb $1, %al # read 1 sector | ||
118 | movb $0, %dh # at head 0 | ||
119 | movw $1, %cx # cylinder 0, sector 0 | ||
120 | pushw %es | ||
121 | pushw %ds | ||
122 | popw %es | ||
123 | movw $EDDBUF, %bx # disk's data goes into EDDBUF | ||
124 | pushw %dx # work around buggy BIOSes | ||
125 | stc # work around buggy BIOSes | ||
126 | int $0x13 | ||
127 | sti # work around buggy BIOSes | ||
128 | popw %dx | ||
129 | popw %es | ||
130 | popw %bx | ||
131 | jc edd_mbr_sig_done # on failure, we're done. | ||
132 | cmpb $0, %ah # some BIOSes do not set CF | ||
133 | jne edd_mbr_sig_done # on failure, we're done. | ||
134 | movl (EDDBUF+EDD_MBR_SIG_OFFSET), %eax # read sig out of the MBR | ||
135 | movl %eax, (%bx) # store success | ||
136 | incb (EDD_MBR_SIG_NR_BUF) # note that we stored something | ||
137 | incb %dl # increment to next device | ||
138 | addw $4, %bx # increment sig buffer ptr | ||
139 | cmpb $EDD_MBR_SIG_MAX, (EDD_MBR_SIG_NR_BUF) # Out of space? | ||
140 | jb edd_mbr_sig_read # keep looping | ||
141 | edd_mbr_sig_done: | ||
142 | |||
143 | # Do the BIOS Enhanced Disk Drive calls | ||
144 | # This consists of two calls: | ||
145 | # int 13h ah=41h "Check Extensions Present" | ||
146 | # int 13h ah=48h "Get Device Parameters" | ||
147 | # int 13h ah=08h "Legacy Get Device Parameters" | ||
148 | # | ||
149 | # A buffer of size EDDMAXNR*(EDDEXTSIZE+EDDPARMSIZE) is reserved for our use | ||
150 | # in the boot_params at EDDBUF. The first four bytes of which are | ||
151 | # used to store the device number, interface support map and version | ||
152 | # results from fn41. The next four bytes are used to store the legacy | ||
153 | # cylinders, heads, and sectors from fn08. The following 74 bytes are used to | ||
154 | # store the results from fn48. Starting from device 80h, fn41, then fn48 | ||
155 | # are called and their results stored in EDDBUF+n*(EDDEXTSIZE+EDDPARMIZE). | ||
156 | # Then the pointer is incremented to store the data for the next call. | ||
157 | # This repeats until either a device doesn't exist, or until EDDMAXNR | ||
158 | # devices have been stored. | ||
159 | # The one tricky part is that ds:si always points EDDEXTSIZE bytes into | ||
160 | # the structure, and the fn41 and fn08 results are stored at offsets | ||
161 | # from there. This removes the need to increment the pointer for | ||
162 | # every store, and leaves it ready for the fn48 call. | ||
163 | # A second one-byte buffer, EDDNR, in the boot_params stores | ||
164 | # the number of BIOS devices which exist, up to EDDMAXNR. | ||
165 | # In setup.c, copy_edd() stores both boot_params buffers away | ||
166 | # for later use, as they would get overwritten otherwise. | ||
167 | # This code is sensitive to the size of the structs in edd.h | ||
168 | edd_start: | ||
169 | # %ds points to the bootsector | ||
170 | # result buffer for fn48 | ||
171 | movw $EDDBUF+EDDEXTSIZE, %si # in ds:si, fn41 results | ||
172 | # kept just before that | ||
173 | movb $0x80, %dl # BIOS device 0x80 | ||
174 | |||
175 | edd_check_ext: | ||
176 | movb $CHECKEXTENSIONSPRESENT, %ah # Function 41 | ||
177 | movw $EDDMAGIC1, %bx # magic | ||
178 | int $0x13 # make the call | ||
179 | jc edd_done # no more BIOS devices | ||
180 | |||
181 | cmpw $EDDMAGIC2, %bx # is magic right? | ||
182 | jne edd_next # nope, next... | ||
183 | |||
184 | movb %dl, %ds:-8(%si) # store device number | ||
185 | movb %ah, %ds:-7(%si) # store version | ||
186 | movw %cx, %ds:-6(%si) # store extensions | ||
187 | incb (EDDNR) # note that we stored something | ||
188 | |||
189 | edd_get_device_params: | ||
190 | movw $EDDPARMSIZE, %ds:(%si) # put size | ||
191 | movw $0x0, %ds:2(%si) # work around buggy BIOSes | ||
192 | movb $GETDEVICEPARAMETERS, %ah # Function 48 | ||
193 | int $0x13 # make the call | ||
194 | # Don't check for fail return | ||
195 | # it doesn't matter. | ||
196 | edd_get_legacy_chs: | ||
197 | xorw %ax, %ax | ||
198 | movw %ax, %ds:-4(%si) | ||
199 | movw %ax, %ds:-2(%si) | ||
200 | # Ralf Brown's Interrupt List says to set ES:DI to | ||
201 | # 0000h:0000h "to guard against BIOS bugs" | ||
202 | pushw %es | ||
203 | movw %ax, %es | ||
204 | movw %ax, %di | ||
205 | pushw %dx # legacy call clobbers %dl | ||
206 | movb $LEGACYGETDEVICEPARAMETERS, %ah # Function 08 | ||
207 | int $0x13 # make the call | ||
208 | jc edd_legacy_done # failed | ||
209 | movb %cl, %al # Low 6 bits are max | ||
210 | andb $0x3F, %al # sector number | ||
211 | movb %al, %ds:-1(%si) # Record max sect | ||
212 | movb %dh, %ds:-2(%si) # Record max head number | ||
213 | movb %ch, %al # Low 8 bits of max cyl | ||
214 | shr $6, %cl | ||
215 | movb %cl, %ah # High 2 bits of max cyl | ||
216 | movw %ax, %ds:-4(%si) | ||
217 | |||
218 | edd_legacy_done: | ||
219 | popw %dx | ||
220 | popw %es | ||
221 | movw %si, %ax # increment si | ||
222 | addw $EDDPARMSIZE+EDDEXTSIZE, %ax | ||
223 | movw %ax, %si | ||
224 | |||
225 | edd_next: | ||
226 | incb %dl # increment to next device | ||
227 | cmpb $EDDMAXNR, (EDDNR) # Out of space? | ||
228 | jb edd_check_ext # keep looping | ||
229 | |||
230 | edd_done: | ||
231 | #endif | ||
diff --git a/arch/i386/boot/edd.c b/arch/i386/boot/edd.c new file mode 100644 index 000000000000..25a282494f4c --- /dev/null +++ b/arch/i386/boot/edd.c | |||
@@ -0,0 +1,196 @@ | |||
1 | /* -*- linux-c -*- ------------------------------------------------------- * | ||
2 | * | ||
3 | * Copyright (C) 1991, 1992 Linus Torvalds | ||
4 | * Copyright 2007 rPath, Inc. - All Rights Reserved | ||
5 | * | ||
6 | * This file is part of the Linux kernel, and is made available under | ||
7 | * the terms of the GNU General Public License version 2. | ||
8 | * | ||
9 | * ----------------------------------------------------------------------- */ | ||
10 | |||
11 | /* | ||
12 | * arch/i386/boot/edd.c | ||
13 | * | ||
14 | * Get EDD BIOS disk information | ||
15 | */ | ||
16 | |||
17 | #include "boot.h" | ||
18 | #include <linux/edd.h> | ||
19 | |||
20 | #if defined(CONFIG_EDD) || defined(CONFIG_EDD_MODULE) | ||
21 | |||
22 | struct edd_dapa { | ||
23 | u8 pkt_size; | ||
24 | u8 rsvd; | ||
25 | u16 sector_cnt; | ||
26 | u16 buf_off, buf_seg; | ||
27 | u64 lba; | ||
28 | u64 buf_lin_addr; | ||
29 | }; | ||
30 | |||
31 | /* | ||
32 | * Read the MBR (first sector) from a specific device. | ||
33 | */ | ||
34 | static int read_mbr(u8 devno, void *buf) | ||
35 | { | ||
36 | struct edd_dapa dapa; | ||
37 | u16 ax, bx, cx, dx, si; | ||
38 | |||
39 | memset(&dapa, 0, sizeof dapa); | ||
40 | dapa.pkt_size = sizeof(dapa); | ||
41 | dapa.sector_cnt = 1; | ||
42 | dapa.buf_off = (size_t)buf; | ||
43 | dapa.buf_seg = ds(); | ||
44 | /* dapa.lba = 0; */ | ||
45 | |||
46 | ax = 0x4200; /* Extended Read */ | ||
47 | si = (size_t)&dapa; | ||
48 | dx = devno; | ||
49 | asm("pushfl; stc; int $0x13; setc %%al; popfl" | ||
50 | : "+a" (ax), "+S" (si), "+d" (dx) | ||
51 | : "m" (dapa) | ||
52 | : "ebx", "ecx", "edi", "memory"); | ||
53 | |||
54 | if (!(u8)ax) | ||
55 | return 0; /* OK */ | ||
56 | |||
57 | ax = 0x0201; /* Legacy Read, one sector */ | ||
58 | cx = 0x0001; /* Sector 0-0-1 */ | ||
59 | dx = devno; | ||
60 | bx = (size_t)buf; | ||
61 | asm("pushfl; stc; int $0x13; setc %%al; popfl" | ||
62 | : "+a" (ax), "+c" (cx), "+d" (dx), "+b" (bx) | ||
63 | : : "esi", "edi", "memory"); | ||
64 | |||
65 | return -(u8)ax; /* 0 or -1 */ | ||
66 | } | ||
67 | |||
68 | static u32 read_mbr_sig(u8 devno, struct edd_info *ei) | ||
69 | { | ||
70 | int sector_size; | ||
71 | char *mbrbuf_ptr, *mbrbuf_end; | ||
72 | u32 mbrsig; | ||
73 | u32 buf_base, mbr_base; | ||
74 | extern char _end[]; | ||
75 | static char mbr_buf[1024]; | ||
76 | |||
77 | sector_size = ei->params.bytes_per_sector; | ||
78 | if (!sector_size) | ||
79 | sector_size = 512; /* Best available guess */ | ||
80 | |||
81 | buf_base = (ds() << 4) + (u32)&_end; | ||
82 | mbr_base = (buf_base+sector_size-1) & ~(sector_size-1); | ||
83 | mbrbuf_ptr = mbr_buf + (mbr_base-buf_base); | ||
84 | mbrbuf_end = mbrbuf_ptr + sector_size; | ||
85 | |||
86 | if (!(boot_params.hdr.loadflags & CAN_USE_HEAP)) | ||
87 | return 0; | ||
88 | if (mbrbuf_end > (char *)(size_t)boot_params.hdr.heap_end_ptr) | ||
89 | return 0; | ||
90 | |||
91 | if (read_mbr(devno, mbrbuf_ptr)) | ||
92 | return 0; | ||
93 | |||
94 | mbrsig = *(u32 *)&mbrbuf_ptr[EDD_MBR_SIG_OFFSET]; | ||
95 | return mbrsig; | ||
96 | } | ||
97 | |||
98 | static int get_edd_info(u8 devno, struct edd_info *ei) | ||
99 | { | ||
100 | u16 ax, bx, cx, dx, di; | ||
101 | |||
102 | memset(ei, 0, sizeof *ei); | ||
103 | |||
104 | /* Check Extensions Present */ | ||
105 | |||
106 | ax = 0x4100; | ||
107 | bx = EDDMAGIC1; | ||
108 | dx = devno; | ||
109 | asm("pushfl; stc; int $0x13; setc %%al; popfl" | ||
110 | : "+a" (ax), "+b" (bx), "=c" (cx), "+d" (dx) | ||
111 | : : "esi", "edi"); | ||
112 | |||
113 | if ((u8)ax) | ||
114 | return -1; /* No extended information */ | ||
115 | |||
116 | if (bx != EDDMAGIC2) | ||
117 | return -1; | ||
118 | |||
119 | ei->device = devno; | ||
120 | ei->version = ax >> 8; /* EDD version number */ | ||
121 | ei->interface_support = cx; /* EDD functionality subsets */ | ||
122 | |||
123 | /* Extended Get Device Parameters */ | ||
124 | |||
125 | ei->params.length = sizeof(ei->params); | ||
126 | ax = 0x4800; | ||
127 | dx = devno; | ||
128 | asm("pushfl; int $0x13; popfl" | ||
129 | : "+a" (ax), "+d" (dx) | ||
130 | : "S" (&ei->params) | ||
131 | : "ebx", "ecx", "edi"); | ||
132 | |||
133 | /* Get legacy CHS parameters */ | ||
134 | |||
135 | /* Ralf Brown recommends setting ES:DI to 0:0 */ | ||
136 | ax = 0x0800; | ||
137 | dx = devno; | ||
138 | di = 0; | ||
139 | asm("pushw %%es; " | ||
140 | "movw %%di,%%es; " | ||
141 | "pushfl; stc; int $0x13; setc %%al; popfl; " | ||
142 | "popw %%es" | ||
143 | : "+a" (ax), "=b" (bx), "=c" (cx), "+d" (dx), "+D" (di) | ||
144 | : : "esi"); | ||
145 | |||
146 | if ((u8)ax == 0) { | ||
147 | ei->legacy_max_cylinder = (cx >> 8) + ((cx & 0xc0) << 2); | ||
148 | ei->legacy_max_head = dx >> 8; | ||
149 | ei->legacy_sectors_per_track = cx & 0x3f; | ||
150 | } | ||
151 | |||
152 | return 0; | ||
153 | } | ||
154 | |||
155 | void query_edd(void) | ||
156 | { | ||
157 | char eddarg[8]; | ||
158 | int do_mbr = 1; | ||
159 | int do_edd = 1; | ||
160 | int devno; | ||
161 | struct edd_info ei, *edp; | ||
162 | |||
163 | if (cmdline_find_option("edd", eddarg, sizeof eddarg) > 0) { | ||
164 | if (!strcmp(eddarg, "skipmbr") || !strcmp(eddarg, "skip")) | ||
165 | do_mbr = 0; | ||
166 | else if (!strcmp(eddarg, "off")) | ||
167 | do_edd = 0; | ||
168 | } | ||
169 | |||
170 | edp = (struct edd_info *)boot_params.eddbuf; | ||
171 | |||
172 | if (!do_edd) | ||
173 | return; | ||
174 | |||
175 | for (devno = 0x80; devno < 0x80+EDD_MBR_SIG_MAX; devno++) { | ||
176 | /* | ||
177 | * Scan the BIOS-supported hard disks and query EDD | ||
178 | * information... | ||
179 | */ | ||
180 | get_edd_info(devno, &ei); | ||
181 | |||
182 | if (boot_params.eddbuf_entries < EDDMAXNR) { | ||
183 | memcpy(edp, &ei, sizeof ei); | ||
184 | edp++; | ||
185 | boot_params.eddbuf_entries++; | ||
186 | } | ||
187 | |||
188 | if (do_mbr) { | ||
189 | u32 mbr_sig; | ||
190 | mbr_sig = read_mbr_sig(devno, &ei); | ||
191 | boot_params.edd_mbr_sig_buffer[devno-0x80] = mbr_sig; | ||
192 | } | ||
193 | } | ||
194 | } | ||
195 | |||
196 | #endif | ||
diff --git a/arch/i386/boot/header.S b/arch/i386/boot/header.S new file mode 100644 index 000000000000..6b9923fb6eae --- /dev/null +++ b/arch/i386/boot/header.S | |||
@@ -0,0 +1,283 @@ | |||
1 | /* | ||
2 | * header.S | ||
3 | * | ||
4 | * Copyright (C) 1991, 1992 Linus Torvalds | ||
5 | * | ||
6 | * Based on bootsect.S and setup.S | ||
7 | * modified by more people than can be counted | ||
8 | * | ||
9 | * Rewritten as a common file by H. Peter Anvin (Apr 2007) | ||
10 | * | ||
11 | * BIG FAT NOTE: We're in real mode using 64k segments. Therefore segment | ||
12 | * addresses must be multiplied by 16 to obtain their respective linear | ||
13 | * addresses. To avoid confusion, linear addresses are written using leading | ||
14 | * hex while segment addresses are written as segment:offset. | ||
15 | * | ||
16 | */ | ||
17 | |||
18 | #include <asm/segment.h> | ||
19 | #include <linux/utsrelease.h> | ||
20 | #include <asm/boot.h> | ||
21 | #include <asm/e820.h> | ||
22 | #include <asm/page.h> | ||
23 | #include <asm/setup.h> | ||
24 | #include "boot.h" | ||
25 | |||
26 | SETUPSECTS = 4 /* default nr of setup-sectors */ | ||
27 | BOOTSEG = 0x07C0 /* original address of boot-sector */ | ||
28 | SYSSEG = DEF_SYSSEG /* system loaded at 0x10000 (65536) */ | ||
29 | SYSSIZE = DEF_SYSSIZE /* system size: # of 16-byte clicks */ | ||
30 | /* to be loaded */ | ||
31 | ROOT_DEV = 0 /* ROOT_DEV is now written by "build" */ | ||
32 | SWAP_DEV = 0 /* SWAP_DEV is now written by "build" */ | ||
33 | |||
34 | #ifndef SVGA_MODE | ||
35 | #define SVGA_MODE ASK_VGA | ||
36 | #endif | ||
37 | |||
38 | #ifndef RAMDISK | ||
39 | #define RAMDISK 0 | ||
40 | #endif | ||
41 | |||
42 | #ifndef ROOT_RDONLY | ||
43 | #define ROOT_RDONLY 1 | ||
44 | #endif | ||
45 | |||
46 | .code16 | ||
47 | .section ".bstext", "ax" | ||
48 | |||
49 | .global bootsect_start | ||
50 | bootsect_start: | ||
51 | |||
52 | # Normalize the start address | ||
53 | ljmp $BOOTSEG, $start2 | ||
54 | |||
55 | start2: | ||
56 | movw %cs, %ax | ||
57 | movw %ax, %ds | ||
58 | movw %ax, %es | ||
59 | movw %ax, %ss | ||
60 | xorw %sp, %sp | ||
61 | sti | ||
62 | cld | ||
63 | |||
64 | movw $bugger_off_msg, %si | ||
65 | |||
66 | msg_loop: | ||
67 | lodsb | ||
68 | andb %al, %al | ||
69 | jz bs_die | ||
70 | movb $0xe, %ah | ||
71 | movw $7, %bx | ||
72 | int $0x10 | ||
73 | jmp msg_loop | ||
74 | |||
75 | bs_die: | ||
76 | # Allow the user to press a key, then reboot | ||
77 | xorw %ax, %ax | ||
78 | int $0x16 | ||
79 | int $0x19 | ||
80 | |||
81 | # int 0x19 should never return. In case it does anyway, | ||
82 | # invoke the BIOS reset code... | ||
83 | ljmp $0xf000,$0xfff0 | ||
84 | |||
85 | .section ".bsdata", "a" | ||
86 | bugger_off_msg: | ||
87 | .ascii "Direct booting from floppy is no longer supported.\r\n" | ||
88 | .ascii "Please use a boot loader program instead.\r\n" | ||
89 | .ascii "\n" | ||
90 | .ascii "Remove disk and press any key to reboot . . .\r\n" | ||
91 | .byte 0 | ||
92 | |||
93 | |||
94 | # Kernel attributes; used by setup. This is part 1 of the | ||
95 | # header, from the old boot sector. | ||
96 | |||
97 | .section ".header", "a" | ||
98 | .globl hdr | ||
99 | hdr: | ||
100 | setup_sects: .byte SETUPSECTS | ||
101 | root_flags: .word ROOT_RDONLY | ||
102 | syssize: .long SYSSIZE | ||
103 | ram_size: .word RAMDISK | ||
104 | vid_mode: .word SVGA_MODE | ||
105 | root_dev: .word ROOT_DEV | ||
106 | boot_flag: .word 0xAA55 | ||
107 | |||
108 | # offset 512, entry point | ||
109 | |||
110 | .globl _start | ||
111 | _start: | ||
112 | # Explicitly enter this as bytes, or the assembler | ||
113 | # tries to generate a 3-byte jump here, which causes | ||
114 | # everything else to push off to the wrong offset. | ||
115 | .byte 0xeb # short (2-byte) jump | ||
116 | .byte start_of_setup-1f | ||
117 | 1: | ||
118 | |||
119 | # Part 2 of the header, from the old setup.S | ||
120 | |||
121 | .ascii "HdrS" # header signature | ||
122 | .word 0x0206 # header version number (>= 0x0105) | ||
123 | # or else old loadlin-1.5 will fail) | ||
124 | .globl realmode_swtch | ||
125 | realmode_swtch: .word 0, 0 # default_switch, SETUPSEG | ||
126 | start_sys_seg: .word SYSSEG | ||
127 | .word kernel_version-512 # pointing to kernel version string | ||
128 | # above section of header is compatible | ||
129 | # with loadlin-1.5 (header v1.5). Don't | ||
130 | # change it. | ||
131 | |||
132 | type_of_loader: .byte 0 # = 0, old one (LILO, Loadlin, | ||
133 | # Bootlin, SYSLX, bootsect...) | ||
134 | # See Documentation/i386/boot.txt for | ||
135 | # assigned ids | ||
136 | |||
137 | # flags, unused bits must be zero (RFU) bit within loadflags | ||
138 | loadflags: | ||
139 | LOADED_HIGH = 1 # If set, the kernel is loaded high | ||
140 | CAN_USE_HEAP = 0x80 # If set, the loader also has set | ||
141 | # heap_end_ptr to tell how much | ||
142 | # space behind setup.S can be used for | ||
143 | # heap purposes. | ||
144 | # Only the loader knows what is free | ||
145 | #ifndef __BIG_KERNEL__ | ||
146 | .byte 0 | ||
147 | #else | ||
148 | .byte LOADED_HIGH | ||
149 | #endif | ||
150 | |||
151 | setup_move_size: .word 0x8000 # size to move, when setup is not | ||
152 | # loaded at 0x90000. We will move setup | ||
153 | # to 0x90000 then just before jumping | ||
154 | # into the kernel. However, only the | ||
155 | # loader knows how much data behind | ||
156 | # us also needs to be loaded. | ||
157 | |||
158 | code32_start: # here loaders can put a different | ||
159 | # start address for 32-bit code. | ||
160 | #ifndef __BIG_KERNEL__ | ||
161 | .long 0x1000 # 0x1000 = default for zImage | ||
162 | #else | ||
163 | .long 0x100000 # 0x100000 = default for big kernel | ||
164 | #endif | ||
165 | |||
166 | ramdisk_image: .long 0 # address of loaded ramdisk image | ||
167 | # Here the loader puts the 32-bit | ||
168 | # address where it loaded the image. | ||
169 | # This only will be read by the kernel. | ||
170 | |||
171 | ramdisk_size: .long 0 # its size in bytes | ||
172 | |||
173 | bootsect_kludge: | ||
174 | .long 0 # obsolete | ||
175 | |||
176 | heap_end_ptr: .word _end+1024 # (Header version 0x0201 or later) | ||
177 | # space from here (exclusive) down to | ||
178 | # end of setup code can be used by setup | ||
179 | # for local heap purposes. | ||
180 | |||
181 | pad1: .word 0 | ||
182 | cmd_line_ptr: .long 0 # (Header version 0x0202 or later) | ||
183 | # If nonzero, a 32-bit pointer | ||
184 | # to the kernel command line. | ||
185 | # The command line should be | ||
186 | # located between the start of | ||
187 | # setup and the end of low | ||
188 | # memory (0xa0000), or it may | ||
189 | # get overwritten before it | ||
190 | # gets read. If this field is | ||
191 | # used, there is no longer | ||
192 | # anything magical about the | ||
193 | # 0x90000 segment; the setup | ||
194 | # can be located anywhere in | ||
195 | # low memory 0x10000 or higher. | ||
196 | |||
197 | ramdisk_max: .long (-__PAGE_OFFSET-(512 << 20)-1) & 0x7fffffff | ||
198 | # (Header version 0x0203 or later) | ||
199 | # The highest safe address for | ||
200 | # the contents of an initrd | ||
201 | |||
202 | kernel_alignment: .long CONFIG_PHYSICAL_ALIGN #physical addr alignment | ||
203 | #required for protected mode | ||
204 | #kernel | ||
205 | #ifdef CONFIG_RELOCATABLE | ||
206 | relocatable_kernel: .byte 1 | ||
207 | #else | ||
208 | relocatable_kernel: .byte 0 | ||
209 | #endif | ||
210 | pad2: .byte 0 | ||
211 | pad3: .word 0 | ||
212 | |||
213 | cmdline_size: .long COMMAND_LINE_SIZE-1 #length of the command line, | ||
214 | #added with boot protocol | ||
215 | #version 2.06 | ||
216 | |||
217 | # End of setup header ##################################################### | ||
218 | |||
219 | .section ".inittext", "ax" | ||
220 | start_of_setup: | ||
221 | #ifdef SAFE_RESET_DISK_CONTROLLER | ||
222 | # Reset the disk controller. | ||
223 | movw $0x0000, %ax # Reset disk controller | ||
224 | movb $0x80, %dl # All disks | ||
225 | int $0x13 | ||
226 | #endif | ||
227 | |||
228 | # We will have entired with %cs = %ds+0x20, normalize %cs so | ||
229 | # it is on par with the other segments. | ||
230 | pushw %ds | ||
231 | pushw $setup2 | ||
232 | lretw | ||
233 | |||
234 | setup2: | ||
235 | # Force %es = %ds | ||
236 | movw %ds, %ax | ||
237 | movw %ax, %es | ||
238 | cld | ||
239 | |||
240 | # Stack paranoia: align the stack and make sure it is good | ||
241 | # for both 16- and 32-bit references. In particular, if we | ||
242 | # were meant to have been using the full 16-bit segment, the | ||
243 | # caller might have set %sp to zero, which breaks %esp-based | ||
244 | # references. | ||
245 | andw $~3, %sp # dword align (might as well...) | ||
246 | jnz 1f | ||
247 | movw $0xfffc, %sp # Make sure we're not zero | ||
248 | 1: movzwl %sp, %esp # Clear upper half of %esp | ||
249 | sti | ||
250 | |||
251 | # Check signature at end of setup | ||
252 | cmpl $0x5a5aaa55, setup_sig | ||
253 | jne setup_bad | ||
254 | |||
255 | # Zero the bss | ||
256 | movw $__bss_start, %di | ||
257 | movw $_end+3, %cx | ||
258 | xorl %eax, %eax | ||
259 | subw %di, %cx | ||
260 | shrw $2, %cx | ||
261 | rep; stosl | ||
262 | |||
263 | # Jump to C code (should not return) | ||
264 | calll main | ||
265 | |||
266 | # Setup corrupt somehow... | ||
267 | setup_bad: | ||
268 | movl $setup_corrupt, %eax | ||
269 | calll puts | ||
270 | # Fall through... | ||
271 | |||
272 | .globl die | ||
273 | .type die, @function | ||
274 | die: | ||
275 | hlt | ||
276 | jmp die | ||
277 | |||
278 | .size die, .-due | ||
279 | |||
280 | .section ".initdata", "a" | ||
281 | setup_corrupt: | ||
282 | .byte 7 | ||
283 | .string "No setup signature found..." | ||
diff --git a/arch/i386/boot/main.c b/arch/i386/boot/main.c new file mode 100644 index 000000000000..7f01f96c4fb8 --- /dev/null +++ b/arch/i386/boot/main.c | |||
@@ -0,0 +1,161 @@ | |||
1 | /* -*- linux-c -*- ------------------------------------------------------- * | ||
2 | * | ||
3 | * Copyright (C) 1991, 1992 Linus Torvalds | ||
4 | * Copyright 2007 rPath, Inc. - All Rights Reserved | ||
5 | * | ||
6 | * This file is part of the Linux kernel, and is made available under | ||
7 | * the terms of the GNU General Public License version 2. | ||
8 | * | ||
9 | * ----------------------------------------------------------------------- */ | ||
10 | |||
11 | /* | ||
12 | * arch/i386/boot/main.c | ||
13 | * | ||
14 | * Main module for the real-mode kernel code | ||
15 | */ | ||
16 | |||
17 | #include "boot.h" | ||
18 | |||
19 | struct boot_params boot_params __attribute__((aligned(16))); | ||
20 | |||
21 | char *HEAP = _end; | ||
22 | char *heap_end = _end; /* Default end of heap = no heap */ | ||
23 | |||
24 | /* | ||
25 | * Copy the header into the boot parameter block. Since this | ||
26 | * screws up the old-style command line protocol, adjust by | ||
27 | * filling in the new-style command line pointer instead. | ||
28 | */ | ||
29 | #define OLD_CL_MAGIC 0xA33F | ||
30 | #define OLD_CL_ADDRESS 0x20 | ||
31 | |||
32 | static void copy_boot_params(void) | ||
33 | { | ||
34 | struct old_cmdline { | ||
35 | u16 cl_magic; | ||
36 | u16 cl_offset; | ||
37 | }; | ||
38 | const struct old_cmdline * const oldcmd = | ||
39 | (const struct old_cmdline *)OLD_CL_ADDRESS; | ||
40 | |||
41 | BUILD_BUG_ON(sizeof boot_params != 4096); | ||
42 | memcpy(&boot_params.hdr, &hdr, sizeof hdr); | ||
43 | |||
44 | if (!boot_params.hdr.cmd_line_ptr && | ||
45 | oldcmd->cl_magic == OLD_CL_MAGIC) { | ||
46 | /* Old-style command line protocol. */ | ||
47 | u16 cmdline_seg; | ||
48 | |||
49 | /* Figure out if the command line falls in the region | ||
50 | of memory that an old kernel would have copied up | ||
51 | to 0x90000... */ | ||
52 | if (oldcmd->cl_offset < boot_params.hdr.setup_move_size) | ||
53 | cmdline_seg = ds(); | ||
54 | else | ||
55 | cmdline_seg = 0x9000; | ||
56 | |||
57 | boot_params.hdr.cmd_line_ptr = | ||
58 | (cmdline_seg << 4) + oldcmd->cl_offset; | ||
59 | } | ||
60 | } | ||
61 | |||
62 | /* | ||
63 | * Set the keyboard repeat rate to maximum. Unclear why this | ||
64 | * is done here; this might be possible to kill off as stale code. | ||
65 | */ | ||
66 | static void keyboard_set_repeat(void) | ||
67 | { | ||
68 | u16 ax = 0x0305; | ||
69 | u16 bx = 0; | ||
70 | asm volatile("int $0x16" | ||
71 | : "+a" (ax), "+b" (bx) | ||
72 | : : "ecx", "edx", "esi", "edi"); | ||
73 | } | ||
74 | |||
75 | /* | ||
76 | * Get Intel SpeedStep IST information. | ||
77 | */ | ||
78 | static void query_speedstep_ist(void) | ||
79 | { | ||
80 | asm("int $0x15" | ||
81 | : "=a" (boot_params.speedstep_info[0]), | ||
82 | "=b" (boot_params.speedstep_info[1]), | ||
83 | "=c" (boot_params.speedstep_info[2]), | ||
84 | "=d" (boot_params.speedstep_info[3]) | ||
85 | : "a" (0x0000e980), /* IST Support */ | ||
86 | "d" (0x47534943)); /* Request value */ | ||
87 | } | ||
88 | |||
89 | /* | ||
90 | * Tell the BIOS what CPU mode we intend to run in. | ||
91 | */ | ||
92 | static void set_bios_mode(void) | ||
93 | { | ||
94 | #ifdef CONFIG_X86_64 | ||
95 | u32 eax, ebx; | ||
96 | |||
97 | eax = 0xec00; | ||
98 | ebx = 2; | ||
99 | asm volatile("int $0x15" | ||
100 | : "+a" (eax), "+b" (ebx) | ||
101 | : : "ecx", "edx", "esi", "edi"); | ||
102 | #endif | ||
103 | } | ||
104 | |||
105 | void main(void) | ||
106 | { | ||
107 | /* First, copy the boot header into the "zeropage" */ | ||
108 | copy_boot_params(); | ||
109 | |||
110 | /* End of heap check */ | ||
111 | if (boot_params.hdr.loadflags & CAN_USE_HEAP) { | ||
112 | heap_end = (char *)(boot_params.hdr.heap_end_ptr | ||
113 | +0x200-STACK_SIZE); | ||
114 | } else { | ||
115 | /* Boot protocol 2.00 only, no heap available */ | ||
116 | puts("WARNING: Ancient bootloader, some functionality " | ||
117 | "may be limited!\n"); | ||
118 | } | ||
119 | |||
120 | /* Make sure we have all the proper CPU support */ | ||
121 | if (validate_cpu()) { | ||
122 | puts("Unable to boot - please use a kernel appropriate " | ||
123 | "for your CPU.\n"); | ||
124 | die(); | ||
125 | } | ||
126 | |||
127 | /* Tell the BIOS what CPU mode we intend to run in. */ | ||
128 | set_bios_mode(); | ||
129 | |||
130 | /* Detect memory layout */ | ||
131 | detect_memory(); | ||
132 | |||
133 | /* Set keyboard repeat rate (why?) */ | ||
134 | keyboard_set_repeat(); | ||
135 | |||
136 | /* Set the video mode */ | ||
137 | set_video(); | ||
138 | |||
139 | /* Query MCA information */ | ||
140 | query_mca(); | ||
141 | |||
142 | /* Voyager */ | ||
143 | #ifdef CONFIG_X86_VOYAGER | ||
144 | query_voyager(); | ||
145 | #endif | ||
146 | |||
147 | /* Query SpeedStep IST information */ | ||
148 | query_speedstep_ist(); | ||
149 | |||
150 | /* Query APM information */ | ||
151 | #if defined(CONFIG_APM) || defined(CONFIG_APM_MODULE) | ||
152 | query_apm_bios(); | ||
153 | #endif | ||
154 | |||
155 | /* Query EDD information */ | ||
156 | #if defined(CONFIG_EDD) || defined(CONFIG_EDD_MODULE) | ||
157 | query_edd(); | ||
158 | #endif | ||
159 | /* Do the last things and invoke protected mode */ | ||
160 | go_to_protected_mode(); | ||
161 | } | ||
diff --git a/arch/i386/boot/mca.c b/arch/i386/boot/mca.c new file mode 100644 index 000000000000..9b68bd1aef19 --- /dev/null +++ b/arch/i386/boot/mca.c | |||
@@ -0,0 +1,43 @@ | |||
1 | /* -*- linux-c -*- ------------------------------------------------------- * | ||
2 | * | ||
3 | * Copyright (C) 1991, 1992 Linus Torvalds | ||
4 | * Copyright 2007 rPath, Inc. - All Rights Reserved | ||
5 | * | ||
6 | * This file is part of the Linux kernel, and is made available under | ||
7 | * the terms of the GNU General Public License version 2. | ||
8 | * | ||
9 | * ----------------------------------------------------------------------- */ | ||
10 | |||
11 | /* | ||
12 | * arch/i386/boot/mca.c | ||
13 | * | ||
14 | * Get the MCA system description table | ||
15 | */ | ||
16 | |||
17 | #include "boot.h" | ||
18 | |||
19 | int query_mca(void) | ||
20 | { | ||
21 | u8 err; | ||
22 | u16 es, bx, len; | ||
23 | |||
24 | asm("pushw %%es ; " | ||
25 | "int $0x15 ; " | ||
26 | "setc %0 ; " | ||
27 | "movw %%es, %1 ; " | ||
28 | "popw %%es" | ||
29 | : "=acdSDm" (err), "=acdSDm" (es), "=b" (bx) | ||
30 | : "a" (0xc000)); | ||
31 | |||
32 | if (err) | ||
33 | return -1; /* No MCA present */ | ||
34 | |||
35 | set_fs(es); | ||
36 | len = rdfs16(bx); | ||
37 | |||
38 | if (len > sizeof(boot_params.sys_desc_table)) | ||
39 | len = sizeof(boot_params.sys_desc_table); | ||
40 | |||
41 | copy_from_fs(&boot_params.sys_desc_table, bx, len); | ||
42 | return 0; | ||
43 | } | ||
diff --git a/arch/i386/boot/memory.c b/arch/i386/boot/memory.c new file mode 100644 index 000000000000..1a2e62db8bed --- /dev/null +++ b/arch/i386/boot/memory.c | |||
@@ -0,0 +1,99 @@ | |||
1 | /* -*- linux-c -*- ------------------------------------------------------- * | ||
2 | * | ||
3 | * Copyright (C) 1991, 1992 Linus Torvalds | ||
4 | * Copyright 2007 rPath, Inc. - All Rights Reserved | ||
5 | * | ||
6 | * This file is part of the Linux kernel, and is made available under | ||
7 | * the terms of the GNU General Public License version 2. | ||
8 | * | ||
9 | * ----------------------------------------------------------------------- */ | ||
10 | |||
11 | /* | ||
12 | * arch/i386/boot/memory.c | ||
13 | * | ||
14 | * Memory detection code | ||
15 | */ | ||
16 | |||
17 | #include "boot.h" | ||
18 | |||
19 | #define SMAP 0x534d4150 /* ASCII "SMAP" */ | ||
20 | |||
21 | static int detect_memory_e820(void) | ||
22 | { | ||
23 | u32 next = 0; | ||
24 | u32 size, id; | ||
25 | u8 err; | ||
26 | struct e820entry *desc = boot_params.e820_map; | ||
27 | |||
28 | do { | ||
29 | size = sizeof(struct e820entry); | ||
30 | id = SMAP; | ||
31 | asm("int $0x15; setc %0" | ||
32 | : "=am" (err), "+b" (next), "+d" (id), "+c" (size), | ||
33 | "=m" (*desc) | ||
34 | : "D" (desc), "a" (0xe820)); | ||
35 | |||
36 | if (err || id != SMAP) | ||
37 | break; | ||
38 | |||
39 | boot_params.e820_entries++; | ||
40 | desc++; | ||
41 | } while (next && boot_params.e820_entries < E820MAX); | ||
42 | |||
43 | return boot_params.e820_entries; | ||
44 | } | ||
45 | |||
46 | static int detect_memory_e801(void) | ||
47 | { | ||
48 | u16 ax, bx, cx, dx; | ||
49 | u8 err; | ||
50 | |||
51 | bx = cx = dx = 0; | ||
52 | ax = 0xe801; | ||
53 | asm("stc; int $0x15; setc %0" | ||
54 | : "=m" (err), "+a" (ax), "+b" (bx), "+c" (cx), "+d" (dx)); | ||
55 | |||
56 | if (err) | ||
57 | return -1; | ||
58 | |||
59 | /* Do we really need to do this? */ | ||
60 | if (cx || dx) { | ||
61 | ax = cx; | ||
62 | bx = dx; | ||
63 | } | ||
64 | |||
65 | if (ax > 15*1024) | ||
66 | return -1; /* Bogus! */ | ||
67 | |||
68 | /* This ignores memory above 16MB if we have a memory hole | ||
69 | there. If someone actually finds a machine with a memory | ||
70 | hole at 16MB and no support for 0E820h they should probably | ||
71 | generate a fake e820 map. */ | ||
72 | boot_params.alt_mem_k = (ax == 15*1024) ? (dx << 6)+ax : ax; | ||
73 | |||
74 | return 0; | ||
75 | } | ||
76 | |||
77 | static int detect_memory_88(void) | ||
78 | { | ||
79 | u16 ax; | ||
80 | u8 err; | ||
81 | |||
82 | ax = 0x8800; | ||
83 | asm("stc; int $0x15; setc %0" : "=bcdm" (err), "+a" (ax)); | ||
84 | |||
85 | boot_params.screen_info.ext_mem_k = ax; | ||
86 | |||
87 | return -err; | ||
88 | } | ||
89 | |||
90 | int detect_memory(void) | ||
91 | { | ||
92 | if (detect_memory_e820() > 0) | ||
93 | return 0; | ||
94 | |||
95 | if (!detect_memory_e801()) | ||
96 | return 0; | ||
97 | |||
98 | return detect_memory_88(); | ||
99 | } | ||
diff --git a/arch/i386/boot/pm.c b/arch/i386/boot/pm.c new file mode 100644 index 000000000000..3fa53e15ed77 --- /dev/null +++ b/arch/i386/boot/pm.c | |||
@@ -0,0 +1,170 @@ | |||
1 | /* -*- linux-c -*- ------------------------------------------------------- * | ||
2 | * | ||
3 | * Copyright (C) 1991, 1992 Linus Torvalds | ||
4 | * Copyright 2007 rPath, Inc. - All Rights Reserved | ||
5 | * | ||
6 | * This file is part of the Linux kernel, and is made available under | ||
7 | * the terms of the GNU General Public License version 2. | ||
8 | * | ||
9 | * ----------------------------------------------------------------------- */ | ||
10 | |||
11 | /* | ||
12 | * arch/i386/boot/pm.c | ||
13 | * | ||
14 | * Prepare the machine for transition to protected mode. | ||
15 | */ | ||
16 | |||
17 | #include "boot.h" | ||
18 | #include <asm/segment.h> | ||
19 | |||
20 | /* | ||
21 | * Invoke the realmode switch hook if present; otherwise | ||
22 | * disable all interrupts. | ||
23 | */ | ||
24 | static void realmode_switch_hook(void) | ||
25 | { | ||
26 | if (boot_params.hdr.realmode_swtch) { | ||
27 | asm volatile("lcallw *%0" | ||
28 | : : "m" (boot_params.hdr.realmode_swtch) | ||
29 | : "eax", "ebx", "ecx", "edx"); | ||
30 | } else { | ||
31 | asm volatile("cli"); | ||
32 | outb(0x80, 0x70); /* Disable NMI */ | ||
33 | io_delay(); | ||
34 | } | ||
35 | } | ||
36 | |||
37 | /* | ||
38 | * A zImage kernel is loaded at 0x10000 but wants to run at 0x1000. | ||
39 | * A bzImage kernel is loaded and runs at 0x100000. | ||
40 | */ | ||
41 | static void move_kernel_around(void) | ||
42 | { | ||
43 | /* Note: rely on the compile-time option here rather than | ||
44 | the LOADED_HIGH flag. The Qemu kernel loader unconditionally | ||
45 | sets the loadflags to zero. */ | ||
46 | #ifndef __BIG_KERNEL__ | ||
47 | u16 dst_seg, src_seg; | ||
48 | u32 syssize; | ||
49 | |||
50 | dst_seg = 0x1000 >> 4; | ||
51 | src_seg = 0x10000 >> 4; | ||
52 | syssize = boot_params.hdr.syssize; /* Size in 16-byte paragraphs */ | ||
53 | |||
54 | while (syssize) { | ||
55 | int paras = (syssize >= 0x1000) ? 0x1000 : syssize; | ||
56 | int dwords = paras << 2; | ||
57 | |||
58 | asm volatile("pushw %%es ; " | ||
59 | "pushw %%ds ; " | ||
60 | "movw %1,%%es ; " | ||
61 | "movw %2,%%ds ; " | ||
62 | "xorw %%di,%%di ; " | ||
63 | "xorw %%si,%%si ; " | ||
64 | "rep;movsl ; " | ||
65 | "popw %%ds ; " | ||
66 | "popw %%es" | ||
67 | : "+c" (dwords) | ||
68 | : "rm" (dst_seg), "rm" (src_seg) | ||
69 | : "esi", "edi"); | ||
70 | |||
71 | syssize -= paras; | ||
72 | dst_seg += paras; | ||
73 | src_seg += paras; | ||
74 | } | ||
75 | #endif | ||
76 | } | ||
77 | |||
78 | /* | ||
79 | * Disable all interrupts at the legacy PIC. | ||
80 | */ | ||
81 | static void mask_all_interrupts(void) | ||
82 | { | ||
83 | outb(0xff, 0xa1); /* Mask all interrupts on the seconday PIC */ | ||
84 | io_delay(); | ||
85 | outb(0xfb, 0x21); /* Mask all but cascade on the primary PIC */ | ||
86 | io_delay(); | ||
87 | } | ||
88 | |||
89 | /* | ||
90 | * Reset IGNNE# if asserted in the FPU. | ||
91 | */ | ||
92 | static void reset_coprocessor(void) | ||
93 | { | ||
94 | outb(0, 0xf0); | ||
95 | io_delay(); | ||
96 | outb(0, 0xf1); | ||
97 | io_delay(); | ||
98 | } | ||
99 | |||
100 | /* | ||
101 | * Set up the GDT | ||
102 | */ | ||
103 | #define GDT_ENTRY(flags,base,limit) \ | ||
104 | (((u64)(base & 0xff000000) << 32) | \ | ||
105 | ((u64)flags << 40) | \ | ||
106 | ((u64)(limit & 0x00ff0000) << 32) | \ | ||
107 | ((u64)(base & 0x00ffff00) << 16) | \ | ||
108 | ((u64)(limit & 0x0000ffff))) | ||
109 | |||
110 | struct gdt_ptr { | ||
111 | u16 len; | ||
112 | u32 ptr; | ||
113 | } __attribute__((packed)); | ||
114 | |||
115 | static void setup_gdt(void) | ||
116 | { | ||
117 | /* There are machines which are known to not boot with the GDT | ||
118 | being 8-byte unaligned. Intel recommends 16 byte alignment. */ | ||
119 | static const u64 boot_gdt[] __attribute__((aligned(16))) = { | ||
120 | /* CS: code, read/execute, 4 GB, base 0 */ | ||
121 | [GDT_ENTRY_BOOT_CS] = GDT_ENTRY(0xc09b, 0, 0xfffff), | ||
122 | /* DS: data, read/write, 4 GB, base 0 */ | ||
123 | [GDT_ENTRY_BOOT_DS] = GDT_ENTRY(0xc093, 0, 0xfffff), | ||
124 | }; | ||
125 | struct gdt_ptr gdt; | ||
126 | |||
127 | gdt.len = sizeof(boot_gdt)-1; | ||
128 | gdt.ptr = (u32)&boot_gdt + (ds() << 4); | ||
129 | |||
130 | asm volatile("lgdtl %0" : : "m" (gdt)); | ||
131 | } | ||
132 | |||
133 | /* | ||
134 | * Set up the IDT | ||
135 | */ | ||
136 | static void setup_idt(void) | ||
137 | { | ||
138 | static const struct gdt_ptr null_idt = {0, 0}; | ||
139 | asm volatile("lidtl %0" : : "m" (null_idt)); | ||
140 | } | ||
141 | |||
142 | /* | ||
143 | * Actual invocation sequence | ||
144 | */ | ||
145 | void go_to_protected_mode(void) | ||
146 | { | ||
147 | /* Hook before leaving real mode, also disables interrupts */ | ||
148 | realmode_switch_hook(); | ||
149 | |||
150 | /* Move the kernel/setup to their final resting places */ | ||
151 | move_kernel_around(); | ||
152 | |||
153 | /* Enable the A20 gate */ | ||
154 | if (enable_a20()) { | ||
155 | puts("A20 gate not responding, unable to boot...\n"); | ||
156 | die(); | ||
157 | } | ||
158 | |||
159 | /* Reset coprocessor (IGNNE#) */ | ||
160 | reset_coprocessor(); | ||
161 | |||
162 | /* Mask all interrupts in the PIC */ | ||
163 | mask_all_interrupts(); | ||
164 | |||
165 | /* Actual transition to protected mode... */ | ||
166 | setup_idt(); | ||
167 | setup_gdt(); | ||
168 | protected_mode_jump(boot_params.hdr.code32_start, | ||
169 | (u32)&boot_params + (ds() << 4)); | ||
170 | } | ||
diff --git a/arch/i386/boot/pmjump.S b/arch/i386/boot/pmjump.S new file mode 100644 index 000000000000..2e559233725a --- /dev/null +++ b/arch/i386/boot/pmjump.S | |||
@@ -0,0 +1,54 @@ | |||
1 | /* ----------------------------------------------------------------------- * | ||
2 | * | ||
3 | * Copyright (C) 1991, 1992 Linus Torvalds | ||
4 | * Copyright 2007 rPath, Inc. - All Rights Reserved | ||
5 | * | ||
6 | * This file is part of the Linux kernel, and is made available under | ||
7 | * the terms of the GNU General Public License version 2. | ||
8 | * | ||
9 | * ----------------------------------------------------------------------- */ | ||
10 | |||
11 | /* | ||
12 | * arch/i386/boot/pmjump.S | ||
13 | * | ||
14 | * The actual transition into protected mode | ||
15 | */ | ||
16 | |||
17 | #include <asm/boot.h> | ||
18 | #include <asm/segment.h> | ||
19 | |||
20 | .text | ||
21 | |||
22 | .globl protected_mode_jump | ||
23 | .type protected_mode_jump, @function | ||
24 | |||
25 | .code16 | ||
26 | |||
27 | /* | ||
28 | * void protected_mode_jump(u32 entrypoint, u32 bootparams); | ||
29 | */ | ||
30 | protected_mode_jump: | ||
31 | xorl %ebx, %ebx # Flag to indicate this is a boot | ||
32 | movl %edx, %esi # Pointer to boot_params table | ||
33 | movl %eax, 2f # Patch ljmpl instruction | ||
34 | jmp 1f # Short jump to flush instruction q. | ||
35 | |||
36 | 1: | ||
37 | movw $__BOOT_DS, %cx | ||
38 | |||
39 | movl %cr0, %edx | ||
40 | orb $1, %dl # Protected mode (PE) bit | ||
41 | movl %edx, %cr0 | ||
42 | |||
43 | movw %cx, %ds | ||
44 | movw %cx, %es | ||
45 | movw %cx, %fs | ||
46 | movw %cx, %gs | ||
47 | movw %cx, %ss | ||
48 | |||
49 | # Jump to the 32-bit entrypoint | ||
50 | .byte 0x66, 0xea # ljmpl opcode | ||
51 | 2: .long 0 # offset | ||
52 | .word __BOOT_CS # segment | ||
53 | |||
54 | .size protected_mode_jump, .-protected_mode_jump | ||
diff --git a/arch/i386/boot/printf.c b/arch/i386/boot/printf.c new file mode 100644 index 000000000000..1a09f9309d3c --- /dev/null +++ b/arch/i386/boot/printf.c | |||
@@ -0,0 +1,307 @@ | |||
1 | /* -*- linux-c -*- ------------------------------------------------------- * | ||
2 | * | ||
3 | * Copyright (C) 1991, 1992 Linus Torvalds | ||
4 | * Copyright 2007 rPath, Inc. - All Rights Reserved | ||
5 | * | ||
6 | * This file is part of the Linux kernel, and is made available under | ||
7 | * the terms of the GNU General Public License version 2. | ||
8 | * | ||
9 | * ----------------------------------------------------------------------- */ | ||
10 | |||
11 | /* | ||
12 | * arch/i386/boot/printf.c | ||
13 | * | ||
14 | * Oh, it's a waste of space, but oh-so-yummy for debugging. This | ||
15 | * version of printf() does not include 64-bit support. "Live with | ||
16 | * it." | ||
17 | * | ||
18 | */ | ||
19 | |||
20 | #include "boot.h" | ||
21 | |||
22 | static int skip_atoi(const char **s) | ||
23 | { | ||
24 | int i = 0; | ||
25 | |||
26 | while (isdigit(**s)) | ||
27 | i = i * 10 + *((*s)++) - '0'; | ||
28 | return i; | ||
29 | } | ||
30 | |||
31 | #define ZEROPAD 1 /* pad with zero */ | ||
32 | #define SIGN 2 /* unsigned/signed long */ | ||
33 | #define PLUS 4 /* show plus */ | ||
34 | #define SPACE 8 /* space if plus */ | ||
35 | #define LEFT 16 /* left justified */ | ||
36 | #define SPECIAL 32 /* 0x */ | ||
37 | #define LARGE 64 /* use 'ABCDEF' instead of 'abcdef' */ | ||
38 | |||
39 | #define do_div(n,base) ({ \ | ||
40 | int __res; \ | ||
41 | __res = ((unsigned long) n) % (unsigned) base; \ | ||
42 | n = ((unsigned long) n) / (unsigned) base; \ | ||
43 | __res; }) | ||
44 | |||
45 | static char *number(char *str, long num, int base, int size, int precision, | ||
46 | int type) | ||
47 | { | ||
48 | char c, sign, tmp[66]; | ||
49 | const char *digits = "0123456789abcdefghijklmnopqrstuvwxyz"; | ||
50 | int i; | ||
51 | |||
52 | if (type & LARGE) | ||
53 | digits = "0123456789ABCDEFGHIJKLMNOPQRSTUVWXYZ"; | ||
54 | if (type & LEFT) | ||
55 | type &= ~ZEROPAD; | ||
56 | if (base < 2 || base > 36) | ||
57 | return 0; | ||
58 | c = (type & ZEROPAD) ? '0' : ' '; | ||
59 | sign = 0; | ||
60 | if (type & SIGN) { | ||
61 | if (num < 0) { | ||
62 | sign = '-'; | ||
63 | num = -num; | ||
64 | size--; | ||
65 | } else if (type & PLUS) { | ||
66 | sign = '+'; | ||
67 | size--; | ||
68 | } else if (type & SPACE) { | ||
69 | sign = ' '; | ||
70 | size--; | ||
71 | } | ||
72 | } | ||
73 | if (type & SPECIAL) { | ||
74 | if (base == 16) | ||
75 | size -= 2; | ||
76 | else if (base == 8) | ||
77 | size--; | ||
78 | } | ||
79 | i = 0; | ||
80 | if (num == 0) | ||
81 | tmp[i++] = '0'; | ||
82 | else | ||
83 | while (num != 0) | ||
84 | tmp[i++] = digits[do_div(num, base)]; | ||
85 | if (i > precision) | ||
86 | precision = i; | ||
87 | size -= precision; | ||
88 | if (!(type & (ZEROPAD + LEFT))) | ||
89 | while (size-- > 0) | ||
90 | *str++ = ' '; | ||
91 | if (sign) | ||
92 | *str++ = sign; | ||
93 | if (type & SPECIAL) { | ||
94 | if (base == 8) | ||
95 | *str++ = '0'; | ||
96 | else if (base == 16) { | ||
97 | *str++ = '0'; | ||
98 | *str++ = digits[33]; | ||
99 | } | ||
100 | } | ||
101 | if (!(type & LEFT)) | ||
102 | while (size-- > 0) | ||
103 | *str++ = c; | ||
104 | while (i < precision--) | ||
105 | *str++ = '0'; | ||
106 | while (i-- > 0) | ||
107 | *str++ = tmp[i]; | ||
108 | while (size-- > 0) | ||
109 | *str++ = ' '; | ||
110 | return str; | ||
111 | } | ||
112 | |||
113 | int vsprintf(char *buf, const char *fmt, va_list args) | ||
114 | { | ||
115 | int len; | ||
116 | unsigned long num; | ||
117 | int i, base; | ||
118 | char *str; | ||
119 | const char *s; | ||
120 | |||
121 | int flags; /* flags to number() */ | ||
122 | |||
123 | int field_width; /* width of output field */ | ||
124 | int precision; /* min. # of digits for integers; max | ||
125 | number of chars for from string */ | ||
126 | int qualifier; /* 'h', 'l', or 'L' for integer fields */ | ||
127 | |||
128 | for (str = buf; *fmt; ++fmt) { | ||
129 | if (*fmt != '%') { | ||
130 | *str++ = *fmt; | ||
131 | continue; | ||
132 | } | ||
133 | |||
134 | /* process flags */ | ||
135 | flags = 0; | ||
136 | repeat: | ||
137 | ++fmt; /* this also skips first '%' */ | ||
138 | switch (*fmt) { | ||
139 | case '-': | ||
140 | flags |= LEFT; | ||
141 | goto repeat; | ||
142 | case '+': | ||
143 | flags |= PLUS; | ||
144 | goto repeat; | ||
145 | case ' ': | ||
146 | flags |= SPACE; | ||
147 | goto repeat; | ||
148 | case '#': | ||
149 | flags |= SPECIAL; | ||
150 | goto repeat; | ||
151 | case '0': | ||
152 | flags |= ZEROPAD; | ||
153 | goto repeat; | ||
154 | } | ||
155 | |||
156 | /* get field width */ | ||
157 | field_width = -1; | ||
158 | if (isdigit(*fmt)) | ||
159 | field_width = skip_atoi(&fmt); | ||
160 | else if (*fmt == '*') { | ||
161 | ++fmt; | ||
162 | /* it's the next argument */ | ||
163 | field_width = va_arg(args, int); | ||
164 | if (field_width < 0) { | ||
165 | field_width = -field_width; | ||
166 | flags |= LEFT; | ||
167 | } | ||
168 | } | ||
169 | |||
170 | /* get the precision */ | ||
171 | precision = -1; | ||
172 | if (*fmt == '.') { | ||
173 | ++fmt; | ||
174 | if (isdigit(*fmt)) | ||
175 | precision = skip_atoi(&fmt); | ||
176 | else if (*fmt == '*') { | ||
177 | ++fmt; | ||
178 | /* it's the next argument */ | ||
179 | precision = va_arg(args, int); | ||
180 | } | ||
181 | if (precision < 0) | ||
182 | precision = 0; | ||
183 | } | ||
184 | |||
185 | /* get the conversion qualifier */ | ||
186 | qualifier = -1; | ||
187 | if (*fmt == 'h' || *fmt == 'l' || *fmt == 'L') { | ||
188 | qualifier = *fmt; | ||
189 | ++fmt; | ||
190 | } | ||
191 | |||
192 | /* default base */ | ||
193 | base = 10; | ||
194 | |||
195 | switch (*fmt) { | ||
196 | case 'c': | ||
197 | if (!(flags & LEFT)) | ||
198 | while (--field_width > 0) | ||
199 | *str++ = ' '; | ||
200 | *str++ = (unsigned char)va_arg(args, int); | ||
201 | while (--field_width > 0) | ||
202 | *str++ = ' '; | ||
203 | continue; | ||
204 | |||
205 | case 's': | ||
206 | s = va_arg(args, char *); | ||
207 | len = strnlen(s, precision); | ||
208 | |||
209 | if (!(flags & LEFT)) | ||
210 | while (len < field_width--) | ||
211 | *str++ = ' '; | ||
212 | for (i = 0; i < len; ++i) | ||
213 | *str++ = *s++; | ||
214 | while (len < field_width--) | ||
215 | *str++ = ' '; | ||
216 | continue; | ||
217 | |||
218 | case 'p': | ||
219 | if (field_width == -1) { | ||
220 | field_width = 2 * sizeof(void *); | ||
221 | flags |= ZEROPAD; | ||
222 | } | ||
223 | str = number(str, | ||
224 | (unsigned long)va_arg(args, void *), 16, | ||
225 | field_width, precision, flags); | ||
226 | continue; | ||
227 | |||
228 | case 'n': | ||
229 | if (qualifier == 'l') { | ||
230 | long *ip = va_arg(args, long *); | ||
231 | *ip = (str - buf); | ||
232 | } else { | ||
233 | int *ip = va_arg(args, int *); | ||
234 | *ip = (str - buf); | ||
235 | } | ||
236 | continue; | ||
237 | |||
238 | case '%': | ||
239 | *str++ = '%'; | ||
240 | continue; | ||
241 | |||
242 | /* integer number formats - set up the flags and "break" */ | ||
243 | case 'o': | ||
244 | base = 8; | ||
245 | break; | ||
246 | |||
247 | case 'X': | ||
248 | flags |= LARGE; | ||
249 | case 'x': | ||
250 | base = 16; | ||
251 | break; | ||
252 | |||
253 | case 'd': | ||
254 | case 'i': | ||
255 | flags |= SIGN; | ||
256 | case 'u': | ||
257 | break; | ||
258 | |||
259 | default: | ||
260 | *str++ = '%'; | ||
261 | if (*fmt) | ||
262 | *str++ = *fmt; | ||
263 | else | ||
264 | --fmt; | ||
265 | continue; | ||
266 | } | ||
267 | if (qualifier == 'l') | ||
268 | num = va_arg(args, unsigned long); | ||
269 | else if (qualifier == 'h') { | ||
270 | num = (unsigned short)va_arg(args, int); | ||
271 | if (flags & SIGN) | ||
272 | num = (short)num; | ||
273 | } else if (flags & SIGN) | ||
274 | num = va_arg(args, int); | ||
275 | else | ||
276 | num = va_arg(args, unsigned int); | ||
277 | str = number(str, num, base, field_width, precision, flags); | ||
278 | } | ||
279 | *str = '\0'; | ||
280 | return str - buf; | ||
281 | } | ||
282 | |||
283 | int sprintf(char *buf, const char *fmt, ...) | ||
284 | { | ||
285 | va_list args; | ||
286 | int i; | ||
287 | |||
288 | va_start(args, fmt); | ||
289 | i = vsprintf(buf, fmt, args); | ||
290 | va_end(args); | ||
291 | return i; | ||
292 | } | ||
293 | |||
294 | int printf(const char *fmt, ...) | ||
295 | { | ||
296 | char printf_buf[1024]; | ||
297 | va_list args; | ||
298 | int printed; | ||
299 | |||
300 | va_start(args, fmt); | ||
301 | printed = vsprintf(printf_buf, fmt, args); | ||
302 | va_end(args); | ||
303 | |||
304 | puts(printf_buf); | ||
305 | |||
306 | return printed; | ||
307 | } | ||
diff --git a/arch/i386/boot/setup.S b/arch/i386/boot/setup.S deleted file mode 100644 index 6dbcc95b2120..000000000000 --- a/arch/i386/boot/setup.S +++ /dev/null | |||
@@ -1,1075 +0,0 @@ | |||
1 | /* | ||
2 | * setup.S Copyright (C) 1991, 1992 Linus Torvalds | ||
3 | * | ||
4 | * setup.s is responsible for getting the system data from the BIOS, | ||
5 | * and putting them into the appropriate places in system memory. | ||
6 | * both setup.s and system has been loaded by the bootblock. | ||
7 | * | ||
8 | * This code asks the bios for memory/disk/other parameters, and | ||
9 | * puts them in a "safe" place: 0x90000-0x901FF, ie where the | ||
10 | * boot-block used to be. It is then up to the protected mode | ||
11 | * system to read them from there before the area is overwritten | ||
12 | * for buffer-blocks. | ||
13 | * | ||
14 | * Move PS/2 aux init code to psaux.c | ||
15 | * (troyer@saifr00.cfsat.Honeywell.COM) 03Oct92 | ||
16 | * | ||
17 | * some changes and additional features by Christoph Niemann, | ||
18 | * March 1993/June 1994 (Christoph.Niemann@linux.org) | ||
19 | * | ||
20 | * add APM BIOS checking by Stephen Rothwell, May 1994 | ||
21 | * (sfr@canb.auug.org.au) | ||
22 | * | ||
23 | * High load stuff, initrd support and position independency | ||
24 | * by Hans Lermen & Werner Almesberger, February 1996 | ||
25 | * <lermen@elserv.ffm.fgan.de>, <almesber@lrc.epfl.ch> | ||
26 | * | ||
27 | * Video handling moved to video.S by Martin Mares, March 1996 | ||
28 | * <mj@k332.feld.cvut.cz> | ||
29 | * | ||
30 | * Extended memory detection scheme retwiddled by orc@pell.chi.il.us (david | ||
31 | * parsons) to avoid loadlin confusion, July 1997 | ||
32 | * | ||
33 | * Transcribed from Intel (as86) -> AT&T (gas) by Chris Noe, May 1999. | ||
34 | * <stiker@northlink.com> | ||
35 | * | ||
36 | * Fix to work around buggy BIOSes which don't use carry bit correctly | ||
37 | * and/or report extended memory in CX/DX for e801h memory size detection | ||
38 | * call. As a result the kernel got wrong figures. The int15/e801h docs | ||
39 | * from Ralf Brown interrupt list seem to indicate AX/BX should be used | ||
40 | * anyway. So to avoid breaking many machines (presumably there was a reason | ||
41 | * to orginally use CX/DX instead of AX/BX), we do a kludge to see | ||
42 | * if CX/DX have been changed in the e801 call and if so use AX/BX . | ||
43 | * Michael Miller, April 2001 <michaelm@mjmm.org> | ||
44 | * | ||
45 | * New A20 code ported from SYSLINUX by H. Peter Anvin. AMD Elan bugfixes | ||
46 | * by Robert Schwebel, December 2001 <robert@schwebel.de> | ||
47 | */ | ||
48 | |||
49 | #include <asm/segment.h> | ||
50 | #include <linux/utsrelease.h> | ||
51 | #include <linux/compile.h> | ||
52 | #include <asm/boot.h> | ||
53 | #include <asm/e820.h> | ||
54 | #include <asm/page.h> | ||
55 | #include <asm/setup.h> | ||
56 | |||
57 | /* Signature words to ensure LILO loaded us right */ | ||
58 | #define SIG1 0xAA55 | ||
59 | #define SIG2 0x5A5A | ||
60 | |||
61 | INITSEG = DEF_INITSEG # 0x9000, we move boot here, out of the way | ||
62 | SYSSEG = DEF_SYSSEG # 0x1000, system loaded at 0x10000 (65536). | ||
63 | SETUPSEG = DEF_SETUPSEG # 0x9020, this is the current segment | ||
64 | # ... and the former contents of CS | ||
65 | |||
66 | DELTA_INITSEG = SETUPSEG - INITSEG # 0x0020 | ||
67 | |||
68 | .code16 | ||
69 | .globl begtext, begdata, begbss, endtext, enddata, endbss | ||
70 | |||
71 | .text | ||
72 | begtext: | ||
73 | .data | ||
74 | begdata: | ||
75 | .bss | ||
76 | begbss: | ||
77 | .text | ||
78 | |||
79 | start: | ||
80 | jmp trampoline | ||
81 | |||
82 | # This is the setup header, and it must start at %cs:2 (old 0x9020:2) | ||
83 | |||
84 | .ascii "HdrS" # header signature | ||
85 | .word 0x0206 # header version number (>= 0x0105) | ||
86 | # or else old loadlin-1.5 will fail) | ||
87 | realmode_swtch: .word 0, 0 # default_switch, SETUPSEG | ||
88 | start_sys_seg: .word SYSSEG | ||
89 | .word kernel_version # pointing to kernel version string | ||
90 | # above section of header is compatible | ||
91 | # with loadlin-1.5 (header v1.5). Don't | ||
92 | # change it. | ||
93 | |||
94 | type_of_loader: .byte 0 # = 0, old one (LILO, Loadlin, | ||
95 | # Bootlin, SYSLX, bootsect...) | ||
96 | # See Documentation/i386/boot.txt for | ||
97 | # assigned ids | ||
98 | |||
99 | # flags, unused bits must be zero (RFU) bit within loadflags | ||
100 | loadflags: | ||
101 | LOADED_HIGH = 1 # If set, the kernel is loaded high | ||
102 | CAN_USE_HEAP = 0x80 # If set, the loader also has set | ||
103 | # heap_end_ptr to tell how much | ||
104 | # space behind setup.S can be used for | ||
105 | # heap purposes. | ||
106 | # Only the loader knows what is free | ||
107 | #ifndef __BIG_KERNEL__ | ||
108 | .byte 0 | ||
109 | #else | ||
110 | .byte LOADED_HIGH | ||
111 | #endif | ||
112 | |||
113 | setup_move_size: .word 0x8000 # size to move, when setup is not | ||
114 | # loaded at 0x90000. We will move setup | ||
115 | # to 0x90000 then just before jumping | ||
116 | # into the kernel. However, only the | ||
117 | # loader knows how much data behind | ||
118 | # us also needs to be loaded. | ||
119 | |||
120 | code32_start: # here loaders can put a different | ||
121 | # start address for 32-bit code. | ||
122 | #ifndef __BIG_KERNEL__ | ||
123 | .long 0x1000 # 0x1000 = default for zImage | ||
124 | #else | ||
125 | .long 0x100000 # 0x100000 = default for big kernel | ||
126 | #endif | ||
127 | |||
128 | ramdisk_image: .long 0 # address of loaded ramdisk image | ||
129 | # Here the loader puts the 32-bit | ||
130 | # address where it loaded the image. | ||
131 | # This only will be read by the kernel. | ||
132 | |||
133 | ramdisk_size: .long 0 # its size in bytes | ||
134 | |||
135 | bootsect_kludge: | ||
136 | .long 0 # obsolete | ||
137 | |||
138 | heap_end_ptr: .word modelist+1024 # (Header version 0x0201 or later) | ||
139 | # space from here (exclusive) down to | ||
140 | # end of setup code can be used by setup | ||
141 | # for local heap purposes. | ||
142 | |||
143 | pad1: .word 0 | ||
144 | cmd_line_ptr: .long 0 # (Header version 0x0202 or later) | ||
145 | # If nonzero, a 32-bit pointer | ||
146 | # to the kernel command line. | ||
147 | # The command line should be | ||
148 | # located between the start of | ||
149 | # setup and the end of low | ||
150 | # memory (0xa0000), or it may | ||
151 | # get overwritten before it | ||
152 | # gets read. If this field is | ||
153 | # used, there is no longer | ||
154 | # anything magical about the | ||
155 | # 0x90000 segment; the setup | ||
156 | # can be located anywhere in | ||
157 | # low memory 0x10000 or higher. | ||
158 | |||
159 | ramdisk_max: .long (-__PAGE_OFFSET-(512 << 20)-1) & 0x7fffffff | ||
160 | # (Header version 0x0203 or later) | ||
161 | # The highest safe address for | ||
162 | # the contents of an initrd | ||
163 | |||
164 | kernel_alignment: .long CONFIG_PHYSICAL_ALIGN #physical addr alignment | ||
165 | #required for protected mode | ||
166 | #kernel | ||
167 | #ifdef CONFIG_RELOCATABLE | ||
168 | relocatable_kernel: .byte 1 | ||
169 | #else | ||
170 | relocatable_kernel: .byte 0 | ||
171 | #endif | ||
172 | pad2: .byte 0 | ||
173 | pad3: .word 0 | ||
174 | |||
175 | cmdline_size: .long COMMAND_LINE_SIZE-1 #length of the command line, | ||
176 | #added with boot protocol | ||
177 | #version 2.06 | ||
178 | |||
179 | trampoline: call start_of_setup | ||
180 | .align 16 | ||
181 | # The offset at this point is 0x240 | ||
182 | .space (0xeff-0x240+1) # E820 & EDD space (ending at 0xeff) | ||
183 | # End of setup header ##################################################### | ||
184 | |||
185 | start_of_setup: | ||
186 | # Bootlin depends on this being done early | ||
187 | movw $0x01500, %ax | ||
188 | movb $0x81, %dl | ||
189 | int $0x13 | ||
190 | |||
191 | #ifdef SAFE_RESET_DISK_CONTROLLER | ||
192 | # Reset the disk controller. | ||
193 | movw $0x0000, %ax | ||
194 | movb $0x80, %dl | ||
195 | int $0x13 | ||
196 | #endif | ||
197 | |||
198 | # Set %ds = %cs, we know that SETUPSEG = %cs at this point | ||
199 | movw %cs, %ax # aka SETUPSEG | ||
200 | movw %ax, %ds | ||
201 | # Check signature at end of setup | ||
202 | cmpw $SIG1, setup_sig1 | ||
203 | jne bad_sig | ||
204 | |||
205 | cmpw $SIG2, setup_sig2 | ||
206 | jne bad_sig | ||
207 | |||
208 | jmp good_sig1 | ||
209 | |||
210 | # Routine to print asciiz string at ds:si | ||
211 | prtstr: | ||
212 | lodsb | ||
213 | andb %al, %al | ||
214 | jz fin | ||
215 | |||
216 | call prtchr | ||
217 | jmp prtstr | ||
218 | |||
219 | fin: ret | ||
220 | |||
221 | # Space printing | ||
222 | prtsp2: call prtspc # Print double space | ||
223 | prtspc: movb $0x20, %al # Print single space (note: fall-thru) | ||
224 | |||
225 | # Part of above routine, this one just prints ascii al | ||
226 | prtchr: pushw %ax | ||
227 | pushw %cx | ||
228 | movw $7,%bx | ||
229 | movw $0x01, %cx | ||
230 | movb $0x0e, %ah | ||
231 | int $0x10 | ||
232 | popw %cx | ||
233 | popw %ax | ||
234 | ret | ||
235 | |||
236 | beep: movb $0x07, %al | ||
237 | jmp prtchr | ||
238 | |||
239 | no_sig_mess: .string "No setup signature found ..." | ||
240 | |||
241 | good_sig1: | ||
242 | jmp good_sig | ||
243 | |||
244 | # We now have to find the rest of the setup code/data | ||
245 | bad_sig: | ||
246 | movw %cs, %ax # SETUPSEG | ||
247 | subw $DELTA_INITSEG, %ax # INITSEG | ||
248 | movw %ax, %ds | ||
249 | xorb %bh, %bh | ||
250 | movb (497), %bl # get setup sect from bootsect | ||
251 | subw $4, %bx # LILO loads 4 sectors of setup | ||
252 | shlw $8, %bx # convert to words (1sect=2^8 words) | ||
253 | movw %bx, %cx | ||
254 | shrw $3, %bx # convert to segment | ||
255 | addw $SYSSEG, %bx | ||
256 | movw %bx, %cs:start_sys_seg | ||
257 | # Move rest of setup code/data to here | ||
258 | movw $2048, %di # four sectors loaded by LILO | ||
259 | subw %si, %si | ||
260 | pushw %cs | ||
261 | popw %es | ||
262 | movw $SYSSEG, %ax | ||
263 | movw %ax, %ds | ||
264 | rep | ||
265 | movsw | ||
266 | movw %cs, %ax # aka SETUPSEG | ||
267 | movw %ax, %ds | ||
268 | cmpw $SIG1, setup_sig1 | ||
269 | jne no_sig | ||
270 | |||
271 | cmpw $SIG2, setup_sig2 | ||
272 | jne no_sig | ||
273 | |||
274 | jmp good_sig | ||
275 | |||
276 | no_sig: | ||
277 | lea no_sig_mess, %si | ||
278 | call prtstr | ||
279 | |||
280 | no_sig_loop: | ||
281 | hlt | ||
282 | jmp no_sig_loop | ||
283 | |||
284 | good_sig: | ||
285 | movw %cs, %ax # aka SETUPSEG | ||
286 | subw $DELTA_INITSEG, %ax # aka INITSEG | ||
287 | movw %ax, %ds | ||
288 | # Check if an old loader tries to load a big-kernel | ||
289 | testb $LOADED_HIGH, %cs:loadflags # Do we have a big kernel? | ||
290 | jz loader_ok # No, no danger for old loaders. | ||
291 | |||
292 | cmpb $0, %cs:type_of_loader # Do we have a loader that | ||
293 | # can deal with us? | ||
294 | jnz loader_ok # Yes, continue. | ||
295 | |||
296 | pushw %cs # No, we have an old loader, | ||
297 | popw %ds # die. | ||
298 | lea loader_panic_mess, %si | ||
299 | call prtstr | ||
300 | |||
301 | jmp no_sig_loop | ||
302 | |||
303 | loader_panic_mess: .string "Wrong loader, giving up..." | ||
304 | |||
305 | # check minimum cpuid | ||
306 | # we do this here because it is the last place we can actually | ||
307 | # show a user visible error message. Later the video modus | ||
308 | # might be already messed up. | ||
309 | loader_ok: | ||
310 | call verify_cpu | ||
311 | testl %eax,%eax | ||
312 | jz cpu_ok | ||
313 | movw %cs,%ax # aka SETUPSEG | ||
314 | movw %ax,%ds | ||
315 | lea cpu_panic_mess,%si | ||
316 | call prtstr | ||
317 | 1: jmp 1b | ||
318 | |||
319 | cpu_panic_mess: | ||
320 | .asciz "PANIC: CPU too old for this kernel." | ||
321 | |||
322 | #include "../kernel/verify_cpu.S" | ||
323 | |||
324 | cpu_ok: | ||
325 | # Get memory size (extended mem, kB) | ||
326 | |||
327 | xorl %eax, %eax | ||
328 | movl %eax, (0x1e0) | ||
329 | #ifndef STANDARD_MEMORY_BIOS_CALL | ||
330 | movb %al, (E820NR) | ||
331 | # Try three different memory detection schemes. First, try | ||
332 | # e820h, which lets us assemble a memory map, then try e801h, | ||
333 | # which returns a 32-bit memory size, and finally 88h, which | ||
334 | # returns 0-64m | ||
335 | |||
336 | # method E820H: | ||
337 | # the memory map from hell. e820h returns memory classified into | ||
338 | # a whole bunch of different types, and allows memory holes and | ||
339 | # everything. We scan through this memory map and build a list | ||
340 | # of the first 32 memory areas, which we return at [E820MAP]. | ||
341 | # This is documented at http://www.acpi.info/, in the ACPI 2.0 specification. | ||
342 | |||
343 | #define SMAP 0x534d4150 | ||
344 | |||
345 | meme820: | ||
346 | xorl %ebx, %ebx # continuation counter | ||
347 | movw $E820MAP, %di # point into the whitelist | ||
348 | # so we can have the bios | ||
349 | # directly write into it. | ||
350 | |||
351 | jmpe820: | ||
352 | movl $0x0000e820, %eax # e820, upper word zeroed | ||
353 | movl $SMAP, %edx # ascii 'SMAP' | ||
354 | movl $20, %ecx # size of the e820rec | ||
355 | pushw %ds # data record. | ||
356 | popw %es | ||
357 | int $0x15 # make the call | ||
358 | jc bail820 # fall to e801 if it fails | ||
359 | |||
360 | cmpl $SMAP, %eax # check the return is `SMAP' | ||
361 | jne bail820 # fall to e801 if it fails | ||
362 | |||
363 | # cmpl $1, 16(%di) # is this usable memory? | ||
364 | # jne again820 | ||
365 | |||
366 | # If this is usable memory, we save it by simply advancing %di by | ||
367 | # sizeof(e820rec). | ||
368 | # | ||
369 | good820: | ||
370 | movb (E820NR), %al # up to 128 entries | ||
371 | cmpb $E820MAX, %al | ||
372 | jae bail820 | ||
373 | |||
374 | incb (E820NR) | ||
375 | movw %di, %ax | ||
376 | addw $20, %ax | ||
377 | movw %ax, %di | ||
378 | again820: | ||
379 | cmpl $0, %ebx # check to see if | ||
380 | jne jmpe820 # %ebx is set to EOF | ||
381 | bail820: | ||
382 | |||
383 | |||
384 | # method E801H: | ||
385 | # memory size is in 1k chunksizes, to avoid confusing loadlin. | ||
386 | # we store the 0xe801 memory size in a completely different place, | ||
387 | # because it will most likely be longer than 16 bits. | ||
388 | # (use 1e0 because that's what Larry Augustine uses in his | ||
389 | # alternative new memory detection scheme, and it's sensible | ||
390 | # to write everything into the same place.) | ||
391 | |||
392 | meme801: | ||
393 | stc # fix to work around buggy | ||
394 | xorw %cx,%cx # BIOSes which don't clear/set | ||
395 | xorw %dx,%dx # carry on pass/error of | ||
396 | # e801h memory size call | ||
397 | # or merely pass cx,dx though | ||
398 | # without changing them. | ||
399 | movw $0xe801, %ax | ||
400 | int $0x15 | ||
401 | jc mem88 | ||
402 | |||
403 | cmpw $0x0, %cx # Kludge to handle BIOSes | ||
404 | jne e801usecxdx # which report their extended | ||
405 | cmpw $0x0, %dx # memory in AX/BX rather than | ||
406 | jne e801usecxdx # CX/DX. The spec I have read | ||
407 | movw %ax, %cx # seems to indicate AX/BX | ||
408 | movw %bx, %dx # are more reasonable anyway... | ||
409 | |||
410 | e801usecxdx: | ||
411 | andl $0xffff, %edx # clear sign extend | ||
412 | shll $6, %edx # and go from 64k to 1k chunks | ||
413 | movl %edx, (0x1e0) # store extended memory size | ||
414 | andl $0xffff, %ecx # clear sign extend | ||
415 | addl %ecx, (0x1e0) # and add lower memory into | ||
416 | # total size. | ||
417 | |||
418 | # Ye Olde Traditional Methode. Returns the memory size (up to 16mb or | ||
419 | # 64mb, depending on the bios) in ax. | ||
420 | mem88: | ||
421 | |||
422 | #endif | ||
423 | movb $0x88, %ah | ||
424 | int $0x15 | ||
425 | movw %ax, (2) | ||
426 | |||
427 | # Set the keyboard repeat rate to the max | ||
428 | movw $0x0305, %ax | ||
429 | xorw %bx, %bx | ||
430 | int $0x16 | ||
431 | |||
432 | # Check for video adapter and its parameters and allow the | ||
433 | # user to browse video modes. | ||
434 | call video # NOTE: we need %ds pointing | ||
435 | # to bootsector | ||
436 | |||
437 | # Get hd0 data... | ||
438 | xorw %ax, %ax | ||
439 | movw %ax, %ds | ||
440 | ldsw (4 * 0x41), %si | ||
441 | movw %cs, %ax # aka SETUPSEG | ||
442 | subw $DELTA_INITSEG, %ax # aka INITSEG | ||
443 | pushw %ax | ||
444 | movw %ax, %es | ||
445 | movw $0x0080, %di | ||
446 | movw $0x10, %cx | ||
447 | pushw %cx | ||
448 | cld | ||
449 | rep | ||
450 | movsb | ||
451 | # Get hd1 data... | ||
452 | xorw %ax, %ax | ||
453 | movw %ax, %ds | ||
454 | ldsw (4 * 0x46), %si | ||
455 | popw %cx | ||
456 | popw %es | ||
457 | movw $0x0090, %di | ||
458 | rep | ||
459 | movsb | ||
460 | # Check that there IS a hd1 :-) | ||
461 | movw $0x01500, %ax | ||
462 | movb $0x81, %dl | ||
463 | int $0x13 | ||
464 | jc no_disk1 | ||
465 | |||
466 | cmpb $3, %ah | ||
467 | je is_disk1 | ||
468 | |||
469 | no_disk1: | ||
470 | movw %cs, %ax # aka SETUPSEG | ||
471 | subw $DELTA_INITSEG, %ax # aka INITSEG | ||
472 | movw %ax, %es | ||
473 | movw $0x0090, %di | ||
474 | movw $0x10, %cx | ||
475 | xorw %ax, %ax | ||
476 | cld | ||
477 | rep | ||
478 | stosb | ||
479 | is_disk1: | ||
480 | # check for Micro Channel (MCA) bus | ||
481 | movw %cs, %ax # aka SETUPSEG | ||
482 | subw $DELTA_INITSEG, %ax # aka INITSEG | ||
483 | movw %ax, %ds | ||
484 | xorw %ax, %ax | ||
485 | movw %ax, (0xa0) # set table length to 0 | ||
486 | movb $0xc0, %ah | ||
487 | stc | ||
488 | int $0x15 # moves feature table to es:bx | ||
489 | jc no_mca | ||
490 | |||
491 | pushw %ds | ||
492 | movw %es, %ax | ||
493 | movw %ax, %ds | ||
494 | movw %cs, %ax # aka SETUPSEG | ||
495 | subw $DELTA_INITSEG, %ax # aka INITSEG | ||
496 | movw %ax, %es | ||
497 | movw %bx, %si | ||
498 | movw $0xa0, %di | ||
499 | movw (%si), %cx | ||
500 | addw $2, %cx # table length is a short | ||
501 | cmpw $0x10, %cx | ||
502 | jc sysdesc_ok | ||
503 | |||
504 | movw $0x10, %cx # we keep only first 16 bytes | ||
505 | sysdesc_ok: | ||
506 | rep | ||
507 | movsb | ||
508 | popw %ds | ||
509 | no_mca: | ||
510 | #ifdef CONFIG_X86_VOYAGER | ||
511 | movb $0xff, 0x40 # flag on config found | ||
512 | movb $0xc0, %al | ||
513 | mov $0xff, %ah | ||
514 | int $0x15 # put voyager config info at es:di | ||
515 | jc no_voyager | ||
516 | movw $0x40, %si # place voyager info in apm table | ||
517 | cld | ||
518 | movw $7, %cx | ||
519 | voyager_rep: | ||
520 | movb %es:(%di), %al | ||
521 | movb %al,(%si) | ||
522 | incw %di | ||
523 | incw %si | ||
524 | decw %cx | ||
525 | jnz voyager_rep | ||
526 | no_voyager: | ||
527 | #endif | ||
528 | # Check for PS/2 pointing device | ||
529 | movw %cs, %ax # aka SETUPSEG | ||
530 | subw $DELTA_INITSEG, %ax # aka INITSEG | ||
531 | movw %ax, %ds | ||
532 | movb $0, (0x1ff) # default is no pointing device | ||
533 | int $0x11 # int 0x11: equipment list | ||
534 | testb $0x04, %al # check if mouse installed | ||
535 | jz no_psmouse | ||
536 | |||
537 | movb $0xAA, (0x1ff) # device present | ||
538 | no_psmouse: | ||
539 | |||
540 | #if defined(CONFIG_X86_SPEEDSTEP_SMI) || defined(CONFIG_X86_SPEEDSTEP_SMI_MODULE) | ||
541 | movl $0x0000E980, %eax # IST Support | ||
542 | movl $0x47534943, %edx # Request value | ||
543 | int $0x15 | ||
544 | |||
545 | movl %eax, (96) | ||
546 | movl %ebx, (100) | ||
547 | movl %ecx, (104) | ||
548 | movl %edx, (108) | ||
549 | #endif | ||
550 | |||
551 | #if defined(CONFIG_APM) || defined(CONFIG_APM_MODULE) | ||
552 | # Then check for an APM BIOS... | ||
553 | # %ds points to the bootsector | ||
554 | movw $0, 0x40 # version = 0 means no APM BIOS | ||
555 | movw $0x05300, %ax # APM BIOS installation check | ||
556 | xorw %bx, %bx | ||
557 | int $0x15 | ||
558 | jc done_apm_bios # Nope, no APM BIOS | ||
559 | |||
560 | cmpw $0x0504d, %bx # Check for "PM" signature | ||
561 | jne done_apm_bios # No signature, no APM BIOS | ||
562 | |||
563 | andw $0x02, %cx # Is 32 bit supported? | ||
564 | je done_apm_bios # No 32-bit, no (good) APM BIOS | ||
565 | |||
566 | movw $0x05304, %ax # Disconnect first just in case | ||
567 | xorw %bx, %bx | ||
568 | int $0x15 # ignore return code | ||
569 | movw $0x05303, %ax # 32 bit connect | ||
570 | xorl %ebx, %ebx | ||
571 | xorw %cx, %cx # paranoia :-) | ||
572 | xorw %dx, %dx # ... | ||
573 | xorl %esi, %esi # ... | ||
574 | xorw %di, %di # ... | ||
575 | int $0x15 | ||
576 | jc no_32_apm_bios # Ack, error. | ||
577 | |||
578 | movw %ax, (66) # BIOS code segment | ||
579 | movl %ebx, (68) # BIOS entry point offset | ||
580 | movw %cx, (72) # BIOS 16 bit code segment | ||
581 | movw %dx, (74) # BIOS data segment | ||
582 | movl %esi, (78) # BIOS code segment lengths | ||
583 | movw %di, (82) # BIOS data segment length | ||
584 | # Redo the installation check as the 32 bit connect | ||
585 | # modifies the flags returned on some BIOSs | ||
586 | movw $0x05300, %ax # APM BIOS installation check | ||
587 | xorw %bx, %bx | ||
588 | xorw %cx, %cx # paranoia | ||
589 | int $0x15 | ||
590 | jc apm_disconnect # error -> shouldn't happen | ||
591 | |||
592 | cmpw $0x0504d, %bx # check for "PM" signature | ||
593 | jne apm_disconnect # no sig -> shouldn't happen | ||
594 | |||
595 | movw %ax, (64) # record the APM BIOS version | ||
596 | movw %cx, (76) # and flags | ||
597 | jmp done_apm_bios | ||
598 | |||
599 | apm_disconnect: # Tidy up | ||
600 | movw $0x05304, %ax # Disconnect | ||
601 | xorw %bx, %bx | ||
602 | int $0x15 # ignore return code | ||
603 | |||
604 | jmp done_apm_bios | ||
605 | |||
606 | no_32_apm_bios: | ||
607 | andw $0xfffd, (76) # remove 32 bit support bit | ||
608 | done_apm_bios: | ||
609 | #endif | ||
610 | |||
611 | #include "edd.S" | ||
612 | |||
613 | # Now we want to move to protected mode ... | ||
614 | cmpw $0, %cs:realmode_swtch | ||
615 | jz rmodeswtch_normal | ||
616 | |||
617 | lcall *%cs:realmode_swtch | ||
618 | |||
619 | jmp rmodeswtch_end | ||
620 | |||
621 | rmodeswtch_normal: | ||
622 | pushw %cs | ||
623 | call default_switch | ||
624 | |||
625 | rmodeswtch_end: | ||
626 | # Now we move the system to its rightful place ... but we check if we have a | ||
627 | # big-kernel. In that case we *must* not move it ... | ||
628 | testb $LOADED_HIGH, %cs:loadflags | ||
629 | jz do_move0 # .. then we have a normal low | ||
630 | # loaded zImage | ||
631 | # .. or else we have a high | ||
632 | # loaded bzImage | ||
633 | jmp end_move # ... and we skip moving | ||
634 | |||
635 | do_move0: | ||
636 | movw $0x100, %ax # start of destination segment | ||
637 | movw %cs, %bp # aka SETUPSEG | ||
638 | subw $DELTA_INITSEG, %bp # aka INITSEG | ||
639 | movw %cs:start_sys_seg, %bx # start of source segment | ||
640 | cld | ||
641 | do_move: | ||
642 | movw %ax, %es # destination segment | ||
643 | incb %ah # instead of add ax,#0x100 | ||
644 | movw %bx, %ds # source segment | ||
645 | addw $0x100, %bx | ||
646 | subw %di, %di | ||
647 | subw %si, %si | ||
648 | movw $0x800, %cx | ||
649 | rep | ||
650 | movsw | ||
651 | cmpw %bp, %bx # assume start_sys_seg > 0x200, | ||
652 | # so we will perhaps read one | ||
653 | # page more than needed, but | ||
654 | # never overwrite INITSEG | ||
655 | # because destination is a | ||
656 | # minimum one page below source | ||
657 | jb do_move | ||
658 | |||
659 | end_move: | ||
660 | # then we load the segment descriptors | ||
661 | movw %cs, %ax # aka SETUPSEG | ||
662 | movw %ax, %ds | ||
663 | |||
664 | # Check whether we need to be downward compatible with version <=201 | ||
665 | cmpl $0, cmd_line_ptr | ||
666 | jne end_move_self # loader uses version >=202 features | ||
667 | cmpb $0x20, type_of_loader | ||
668 | je end_move_self # bootsect loader, we know of it | ||
669 | |||
670 | # Boot loader doesnt support boot protocol version 2.02. | ||
671 | # If we have our code not at 0x90000, we need to move it there now. | ||
672 | # We also then need to move the params behind it (commandline) | ||
673 | # Because we would overwrite the code on the current IP, we move | ||
674 | # it in two steps, jumping high after the first one. | ||
675 | movw %cs, %ax | ||
676 | cmpw $SETUPSEG, %ax | ||
677 | je end_move_self | ||
678 | |||
679 | cli # make sure we really have | ||
680 | # interrupts disabled ! | ||
681 | # because after this the stack | ||
682 | # should not be used | ||
683 | subw $DELTA_INITSEG, %ax # aka INITSEG | ||
684 | movw %ss, %dx | ||
685 | cmpw %ax, %dx | ||
686 | jb move_self_1 | ||
687 | |||
688 | addw $INITSEG, %dx | ||
689 | subw %ax, %dx # this will go into %ss after | ||
690 | # the move | ||
691 | move_self_1: | ||
692 | movw %ax, %ds | ||
693 | movw $INITSEG, %ax # real INITSEG | ||
694 | movw %ax, %es | ||
695 | movw %cs:setup_move_size, %cx | ||
696 | std # we have to move up, so we use | ||
697 | # direction down because the | ||
698 | # areas may overlap | ||
699 | movw %cx, %di | ||
700 | decw %di | ||
701 | movw %di, %si | ||
702 | subw $move_self_here+0x200, %cx | ||
703 | rep | ||
704 | movsb | ||
705 | ljmp $SETUPSEG, $move_self_here | ||
706 | |||
707 | move_self_here: | ||
708 | movw $move_self_here+0x200, %cx | ||
709 | rep | ||
710 | movsb | ||
711 | movw $SETUPSEG, %ax | ||
712 | movw %ax, %ds | ||
713 | movw %dx, %ss | ||
714 | end_move_self: # now we are at the right place | ||
715 | |||
716 | # | ||
717 | # Enable A20. This is at the very best an annoying procedure. | ||
718 | # A20 code ported from SYSLINUX 1.52-1.63 by H. Peter Anvin. | ||
719 | # AMD Elan bug fix by Robert Schwebel. | ||
720 | # | ||
721 | |||
722 | #if defined(CONFIG_X86_ELAN) | ||
723 | movb $0x02, %al # alternate A20 gate | ||
724 | outb %al, $0x92 # this works on SC410/SC520 | ||
725 | a20_elan_wait: | ||
726 | call a20_test | ||
727 | jz a20_elan_wait | ||
728 | jmp a20_done | ||
729 | #endif | ||
730 | |||
731 | |||
732 | A20_TEST_LOOPS = 32 # Iterations per wait | ||
733 | A20_ENABLE_LOOPS = 255 # Total loops to try | ||
734 | |||
735 | |||
736 | #ifndef CONFIG_X86_VOYAGER | ||
737 | a20_try_loop: | ||
738 | |||
739 | # First, see if we are on a system with no A20 gate. | ||
740 | a20_none: | ||
741 | call a20_test | ||
742 | jnz a20_done | ||
743 | |||
744 | # Next, try the BIOS (INT 0x15, AX=0x2401) | ||
745 | a20_bios: | ||
746 | movw $0x2401, %ax | ||
747 | pushfl # Be paranoid about flags | ||
748 | int $0x15 | ||
749 | popfl | ||
750 | |||
751 | call a20_test | ||
752 | jnz a20_done | ||
753 | |||
754 | # Try enabling A20 through the keyboard controller | ||
755 | #endif /* CONFIG_X86_VOYAGER */ | ||
756 | a20_kbc: | ||
757 | call empty_8042 | ||
758 | |||
759 | #ifndef CONFIG_X86_VOYAGER | ||
760 | call a20_test # Just in case the BIOS worked | ||
761 | jnz a20_done # but had a delayed reaction. | ||
762 | #endif | ||
763 | |||
764 | movb $0xD1, %al # command write | ||
765 | outb %al, $0x64 | ||
766 | call empty_8042 | ||
767 | |||
768 | movb $0xDF, %al # A20 on | ||
769 | outb %al, $0x60 | ||
770 | call empty_8042 | ||
771 | |||
772 | #ifndef CONFIG_X86_VOYAGER | ||
773 | # Wait until a20 really *is* enabled; it can take a fair amount of | ||
774 | # time on certain systems; Toshiba Tecras are known to have this | ||
775 | # problem. | ||
776 | a20_kbc_wait: | ||
777 | xorw %cx, %cx | ||
778 | a20_kbc_wait_loop: | ||
779 | call a20_test | ||
780 | jnz a20_done | ||
781 | loop a20_kbc_wait_loop | ||
782 | |||
783 | # Final attempt: use "configuration port A" | ||
784 | a20_fast: | ||
785 | inb $0x92, %al # Configuration Port A | ||
786 | orb $0x02, %al # "fast A20" version | ||
787 | andb $0xFE, %al # don't accidentally reset | ||
788 | outb %al, $0x92 | ||
789 | |||
790 | # Wait for configuration port A to take effect | ||
791 | a20_fast_wait: | ||
792 | xorw %cx, %cx | ||
793 | a20_fast_wait_loop: | ||
794 | call a20_test | ||
795 | jnz a20_done | ||
796 | loop a20_fast_wait_loop | ||
797 | |||
798 | # A20 is still not responding. Try frobbing it again. | ||
799 | # | ||
800 | decb (a20_tries) | ||
801 | jnz a20_try_loop | ||
802 | |||
803 | movw $a20_err_msg, %si | ||
804 | call prtstr | ||
805 | |||
806 | a20_die: | ||
807 | hlt | ||
808 | jmp a20_die | ||
809 | |||
810 | a20_tries: | ||
811 | .byte A20_ENABLE_LOOPS | ||
812 | |||
813 | a20_err_msg: | ||
814 | .ascii "linux: fatal error: A20 gate not responding!" | ||
815 | .byte 13, 10, 0 | ||
816 | |||
817 | # If we get here, all is good | ||
818 | a20_done: | ||
819 | |||
820 | #endif /* CONFIG_X86_VOYAGER */ | ||
821 | # set up gdt and idt and 32bit start address | ||
822 | lidt idt_48 # load idt with 0,0 | ||
823 | xorl %eax, %eax # Compute gdt_base | ||
824 | movw %ds, %ax # (Convert %ds:gdt to a linear ptr) | ||
825 | shll $4, %eax | ||
826 | addl %eax, code32 | ||
827 | addl $gdt, %eax | ||
828 | movl %eax, (gdt_48+2) | ||
829 | lgdt gdt_48 # load gdt with whatever is | ||
830 | # appropriate | ||
831 | |||
832 | # make sure any possible coprocessor is properly reset.. | ||
833 | xorw %ax, %ax | ||
834 | outb %al, $0xf0 | ||
835 | call delay | ||
836 | |||
837 | outb %al, $0xf1 | ||
838 | call delay | ||
839 | |||
840 | # well, that went ok, I hope. Now we mask all interrupts - the rest | ||
841 | # is done in init_IRQ(). | ||
842 | movb $0xFF, %al # mask all interrupts for now | ||
843 | outb %al, $0xA1 | ||
844 | call delay | ||
845 | |||
846 | movb $0xFB, %al # mask all irq's but irq2 which | ||
847 | outb %al, $0x21 # is cascaded | ||
848 | |||
849 | # Well, that certainly wasn't fun :-(. Hopefully it works, and we don't | ||
850 | # need no steenking BIOS anyway (except for the initial loading :-). | ||
851 | # The BIOS-routine wants lots of unnecessary data, and it's less | ||
852 | # "interesting" anyway. This is how REAL programmers do it. | ||
853 | # | ||
854 | # Well, now's the time to actually move into protected mode. To make | ||
855 | # things as simple as possible, we do no register set-up or anything, | ||
856 | # we let the gnu-compiled 32-bit programs do that. We just jump to | ||
857 | # absolute address 0x1000 (or the loader supplied one), | ||
858 | # in 32-bit protected mode. | ||
859 | # | ||
860 | # Note that the short jump isn't strictly needed, although there are | ||
861 | # reasons why it might be a good idea. It won't hurt in any case. | ||
862 | movw $1, %ax # protected mode (PE) bit | ||
863 | lmsw %ax # This is it! | ||
864 | jmp flush_instr | ||
865 | |||
866 | flush_instr: | ||
867 | xorw %bx, %bx # Flag to indicate a boot | ||
868 | xorl %esi, %esi # Pointer to real-mode code | ||
869 | movw %cs, %si | ||
870 | subw $DELTA_INITSEG, %si | ||
871 | shll $4, %esi # Convert to 32-bit pointer | ||
872 | |||
873 | # jump to startup_32 in arch/i386/boot/compressed/head.S | ||
874 | # | ||
875 | # NOTE: For high loaded big kernels we need a | ||
876 | # jmpi 0x100000,__BOOT_CS | ||
877 | # | ||
878 | # but we yet haven't reloaded the CS register, so the default size | ||
879 | # of the target offset still is 16 bit. | ||
880 | # However, using an operand prefix (0x66), the CPU will properly | ||
881 | # take our 48 bit far pointer. (INTeL 80386 Programmer's Reference | ||
882 | # Manual, Mixing 16-bit and 32-bit code, page 16-6) | ||
883 | |||
884 | .byte 0x66, 0xea # prefix + jmpi-opcode | ||
885 | code32: .long startup_32 # will be set to %cs+startup_32 | ||
886 | .word __BOOT_CS | ||
887 | .code32 | ||
888 | startup_32: | ||
889 | movl $(__BOOT_DS), %eax | ||
890 | movl %eax, %ds | ||
891 | movl %eax, %es | ||
892 | movl %eax, %fs | ||
893 | movl %eax, %gs | ||
894 | movl %eax, %ss | ||
895 | |||
896 | xorl %eax, %eax | ||
897 | 1: incl %eax # check that A20 really IS enabled | ||
898 | movl %eax, 0x00000000 # loop forever if it isn't | ||
899 | cmpl %eax, 0x00100000 | ||
900 | je 1b | ||
901 | |||
902 | # Jump to the 32bit entry point | ||
903 | jmpl *(code32_start - start + (DELTA_INITSEG << 4))(%esi) | ||
904 | .code16 | ||
905 | |||
906 | # Here's a bunch of information about your current kernel.. | ||
907 | kernel_version: .ascii UTS_RELEASE | ||
908 | .ascii " (" | ||
909 | .ascii LINUX_COMPILE_BY | ||
910 | .ascii "@" | ||
911 | .ascii LINUX_COMPILE_HOST | ||
912 | .ascii ") " | ||
913 | .ascii UTS_VERSION | ||
914 | .byte 0 | ||
915 | |||
916 | # This is the default real mode switch routine. | ||
917 | # to be called just before protected mode transition | ||
918 | default_switch: | ||
919 | cli # no interrupts allowed ! | ||
920 | movb $0x80, %al # disable NMI for bootup | ||
921 | # sequence | ||
922 | outb %al, $0x70 | ||
923 | lret | ||
924 | |||
925 | |||
926 | #ifndef CONFIG_X86_VOYAGER | ||
927 | # This routine tests whether or not A20 is enabled. If so, it | ||
928 | # exits with zf = 0. | ||
929 | # | ||
930 | # The memory address used, 0x200, is the int $0x80 vector, which | ||
931 | # should be safe. | ||
932 | |||
933 | A20_TEST_ADDR = 4*0x80 | ||
934 | |||
935 | a20_test: | ||
936 | pushw %cx | ||
937 | pushw %ax | ||
938 | xorw %cx, %cx | ||
939 | movw %cx, %fs # Low memory | ||
940 | decw %cx | ||
941 | movw %cx, %gs # High memory area | ||
942 | movw $A20_TEST_LOOPS, %cx | ||
943 | movw %fs:(A20_TEST_ADDR), %ax | ||
944 | pushw %ax | ||
945 | a20_test_wait: | ||
946 | incw %ax | ||
947 | movw %ax, %fs:(A20_TEST_ADDR) | ||
948 | call delay # Serialize and make delay constant | ||
949 | cmpw %gs:(A20_TEST_ADDR+0x10), %ax | ||
950 | loope a20_test_wait | ||
951 | |||
952 | popw %fs:(A20_TEST_ADDR) | ||
953 | popw %ax | ||
954 | popw %cx | ||
955 | ret | ||
956 | |||
957 | #endif /* CONFIG_X86_VOYAGER */ | ||
958 | |||
959 | # This routine checks that the keyboard command queue is empty | ||
960 | # (after emptying the output buffers) | ||
961 | # | ||
962 | # Some machines have delusions that the keyboard buffer is always full | ||
963 | # with no keyboard attached... | ||
964 | # | ||
965 | # If there is no keyboard controller, we will usually get 0xff | ||
966 | # to all the reads. With each IO taking a microsecond and | ||
967 | # a timeout of 100,000 iterations, this can take about half a | ||
968 | # second ("delay" == outb to port 0x80). That should be ok, | ||
969 | # and should also be plenty of time for a real keyboard controller | ||
970 | # to empty. | ||
971 | # | ||
972 | |||
973 | empty_8042: | ||
974 | pushl %ecx | ||
975 | movl $100000, %ecx | ||
976 | |||
977 | empty_8042_loop: | ||
978 | decl %ecx | ||
979 | jz empty_8042_end_loop | ||
980 | |||
981 | call delay | ||
982 | |||
983 | inb $0x64, %al # 8042 status port | ||
984 | testb $1, %al # output buffer? | ||
985 | jz no_output | ||
986 | |||
987 | call delay | ||
988 | inb $0x60, %al # read it | ||
989 | jmp empty_8042_loop | ||
990 | |||
991 | no_output: | ||
992 | testb $2, %al # is input buffer full? | ||
993 | jnz empty_8042_loop # yes - loop | ||
994 | empty_8042_end_loop: | ||
995 | popl %ecx | ||
996 | ret | ||
997 | |||
998 | # Read the cmos clock. Return the seconds in al | ||
999 | gettime: | ||
1000 | pushw %cx | ||
1001 | movb $0x02, %ah | ||
1002 | int $0x1a | ||
1003 | movb %dh, %al # %dh contains the seconds | ||
1004 | andb $0x0f, %al | ||
1005 | movb %dh, %ah | ||
1006 | movb $0x04, %cl | ||
1007 | shrb %cl, %ah | ||
1008 | aad | ||
1009 | popw %cx | ||
1010 | ret | ||
1011 | |||
1012 | # Delay is needed after doing I/O | ||
1013 | delay: | ||
1014 | outb %al,$0x80 | ||
1015 | ret | ||
1016 | |||
1017 | # Descriptor tables | ||
1018 | # | ||
1019 | # NOTE: The intel manual says gdt should be sixteen bytes aligned for | ||
1020 | # efficiency reasons. However, there are machines which are known not | ||
1021 | # to boot with misaligned GDTs, so alter this at your peril! If you alter | ||
1022 | # GDT_ENTRY_BOOT_CS (in asm/segment.h) remember to leave at least two | ||
1023 | # empty GDT entries (one for NULL and one reserved). | ||
1024 | # | ||
1025 | # NOTE: On some CPUs, the GDT must be 8 byte aligned. This is | ||
1026 | # true for the Voyager Quad CPU card which will not boot without | ||
1027 | # This directive. 16 byte aligment is recommended by intel. | ||
1028 | # | ||
1029 | .align 16 | ||
1030 | gdt: | ||
1031 | .fill GDT_ENTRY_BOOT_CS,8,0 | ||
1032 | |||
1033 | .word 0xFFFF # 4Gb - (0x100000*0x1000 = 4Gb) | ||
1034 | .word 0 # base address = 0 | ||
1035 | .word 0x9A00 # code read/exec | ||
1036 | .word 0x00CF # granularity = 4096, 386 | ||
1037 | # (+5th nibble of limit) | ||
1038 | |||
1039 | .word 0xFFFF # 4Gb - (0x100000*0x1000 = 4Gb) | ||
1040 | .word 0 # base address = 0 | ||
1041 | .word 0x9200 # data read/write | ||
1042 | .word 0x00CF # granularity = 4096, 386 | ||
1043 | # (+5th nibble of limit) | ||
1044 | gdt_end: | ||
1045 | .align 4 | ||
1046 | |||
1047 | .word 0 # alignment byte | ||
1048 | idt_48: | ||
1049 | .word 0 # idt limit = 0 | ||
1050 | .word 0, 0 # idt base = 0L | ||
1051 | |||
1052 | .word 0 # alignment byte | ||
1053 | gdt_48: | ||
1054 | .word gdt_end - gdt - 1 # gdt limit | ||
1055 | .word 0, 0 # gdt base (filled in later) | ||
1056 | |||
1057 | # Include video setup & detection code | ||
1058 | |||
1059 | #include "video.S" | ||
1060 | |||
1061 | # Setup signature -- must be last | ||
1062 | setup_sig1: .word SIG1 | ||
1063 | setup_sig2: .word SIG2 | ||
1064 | |||
1065 | # After this point, there is some free space which is used by the video mode | ||
1066 | # handling code to store the temporary mode table (not used by the kernel). | ||
1067 | |||
1068 | modelist: | ||
1069 | |||
1070 | .text | ||
1071 | endtext: | ||
1072 | .data | ||
1073 | enddata: | ||
1074 | .bss | ||
1075 | endbss: | ||
diff --git a/arch/i386/boot/setup.ld b/arch/i386/boot/setup.ld new file mode 100644 index 000000000000..df9234b3a5e0 --- /dev/null +++ b/arch/i386/boot/setup.ld | |||
@@ -0,0 +1,54 @@ | |||
1 | /* | ||
2 | * setup.ld | ||
3 | * | ||
4 | * Linker script for the i386 setup code | ||
5 | */ | ||
6 | OUTPUT_FORMAT("elf32-i386", "elf32-i386", "elf32-i386") | ||
7 | OUTPUT_ARCH(i386) | ||
8 | ENTRY(_start) | ||
9 | |||
10 | SECTIONS | ||
11 | { | ||
12 | . = 0; | ||
13 | .bstext : { *(.bstext) } | ||
14 | .bsdata : { *(.bsdata) } | ||
15 | |||
16 | . = 497; | ||
17 | .header : { *(.header) } | ||
18 | .inittext : { *(.inittext) } | ||
19 | .initdata : { *(.initdata) } | ||
20 | .text : { *(.text*) } | ||
21 | |||
22 | . = ALIGN(16); | ||
23 | .rodata : { *(.rodata*) } | ||
24 | |||
25 | .videocards : { | ||
26 | video_cards = .; | ||
27 | *(.videocards) | ||
28 | video_cards_end = .; | ||
29 | } | ||
30 | |||
31 | . = ALIGN(16); | ||
32 | .data : { *(.data*) } | ||
33 | |||
34 | .signature : { | ||
35 | setup_sig = .; | ||
36 | LONG(0x5a5aaa55) | ||
37 | } | ||
38 | |||
39 | |||
40 | . = ALIGN(16); | ||
41 | .bss : | ||
42 | { | ||
43 | __bss_start = .; | ||
44 | *(.bss) | ||
45 | __bss_end = .; | ||
46 | } | ||
47 | . = ALIGN(16); | ||
48 | _end = .; | ||
49 | |||
50 | /DISCARD/ : { *(.note*) } | ||
51 | |||
52 | . = ASSERT(_end <= 0x8000, "Setup too big!"); | ||
53 | . = ASSERT(hdr == 0x1f1, "The setup header has the wrong offset!"); | ||
54 | } | ||
diff --git a/arch/i386/boot/string.c b/arch/i386/boot/string.c new file mode 100644 index 000000000000..481a22097781 --- /dev/null +++ b/arch/i386/boot/string.c | |||
@@ -0,0 +1,52 @@ | |||
1 | /* -*- linux-c -*- ------------------------------------------------------- * | ||
2 | * | ||
3 | * Copyright (C) 1991, 1992 Linus Torvalds | ||
4 | * Copyright 2007 rPath, Inc. - All Rights Reserved | ||
5 | * | ||
6 | * This file is part of the Linux kernel, and is made available under | ||
7 | * the terms of the GNU General Public License version 2. | ||
8 | * | ||
9 | * ----------------------------------------------------------------------- */ | ||
10 | |||
11 | /* | ||
12 | * arch/i386/boot/string.c | ||
13 | * | ||
14 | * Very basic string functions | ||
15 | */ | ||
16 | |||
17 | #include "boot.h" | ||
18 | |||
19 | int strcmp(const char *str1, const char *str2) | ||
20 | { | ||
21 | const unsigned char *s1 = (const unsigned char *)str1; | ||
22 | const unsigned char *s2 = (const unsigned char *)str2; | ||
23 | int delta = 0; | ||
24 | |||
25 | while (*s1 || *s2) { | ||
26 | delta = *s2 - *s1; | ||
27 | if (delta) | ||
28 | return delta; | ||
29 | s1++; | ||
30 | s2++; | ||
31 | } | ||
32 | return 0; | ||
33 | } | ||
34 | |||
35 | size_t strnlen(const char *s, size_t maxlen) | ||
36 | { | ||
37 | const char *es = s; | ||
38 | while (*es && maxlen) { | ||
39 | es++; | ||
40 | maxlen--; | ||
41 | } | ||
42 | |||
43 | return (es - s); | ||
44 | } | ||
45 | |||
46 | unsigned int atou(const char *s) | ||
47 | { | ||
48 | unsigned int i = 0; | ||
49 | while (isdigit(*s)) | ||
50 | i = i * 10 + (*s++ - '0'); | ||
51 | return i; | ||
52 | } | ||
diff --git a/arch/i386/boot/tools/build.c b/arch/i386/boot/tools/build.c index 05798419a6a9..886f47d8a488 100644 --- a/arch/i386/boot/tools/build.c +++ b/arch/i386/boot/tools/build.c | |||
@@ -1,13 +1,12 @@ | |||
1 | /* | 1 | /* |
2 | * Copyright (C) 1991, 1992 Linus Torvalds | 2 | * Copyright (C) 1991, 1992 Linus Torvalds |
3 | * Copyright (C) 1997 Martin Mares | 3 | * Copyright (C) 1997 Martin Mares |
4 | * Copyright (C) 2007 H. Peter Anvin | ||
4 | */ | 5 | */ |
5 | 6 | ||
6 | /* | 7 | /* |
7 | * This file builds a disk-image from three different files: | 8 | * This file builds a disk-image from three different files: |
8 | * | 9 | * |
9 | * - bootsect: compatibility mbr which prints an error message if | ||
10 | * someone tries to boot the kernel directly. | ||
11 | * - setup: 8086 machine code, sets up system parm | 10 | * - setup: 8086 machine code, sets up system parm |
12 | * - system: 80386 code for actual system | 11 | * - system: 80386 code for actual system |
13 | * | 12 | * |
@@ -21,6 +20,7 @@ | |||
21 | * High loaded stuff by Hans Lermen & Werner Almesberger, Feb. 1996 | 20 | * High loaded stuff by Hans Lermen & Werner Almesberger, Feb. 1996 |
22 | * Cross compiling fixes by Gertjan van Wingerde, July 1996 | 21 | * Cross compiling fixes by Gertjan van Wingerde, July 1996 |
23 | * Rewritten by Martin Mares, April 1997 | 22 | * Rewritten by Martin Mares, April 1997 |
23 | * Substantially overhauled by H. Peter Anvin, April 2007 | ||
24 | */ | 24 | */ |
25 | 25 | ||
26 | #include <stdio.h> | 26 | #include <stdio.h> |
@@ -32,23 +32,25 @@ | |||
32 | #include <sys/sysmacros.h> | 32 | #include <sys/sysmacros.h> |
33 | #include <unistd.h> | 33 | #include <unistd.h> |
34 | #include <fcntl.h> | 34 | #include <fcntl.h> |
35 | #include <sys/mman.h> | ||
35 | #include <asm/boot.h> | 36 | #include <asm/boot.h> |
36 | 37 | ||
37 | typedef unsigned char byte; | 38 | typedef unsigned char u8; |
38 | typedef unsigned short word; | 39 | typedef unsigned short u16; |
39 | typedef unsigned long u32; | 40 | typedef unsigned long u32; |
40 | 41 | ||
41 | #define DEFAULT_MAJOR_ROOT 0 | 42 | #define DEFAULT_MAJOR_ROOT 0 |
42 | #define DEFAULT_MINOR_ROOT 0 | 43 | #define DEFAULT_MINOR_ROOT 0 |
43 | 44 | ||
44 | /* Minimal number of setup sectors (see also bootsect.S) */ | 45 | /* Minimal number of setup sectors */ |
45 | #define SETUP_SECTS 4 | 46 | #define SETUP_SECT_MIN 5 |
47 | #define SETUP_SECT_MAX 64 | ||
46 | 48 | ||
47 | byte buf[1024]; | 49 | /* This must be large enough to hold the entire setup */ |
48 | int fd; | 50 | u8 buf[SETUP_SECT_MAX*512]; |
49 | int is_big_kernel; | 51 | int is_big_kernel; |
50 | 52 | ||
51 | void die(const char * str, ...) | 53 | static void die(const char * str, ...) |
52 | { | 54 | { |
53 | va_list args; | 55 | va_list args; |
54 | va_start(args, str); | 56 | va_start(args, str); |
@@ -57,15 +59,9 @@ void die(const char * str, ...) | |||
57 | exit(1); | 59 | exit(1); |
58 | } | 60 | } |
59 | 61 | ||
60 | void file_open(const char *name) | 62 | static void usage(void) |
61 | { | 63 | { |
62 | if ((fd = open(name, O_RDONLY, 0)) < 0) | 64 | die("Usage: build [-b] setup system [rootdev] [> image]"); |
63 | die("Unable to open `%s': %m", name); | ||
64 | } | ||
65 | |||
66 | void usage(void) | ||
67 | { | ||
68 | die("Usage: build [-b] bootsect setup system [rootdev] [> image]"); | ||
69 | } | 65 | } |
70 | 66 | ||
71 | int main(int argc, char ** argv) | 67 | int main(int argc, char ** argv) |
@@ -73,27 +69,30 @@ int main(int argc, char ** argv) | |||
73 | unsigned int i, sz, setup_sectors; | 69 | unsigned int i, sz, setup_sectors; |
74 | int c; | 70 | int c; |
75 | u32 sys_size; | 71 | u32 sys_size; |
76 | byte major_root, minor_root; | 72 | u8 major_root, minor_root; |
77 | struct stat sb; | 73 | struct stat sb; |
74 | FILE *file; | ||
75 | int fd; | ||
76 | void *kernel; | ||
78 | 77 | ||
79 | if (argc > 2 && !strcmp(argv[1], "-b")) | 78 | if (argc > 2 && !strcmp(argv[1], "-b")) |
80 | { | 79 | { |
81 | is_big_kernel = 1; | 80 | is_big_kernel = 1; |
82 | argc--, argv++; | 81 | argc--, argv++; |
83 | } | 82 | } |
84 | if ((argc < 4) || (argc > 5)) | 83 | if ((argc < 3) || (argc > 4)) |
85 | usage(); | 84 | usage(); |
86 | if (argc > 4) { | 85 | if (argc > 3) { |
87 | if (!strcmp(argv[4], "CURRENT")) { | 86 | if (!strcmp(argv[3], "CURRENT")) { |
88 | if (stat("/", &sb)) { | 87 | if (stat("/", &sb)) { |
89 | perror("/"); | 88 | perror("/"); |
90 | die("Couldn't stat /"); | 89 | die("Couldn't stat /"); |
91 | } | 90 | } |
92 | major_root = major(sb.st_dev); | 91 | major_root = major(sb.st_dev); |
93 | minor_root = minor(sb.st_dev); | 92 | minor_root = minor(sb.st_dev); |
94 | } else if (strcmp(argv[4], "FLOPPY")) { | 93 | } else if (strcmp(argv[3], "FLOPPY")) { |
95 | if (stat(argv[4], &sb)) { | 94 | if (stat(argv[3], &sb)) { |
96 | perror(argv[4]); | 95 | perror(argv[3]); |
97 | die("Couldn't stat root device."); | 96 | die("Couldn't stat root device."); |
98 | } | 97 | } |
99 | major_root = major(sb.st_rdev); | 98 | major_root = major(sb.st_rdev); |
@@ -108,79 +107,62 @@ int main(int argc, char ** argv) | |||
108 | } | 107 | } |
109 | fprintf(stderr, "Root device is (%d, %d)\n", major_root, minor_root); | 108 | fprintf(stderr, "Root device is (%d, %d)\n", major_root, minor_root); |
110 | 109 | ||
111 | file_open(argv[1]); | 110 | /* Copy the setup code */ |
112 | i = read(fd, buf, sizeof(buf)); | 111 | file = fopen(argv[1], "r"); |
113 | fprintf(stderr,"Boot sector %d bytes.\n",i); | 112 | if (!file) |
114 | if (i != 512) | 113 | die("Unable to open `%s': %m", argv[1]); |
115 | die("Boot block must be exactly 512 bytes"); | 114 | c = fread(buf, 1, sizeof(buf), file); |
115 | if (ferror(file)) | ||
116 | die("read-error on `setup'"); | ||
117 | if (c < 1024) | ||
118 | die("The setup must be at least 1024 bytes"); | ||
116 | if (buf[510] != 0x55 || buf[511] != 0xaa) | 119 | if (buf[510] != 0x55 || buf[511] != 0xaa) |
117 | die("Boot block hasn't got boot flag (0xAA55)"); | 120 | die("Boot block hasn't got boot flag (0xAA55)"); |
121 | fclose(file); | ||
122 | |||
123 | /* Pad unused space with zeros */ | ||
124 | setup_sectors = (c + 511) / 512; | ||
125 | if (setup_sectors < SETUP_SECT_MIN) | ||
126 | setup_sectors = SETUP_SECT_MIN; | ||
127 | i = setup_sectors*512; | ||
128 | memset(buf+c, 0, i-c); | ||
129 | |||
130 | /* Set the default root device */ | ||
118 | buf[508] = minor_root; | 131 | buf[508] = minor_root; |
119 | buf[509] = major_root; | 132 | buf[509] = major_root; |
120 | if (write(1, buf, 512) != 512) | ||
121 | die("Write call failed"); | ||
122 | close (fd); | ||
123 | |||
124 | file_open(argv[2]); /* Copy the setup code */ | ||
125 | for (i=0 ; (c=read(fd, buf, sizeof(buf)))>0 ; i+=c ) | ||
126 | if (write(1, buf, c) != c) | ||
127 | die("Write call failed"); | ||
128 | if (c != 0) | ||
129 | die("read-error on `setup'"); | ||
130 | close (fd); | ||
131 | |||
132 | setup_sectors = (i + 511) / 512; /* Pad unused space with zeros */ | ||
133 | /* for compatibility with ancient versions of LILO. */ | ||
134 | if (setup_sectors < SETUP_SECTS) | ||
135 | setup_sectors = SETUP_SECTS; | ||
136 | fprintf(stderr, "Setup is %d bytes.\n", i); | ||
137 | memset(buf, 0, sizeof(buf)); | ||
138 | while (i < setup_sectors * 512) { | ||
139 | c = setup_sectors * 512 - i; | ||
140 | if (c > sizeof(buf)) | ||
141 | c = sizeof(buf); | ||
142 | if (write(1, buf, c) != c) | ||
143 | die("Write call failed"); | ||
144 | i += c; | ||
145 | } | ||
146 | 133 | ||
147 | file_open(argv[3]); | 134 | fprintf(stderr, "Setup is %d bytes (padded to %d bytes).\n", c, i); |
148 | if (fstat (fd, &sb)) | 135 | |
149 | die("Unable to stat `%s': %m", argv[3]); | 136 | /* Open and stat the kernel file */ |
137 | fd = open(argv[2], O_RDONLY); | ||
138 | if (fd < 0) | ||
139 | die("Unable to open `%s': %m", argv[2]); | ||
140 | if (fstat(fd, &sb)) | ||
141 | die("Unable to stat `%s': %m", argv[2]); | ||
150 | sz = sb.st_size; | 142 | sz = sb.st_size; |
151 | fprintf (stderr, "System is %d kB\n", sz/1024); | 143 | fprintf (stderr, "System is %d kB\n", (sz+1023)/1024); |
144 | kernel = mmap(NULL, sz, PROT_READ, MAP_SHARED, fd, 0); | ||
145 | if (kernel == MAP_FAILED) | ||
146 | die("Unable to mmap '%s': %m", argv[2]); | ||
152 | sys_size = (sz + 15) / 16; | 147 | sys_size = (sz + 15) / 16; |
153 | if (!is_big_kernel && sys_size > DEF_SYSSIZE) | 148 | if (!is_big_kernel && sys_size > DEF_SYSSIZE) |
154 | die("System is too big. Try using bzImage or modules."); | 149 | die("System is too big. Try using bzImage or modules."); |
155 | while (sz > 0) { | 150 | |
156 | int l, n; | 151 | /* Patch the setup code with the appropriate size parameters */ |
157 | 152 | buf[0x1f1] = setup_sectors-1; | |
158 | l = (sz > sizeof(buf)) ? sizeof(buf) : sz; | 153 | buf[0x1f4] = sys_size; |
159 | if ((n=read(fd, buf, l)) != l) { | 154 | buf[0x1f5] = sys_size >> 8; |
160 | if (n < 0) | 155 | buf[0x1f6] = sys_size >> 16; |
161 | die("Error reading %s: %m", argv[3]); | 156 | buf[0x1f7] = sys_size >> 24; |
162 | else | 157 | |
163 | die("%s: Unexpected EOF", argv[3]); | 158 | if (fwrite(buf, 1, i, stdout) != i) |
164 | } | 159 | die("Writing setup failed"); |
165 | if (write(1, buf, l) != l) | 160 | |
166 | die("Write failed"); | 161 | /* Copy the kernel code */ |
167 | sz -= l; | 162 | if (fwrite(kernel, 1, sz, stdout) != sz) |
168 | } | 163 | die("Writing kernel failed"); |
169 | close(fd); | 164 | close(fd); |
170 | 165 | ||
171 | if (lseek(1, 497, SEEK_SET) != 497) /* Write sizes to the bootsector */ | 166 | /* Everything is OK */ |
172 | die("Output: seek failed"); | 167 | return 0; |
173 | buf[0] = setup_sectors; | ||
174 | if (write(1, buf, 1) != 1) | ||
175 | die("Write of setup sector count failed"); | ||
176 | if (lseek(1, 500, SEEK_SET) != 500) | ||
177 | die("Output: seek failed"); | ||
178 | buf[0] = (sys_size & 0xff); | ||
179 | buf[1] = ((sys_size >> 8) & 0xff); | ||
180 | buf[2] = ((sys_size >> 16) & 0xff); | ||
181 | buf[3] = ((sys_size >> 24) & 0xff); | ||
182 | if (write(1, buf, 4) != 4) | ||
183 | die("Write of image length failed"); | ||
184 | |||
185 | return 0; /* Everything is OK */ | ||
186 | } | 168 | } |
diff --git a/arch/i386/boot/tty.c b/arch/i386/boot/tty.c new file mode 100644 index 000000000000..a8db78736b02 --- /dev/null +++ b/arch/i386/boot/tty.c | |||
@@ -0,0 +1,112 @@ | |||
1 | /* -*- linux-c -*- ------------------------------------------------------- * | ||
2 | * | ||
3 | * Copyright (C) 1991, 1992 Linus Torvalds | ||
4 | * Copyright 2007 rPath, Inc. - All Rights Reserved | ||
5 | * | ||
6 | * This file is part of the Linux kernel, and is made available under | ||
7 | * the terms of the GNU General Public License version 2. | ||
8 | * | ||
9 | * ----------------------------------------------------------------------- */ | ||
10 | |||
11 | /* | ||
12 | * arch/i386/boot/tty.c | ||
13 | * | ||
14 | * Very simple screen I/O | ||
15 | * XXX: Probably should add very simple serial I/O? | ||
16 | */ | ||
17 | |||
18 | #include "boot.h" | ||
19 | |||
20 | /* | ||
21 | * These functions are in .inittext so they can be used to signal | ||
22 | * error during initialization. | ||
23 | */ | ||
24 | |||
25 | void __attribute__((section(".inittext"))) putchar(int ch) | ||
26 | { | ||
27 | unsigned char c = ch; | ||
28 | |||
29 | if (c == '\n') | ||
30 | putchar('\r'); /* \n -> \r\n */ | ||
31 | |||
32 | /* int $0x10 is known to have bugs involving touching registers | ||
33 | it shouldn't. Be extra conservative... */ | ||
34 | asm volatile("pushal; int $0x10; popal" | ||
35 | : : "b" (0x0007), "c" (0x0001), "a" (0x0e00|ch)); | ||
36 | } | ||
37 | |||
38 | void __attribute__((section(".inittext"))) puts(const char *str) | ||
39 | { | ||
40 | int n = 0; | ||
41 | while (*str) { | ||
42 | putchar(*str++); | ||
43 | n++; | ||
44 | } | ||
45 | } | ||
46 | |||
47 | /* | ||
48 | * Read the CMOS clock through the BIOS, and return the | ||
49 | * seconds in BCD. | ||
50 | */ | ||
51 | |||
52 | static u8 gettime(void) | ||
53 | { | ||
54 | u16 ax = 0x0200; | ||
55 | u16 cx, dx; | ||
56 | |||
57 | asm("int $0x1a" | ||
58 | : "+a" (ax), "=c" (cx), "=d" (dx) | ||
59 | : : "ebx", "esi", "edi"); | ||
60 | |||
61 | return dx >> 8; | ||
62 | } | ||
63 | |||
64 | /* | ||
65 | * Read from the keyboard | ||
66 | */ | ||
67 | int getchar(void) | ||
68 | { | ||
69 | u16 ax = 0; | ||
70 | asm("int $0x16" : "+a" (ax)); | ||
71 | |||
72 | return ax & 0xff; | ||
73 | } | ||
74 | |||
75 | static int kbd_pending(void) | ||
76 | { | ||
77 | u8 pending; | ||
78 | asm("int $0x16; setnz %0" | ||
79 | : "=rm" (pending) | ||
80 | : "a" (0x0100)); | ||
81 | return pending; | ||
82 | } | ||
83 | |||
84 | void kbd_flush(void) | ||
85 | { | ||
86 | for (;;) { | ||
87 | if (!kbd_pending()) | ||
88 | break; | ||
89 | getchar(); | ||
90 | } | ||
91 | } | ||
92 | |||
93 | int getchar_timeout(void) | ||
94 | { | ||
95 | int cnt = 30; | ||
96 | int t0, t1; | ||
97 | |||
98 | t0 = gettime(); | ||
99 | |||
100 | while (cnt) { | ||
101 | if (kbd_pending()) | ||
102 | return getchar(); | ||
103 | |||
104 | t1 = gettime(); | ||
105 | if (t0 != t1) { | ||
106 | cnt--; | ||
107 | t0 = t1; | ||
108 | } | ||
109 | } | ||
110 | |||
111 | return 0; /* Timeout! */ | ||
112 | } | ||
diff --git a/arch/i386/boot/version.c b/arch/i386/boot/version.c new file mode 100644 index 000000000000..c61462f7d9a7 --- /dev/null +++ b/arch/i386/boot/version.c | |||
@@ -0,0 +1,23 @@ | |||
1 | /* -*- linux-c -*- ------------------------------------------------------- * | ||
2 | * | ||
3 | * Copyright (C) 1991, 1992 Linus Torvalds | ||
4 | * Copyright 2007 rPath, Inc. - All Rights Reserved | ||
5 | * | ||
6 | * This file is part of the Linux kernel, and is made available under | ||
7 | * the terms of the GNU General Public License version 2. | ||
8 | * | ||
9 | * ----------------------------------------------------------------------- */ | ||
10 | |||
11 | /* | ||
12 | * arch/i386/boot/version.c | ||
13 | * | ||
14 | * Kernel version string | ||
15 | */ | ||
16 | |||
17 | #include "boot.h" | ||
18 | #include <linux/utsrelease.h> | ||
19 | #include <linux/compile.h> | ||
20 | |||
21 | const char kernel_version[] = | ||
22 | UTS_RELEASE " (" LINUX_COMPILE_BY "@" LINUX_COMPILE_HOST ") " | ||
23 | UTS_VERSION; | ||
diff --git a/arch/i386/boot/vesa.h b/arch/i386/boot/vesa.h new file mode 100644 index 000000000000..ff5b73cd406f --- /dev/null +++ b/arch/i386/boot/vesa.h | |||
@@ -0,0 +1,79 @@ | |||
1 | /* ----------------------------------------------------------------------- * | ||
2 | * | ||
3 | * Copyright 1999-2007 H. Peter Anvin - All Rights Reserved | ||
4 | * | ||
5 | * This program is free software; you can redistribute it and/or modify | ||
6 | * it under the terms of the GNU General Public License as published by | ||
7 | * the Free Software Foundation, Inc., 53 Temple Place Ste 330, | ||
8 | * Boston MA 02111-1307, USA; either version 2 of the License, or | ||
9 | * (at your option) any later version; incorporated herein by reference. | ||
10 | * | ||
11 | * ----------------------------------------------------------------------- */ | ||
12 | |||
13 | #ifndef BOOT_VESA_H | ||
14 | #define BOOT_VESA_H | ||
15 | |||
16 | typedef struct { | ||
17 | u16 off, seg; | ||
18 | } far_ptr; | ||
19 | |||
20 | /* VESA General Information table */ | ||
21 | struct vesa_general_info { | ||
22 | u32 signature; /* 0 Magic number = "VESA" */ | ||
23 | u16 version; /* 4 */ | ||
24 | far_ptr vendor_string; /* 6 */ | ||
25 | u32 capabilities; /* 10 */ | ||
26 | far_ptr video_mode_ptr; /* 14 */ | ||
27 | u16 total_memory; /* 18 */ | ||
28 | |||
29 | u16 oem_software_rev; /* 20 */ | ||
30 | far_ptr oem_vendor_name_ptr; /* 22 */ | ||
31 | far_ptr oem_product_name_ptr; /* 26 */ | ||
32 | far_ptr oem_product_rev_ptr; /* 30 */ | ||
33 | |||
34 | u8 reserved[222]; /* 34 */ | ||
35 | u8 oem_data[256]; /* 256 */ | ||
36 | } __attribute__ ((packed)); | ||
37 | |||
38 | #define VESA_MAGIC ('V' + ('E' << 8) + ('S' << 16) + ('A' << 24)) | ||
39 | #define VBE2_MAGIC ('V' + ('B' << 8) + ('E' << 16) + ('2' << 24)) | ||
40 | |||
41 | struct vesa_mode_info { | ||
42 | u16 mode_attr; /* 0 */ | ||
43 | u8 win_attr[2]; /* 2 */ | ||
44 | u16 win_grain; /* 4 */ | ||
45 | u16 win_size; /* 6 */ | ||
46 | u16 win_seg[2]; /* 8 */ | ||
47 | far_ptr win_scheme; /* 12 */ | ||
48 | u16 logical_scan; /* 16 */ | ||
49 | |||
50 | u16 h_res; /* 18 */ | ||
51 | u16 v_res; /* 20 */ | ||
52 | u8 char_width; /* 22 */ | ||
53 | u8 char_height; /* 23 */ | ||
54 | u8 memory_planes; /* 24 */ | ||
55 | u8 bpp; /* 25 */ | ||
56 | u8 banks; /* 26 */ | ||
57 | u8 memory_layout; /* 27 */ | ||
58 | u8 bank_size; /* 28 */ | ||
59 | u8 image_planes; /* 29 */ | ||
60 | u8 page_function; /* 30 */ | ||
61 | |||
62 | u8 rmask; /* 31 */ | ||
63 | u8 rpos; /* 32 */ | ||
64 | u8 gmask; /* 33 */ | ||
65 | u8 gpos; /* 34 */ | ||
66 | u8 bmask; /* 35 */ | ||
67 | u8 bpos; /* 36 */ | ||
68 | u8 resv_mask; /* 37 */ | ||
69 | u8 resv_pos; /* 38 */ | ||
70 | u8 dcm_info; /* 39 */ | ||
71 | |||
72 | u32 lfb_ptr; /* 40 Linear frame buffer address */ | ||
73 | u32 offscreen_ptr; /* 44 Offscreen memory address */ | ||
74 | u16 offscreen_size; /* 48 */ | ||
75 | |||
76 | u8 reserved[206]; /* 50 */ | ||
77 | } __attribute__ ((packed)); | ||
78 | |||
79 | #endif /* LIB_SYS_VESA_H */ | ||
diff --git a/arch/i386/boot/video-bios.c b/arch/i386/boot/video-bios.c new file mode 100644 index 000000000000..afea46c500cc --- /dev/null +++ b/arch/i386/boot/video-bios.c | |||
@@ -0,0 +1,125 @@ | |||
1 | /* -*- linux-c -*- ------------------------------------------------------- * | ||
2 | * | ||
3 | * Copyright (C) 1991, 1992 Linus Torvalds | ||
4 | * Copyright 2007 rPath, Inc. - All Rights Reserved | ||
5 | * | ||
6 | * This file is part of the Linux kernel, and is made available under | ||
7 | * the terms of the GNU General Public License version 2. | ||
8 | * | ||
9 | * ----------------------------------------------------------------------- */ | ||
10 | |||
11 | /* | ||
12 | * arch/i386/boot/video-bios.c | ||
13 | * | ||
14 | * Standard video BIOS modes | ||
15 | * | ||
16 | * We have two options for this; silent and scanned. | ||
17 | */ | ||
18 | |||
19 | #include "boot.h" | ||
20 | #include "video.h" | ||
21 | |||
22 | __videocard video_bios; | ||
23 | |||
24 | /* Set a conventional BIOS mode */ | ||
25 | static int set_bios_mode(u8 mode); | ||
26 | |||
27 | static int bios_set_mode(struct mode_info *mi) | ||
28 | { | ||
29 | return set_bios_mode(mi->mode - VIDEO_FIRST_BIOS); | ||
30 | } | ||
31 | |||
32 | static int set_bios_mode(u8 mode) | ||
33 | { | ||
34 | u16 ax; | ||
35 | u8 new_mode; | ||
36 | |||
37 | ax = mode; /* AH=0x00 Set Video Mode */ | ||
38 | asm volatile(INT10 | ||
39 | : "+a" (ax) | ||
40 | : : "ebx", "ecx", "edx", "esi", "edi"); | ||
41 | |||
42 | ax = 0x0f00; /* Get Current Video Mode */ | ||
43 | asm volatile(INT10 | ||
44 | : "+a" (ax) | ||
45 | : : "ebx", "ecx", "edx", "esi", "edi"); | ||
46 | |||
47 | do_restore = 1; /* Assume video contents was lost */ | ||
48 | new_mode = ax & 0x7f; /* Not all BIOSes are clean with the top bit */ | ||
49 | |||
50 | if (new_mode == mode) | ||
51 | return 0; /* Mode change OK */ | ||
52 | |||
53 | if (new_mode != boot_params.screen_info.orig_video_mode) { | ||
54 | /* Mode setting failed, but we didn't end up where we | ||
55 | started. That's bad. Try to revert to the original | ||
56 | video mode. */ | ||
57 | ax = boot_params.screen_info.orig_video_mode; | ||
58 | asm volatile(INT10 | ||
59 | : "+a" (ax) | ||
60 | : : "ebx", "ecx", "edx", "esi", "edi"); | ||
61 | } | ||
62 | return -1; | ||
63 | } | ||
64 | |||
65 | static int bios_probe(void) | ||
66 | { | ||
67 | u8 mode; | ||
68 | u8 saved_mode = boot_params.screen_info.orig_video_mode; | ||
69 | u16 crtc; | ||
70 | struct mode_info *mi; | ||
71 | int nmodes = 0; | ||
72 | |||
73 | if (adapter != ADAPTER_EGA && adapter != ADAPTER_VGA) | ||
74 | return 0; | ||
75 | |||
76 | set_fs(0); | ||
77 | crtc = vga_crtc(); | ||
78 | |||
79 | video_bios.modes = GET_HEAP(struct mode_info, 0); | ||
80 | |||
81 | for (mode = 0x14; mode <= 0x7f; mode++) { | ||
82 | if (heap_free() < sizeof(struct mode_info)) | ||
83 | break; | ||
84 | |||
85 | if (mode_defined(VIDEO_FIRST_BIOS+mode)) | ||
86 | continue; | ||
87 | |||
88 | if (set_bios_mode(mode)) | ||
89 | continue; | ||
90 | |||
91 | /* Try to verify that it's a text mode. */ | ||
92 | |||
93 | /* Attribute Controller: make graphics controller disabled */ | ||
94 | if (in_idx(0x3c0, 0x10) & 0x01) | ||
95 | continue; | ||
96 | |||
97 | /* Graphics Controller: verify Alpha addressing enabled */ | ||
98 | if (in_idx(0x3ce, 0x06) & 0x01) | ||
99 | continue; | ||
100 | |||
101 | /* CRTC cursor location low should be zero(?) */ | ||
102 | if (in_idx(crtc, 0x0f)) | ||
103 | continue; | ||
104 | |||
105 | mi = GET_HEAP(struct mode_info, 1); | ||
106 | mi->mode = VIDEO_FIRST_BIOS+mode; | ||
107 | mi->x = rdfs16(0x44a); | ||
108 | mi->y = rdfs8(0x484)+1; | ||
109 | nmodes++; | ||
110 | } | ||
111 | |||
112 | set_bios_mode(saved_mode); | ||
113 | |||
114 | return nmodes; | ||
115 | } | ||
116 | |||
117 | __videocard video_bios = | ||
118 | { | ||
119 | .card_name = "BIOS (scanned)", | ||
120 | .probe = bios_probe, | ||
121 | .set_mode = bios_set_mode, | ||
122 | .unsafe = 1, | ||
123 | .xmode_first = VIDEO_FIRST_BIOS, | ||
124 | .xmode_n = 0x80, | ||
125 | }; | ||
diff --git a/arch/i386/boot/video-vesa.c b/arch/i386/boot/video-vesa.c new file mode 100644 index 000000000000..e6aa9eb8d93a --- /dev/null +++ b/arch/i386/boot/video-vesa.c | |||
@@ -0,0 +1,284 @@ | |||
1 | /* -*- linux-c -*- ------------------------------------------------------- * | ||
2 | * | ||
3 | * Copyright (C) 1991, 1992 Linus Torvalds | ||
4 | * Copyright 2007 rPath, Inc. - All Rights Reserved | ||
5 | * | ||
6 | * This file is part of the Linux kernel, and is made available under | ||
7 | * the terms of the GNU General Public License version 2. | ||
8 | * | ||
9 | * ----------------------------------------------------------------------- */ | ||
10 | |||
11 | /* | ||
12 | * arch/i386/boot/video-vesa.c | ||
13 | * | ||
14 | * VESA text modes | ||
15 | */ | ||
16 | |||
17 | #include "boot.h" | ||
18 | #include "video.h" | ||
19 | #include "vesa.h" | ||
20 | |||
21 | /* VESA information */ | ||
22 | static struct vesa_general_info vginfo; | ||
23 | static struct vesa_mode_info vminfo; | ||
24 | |||
25 | __videocard video_vesa; | ||
26 | |||
27 | static void vesa_store_mode_params_graphics(void); | ||
28 | |||
29 | static int vesa_probe(void) | ||
30 | { | ||
31 | #if defined(CONFIG_VIDEO_VESA) || defined(CONFIG_FIRMWARE_EDID) | ||
32 | u16 ax; | ||
33 | u16 mode; | ||
34 | addr_t mode_ptr; | ||
35 | struct mode_info *mi; | ||
36 | int nmodes = 0; | ||
37 | |||
38 | video_vesa.modes = GET_HEAP(struct mode_info, 0); | ||
39 | |||
40 | vginfo.signature = VBE2_MAGIC; | ||
41 | |||
42 | /* Optimistically assume a VESA BIOS is register-clean... */ | ||
43 | ax = 0x4f00; | ||
44 | asm("int $0x10" : "+a" (ax), "=m" (vginfo) : "D" (&vginfo)); | ||
45 | |||
46 | if (ax != 0x004f || | ||
47 | vginfo.signature != VESA_MAGIC || | ||
48 | vginfo.version < 0x0102) | ||
49 | return 0; /* Not present */ | ||
50 | #endif /* CONFIG_VIDEO_VESA || CONFIG_FIRMWARE_EDID */ | ||
51 | #ifdef CONFIG_VIDEO_VESA | ||
52 | set_fs(vginfo.video_mode_ptr.seg); | ||
53 | mode_ptr = vginfo.video_mode_ptr.off; | ||
54 | |||
55 | while ((mode = rdfs16(mode_ptr)) != 0xffff) { | ||
56 | mode_ptr += 2; | ||
57 | |||
58 | if (heap_free() < sizeof(struct mode_info)) | ||
59 | break; /* Heap full, can't save mode info */ | ||
60 | |||
61 | if (mode & ~0x1ff) | ||
62 | continue; | ||
63 | |||
64 | memset(&vminfo, 0, sizeof vminfo); /* Just in case... */ | ||
65 | |||
66 | ax = 0x4f01; | ||
67 | asm("int $0x10" | ||
68 | : "+a" (ax), "=m" (vminfo) | ||
69 | : "c" (mode), "D" (&vminfo)); | ||
70 | |||
71 | if (ax != 0x004f) | ||
72 | continue; | ||
73 | |||
74 | if ((vminfo.mode_attr & 0x15) == 0x05) { | ||
75 | /* Text Mode, TTY BIOS supported, | ||
76 | supported by hardware */ | ||
77 | mi = GET_HEAP(struct mode_info, 1); | ||
78 | mi->mode = mode + VIDEO_FIRST_VESA; | ||
79 | mi->x = vminfo.h_res; | ||
80 | mi->y = vminfo.v_res; | ||
81 | nmodes++; | ||
82 | } else if ((vminfo.mode_attr & 0x99) == 0x99) { | ||
83 | #ifdef CONFIG_FB | ||
84 | /* Graphics mode, color, linear frame buffer | ||
85 | supported -- register the mode but hide from | ||
86 | the menu. Only do this if framebuffer is | ||
87 | configured, however, otherwise the user will | ||
88 | be left without a screen. */ | ||
89 | mi = GET_HEAP(struct mode_info, 1); | ||
90 | mi->mode = mode + VIDEO_FIRST_VESA; | ||
91 | mi->x = mi->y = 0; | ||
92 | nmodes++; | ||
93 | #endif | ||
94 | } | ||
95 | } | ||
96 | |||
97 | return nmodes; | ||
98 | #else | ||
99 | return 0; | ||
100 | #endif /* CONFIG_VIDEO_VESA */ | ||
101 | } | ||
102 | |||
103 | static int vesa_set_mode(struct mode_info *mode) | ||
104 | { | ||
105 | u16 ax; | ||
106 | int is_graphic; | ||
107 | u16 vesa_mode = mode->mode - VIDEO_FIRST_VESA; | ||
108 | |||
109 | memset(&vminfo, 0, sizeof vminfo); /* Just in case... */ | ||
110 | |||
111 | ax = 0x4f01; | ||
112 | asm("int $0x10" | ||
113 | : "+a" (ax), "=m" (vminfo) | ||
114 | : "c" (vesa_mode), "D" (&vminfo)); | ||
115 | |||
116 | if (ax != 0x004f) | ||
117 | return -1; | ||
118 | |||
119 | if ((vminfo.mode_attr & 0x15) == 0x05) { | ||
120 | /* It's a supported text mode */ | ||
121 | is_graphic = 0; | ||
122 | } else if ((vminfo.mode_attr & 0x99) == 0x99) { | ||
123 | /* It's a graphics mode with linear frame buffer */ | ||
124 | is_graphic = 1; | ||
125 | vesa_mode |= 0x4000; /* Request linear frame buffer */ | ||
126 | } else { | ||
127 | return -1; /* Invalid mode */ | ||
128 | } | ||
129 | |||
130 | |||
131 | ax = 0x4f02; | ||
132 | asm volatile("int $0x10" | ||
133 | : "+a" (ax) | ||
134 | : "b" (vesa_mode), "D" (0)); | ||
135 | |||
136 | if (ax != 0x004f) | ||
137 | return -1; | ||
138 | |||
139 | graphic_mode = is_graphic; | ||
140 | if (!is_graphic) { | ||
141 | /* Text mode */ | ||
142 | force_x = mode->x; | ||
143 | force_y = mode->y; | ||
144 | do_restore = 1; | ||
145 | } else { | ||
146 | /* Graphics mode */ | ||
147 | vesa_store_mode_params_graphics(); | ||
148 | } | ||
149 | |||
150 | return 0; | ||
151 | } | ||
152 | |||
153 | |||
154 | /* Switch DAC to 8-bit mode */ | ||
155 | static void vesa_dac_set_8bits(void) | ||
156 | { | ||
157 | u8 dac_size = 6; | ||
158 | |||
159 | /* If possible, switch the DAC to 8-bit mode */ | ||
160 | if (vginfo.capabilities & 1) { | ||
161 | u16 ax, bx; | ||
162 | |||
163 | ax = 0x4f08; | ||
164 | bx = 0x0800; | ||
165 | asm volatile(INT10 | ||
166 | : "+a" (ax), "+b" (bx) | ||
167 | : : "ecx", "edx", "esi", "edi"); | ||
168 | |||
169 | if (ax == 0x004f) | ||
170 | dac_size = bx >> 8; | ||
171 | } | ||
172 | |||
173 | /* Set the color sizes to the DAC size, and offsets to 0 */ | ||
174 | boot_params.screen_info.red_size = dac_size; | ||
175 | boot_params.screen_info.green_size = dac_size; | ||
176 | boot_params.screen_info.blue_size = dac_size; | ||
177 | boot_params.screen_info.rsvd_size = dac_size; | ||
178 | |||
179 | boot_params.screen_info.red_pos = 0; | ||
180 | boot_params.screen_info.green_pos = 0; | ||
181 | boot_params.screen_info.blue_pos = 0; | ||
182 | boot_params.screen_info.rsvd_pos = 0; | ||
183 | } | ||
184 | |||
185 | /* Save the VESA protected mode info */ | ||
186 | static void vesa_store_pm_info(void) | ||
187 | { | ||
188 | u16 ax, bx, di, es; | ||
189 | |||
190 | ax = 0x4f0a; | ||
191 | bx = di = 0; | ||
192 | asm("pushw %%es; "INT10"; movw %%es,%0; popw %%es" | ||
193 | : "=d" (es), "+a" (ax), "+b" (bx), "+D" (di) | ||
194 | : : "ecx", "esi"); | ||
195 | |||
196 | if (ax != 0x004f) | ||
197 | return; | ||
198 | |||
199 | boot_params.screen_info.vesapm_seg = es; | ||
200 | boot_params.screen_info.vesapm_off = di; | ||
201 | } | ||
202 | |||
203 | /* | ||
204 | * Save video mode parameters for graphics mode | ||
205 | */ | ||
206 | static void vesa_store_mode_params_graphics(void) | ||
207 | { | ||
208 | /* Tell the kernel we're in VESA graphics mode */ | ||
209 | boot_params.screen_info.orig_video_isVGA = 0x23; | ||
210 | |||
211 | /* Mode parameters */ | ||
212 | boot_params.screen_info.vesa_attributes = vminfo.mode_attr; | ||
213 | boot_params.screen_info.lfb_linelength = vminfo.logical_scan; | ||
214 | boot_params.screen_info.lfb_width = vminfo.h_res; | ||
215 | boot_params.screen_info.lfb_height = vminfo.v_res; | ||
216 | boot_params.screen_info.lfb_depth = vminfo.bpp; | ||
217 | boot_params.screen_info.pages = vminfo.image_planes; | ||
218 | boot_params.screen_info.lfb_base = vminfo.lfb_ptr; | ||
219 | memcpy(&boot_params.screen_info.red_size, | ||
220 | &vminfo.rmask, 8); | ||
221 | |||
222 | /* General parameters */ | ||
223 | boot_params.screen_info.lfb_size = vginfo.total_memory; | ||
224 | |||
225 | if (vminfo.bpp <= 8) | ||
226 | vesa_dac_set_8bits(); | ||
227 | |||
228 | vesa_store_pm_info(); | ||
229 | } | ||
230 | |||
231 | /* | ||
232 | * Save EDID information for the kernel; this is invoked, separately, | ||
233 | * after mode-setting. | ||
234 | */ | ||
235 | void vesa_store_edid(void) | ||
236 | { | ||
237 | #ifdef CONFIG_FIRMWARE_EDID | ||
238 | u16 ax, bx, cx, dx, di; | ||
239 | |||
240 | /* Apparently used as a nonsense token... */ | ||
241 | memset(&boot_params.edid_info, 0x13, sizeof boot_params.edid_info); | ||
242 | |||
243 | if (vginfo.version < 0x0200) | ||
244 | return; /* EDID requires VBE 2.0+ */ | ||
245 | |||
246 | ax = 0x4f15; /* VBE DDC */ | ||
247 | bx = 0x0000; /* Report DDC capabilities */ | ||
248 | cx = 0; /* Controller 0 */ | ||
249 | di = 0; /* ES:DI must be 0 by spec */ | ||
250 | |||
251 | /* Note: The VBE DDC spec is different from the main VESA spec; | ||
252 | we genuinely have to assume all registers are destroyed here. */ | ||
253 | |||
254 | asm("pushw %%es; movw %2,%%es; "INT10"; popw %%es" | ||
255 | : "+a" (ax), "+b" (bx) | ||
256 | : "c" (cx), "D" (di) | ||
257 | : "esi"); | ||
258 | |||
259 | if (ax != 0x004f) | ||
260 | return; /* No EDID */ | ||
261 | |||
262 | /* BH = time in seconds to transfer EDD information */ | ||
263 | /* BL = DDC level supported */ | ||
264 | |||
265 | ax = 0x4f15; /* VBE DDC */ | ||
266 | bx = 0x0001; /* Read EDID */ | ||
267 | cx = 0; /* Controller 0 */ | ||
268 | dx = 0; /* EDID block number */ | ||
269 | di =(size_t) &boot_params.edid_info; /* (ES:)Pointer to block */ | ||
270 | asm(INT10 | ||
271 | : "+a" (ax), "+b" (bx), "+d" (dx) | ||
272 | : "c" (cx), "D" (di) | ||
273 | : "esi"); | ||
274 | #endif /* CONFIG_FIRMWARE_EDID */ | ||
275 | } | ||
276 | |||
277 | __videocard video_vesa = | ||
278 | { | ||
279 | .card_name = "VESA", | ||
280 | .probe = vesa_probe, | ||
281 | .set_mode = vesa_set_mode, | ||
282 | .xmode_first = VIDEO_FIRST_VESA, | ||
283 | .xmode_n = 0x200, | ||
284 | }; | ||
diff --git a/arch/i386/boot/video-vga.c b/arch/i386/boot/video-vga.c new file mode 100644 index 000000000000..700d09a9c9b3 --- /dev/null +++ b/arch/i386/boot/video-vga.c | |||
@@ -0,0 +1,260 @@ | |||
1 | /* -*- linux-c -*- ------------------------------------------------------- * | ||
2 | * | ||
3 | * Copyright (C) 1991, 1992 Linus Torvalds | ||
4 | * Copyright 2007 rPath, Inc. - All Rights Reserved | ||
5 | * | ||
6 | * This file is part of the Linux kernel, and is made available under | ||
7 | * the terms of the GNU General Public License version 2. | ||
8 | * | ||
9 | * ----------------------------------------------------------------------- */ | ||
10 | |||
11 | /* | ||
12 | * arch/i386/boot/video-vga.c | ||
13 | * | ||
14 | * Common all-VGA modes | ||
15 | */ | ||
16 | |||
17 | #include "boot.h" | ||
18 | #include "video.h" | ||
19 | |||
20 | static struct mode_info vga_modes[] = { | ||
21 | { VIDEO_80x25, 80, 25 }, | ||
22 | { VIDEO_8POINT, 80, 50 }, | ||
23 | { VIDEO_80x43, 80, 43 }, | ||
24 | { VIDEO_80x28, 80, 28 }, | ||
25 | { VIDEO_80x30, 80, 30 }, | ||
26 | { VIDEO_80x34, 80, 34 }, | ||
27 | { VIDEO_80x60, 80, 60 }, | ||
28 | }; | ||
29 | |||
30 | static struct mode_info ega_modes[] = { | ||
31 | { VIDEO_80x25, 80, 25 }, | ||
32 | { VIDEO_8POINT, 80, 43 }, | ||
33 | }; | ||
34 | |||
35 | static struct mode_info cga_modes[] = { | ||
36 | { VIDEO_80x25, 80, 25 }, | ||
37 | }; | ||
38 | |||
39 | __videocard video_vga; | ||
40 | |||
41 | /* Set basic 80x25 mode */ | ||
42 | static u8 vga_set_basic_mode(void) | ||
43 | { | ||
44 | u16 ax; | ||
45 | u8 rows; | ||
46 | u8 mode; | ||
47 | |||
48 | #ifdef CONFIG_VIDEO_400_HACK | ||
49 | if (adapter >= ADAPTER_VGA) { | ||
50 | asm(INT10 | ||
51 | : : "a" (0x1202), "b" (0x0030) | ||
52 | : "ecx", "edx", "esi", "edi"); | ||
53 | } | ||
54 | #endif | ||
55 | |||
56 | ax = 0x0f00; | ||
57 | asm(INT10 | ||
58 | : "+a" (ax) | ||
59 | : : "ebx", "ecx", "edx", "esi", "edi"); | ||
60 | |||
61 | mode = (u8)ax; | ||
62 | |||
63 | set_fs(0); | ||
64 | rows = rdfs8(0x484); /* rows minus one */ | ||
65 | |||
66 | #ifndef CONFIG_VIDEO_400_HACK | ||
67 | if ((ax == 0x5003 || ax == 0x5007) && | ||
68 | (rows == 0 || rows == 24)) | ||
69 | return mode; | ||
70 | #endif | ||
71 | |||
72 | if (mode != 3 && mode != 7) | ||
73 | mode = 3; | ||
74 | |||
75 | /* Set the mode */ | ||
76 | asm volatile(INT10 | ||
77 | : : "a" (mode) | ||
78 | : "ebx", "ecx", "edx", "esi", "edi"); | ||
79 | do_restore = 1; | ||
80 | return mode; | ||
81 | } | ||
82 | |||
83 | static void vga_set_8font(void) | ||
84 | { | ||
85 | /* Set 8x8 font - 80x43 on EGA, 80x50 on VGA */ | ||
86 | |||
87 | /* Set 8x8 font */ | ||
88 | asm volatile(INT10 : : "a" (0x1112), "b" (0)); | ||
89 | |||
90 | /* Use alternate print screen */ | ||
91 | asm volatile(INT10 : : "a" (0x1200), "b" (0x20)); | ||
92 | |||
93 | /* Turn off cursor emulation */ | ||
94 | asm volatile(INT10 : : "a" (0x1201), "b" (0x34)); | ||
95 | |||
96 | /* Cursor is scan lines 6-7 */ | ||
97 | asm volatile(INT10 : : "a" (0x0100), "c" (0x0607)); | ||
98 | } | ||
99 | |||
100 | static void vga_set_14font(void) | ||
101 | { | ||
102 | /* Set 9x14 font - 80x28 on VGA */ | ||
103 | |||
104 | /* Set 9x14 font */ | ||
105 | asm volatile(INT10 : : "a" (0x1111), "b" (0)); | ||
106 | |||
107 | /* Turn off cursor emulation */ | ||
108 | asm volatile(INT10 : : "a" (0x1201), "b" (0x34)); | ||
109 | |||
110 | /* Cursor is scan lines 11-12 */ | ||
111 | asm volatile(INT10 : : "a" (0x0100), "c" (0x0b0c)); | ||
112 | } | ||
113 | |||
114 | static void vga_set_80x43(void) | ||
115 | { | ||
116 | /* Set 80x43 mode on VGA (not EGA) */ | ||
117 | |||
118 | /* Set 350 scans */ | ||
119 | asm volatile(INT10 : : "a" (0x1201), "b" (0x30)); | ||
120 | |||
121 | /* Reset video mode */ | ||
122 | asm volatile(INT10 : : "a" (0x0003)); | ||
123 | |||
124 | vga_set_8font(); | ||
125 | } | ||
126 | |||
127 | /* I/O address of the VGA CRTC */ | ||
128 | u16 vga_crtc(void) | ||
129 | { | ||
130 | return (inb(0x3cc) & 1) ? 0x3d4 : 0x3b4; | ||
131 | } | ||
132 | |||
133 | static void vga_set_480_scanlines(int end) | ||
134 | { | ||
135 | u16 crtc; | ||
136 | u8 csel; | ||
137 | |||
138 | crtc = vga_crtc(); | ||
139 | |||
140 | out_idx(0x0c, crtc, 0x11); /* Vertical sync end, unlock CR0-7 */ | ||
141 | out_idx(0x0b, crtc, 0x06); /* Vertical total */ | ||
142 | out_idx(0x3e, crtc, 0x07); /* Vertical overflow */ | ||
143 | out_idx(0xea, crtc, 0x10); /* Vertical sync start */ | ||
144 | out_idx(end, crtc, 0x12); /* Vertical display end */ | ||
145 | out_idx(0xe7, crtc, 0x15); /* Vertical blank start */ | ||
146 | out_idx(0x04, crtc, 0x16); /* Vertical blank end */ | ||
147 | csel = inb(0x3cc); | ||
148 | csel &= 0x0d; | ||
149 | csel |= 0xe2; | ||
150 | outb(csel, 0x3cc); | ||
151 | } | ||
152 | |||
153 | static void vga_set_80x30(void) | ||
154 | { | ||
155 | vga_set_480_scanlines(0xdf); | ||
156 | } | ||
157 | |||
158 | static void vga_set_80x34(void) | ||
159 | { | ||
160 | vga_set_14font(); | ||
161 | vga_set_480_scanlines(0xdb); | ||
162 | } | ||
163 | |||
164 | static void vga_set_80x60(void) | ||
165 | { | ||
166 | vga_set_8font(); | ||
167 | vga_set_480_scanlines(0xdf); | ||
168 | } | ||
169 | |||
170 | static int vga_set_mode(struct mode_info *mode) | ||
171 | { | ||
172 | /* Set the basic mode */ | ||
173 | vga_set_basic_mode(); | ||
174 | |||
175 | /* Override a possibly broken BIOS */ | ||
176 | force_x = mode->x; | ||
177 | force_y = mode->y; | ||
178 | |||
179 | switch (mode->mode) { | ||
180 | case VIDEO_80x25: | ||
181 | break; | ||
182 | case VIDEO_8POINT: | ||
183 | vga_set_8font(); | ||
184 | break; | ||
185 | case VIDEO_80x43: | ||
186 | vga_set_80x43(); | ||
187 | break; | ||
188 | case VIDEO_80x28: | ||
189 | vga_set_14font(); | ||
190 | break; | ||
191 | case VIDEO_80x30: | ||
192 | vga_set_80x30(); | ||
193 | break; | ||
194 | case VIDEO_80x34: | ||
195 | vga_set_80x34(); | ||
196 | break; | ||
197 | case VIDEO_80x60: | ||
198 | vga_set_80x60(); | ||
199 | break; | ||
200 | } | ||
201 | |||
202 | return 0; | ||
203 | } | ||
204 | |||
205 | /* | ||
206 | * Note: this probe includes basic information required by all | ||
207 | * systems. It should be executed first, by making sure | ||
208 | * video-vga.c is listed first in the Makefile. | ||
209 | */ | ||
210 | static int vga_probe(void) | ||
211 | { | ||
212 | static const char *card_name[] = { | ||
213 | "CGA/MDA/HGC", "EGA", "VGA" | ||
214 | }; | ||
215 | static struct mode_info *mode_lists[] = { | ||
216 | cga_modes, | ||
217 | ega_modes, | ||
218 | vga_modes, | ||
219 | }; | ||
220 | static int mode_count[] = { | ||
221 | sizeof(cga_modes)/sizeof(struct mode_info), | ||
222 | sizeof(ega_modes)/sizeof(struct mode_info), | ||
223 | sizeof(vga_modes)/sizeof(struct mode_info), | ||
224 | }; | ||
225 | u8 vga_flag; | ||
226 | |||
227 | asm(INT10 | ||
228 | : "=b" (boot_params.screen_info.orig_video_ega_bx) | ||
229 | : "a" (0x1200), "b" (0x10) /* Check EGA/VGA */ | ||
230 | : "ecx", "edx", "esi", "edi"); | ||
231 | |||
232 | /* If we have MDA/CGA/HGC then BL will be unchanged at 0x10 */ | ||
233 | if ((u8)boot_params.screen_info.orig_video_ega_bx != 0x10) { | ||
234 | /* EGA/VGA */ | ||
235 | asm(INT10 | ||
236 | : "=a" (vga_flag) | ||
237 | : "a" (0x1a00) | ||
238 | : "ebx", "ecx", "edx", "esi", "edi"); | ||
239 | |||
240 | if (vga_flag == 0x1a) { | ||
241 | adapter = ADAPTER_VGA; | ||
242 | boot_params.screen_info.orig_video_isVGA = 1; | ||
243 | } else { | ||
244 | adapter = ADAPTER_EGA; | ||
245 | } | ||
246 | } else { | ||
247 | adapter = ADAPTER_CGA; | ||
248 | } | ||
249 | |||
250 | video_vga.modes = mode_lists[adapter]; | ||
251 | video_vga.card_name = card_name[adapter]; | ||
252 | return mode_count[adapter]; | ||
253 | } | ||
254 | |||
255 | __videocard video_vga = | ||
256 | { | ||
257 | .card_name = "VGA", | ||
258 | .probe = vga_probe, | ||
259 | .set_mode = vga_set_mode, | ||
260 | }; | ||
diff --git a/arch/i386/boot/video.S b/arch/i386/boot/video.S deleted file mode 100644 index 8143c9516cb4..000000000000 --- a/arch/i386/boot/video.S +++ /dev/null | |||
@@ -1,2043 +0,0 @@ | |||
1 | /* video.S | ||
2 | * | ||
3 | * Display adapter & video mode setup, version 2.13 (14-May-99) | ||
4 | * | ||
5 | * Copyright (C) 1995 -- 1998 Martin Mares <mj@ucw.cz> | ||
6 | * Based on the original setup.S code (C) Linus Torvalds and Mats Anderson | ||
7 | * | ||
8 | * Rewritten to use GNU 'as' by Chris Noe <stiker@northlink.com> May 1999 | ||
9 | * | ||
10 | * For further information, look at Documentation/svga.txt. | ||
11 | * | ||
12 | */ | ||
13 | |||
14 | /* Enable autodetection of SVGA adapters and modes. */ | ||
15 | #undef CONFIG_VIDEO_SVGA | ||
16 | |||
17 | /* Enable autodetection of VESA modes */ | ||
18 | #define CONFIG_VIDEO_VESA | ||
19 | |||
20 | /* Enable compacting of mode table */ | ||
21 | #define CONFIG_VIDEO_COMPACT | ||
22 | |||
23 | /* Retain screen contents when switching modes */ | ||
24 | #define CONFIG_VIDEO_RETAIN | ||
25 | |||
26 | /* Enable local mode list */ | ||
27 | #undef CONFIG_VIDEO_LOCAL | ||
28 | |||
29 | /* Force 400 scan lines for standard modes (hack to fix bad BIOS behaviour */ | ||
30 | #undef CONFIG_VIDEO_400_HACK | ||
31 | |||
32 | /* Hack that lets you force specific BIOS mode ID and specific dimensions */ | ||
33 | #undef CONFIG_VIDEO_GFX_HACK | ||
34 | #define VIDEO_GFX_BIOS_AX 0x4f02 /* 800x600 on ThinkPad */ | ||
35 | #define VIDEO_GFX_BIOS_BX 0x0102 | ||
36 | #define VIDEO_GFX_DUMMY_RESOLUTION 0x6425 /* 100x37 */ | ||
37 | |||
38 | /* This code uses an extended set of video mode numbers. These include: | ||
39 | * Aliases for standard modes | ||
40 | * NORMAL_VGA (-1) | ||
41 | * EXTENDED_VGA (-2) | ||
42 | * ASK_VGA (-3) | ||
43 | * Video modes numbered by menu position -- NOT RECOMMENDED because of lack | ||
44 | * of compatibility when extending the table. These are between 0x00 and 0xff. | ||
45 | */ | ||
46 | #define VIDEO_FIRST_MENU 0x0000 | ||
47 | |||
48 | /* Standard BIOS video modes (BIOS number + 0x0100) */ | ||
49 | #define VIDEO_FIRST_BIOS 0x0100 | ||
50 | |||
51 | /* VESA BIOS video modes (VESA number + 0x0200) */ | ||
52 | #define VIDEO_FIRST_VESA 0x0200 | ||
53 | |||
54 | /* Video7 special modes (BIOS number + 0x0900) */ | ||
55 | #define VIDEO_FIRST_V7 0x0900 | ||
56 | |||
57 | /* Special video modes */ | ||
58 | #define VIDEO_FIRST_SPECIAL 0x0f00 | ||
59 | #define VIDEO_80x25 0x0f00 | ||
60 | #define VIDEO_8POINT 0x0f01 | ||
61 | #define VIDEO_80x43 0x0f02 | ||
62 | #define VIDEO_80x28 0x0f03 | ||
63 | #define VIDEO_CURRENT_MODE 0x0f04 | ||
64 | #define VIDEO_80x30 0x0f05 | ||
65 | #define VIDEO_80x34 0x0f06 | ||
66 | #define VIDEO_80x60 0x0f07 | ||
67 | #define VIDEO_GFX_HACK 0x0f08 | ||
68 | #define VIDEO_LAST_SPECIAL 0x0f09 | ||
69 | |||
70 | /* Video modes given by resolution */ | ||
71 | #define VIDEO_FIRST_RESOLUTION 0x1000 | ||
72 | |||
73 | /* The "recalculate timings" flag */ | ||
74 | #define VIDEO_RECALC 0x8000 | ||
75 | |||
76 | /* Positions of various video parameters passed to the kernel */ | ||
77 | /* (see also include/linux/tty.h) */ | ||
78 | #define PARAM_CURSOR_POS 0x00 | ||
79 | #define PARAM_VIDEO_PAGE 0x04 | ||
80 | #define PARAM_VIDEO_MODE 0x06 | ||
81 | #define PARAM_VIDEO_COLS 0x07 | ||
82 | #define PARAM_VIDEO_EGA_BX 0x0a | ||
83 | #define PARAM_VIDEO_LINES 0x0e | ||
84 | #define PARAM_HAVE_VGA 0x0f | ||
85 | #define PARAM_FONT_POINTS 0x10 | ||
86 | |||
87 | #define PARAM_LFB_WIDTH 0x12 | ||
88 | #define PARAM_LFB_HEIGHT 0x14 | ||
89 | #define PARAM_LFB_DEPTH 0x16 | ||
90 | #define PARAM_LFB_BASE 0x18 | ||
91 | #define PARAM_LFB_SIZE 0x1c | ||
92 | #define PARAM_LFB_LINELENGTH 0x24 | ||
93 | #define PARAM_LFB_COLORS 0x26 | ||
94 | #define PARAM_VESAPM_SEG 0x2e | ||
95 | #define PARAM_VESAPM_OFF 0x30 | ||
96 | #define PARAM_LFB_PAGES 0x32 | ||
97 | #define PARAM_VESA_ATTRIB 0x34 | ||
98 | #define PARAM_CAPABILITIES 0x36 | ||
99 | |||
100 | /* Define DO_STORE according to CONFIG_VIDEO_RETAIN */ | ||
101 | #ifdef CONFIG_VIDEO_RETAIN | ||
102 | #define DO_STORE call store_screen | ||
103 | #else | ||
104 | #define DO_STORE | ||
105 | #endif /* CONFIG_VIDEO_RETAIN */ | ||
106 | |||
107 | # This is the main entry point called by setup.S | ||
108 | # %ds *must* be pointing to the bootsector | ||
109 | video: pushw %ds # We use different segments | ||
110 | pushw %ds # FS contains original DS | ||
111 | popw %fs | ||
112 | pushw %cs # DS is equal to CS | ||
113 | popw %ds | ||
114 | pushw %cs # ES is equal to CS | ||
115 | popw %es | ||
116 | xorw %ax, %ax | ||
117 | movw %ax, %gs # GS is zero | ||
118 | cld | ||
119 | call basic_detect # Basic adapter type testing (EGA/VGA/MDA/CGA) | ||
120 | #ifdef CONFIG_VIDEO_SELECT | ||
121 | movw %fs:(0x01fa), %ax # User selected video mode | ||
122 | cmpw $ASK_VGA, %ax # Bring up the menu | ||
123 | jz vid2 | ||
124 | |||
125 | call mode_set # Set the mode | ||
126 | jc vid1 | ||
127 | |||
128 | leaw badmdt, %si # Invalid mode ID | ||
129 | call prtstr | ||
130 | vid2: call mode_menu | ||
131 | vid1: | ||
132 | #ifdef CONFIG_VIDEO_RETAIN | ||
133 | call restore_screen # Restore screen contents | ||
134 | #endif /* CONFIG_VIDEO_RETAIN */ | ||
135 | call store_edid | ||
136 | #endif /* CONFIG_VIDEO_SELECT */ | ||
137 | call mode_params # Store mode parameters | ||
138 | popw %ds # Restore original DS | ||
139 | ret | ||
140 | |||
141 | # Detect if we have CGA, MDA, EGA or VGA and pass it to the kernel. | ||
142 | basic_detect: | ||
143 | movb $0, %fs:(PARAM_HAVE_VGA) | ||
144 | movb $0x12, %ah # Check EGA/VGA | ||
145 | movb $0x10, %bl | ||
146 | int $0x10 | ||
147 | movw %bx, %fs:(PARAM_VIDEO_EGA_BX) # Identifies EGA to the kernel | ||
148 | cmpb $0x10, %bl # No, it's a CGA/MDA/HGA card. | ||
149 | je basret | ||
150 | |||
151 | incb adapter | ||
152 | movw $0x1a00, %ax # Check EGA or VGA? | ||
153 | int $0x10 | ||
154 | cmpb $0x1a, %al # 1a means VGA... | ||
155 | jne basret # anything else is EGA. | ||
156 | |||
157 | incb %fs:(PARAM_HAVE_VGA) # We've detected a VGA | ||
158 | incb adapter | ||
159 | basret: ret | ||
160 | |||
161 | # Store the video mode parameters for later usage by the kernel. | ||
162 | # This is done by asking the BIOS except for the rows/columns | ||
163 | # parameters in the default 80x25 mode -- these are set directly, | ||
164 | # because some very obscure BIOSes supply insane values. | ||
165 | mode_params: | ||
166 | #ifdef CONFIG_VIDEO_SELECT | ||
167 | cmpb $0, graphic_mode | ||
168 | jnz mopar_gr | ||
169 | #endif | ||
170 | movb $0x03, %ah # Read cursor position | ||
171 | xorb %bh, %bh | ||
172 | int $0x10 | ||
173 | movw %dx, %fs:(PARAM_CURSOR_POS) | ||
174 | movb $0x0f, %ah # Read page/mode/width | ||
175 | int $0x10 | ||
176 | movw %bx, %fs:(PARAM_VIDEO_PAGE) | ||
177 | movw %ax, %fs:(PARAM_VIDEO_MODE) # Video mode and screen width | ||
178 | cmpb $0x7, %al # MDA/HGA => segment differs | ||
179 | jnz mopar0 | ||
180 | |||
181 | movw $0xb000, video_segment | ||
182 | mopar0: movw %gs:(0x485), %ax # Font size | ||
183 | movw %ax, %fs:(PARAM_FONT_POINTS) # (valid only on EGA/VGA) | ||
184 | movw force_size, %ax # Forced size? | ||
185 | orw %ax, %ax | ||
186 | jz mopar1 | ||
187 | |||
188 | movb %ah, %fs:(PARAM_VIDEO_COLS) | ||
189 | movb %al, %fs:(PARAM_VIDEO_LINES) | ||
190 | ret | ||
191 | |||
192 | mopar1: movb $25, %al | ||
193 | cmpb $0, adapter # If we are on CGA/MDA/HGA, the | ||
194 | jz mopar2 # screen must have 25 lines. | ||
195 | |||
196 | movb %gs:(0x484), %al # On EGA/VGA, use the EGA+ BIOS | ||
197 | incb %al # location of max lines. | ||
198 | mopar2: movb %al, %fs:(PARAM_VIDEO_LINES) | ||
199 | ret | ||
200 | |||
201 | #ifdef CONFIG_VIDEO_SELECT | ||
202 | # Fetching of VESA frame buffer parameters | ||
203 | mopar_gr: | ||
204 | leaw modelist+1024, %di | ||
205 | movb $0x23, %fs:(PARAM_HAVE_VGA) | ||
206 | movw 16(%di), %ax | ||
207 | movw %ax, %fs:(PARAM_LFB_LINELENGTH) | ||
208 | movw 18(%di), %ax | ||
209 | movw %ax, %fs:(PARAM_LFB_WIDTH) | ||
210 | movw 20(%di), %ax | ||
211 | movw %ax, %fs:(PARAM_LFB_HEIGHT) | ||
212 | movb 25(%di), %al | ||
213 | movb $0, %ah | ||
214 | movw %ax, %fs:(PARAM_LFB_DEPTH) | ||
215 | movb 29(%di), %al | ||
216 | movb $0, %ah | ||
217 | movw %ax, %fs:(PARAM_LFB_PAGES) | ||
218 | movl 40(%di), %eax | ||
219 | movl %eax, %fs:(PARAM_LFB_BASE) | ||
220 | movl 31(%di), %eax | ||
221 | movl %eax, %fs:(PARAM_LFB_COLORS) | ||
222 | movl 35(%di), %eax | ||
223 | movl %eax, %fs:(PARAM_LFB_COLORS+4) | ||
224 | movw 0(%di), %ax | ||
225 | movw %ax, %fs:(PARAM_VESA_ATTRIB) | ||
226 | |||
227 | # get video mem size | ||
228 | leaw modelist+1024, %di | ||
229 | movw $0x4f00, %ax | ||
230 | int $0x10 | ||
231 | xorl %eax, %eax | ||
232 | movw 18(%di), %ax | ||
233 | movl %eax, %fs:(PARAM_LFB_SIZE) | ||
234 | |||
235 | # store mode capabilities | ||
236 | movl 10(%di), %eax | ||
237 | movl %eax, %fs:(PARAM_CAPABILITIES) | ||
238 | |||
239 | # switching the DAC to 8-bit is for <= 8 bpp only | ||
240 | movw %fs:(PARAM_LFB_DEPTH), %ax | ||
241 | cmpw $8, %ax | ||
242 | jg dac_done | ||
243 | |||
244 | # get DAC switching capability | ||
245 | xorl %eax, %eax | ||
246 | movb 10(%di), %al | ||
247 | testb $1, %al | ||
248 | jz dac_set | ||
249 | |||
250 | # attempt to switch DAC to 8-bit | ||
251 | movw $0x4f08, %ax | ||
252 | movw $0x0800, %bx | ||
253 | int $0x10 | ||
254 | cmpw $0x004f, %ax | ||
255 | jne dac_set | ||
256 | movb %bh, dac_size # store actual DAC size | ||
257 | |||
258 | dac_set: | ||
259 | # set color size to DAC size | ||
260 | movb dac_size, %al | ||
261 | movb %al, %fs:(PARAM_LFB_COLORS+0) | ||
262 | movb %al, %fs:(PARAM_LFB_COLORS+2) | ||
263 | movb %al, %fs:(PARAM_LFB_COLORS+4) | ||
264 | movb %al, %fs:(PARAM_LFB_COLORS+6) | ||
265 | |||
266 | # set color offsets to 0 | ||
267 | movb $0, %fs:(PARAM_LFB_COLORS+1) | ||
268 | movb $0, %fs:(PARAM_LFB_COLORS+3) | ||
269 | movb $0, %fs:(PARAM_LFB_COLORS+5) | ||
270 | movb $0, %fs:(PARAM_LFB_COLORS+7) | ||
271 | |||
272 | dac_done: | ||
273 | # get protected mode interface informations | ||
274 | movw $0x4f0a, %ax | ||
275 | xorw %bx, %bx | ||
276 | xorw %di, %di | ||
277 | int $0x10 | ||
278 | cmp $0x004f, %ax | ||
279 | jnz no_pm | ||
280 | |||
281 | movw %es, %fs:(PARAM_VESAPM_SEG) | ||
282 | movw %di, %fs:(PARAM_VESAPM_OFF) | ||
283 | no_pm: ret | ||
284 | |||
285 | # The video mode menu | ||
286 | mode_menu: | ||
287 | leaw keymsg, %si # "Return/Space/Timeout" message | ||
288 | call prtstr | ||
289 | call flush | ||
290 | nokey: call getkt | ||
291 | |||
292 | cmpb $0x0d, %al # ENTER ? | ||
293 | je listm # yes - manual mode selection | ||
294 | |||
295 | cmpb $0x20, %al # SPACE ? | ||
296 | je defmd1 # no - repeat | ||
297 | |||
298 | call beep | ||
299 | jmp nokey | ||
300 | |||
301 | defmd1: ret # No mode chosen? Default 80x25 | ||
302 | |||
303 | listm: call mode_table # List mode table | ||
304 | listm0: leaw name_bann, %si # Print adapter name | ||
305 | call prtstr | ||
306 | movw card_name, %si | ||
307 | orw %si, %si | ||
308 | jnz an2 | ||
309 | |||
310 | movb adapter, %al | ||
311 | leaw old_name, %si | ||
312 | orb %al, %al | ||
313 | jz an1 | ||
314 | |||
315 | leaw ega_name, %si | ||
316 | decb %al | ||
317 | jz an1 | ||
318 | |||
319 | leaw vga_name, %si | ||
320 | jmp an1 | ||
321 | |||
322 | an2: call prtstr | ||
323 | leaw svga_name, %si | ||
324 | an1: call prtstr | ||
325 | leaw listhdr, %si # Table header | ||
326 | call prtstr | ||
327 | movb $0x30, %dl # DL holds mode number | ||
328 | leaw modelist, %si | ||
329 | lm1: cmpw $ASK_VGA, (%si) # End? | ||
330 | jz lm2 | ||
331 | |||
332 | movb %dl, %al # Menu selection number | ||
333 | call prtchr | ||
334 | call prtsp2 | ||
335 | lodsw | ||
336 | call prthw # Mode ID | ||
337 | call prtsp2 | ||
338 | movb 0x1(%si), %al | ||
339 | call prtdec # Rows | ||
340 | movb $0x78, %al # the letter 'x' | ||
341 | call prtchr | ||
342 | lodsw | ||
343 | call prtdec # Columns | ||
344 | movb $0x0d, %al # New line | ||
345 | call prtchr | ||
346 | movb $0x0a, %al | ||
347 | call prtchr | ||
348 | incb %dl # Next character | ||
349 | cmpb $0x3a, %dl | ||
350 | jnz lm1 | ||
351 | |||
352 | movb $0x61, %dl | ||
353 | jmp lm1 | ||
354 | |||
355 | lm2: leaw prompt, %si # Mode prompt | ||
356 | call prtstr | ||
357 | leaw edit_buf, %di # Editor buffer | ||
358 | lm3: call getkey | ||
359 | cmpb $0x0d, %al # Enter? | ||
360 | jz lment | ||
361 | |||
362 | cmpb $0x08, %al # Backspace? | ||
363 | jz lmbs | ||
364 | |||
365 | cmpb $0x20, %al # Printable? | ||
366 | jc lm3 | ||
367 | |||
368 | cmpw $edit_buf+4, %di # Enough space? | ||
369 | jz lm3 | ||
370 | |||
371 | stosb | ||
372 | call prtchr | ||
373 | jmp lm3 | ||
374 | |||
375 | lmbs: cmpw $edit_buf, %di # Backspace | ||
376 | jz lm3 | ||
377 | |||
378 | decw %di | ||
379 | movb $0x08, %al | ||
380 | call prtchr | ||
381 | call prtspc | ||
382 | movb $0x08, %al | ||
383 | call prtchr | ||
384 | jmp lm3 | ||
385 | |||
386 | lment: movb $0, (%di) | ||
387 | leaw crlft, %si | ||
388 | call prtstr | ||
389 | leaw edit_buf, %si | ||
390 | cmpb $0, (%si) # Empty string = default mode | ||
391 | jz lmdef | ||
392 | |||
393 | cmpb $0, 1(%si) # One character = menu selection | ||
394 | jz mnusel | ||
395 | |||
396 | cmpw $0x6373, (%si) # "scan" => mode scanning | ||
397 | jnz lmhx | ||
398 | |||
399 | cmpw $0x6e61, 2(%si) | ||
400 | jz lmscan | ||
401 | |||
402 | lmhx: xorw %bx, %bx # Else => mode ID in hex | ||
403 | lmhex: lodsb | ||
404 | orb %al, %al | ||
405 | jz lmuse1 | ||
406 | |||
407 | subb $0x30, %al | ||
408 | jc lmbad | ||
409 | |||
410 | cmpb $10, %al | ||
411 | jc lmhx1 | ||
412 | |||
413 | subb $7, %al | ||
414 | andb $0xdf, %al | ||
415 | cmpb $10, %al | ||
416 | jc lmbad | ||
417 | |||
418 | cmpb $16, %al | ||
419 | jnc lmbad | ||
420 | |||
421 | lmhx1: shlw $4, %bx | ||
422 | orb %al, %bl | ||
423 | jmp lmhex | ||
424 | |||
425 | lmuse1: movw %bx, %ax | ||
426 | jmp lmuse | ||
427 | |||
428 | mnusel: lodsb # Menu selection | ||
429 | xorb %ah, %ah | ||
430 | subb $0x30, %al | ||
431 | jc lmbad | ||
432 | |||
433 | cmpb $10, %al | ||
434 | jc lmuse | ||
435 | |||
436 | cmpb $0x61-0x30, %al | ||
437 | jc lmbad | ||
438 | |||
439 | subb $0x61-0x30-10, %al | ||
440 | cmpb $36, %al | ||
441 | jnc lmbad | ||
442 | |||
443 | lmuse: call mode_set | ||
444 | jc lmdef | ||
445 | |||
446 | lmbad: leaw unknt, %si | ||
447 | call prtstr | ||
448 | jmp lm2 | ||
449 | lmscan: cmpb $0, adapter # Scanning only on EGA/VGA | ||
450 | jz lmbad | ||
451 | |||
452 | movw $0, mt_end # Scanning of modes is | ||
453 | movb $1, scanning # done as new autodetection. | ||
454 | call mode_table | ||
455 | jmp listm0 | ||
456 | lmdef: ret | ||
457 | |||
458 | # Additional parts of mode_set... (relative jumps, you know) | ||
459 | setv7: # Video7 extended modes | ||
460 | DO_STORE | ||
461 | subb $VIDEO_FIRST_V7>>8, %bh | ||
462 | movw $0x6f05, %ax | ||
463 | int $0x10 | ||
464 | stc | ||
465 | ret | ||
466 | |||
467 | _setrec: jmp setrec # Ugly... | ||
468 | _set_80x25: jmp set_80x25 | ||
469 | |||
470 | # Aliases for backward compatibility. | ||
471 | setalias: | ||
472 | movw $VIDEO_80x25, %ax | ||
473 | incw %bx | ||
474 | jz mode_set | ||
475 | |||
476 | movb $VIDEO_8POINT-VIDEO_FIRST_SPECIAL, %al | ||
477 | incw %bx | ||
478 | jnz setbad # Fall-through! | ||
479 | |||
480 | # Setting of user mode (AX=mode ID) => CF=success | ||
481 | mode_set: | ||
482 | movw %ax, %fs:(0x01fa) # Store mode for use in acpi_wakeup.S | ||
483 | movw %ax, %bx | ||
484 | cmpb $0xff, %ah | ||
485 | jz setalias | ||
486 | |||
487 | testb $VIDEO_RECALC>>8, %ah | ||
488 | jnz _setrec | ||
489 | |||
490 | cmpb $VIDEO_FIRST_RESOLUTION>>8, %ah | ||
491 | jnc setres | ||
492 | |||
493 | cmpb $VIDEO_FIRST_SPECIAL>>8, %ah | ||
494 | jz setspc | ||
495 | |||
496 | cmpb $VIDEO_FIRST_V7>>8, %ah | ||
497 | jz setv7 | ||
498 | |||
499 | cmpb $VIDEO_FIRST_VESA>>8, %ah | ||
500 | jnc check_vesa | ||
501 | |||
502 | orb %ah, %ah | ||
503 | jz setmenu | ||
504 | |||
505 | decb %ah | ||
506 | jz setbios | ||
507 | |||
508 | setbad: clc | ||
509 | movb $0, do_restore # The screen needn't be restored | ||
510 | ret | ||
511 | |||
512 | setvesa: | ||
513 | DO_STORE | ||
514 | subb $VIDEO_FIRST_VESA>>8, %bh | ||
515 | movw $0x4f02, %ax # VESA BIOS mode set call | ||
516 | int $0x10 | ||
517 | cmpw $0x004f, %ax # AL=4f if implemented | ||
518 | jnz setbad # AH=0 if OK | ||
519 | |||
520 | stc | ||
521 | ret | ||
522 | |||
523 | setbios: | ||
524 | DO_STORE | ||
525 | int $0x10 # Standard BIOS mode set call | ||
526 | pushw %bx | ||
527 | movb $0x0f, %ah # Check if really set | ||
528 | int $0x10 | ||
529 | popw %bx | ||
530 | cmpb %bl, %al | ||
531 | jnz setbad | ||
532 | |||
533 | stc | ||
534 | ret | ||
535 | |||
536 | setspc: xorb %bh, %bh # Set special mode | ||
537 | cmpb $VIDEO_LAST_SPECIAL-VIDEO_FIRST_SPECIAL, %bl | ||
538 | jnc setbad | ||
539 | |||
540 | addw %bx, %bx | ||
541 | jmp *spec_inits(%bx) | ||
542 | |||
543 | setmenu: | ||
544 | orb %al, %al # 80x25 is an exception | ||
545 | jz _set_80x25 | ||
546 | |||
547 | pushw %bx # Set mode chosen from menu | ||
548 | call mode_table # Build the mode table | ||
549 | popw %ax | ||
550 | shlw $2, %ax | ||
551 | addw %ax, %si | ||
552 | cmpw %di, %si | ||
553 | jnc setbad | ||
554 | |||
555 | movw (%si), %ax # Fetch mode ID | ||
556 | _m_s: jmp mode_set | ||
557 | |||
558 | setres: pushw %bx # Set mode chosen by resolution | ||
559 | call mode_table | ||
560 | popw %bx | ||
561 | xchgb %bl, %bh | ||
562 | setr1: lodsw | ||
563 | cmpw $ASK_VGA, %ax # End of the list? | ||
564 | jz setbad | ||
565 | |||
566 | lodsw | ||
567 | cmpw %bx, %ax | ||
568 | jnz setr1 | ||
569 | |||
570 | movw -4(%si), %ax # Fetch mode ID | ||
571 | jmp _m_s | ||
572 | |||
573 | check_vesa: | ||
574 | #ifdef CONFIG_FIRMWARE_EDID | ||
575 | leaw modelist+1024, %di | ||
576 | movw $0x4f00, %ax | ||
577 | int $0x10 | ||
578 | cmpw $0x004f, %ax | ||
579 | jnz setbad | ||
580 | |||
581 | movw 4(%di), %ax | ||
582 | movw %ax, vbe_version | ||
583 | #endif | ||
584 | leaw modelist+1024, %di | ||
585 | subb $VIDEO_FIRST_VESA>>8, %bh | ||
586 | movw %bx, %cx # Get mode information structure | ||
587 | movw $0x4f01, %ax | ||
588 | int $0x10 | ||
589 | addb $VIDEO_FIRST_VESA>>8, %bh | ||
590 | cmpw $0x004f, %ax | ||
591 | jnz setbad | ||
592 | |||
593 | movb (%di), %al # Check capabilities. | ||
594 | andb $0x19, %al | ||
595 | cmpb $0x09, %al | ||
596 | jz setvesa # This is a text mode | ||
597 | |||
598 | movb (%di), %al # Check capabilities. | ||
599 | andb $0x99, %al | ||
600 | cmpb $0x99, %al | ||
601 | jnz _setbad # Doh! No linear frame buffer. | ||
602 | |||
603 | subb $VIDEO_FIRST_VESA>>8, %bh | ||
604 | orw $0x4000, %bx # Use linear frame buffer | ||
605 | movw $0x4f02, %ax # VESA BIOS mode set call | ||
606 | int $0x10 | ||
607 | cmpw $0x004f, %ax # AL=4f if implemented | ||
608 | jnz _setbad # AH=0 if OK | ||
609 | |||
610 | movb $1, graphic_mode # flag graphic mode | ||
611 | movb $0, do_restore # no screen restore | ||
612 | stc | ||
613 | ret | ||
614 | |||
615 | _setbad: jmp setbad # Ugly... | ||
616 | |||
617 | # Recalculate vertical display end registers -- this fixes various | ||
618 | # inconsistencies of extended modes on many adapters. Called when | ||
619 | # the VIDEO_RECALC flag is set in the mode ID. | ||
620 | |||
621 | setrec: subb $VIDEO_RECALC>>8, %ah # Set the base mode | ||
622 | call mode_set | ||
623 | jnc rct3 | ||
624 | |||
625 | movw %gs:(0x485), %ax # Font size in pixels | ||
626 | movb %gs:(0x484), %bl # Number of rows | ||
627 | incb %bl | ||
628 | mulb %bl # Number of visible | ||
629 | decw %ax # scan lines - 1 | ||
630 | movw $0x3d4, %dx | ||
631 | movw %ax, %bx | ||
632 | movb $0x12, %al # Lower 8 bits | ||
633 | movb %bl, %ah | ||
634 | outw %ax, %dx | ||
635 | movb $0x07, %al # Bits 8 and 9 in the overflow register | ||
636 | call inidx | ||
637 | xchgb %al, %ah | ||
638 | andb $0xbd, %ah | ||
639 | shrb %bh | ||
640 | jnc rct1 | ||
641 | orb $0x02, %ah | ||
642 | rct1: shrb %bh | ||
643 | jnc rct2 | ||
644 | orb $0x40, %ah | ||
645 | rct2: movb $0x07, %al | ||
646 | outw %ax, %dx | ||
647 | stc | ||
648 | rct3: ret | ||
649 | |||
650 | # Table of routines for setting of the special modes. | ||
651 | spec_inits: | ||
652 | .word set_80x25 | ||
653 | .word set_8pixel | ||
654 | .word set_80x43 | ||
655 | .word set_80x28 | ||
656 | .word set_current | ||
657 | .word set_80x30 | ||
658 | .word set_80x34 | ||
659 | .word set_80x60 | ||
660 | .word set_gfx | ||
661 | |||
662 | # Set the 80x25 mode. If already set, do nothing. | ||
663 | set_80x25: | ||
664 | movw $0x5019, force_size # Override possibly broken BIOS | ||
665 | use_80x25: | ||
666 | #ifdef CONFIG_VIDEO_400_HACK | ||
667 | movw $0x1202, %ax # Force 400 scan lines | ||
668 | movb $0x30, %bl | ||
669 | int $0x10 | ||
670 | #else | ||
671 | movb $0x0f, %ah # Get current mode ID | ||
672 | int $0x10 | ||
673 | cmpw $0x5007, %ax # Mode 7 (80x25 mono) is the only one available | ||
674 | jz st80 # on CGA/MDA/HGA and is also available on EGAM | ||
675 | |||
676 | cmpw $0x5003, %ax # Unknown mode, force 80x25 color | ||
677 | jnz force3 | ||
678 | |||
679 | st80: cmpb $0, adapter # CGA/MDA/HGA => mode 3/7 is always 80x25 | ||
680 | jz set80 | ||
681 | |||
682 | movb %gs:(0x0484), %al # This is EGA+ -- beware of 80x50 etc. | ||
683 | orb %al, %al # Some buggy BIOS'es set 0 rows | ||
684 | jz set80 | ||
685 | |||
686 | cmpb $24, %al # It's hopefully correct | ||
687 | jz set80 | ||
688 | #endif /* CONFIG_VIDEO_400_HACK */ | ||
689 | force3: DO_STORE | ||
690 | movw $0x0003, %ax # Forced set | ||
691 | int $0x10 | ||
692 | set80: stc | ||
693 | ret | ||
694 | |||
695 | # Set the 80x50/80x43 8-pixel mode. Simple BIOS calls. | ||
696 | set_8pixel: | ||
697 | DO_STORE | ||
698 | call use_80x25 # The base is 80x25 | ||
699 | set_8pt: | ||
700 | movw $0x1112, %ax # Use 8x8 font | ||
701 | xorb %bl, %bl | ||
702 | int $0x10 | ||
703 | movw $0x1200, %ax # Use alternate print screen | ||
704 | movb $0x20, %bl | ||
705 | int $0x10 | ||
706 | movw $0x1201, %ax # Turn off cursor emulation | ||
707 | movb $0x34, %bl | ||
708 | int $0x10 | ||
709 | movb $0x01, %ah # Define cursor scan lines 6-7 | ||
710 | movw $0x0607, %cx | ||
711 | int $0x10 | ||
712 | set_current: | ||
713 | stc | ||
714 | ret | ||
715 | |||
716 | # Set the 80x28 mode. This mode works on all VGA's, because it's a standard | ||
717 | # 80x25 mode with 14-point fonts instead of 16-point. | ||
718 | set_80x28: | ||
719 | DO_STORE | ||
720 | call use_80x25 # The base is 80x25 | ||
721 | set14: movw $0x1111, %ax # Use 9x14 font | ||
722 | xorb %bl, %bl | ||
723 | int $0x10 | ||
724 | movb $0x01, %ah # Define cursor scan lines 11-12 | ||
725 | movw $0x0b0c, %cx | ||
726 | int $0x10 | ||
727 | stc | ||
728 | ret | ||
729 | |||
730 | # Set the 80x43 mode. This mode is works on all VGA's. | ||
731 | # It's a 350-scanline mode with 8-pixel font. | ||
732 | set_80x43: | ||
733 | DO_STORE | ||
734 | movw $0x1201, %ax # Set 350 scans | ||
735 | movb $0x30, %bl | ||
736 | int $0x10 | ||
737 | movw $0x0003, %ax # Reset video mode | ||
738 | int $0x10 | ||
739 | jmp set_8pt # Use 8-pixel font | ||
740 | |||
741 | # Set the 80x30 mode (all VGA's). 480 scanlines, 16-pixel font. | ||
742 | set_80x30: | ||
743 | call use_80x25 # Start with real 80x25 | ||
744 | DO_STORE | ||
745 | movw $0x3cc, %dx # Get CRTC port | ||
746 | inb %dx, %al | ||
747 | movb $0xd4, %dl | ||
748 | rorb %al # Mono or color? | ||
749 | jc set48a | ||
750 | |||
751 | movb $0xb4, %dl | ||
752 | set48a: movw $0x0c11, %ax # Vertical sync end (also unlocks CR0-7) | ||
753 | call outidx | ||
754 | movw $0x0b06, %ax # Vertical total | ||
755 | call outidx | ||
756 | movw $0x3e07, %ax # (Vertical) overflow | ||
757 | call outidx | ||
758 | movw $0xea10, %ax # Vertical sync start | ||
759 | call outidx | ||
760 | movw $0xdf12, %ax # Vertical display end | ||
761 | call outidx | ||
762 | movw $0xe715, %ax # Vertical blank start | ||
763 | call outidx | ||
764 | movw $0x0416, %ax # Vertical blank end | ||
765 | call outidx | ||
766 | pushw %dx | ||
767 | movb $0xcc, %dl # Misc output register (read) | ||
768 | inb %dx, %al | ||
769 | movb $0xc2, %dl # (write) | ||
770 | andb $0x0d, %al # Preserve clock select bits and color bit | ||
771 | orb $0xe2, %al # Set correct sync polarity | ||
772 | outb %al, %dx | ||
773 | popw %dx | ||
774 | movw $0x501e, force_size | ||
775 | stc # That's all. | ||
776 | ret | ||
777 | |||
778 | # Set the 80x34 mode (all VGA's). 480 scans, 14-pixel font. | ||
779 | set_80x34: | ||
780 | call set_80x30 # Set 480 scans | ||
781 | call set14 # And 14-pt font | ||
782 | movw $0xdb12, %ax # VGA vertical display end | ||
783 | movw $0x5022, force_size | ||
784 | setvde: call outidx | ||
785 | stc | ||
786 | ret | ||
787 | |||
788 | # Set the 80x60 mode (all VGA's). 480 scans, 8-pixel font. | ||
789 | set_80x60: | ||
790 | call set_80x30 # Set 480 scans | ||
791 | call set_8pt # And 8-pt font | ||
792 | movw $0xdf12, %ax # VGA vertical display end | ||
793 | movw $0x503c, force_size | ||
794 | jmp setvde | ||
795 | |||
796 | # Special hack for ThinkPad graphics | ||
797 | set_gfx: | ||
798 | #ifdef CONFIG_VIDEO_GFX_HACK | ||
799 | movw $VIDEO_GFX_BIOS_AX, %ax | ||
800 | movw $VIDEO_GFX_BIOS_BX, %bx | ||
801 | int $0x10 | ||
802 | movw $VIDEO_GFX_DUMMY_RESOLUTION, force_size | ||
803 | stc | ||
804 | #endif | ||
805 | ret | ||
806 | |||
807 | #ifdef CONFIG_VIDEO_RETAIN | ||
808 | |||
809 | # Store screen contents to temporary buffer. | ||
810 | store_screen: | ||
811 | cmpb $0, do_restore # Already stored? | ||
812 | jnz stsr | ||
813 | |||
814 | testb $CAN_USE_HEAP, loadflags # Have we space for storing? | ||
815 | jz stsr | ||
816 | |||
817 | pushw %ax | ||
818 | pushw %bx | ||
819 | pushw force_size # Don't force specific size | ||
820 | movw $0, force_size | ||
821 | call mode_params # Obtain params of current mode | ||
822 | popw force_size | ||
823 | movb %fs:(PARAM_VIDEO_LINES), %ah | ||
824 | movb %fs:(PARAM_VIDEO_COLS), %al | ||
825 | movw %ax, %bx # BX=dimensions | ||
826 | mulb %ah | ||
827 | movw %ax, %cx # CX=number of characters | ||
828 | addw %ax, %ax # Calculate image size | ||
829 | addw $modelist+1024+4, %ax | ||
830 | cmpw heap_end_ptr, %ax | ||
831 | jnc sts1 # Unfortunately, out of memory | ||
832 | |||
833 | movw %fs:(PARAM_CURSOR_POS), %ax # Store mode params | ||
834 | leaw modelist+1024, %di | ||
835 | stosw | ||
836 | movw %bx, %ax | ||
837 | stosw | ||
838 | pushw %ds # Store the screen | ||
839 | movw video_segment, %ds | ||
840 | xorw %si, %si | ||
841 | rep | ||
842 | movsw | ||
843 | popw %ds | ||
844 | incb do_restore # Screen will be restored later | ||
845 | sts1: popw %bx | ||
846 | popw %ax | ||
847 | stsr: ret | ||
848 | |||
849 | # Restore screen contents from temporary buffer. | ||
850 | restore_screen: | ||
851 | cmpb $0, do_restore # Has the screen been stored? | ||
852 | jz res1 | ||
853 | |||
854 | call mode_params # Get parameters of current mode | ||
855 | movb %fs:(PARAM_VIDEO_LINES), %cl | ||
856 | movb %fs:(PARAM_VIDEO_COLS), %ch | ||
857 | leaw modelist+1024, %si # Screen buffer | ||
858 | lodsw # Set cursor position | ||
859 | movw %ax, %dx | ||
860 | cmpb %cl, %dh | ||
861 | jc res2 | ||
862 | |||
863 | movb %cl, %dh | ||
864 | decb %dh | ||
865 | res2: cmpb %ch, %dl | ||
866 | jc res3 | ||
867 | |||
868 | movb %ch, %dl | ||
869 | decb %dl | ||
870 | res3: movb $0x02, %ah | ||
871 | movb $0x00, %bh | ||
872 | int $0x10 | ||
873 | lodsw # Display size | ||
874 | movb %ah, %dl # DL=number of lines | ||
875 | movb $0, %ah # BX=phys. length of orig. line | ||
876 | movw %ax, %bx | ||
877 | cmpb %cl, %dl # Too many? | ||
878 | jc res4 | ||
879 | |||
880 | pushw %ax | ||
881 | movb %dl, %al | ||
882 | subb %cl, %al | ||
883 | mulb %bl | ||
884 | addw %ax, %si | ||
885 | addw %ax, %si | ||
886 | popw %ax | ||
887 | movb %cl, %dl | ||
888 | res4: cmpb %ch, %al # Too wide? | ||
889 | jc res5 | ||
890 | |||
891 | movb %ch, %al # AX=width of src. line | ||
892 | res5: movb $0, %cl | ||
893 | xchgb %ch, %cl | ||
894 | movw %cx, %bp # BP=width of dest. line | ||
895 | pushw %es | ||
896 | movw video_segment, %es | ||
897 | xorw %di, %di # Move the data | ||
898 | addw %bx, %bx # Convert BX and BP to _bytes_ | ||
899 | addw %bp, %bp | ||
900 | res6: pushw %si | ||
901 | pushw %di | ||
902 | movw %ax, %cx | ||
903 | rep | ||
904 | movsw | ||
905 | popw %di | ||
906 | popw %si | ||
907 | addw %bp, %di | ||
908 | addw %bx, %si | ||
909 | decb %dl | ||
910 | jnz res6 | ||
911 | |||
912 | popw %es # Done | ||
913 | res1: ret | ||
914 | #endif /* CONFIG_VIDEO_RETAIN */ | ||
915 | |||
916 | # Write to indexed VGA register (AL=index, AH=data, DX=index reg. port) | ||
917 | outidx: outb %al, %dx | ||
918 | pushw %ax | ||
919 | movb %ah, %al | ||
920 | incw %dx | ||
921 | outb %al, %dx | ||
922 | decw %dx | ||
923 | popw %ax | ||
924 | ret | ||
925 | |||
926 | # Build the table of video modes (stored after the setup.S code at the | ||
927 | # `modelist' label. Each video mode record looks like: | ||
928 | # .word MODE-ID (our special mode ID (see above)) | ||
929 | # .byte rows (number of rows) | ||
930 | # .byte columns (number of columns) | ||
931 | # Returns address of the end of the table in DI, the end is marked | ||
932 | # with a ASK_VGA ID. | ||
933 | mode_table: | ||
934 | movw mt_end, %di # Already filled? | ||
935 | orw %di, %di | ||
936 | jnz mtab1x | ||
937 | |||
938 | leaw modelist, %di # Store standard modes: | ||
939 | movl $VIDEO_80x25 + 0x50190000, %eax # The 80x25 mode (ALL) | ||
940 | stosl | ||
941 | movb adapter, %al # CGA/MDA/HGA -- no more modes | ||
942 | orb %al, %al | ||
943 | jz mtabe | ||
944 | |||
945 | decb %al | ||
946 | jnz mtabv | ||
947 | |||
948 | movl $VIDEO_8POINT + 0x502b0000, %eax # The 80x43 EGA mode | ||
949 | stosl | ||
950 | jmp mtabe | ||
951 | |||
952 | mtab1x: jmp mtab1 | ||
953 | |||
954 | mtabv: leaw vga_modes, %si # All modes for std VGA | ||
955 | movw $vga_modes_end-vga_modes, %cx | ||
956 | rep # I'm unable to use movsw as I don't know how to store a half | ||
957 | movsb # of the expression above to cx without using explicit shr. | ||
958 | |||
959 | cmpb $0, scanning # Mode scan requested? | ||
960 | jz mscan1 | ||
961 | |||
962 | call mode_scan | ||
963 | mscan1: | ||
964 | |||
965 | #ifdef CONFIG_VIDEO_LOCAL | ||
966 | call local_modes | ||
967 | #endif /* CONFIG_VIDEO_LOCAL */ | ||
968 | |||
969 | #ifdef CONFIG_VIDEO_VESA | ||
970 | call vesa_modes # Detect VESA VGA modes | ||
971 | #endif /* CONFIG_VIDEO_VESA */ | ||
972 | |||
973 | #ifdef CONFIG_VIDEO_SVGA | ||
974 | cmpb $0, scanning # Bypass when scanning | ||
975 | jnz mscan2 | ||
976 | |||
977 | call svga_modes # Detect SVGA cards & modes | ||
978 | mscan2: | ||
979 | #endif /* CONFIG_VIDEO_SVGA */ | ||
980 | |||
981 | mtabe: | ||
982 | |||
983 | #ifdef CONFIG_VIDEO_COMPACT | ||
984 | leaw modelist, %si | ||
985 | movw %di, %dx | ||
986 | movw %si, %di | ||
987 | cmt1: cmpw %dx, %si # Scan all modes | ||
988 | jz cmt2 | ||
989 | |||
990 | leaw modelist, %bx # Find in previous entries | ||
991 | movw 2(%si), %cx | ||
992 | cmt3: cmpw %bx, %si | ||
993 | jz cmt4 | ||
994 | |||
995 | cmpw 2(%bx), %cx # Found => don't copy this entry | ||
996 | jz cmt5 | ||
997 | |||
998 | addw $4, %bx | ||
999 | jmp cmt3 | ||
1000 | |||
1001 | cmt4: movsl # Copy entry | ||
1002 | jmp cmt1 | ||
1003 | |||
1004 | cmt5: addw $4, %si # Skip entry | ||
1005 | jmp cmt1 | ||
1006 | |||
1007 | cmt2: | ||
1008 | #endif /* CONFIG_VIDEO_COMPACT */ | ||
1009 | |||
1010 | movw $ASK_VGA, (%di) # End marker | ||
1011 | movw %di, mt_end | ||
1012 | mtab1: leaw modelist, %si # SI=mode list, DI=list end | ||
1013 | ret0: ret | ||
1014 | |||
1015 | # Modes usable on all standard VGAs | ||
1016 | vga_modes: | ||
1017 | .word VIDEO_8POINT | ||
1018 | .word 0x5032 # 80x50 | ||
1019 | .word VIDEO_80x43 | ||
1020 | .word 0x502b # 80x43 | ||
1021 | .word VIDEO_80x28 | ||
1022 | .word 0x501c # 80x28 | ||
1023 | .word VIDEO_80x30 | ||
1024 | .word 0x501e # 80x30 | ||
1025 | .word VIDEO_80x34 | ||
1026 | .word 0x5022 # 80x34 | ||
1027 | .word VIDEO_80x60 | ||
1028 | .word 0x503c # 80x60 | ||
1029 | #ifdef CONFIG_VIDEO_GFX_HACK | ||
1030 | .word VIDEO_GFX_HACK | ||
1031 | .word VIDEO_GFX_DUMMY_RESOLUTION | ||
1032 | #endif | ||
1033 | |||
1034 | vga_modes_end: | ||
1035 | # Detect VESA modes. | ||
1036 | |||
1037 | #ifdef CONFIG_VIDEO_VESA | ||
1038 | vesa_modes: | ||
1039 | cmpb $2, adapter # VGA only | ||
1040 | jnz ret0 | ||
1041 | |||
1042 | movw %di, %bp # BP=original mode table end | ||
1043 | addw $0x200, %di # Buffer space | ||
1044 | movw $0x4f00, %ax # VESA Get card info call | ||
1045 | int $0x10 | ||
1046 | movw %bp, %di | ||
1047 | cmpw $0x004f, %ax # Successful? | ||
1048 | jnz ret0 | ||
1049 | |||
1050 | cmpw $0x4556, 0x200(%di) | ||
1051 | jnz ret0 | ||
1052 | |||
1053 | cmpw $0x4153, 0x202(%di) | ||
1054 | jnz ret0 | ||
1055 | |||
1056 | movw $vesa_name, card_name # Set name to "VESA VGA" | ||
1057 | pushw %gs | ||
1058 | lgsw 0x20e(%di), %si # GS:SI=mode list | ||
1059 | movw $128, %cx # Iteration limit | ||
1060 | vesa1: | ||
1061 | # gas version 2.9.1, using BFD version 2.9.1.0.23 buggers the next inst. | ||
1062 | # XXX: lodsw %gs:(%si), %ax # Get next mode in the list | ||
1063 | gs; lodsw | ||
1064 | cmpw $0xffff, %ax # End of the table? | ||
1065 | jz vesar | ||
1066 | |||
1067 | cmpw $0x0080, %ax # Check validity of mode ID | ||
1068 | jc vesa2 | ||
1069 | |||
1070 | orb %ah, %ah # Valid IDs: 0x0000-0x007f/0x0100-0x07ff | ||
1071 | jz vesan # Certain BIOSes report 0x80-0xff! | ||
1072 | |||
1073 | cmpw $0x0800, %ax | ||
1074 | jnc vesae | ||
1075 | |||
1076 | vesa2: pushw %cx | ||
1077 | movw %ax, %cx # Get mode information structure | ||
1078 | movw $0x4f01, %ax | ||
1079 | int $0x10 | ||
1080 | movw %cx, %bx # BX=mode number | ||
1081 | addb $VIDEO_FIRST_VESA>>8, %bh | ||
1082 | popw %cx | ||
1083 | cmpw $0x004f, %ax | ||
1084 | jnz vesan # Don't report errors (buggy BIOSES) | ||
1085 | |||
1086 | movb (%di), %al # Check capabilities. We require | ||
1087 | andb $0x19, %al # a color text mode. | ||
1088 | cmpb $0x09, %al | ||
1089 | jnz vesan | ||
1090 | |||
1091 | cmpw $0xb800, 8(%di) # Standard video memory address required | ||
1092 | jnz vesan | ||
1093 | |||
1094 | testb $2, (%di) # Mode characteristics supplied? | ||
1095 | movw %bx, (%di) # Store mode number | ||
1096 | jz vesa3 | ||
1097 | |||
1098 | xorw %dx, %dx | ||
1099 | movw 0x12(%di), %bx # Width | ||
1100 | orb %bh, %bh | ||
1101 | jnz vesan | ||
1102 | |||
1103 | movb %bl, 0x3(%di) | ||
1104 | movw 0x14(%di), %ax # Height | ||
1105 | orb %ah, %ah | ||
1106 | jnz vesan | ||
1107 | |||
1108 | movb %al, 2(%di) | ||
1109 | mulb %bl | ||
1110 | cmpw $8193, %ax # Small enough for Linux console driver? | ||
1111 | jnc vesan | ||
1112 | |||
1113 | jmp vesaok | ||
1114 | |||
1115 | vesa3: subw $0x8108, %bx # This mode has no detailed info specified, | ||
1116 | jc vesan # so it must be a standard VESA mode. | ||
1117 | |||
1118 | cmpw $5, %bx | ||
1119 | jnc vesan | ||
1120 | |||
1121 | movw vesa_text_mode_table(%bx), %ax | ||
1122 | movw %ax, 2(%di) | ||
1123 | vesaok: addw $4, %di # The mode is valid. Store it. | ||
1124 | vesan: loop vesa1 # Next mode. Limit exceeded => error | ||
1125 | vesae: leaw vesaer, %si | ||
1126 | call prtstr | ||
1127 | movw %bp, %di # Discard already found modes. | ||
1128 | vesar: popw %gs | ||
1129 | ret | ||
1130 | |||
1131 | # Dimensions of standard VESA text modes | ||
1132 | vesa_text_mode_table: | ||
1133 | .byte 60, 80 # 0108 | ||
1134 | .byte 25, 132 # 0109 | ||
1135 | .byte 43, 132 # 010A | ||
1136 | .byte 50, 132 # 010B | ||
1137 | .byte 60, 132 # 010C | ||
1138 | #endif /* CONFIG_VIDEO_VESA */ | ||
1139 | |||
1140 | # Scan for video modes. A bit dirty, but should work. | ||
1141 | mode_scan: | ||
1142 | movw $0x0100, %cx # Start with mode 0 | ||
1143 | scm1: movb $0, %ah # Test the mode | ||
1144 | movb %cl, %al | ||
1145 | int $0x10 | ||
1146 | movb $0x0f, %ah | ||
1147 | int $0x10 | ||
1148 | cmpb %cl, %al | ||
1149 | jnz scm2 # Mode not set | ||
1150 | |||
1151 | movw $0x3c0, %dx # Test if it's a text mode | ||
1152 | movb $0x10, %al # Mode bits | ||
1153 | call inidx | ||
1154 | andb $0x03, %al | ||
1155 | jnz scm2 | ||
1156 | |||
1157 | movb $0xce, %dl # Another set of mode bits | ||
1158 | movb $0x06, %al | ||
1159 | call inidx | ||
1160 | shrb %al | ||
1161 | jc scm2 | ||
1162 | |||
1163 | movb $0xd4, %dl # Cursor location | ||
1164 | movb $0x0f, %al | ||
1165 | call inidx | ||
1166 | orb %al, %al | ||
1167 | jnz scm2 | ||
1168 | |||
1169 | movw %cx, %ax # Ok, store the mode | ||
1170 | stosw | ||
1171 | movb %gs:(0x484), %al # Number of rows | ||
1172 | incb %al | ||
1173 | stosb | ||
1174 | movw %gs:(0x44a), %ax # Number of columns | ||
1175 | stosb | ||
1176 | scm2: incb %cl | ||
1177 | jns scm1 | ||
1178 | |||
1179 | movw $0x0003, %ax # Return back to mode 3 | ||
1180 | int $0x10 | ||
1181 | ret | ||
1182 | |||
1183 | tstidx: outw %ax, %dx # OUT DX,AX and inidx | ||
1184 | inidx: outb %al, %dx # Read from indexed VGA register | ||
1185 | incw %dx # AL=index, DX=index reg port -> AL=data | ||
1186 | inb %dx, %al | ||
1187 | decw %dx | ||
1188 | ret | ||
1189 | |||
1190 | # Try to detect type of SVGA card and supply (usually approximate) video | ||
1191 | # mode table for it. | ||
1192 | |||
1193 | #ifdef CONFIG_VIDEO_SVGA | ||
1194 | svga_modes: | ||
1195 | leaw svga_table, %si # Test all known SVGA adapters | ||
1196 | dosvga: lodsw | ||
1197 | movw %ax, %bp # Default mode table | ||
1198 | orw %ax, %ax | ||
1199 | jz didsv1 | ||
1200 | |||
1201 | lodsw # Pointer to test routine | ||
1202 | pushw %si | ||
1203 | pushw %di | ||
1204 | pushw %es | ||
1205 | movw $0xc000, %bx | ||
1206 | movw %bx, %es | ||
1207 | call *%ax # Call test routine | ||
1208 | popw %es | ||
1209 | popw %di | ||
1210 | popw %si | ||
1211 | orw %bp, %bp | ||
1212 | jz dosvga | ||
1213 | |||
1214 | movw %bp, %si # Found, copy the modes | ||
1215 | movb svga_prefix, %ah | ||
1216 | cpsvga: lodsb | ||
1217 | orb %al, %al | ||
1218 | jz didsv | ||
1219 | |||
1220 | stosw | ||
1221 | movsw | ||
1222 | jmp cpsvga | ||
1223 | |||
1224 | didsv: movw %si, card_name # Store pointer to card name | ||
1225 | didsv1: ret | ||
1226 | |||
1227 | # Table of all known SVGA cards. For each card, we store a pointer to | ||
1228 | # a table of video modes supported by the card and a pointer to a routine | ||
1229 | # used for testing of presence of the card. The video mode table is always | ||
1230 | # followed by the name of the card or the chipset. | ||
1231 | svga_table: | ||
1232 | .word ati_md, ati_test | ||
1233 | .word oak_md, oak_test | ||
1234 | .word paradise_md, paradise_test | ||
1235 | .word realtek_md, realtek_test | ||
1236 | .word s3_md, s3_test | ||
1237 | .word chips_md, chips_test | ||
1238 | .word video7_md, video7_test | ||
1239 | .word cirrus5_md, cirrus5_test | ||
1240 | .word cirrus6_md, cirrus6_test | ||
1241 | .word cirrus1_md, cirrus1_test | ||
1242 | .word ahead_md, ahead_test | ||
1243 | .word everex_md, everex_test | ||
1244 | .word genoa_md, genoa_test | ||
1245 | .word trident_md, trident_test | ||
1246 | .word tseng_md, tseng_test | ||
1247 | .word 0 | ||
1248 | |||
1249 | # Test routines and mode tables: | ||
1250 | |||
1251 | # S3 - The test algorithm was taken from the SuperProbe package | ||
1252 | # for XFree86 1.2.1. Report bugs to Christoph.Niemann@linux.org | ||
1253 | s3_test: | ||
1254 | movw $0x0f35, %cx # we store some constants in cl/ch | ||
1255 | movw $0x03d4, %dx | ||
1256 | movb $0x38, %al | ||
1257 | call inidx | ||
1258 | movb %al, %bh # store current CRT-register 0x38 | ||
1259 | movw $0x0038, %ax | ||
1260 | call outidx # disable writing to special regs | ||
1261 | movb %cl, %al # check whether we can write special reg 0x35 | ||
1262 | call inidx | ||
1263 | movb %al, %bl # save the current value of CRT reg 0x35 | ||
1264 | andb $0xf0, %al # clear bits 0-3 | ||
1265 | movb %al, %ah | ||
1266 | movb %cl, %al # and write it to CRT reg 0x35 | ||
1267 | call outidx | ||
1268 | call inidx # now read it back | ||
1269 | andb %ch, %al # clear the upper 4 bits | ||
1270 | jz s3_2 # the first test failed. But we have a | ||
1271 | |||
1272 | movb %bl, %ah # second chance | ||
1273 | movb %cl, %al | ||
1274 | call outidx | ||
1275 | jmp s3_1 # do the other tests | ||
1276 | |||
1277 | s3_2: movw %cx, %ax # load ah with 0xf and al with 0x35 | ||
1278 | orb %bl, %ah # set the upper 4 bits of ah with the orig value | ||
1279 | call outidx # write ... | ||
1280 | call inidx # ... and reread | ||
1281 | andb %cl, %al # turn off the upper 4 bits | ||
1282 | pushw %ax | ||
1283 | movb %bl, %ah # restore old value in register 0x35 | ||
1284 | movb %cl, %al | ||
1285 | call outidx | ||
1286 | popw %ax | ||
1287 | cmpb %ch, %al # setting lower 4 bits was successful => bad | ||
1288 | je no_s3 # writing is allowed => this is not an S3 | ||
1289 | |||
1290 | s3_1: movw $0x4838, %ax # allow writing to special regs by putting | ||
1291 | call outidx # magic number into CRT-register 0x38 | ||
1292 | movb %cl, %al # check whether we can write special reg 0x35 | ||
1293 | call inidx | ||
1294 | movb %al, %bl | ||
1295 | andb $0xf0, %al | ||
1296 | movb %al, %ah | ||
1297 | movb %cl, %al | ||
1298 | call outidx | ||
1299 | call inidx | ||
1300 | andb %ch, %al | ||
1301 | jnz no_s3 # no, we can't write => no S3 | ||
1302 | |||
1303 | movw %cx, %ax | ||
1304 | orb %bl, %ah | ||
1305 | call outidx | ||
1306 | call inidx | ||
1307 | andb %ch, %al | ||
1308 | pushw %ax | ||
1309 | movb %bl, %ah # restore old value in register 0x35 | ||
1310 | movb %cl, %al | ||
1311 | call outidx | ||
1312 | popw %ax | ||
1313 | cmpb %ch, %al | ||
1314 | jne no_s31 # writing not possible => no S3 | ||
1315 | movb $0x30, %al | ||
1316 | call inidx # now get the S3 id ... | ||
1317 | leaw idS3, %di | ||
1318 | movw $0x10, %cx | ||
1319 | repne | ||
1320 | scasb | ||
1321 | je no_s31 | ||
1322 | |||
1323 | movb %bh, %ah | ||
1324 | movb $0x38, %al | ||
1325 | jmp s3rest | ||
1326 | |||
1327 | no_s3: movb $0x35, %al # restore CRT register 0x35 | ||
1328 | movb %bl, %ah | ||
1329 | call outidx | ||
1330 | no_s31: xorw %bp, %bp # Detection failed | ||
1331 | s3rest: movb %bh, %ah | ||
1332 | movb $0x38, %al # restore old value of CRT register 0x38 | ||
1333 | jmp outidx | ||
1334 | |||
1335 | idS3: .byte 0x81, 0x82, 0x90, 0x91, 0x92, 0x93, 0x94, 0x95 | ||
1336 | .byte 0xa0, 0xa1, 0xa2, 0xa3, 0xa4, 0xa5, 0xa8, 0xb0 | ||
1337 | |||
1338 | s3_md: .byte 0x54, 0x2b, 0x84 | ||
1339 | .byte 0x55, 0x19, 0x84 | ||
1340 | .byte 0 | ||
1341 | .ascii "S3" | ||
1342 | .byte 0 | ||
1343 | |||
1344 | # ATI cards. | ||
1345 | ati_test: | ||
1346 | leaw idati, %si | ||
1347 | movw $0x31, %di | ||
1348 | movw $0x09, %cx | ||
1349 | repe | ||
1350 | cmpsb | ||
1351 | je atiok | ||
1352 | |||
1353 | xorw %bp, %bp | ||
1354 | atiok: ret | ||
1355 | |||
1356 | idati: .ascii "761295520" | ||
1357 | |||
1358 | ati_md: .byte 0x23, 0x19, 0x84 | ||
1359 | .byte 0x33, 0x2c, 0x84 | ||
1360 | .byte 0x22, 0x1e, 0x64 | ||
1361 | .byte 0x21, 0x19, 0x64 | ||
1362 | .byte 0x58, 0x21, 0x50 | ||
1363 | .byte 0x5b, 0x1e, 0x50 | ||
1364 | .byte 0 | ||
1365 | .ascii "ATI" | ||
1366 | .byte 0 | ||
1367 | |||
1368 | # AHEAD | ||
1369 | ahead_test: | ||
1370 | movw $0x200f, %ax | ||
1371 | movw $0x3ce, %dx | ||
1372 | outw %ax, %dx | ||
1373 | incw %dx | ||
1374 | inb %dx, %al | ||
1375 | cmpb $0x20, %al | ||
1376 | je isahed | ||
1377 | |||
1378 | cmpb $0x21, %al | ||
1379 | je isahed | ||
1380 | |||
1381 | xorw %bp, %bp | ||
1382 | isahed: ret | ||
1383 | |||
1384 | ahead_md: | ||
1385 | .byte 0x22, 0x2c, 0x84 | ||
1386 | .byte 0x23, 0x19, 0x84 | ||
1387 | .byte 0x24, 0x1c, 0x84 | ||
1388 | .byte 0x2f, 0x32, 0xa0 | ||
1389 | .byte 0x32, 0x22, 0x50 | ||
1390 | .byte 0x34, 0x42, 0x50 | ||
1391 | .byte 0 | ||
1392 | .ascii "Ahead" | ||
1393 | .byte 0 | ||
1394 | |||
1395 | # Chips & Tech. | ||
1396 | chips_test: | ||
1397 | movw $0x3c3, %dx | ||
1398 | inb %dx, %al | ||
1399 | orb $0x10, %al | ||
1400 | outb %al, %dx | ||
1401 | movw $0x104, %dx | ||
1402 | inb %dx, %al | ||
1403 | movb %al, %bl | ||
1404 | movw $0x3c3, %dx | ||
1405 | inb %dx, %al | ||
1406 | andb $0xef, %al | ||
1407 | outb %al, %dx | ||
1408 | cmpb $0xa5, %bl | ||
1409 | je cantok | ||
1410 | |||
1411 | xorw %bp, %bp | ||
1412 | cantok: ret | ||
1413 | |||
1414 | chips_md: | ||
1415 | .byte 0x60, 0x19, 0x84 | ||
1416 | .byte 0x61, 0x32, 0x84 | ||
1417 | .byte 0 | ||
1418 | .ascii "Chips & Technologies" | ||
1419 | .byte 0 | ||
1420 | |||
1421 | # Cirrus Logic 5X0 | ||
1422 | cirrus1_test: | ||
1423 | movw $0x3d4, %dx | ||
1424 | movb $0x0c, %al | ||
1425 | outb %al, %dx | ||
1426 | incw %dx | ||
1427 | inb %dx, %al | ||
1428 | movb %al, %bl | ||
1429 | xorb %al, %al | ||
1430 | outb %al, %dx | ||
1431 | decw %dx | ||
1432 | movb $0x1f, %al | ||
1433 | outb %al, %dx | ||
1434 | incw %dx | ||
1435 | inb %dx, %al | ||
1436 | movb %al, %bh | ||
1437 | xorb %ah, %ah | ||
1438 | shlb $4, %al | ||
1439 | movw %ax, %cx | ||
1440 | movb %bh, %al | ||
1441 | shrb $4, %al | ||
1442 | addw %ax, %cx | ||
1443 | shlw $8, %cx | ||
1444 | addw $6, %cx | ||
1445 | movw %cx, %ax | ||
1446 | movw $0x3c4, %dx | ||
1447 | outw %ax, %dx | ||
1448 | incw %dx | ||
1449 | inb %dx, %al | ||
1450 | andb %al, %al | ||
1451 | jnz nocirr | ||
1452 | |||
1453 | movb %bh, %al | ||
1454 | outb %al, %dx | ||
1455 | inb %dx, %al | ||
1456 | cmpb $0x01, %al | ||
1457 | je iscirr | ||
1458 | |||
1459 | nocirr: xorw %bp, %bp | ||
1460 | iscirr: movw $0x3d4, %dx | ||
1461 | movb %bl, %al | ||
1462 | xorb %ah, %ah | ||
1463 | shlw $8, %ax | ||
1464 | addw $0x0c, %ax | ||
1465 | outw %ax, %dx | ||
1466 | ret | ||
1467 | |||
1468 | cirrus1_md: | ||
1469 | .byte 0x1f, 0x19, 0x84 | ||
1470 | .byte 0x20, 0x2c, 0x84 | ||
1471 | .byte 0x22, 0x1e, 0x84 | ||
1472 | .byte 0x31, 0x25, 0x64 | ||
1473 | .byte 0 | ||
1474 | .ascii "Cirrus Logic 5X0" | ||
1475 | .byte 0 | ||
1476 | |||
1477 | # Cirrus Logic 54XX | ||
1478 | cirrus5_test: | ||
1479 | movw $0x3c4, %dx | ||
1480 | movb $6, %al | ||
1481 | call inidx | ||
1482 | movb %al, %bl # BL=backup | ||
1483 | movw $6, %ax | ||
1484 | call tstidx | ||
1485 | cmpb $0x0f, %al | ||
1486 | jne c5fail | ||
1487 | |||
1488 | movw $0x1206, %ax | ||
1489 | call tstidx | ||
1490 | cmpb $0x12, %al | ||
1491 | jne c5fail | ||
1492 | |||
1493 | movb $0x1e, %al | ||
1494 | call inidx | ||
1495 | movb %al, %bh | ||
1496 | movb %bh, %ah | ||
1497 | andb $0xc0, %ah | ||
1498 | movb $0x1e, %al | ||
1499 | call tstidx | ||
1500 | andb $0x3f, %al | ||
1501 | jne c5xx | ||
1502 | |||
1503 | movb $0x1e, %al | ||
1504 | movb %bh, %ah | ||
1505 | orb $0x3f, %ah | ||
1506 | call tstidx | ||
1507 | xorb $0x3f, %al | ||
1508 | andb $0x3f, %al | ||
1509 | c5xx: pushf | ||
1510 | movb $0x1e, %al | ||
1511 | movb %bh, %ah | ||
1512 | outw %ax, %dx | ||
1513 | popf | ||
1514 | je c5done | ||
1515 | |||
1516 | c5fail: xorw %bp, %bp | ||
1517 | c5done: movb $6, %al | ||
1518 | movb %bl, %ah | ||
1519 | outw %ax, %dx | ||
1520 | ret | ||
1521 | |||
1522 | cirrus5_md: | ||
1523 | .byte 0x14, 0x19, 0x84 | ||
1524 | .byte 0x54, 0x2b, 0x84 | ||
1525 | .byte 0 | ||
1526 | .ascii "Cirrus Logic 54XX" | ||
1527 | .byte 0 | ||
1528 | |||
1529 | # Cirrus Logic 64XX -- no known extra modes, but must be identified, because | ||
1530 | # it's misidentified by the Ahead test. | ||
1531 | cirrus6_test: | ||
1532 | movw $0x3ce, %dx | ||
1533 | movb $0x0a, %al | ||
1534 | call inidx | ||
1535 | movb %al, %bl # BL=backup | ||
1536 | movw $0xce0a, %ax | ||
1537 | call tstidx | ||
1538 | orb %al, %al | ||
1539 | jne c2fail | ||
1540 | |||
1541 | movw $0xec0a, %ax | ||
1542 | call tstidx | ||
1543 | cmpb $0x01, %al | ||
1544 | jne c2fail | ||
1545 | |||
1546 | movb $0xaa, %al | ||
1547 | call inidx # 4X, 5X, 7X and 8X are valid 64XX chip ID's. | ||
1548 | shrb $4, %al | ||
1549 | subb $4, %al | ||
1550 | jz c6done | ||
1551 | |||
1552 | decb %al | ||
1553 | jz c6done | ||
1554 | |||
1555 | subb $2, %al | ||
1556 | jz c6done | ||
1557 | |||
1558 | decb %al | ||
1559 | jz c6done | ||
1560 | |||
1561 | c2fail: xorw %bp, %bp | ||
1562 | c6done: movb $0x0a, %al | ||
1563 | movb %bl, %ah | ||
1564 | outw %ax, %dx | ||
1565 | ret | ||
1566 | |||
1567 | cirrus6_md: | ||
1568 | .byte 0 | ||
1569 | .ascii "Cirrus Logic 64XX" | ||
1570 | .byte 0 | ||
1571 | |||
1572 | # Everex / Trident | ||
1573 | everex_test: | ||
1574 | movw $0x7000, %ax | ||
1575 | xorw %bx, %bx | ||
1576 | int $0x10 | ||
1577 | cmpb $0x70, %al | ||
1578 | jne noevrx | ||
1579 | |||
1580 | shrw $4, %dx | ||
1581 | cmpw $0x678, %dx | ||
1582 | je evtrid | ||
1583 | |||
1584 | cmpw $0x236, %dx | ||
1585 | jne evrxok | ||
1586 | |||
1587 | evtrid: leaw trident_md, %bp | ||
1588 | evrxok: ret | ||
1589 | |||
1590 | noevrx: xorw %bp, %bp | ||
1591 | ret | ||
1592 | |||
1593 | everex_md: | ||
1594 | .byte 0x03, 0x22, 0x50 | ||
1595 | .byte 0x04, 0x3c, 0x50 | ||
1596 | .byte 0x07, 0x2b, 0x64 | ||
1597 | .byte 0x08, 0x4b, 0x64 | ||
1598 | .byte 0x0a, 0x19, 0x84 | ||
1599 | .byte 0x0b, 0x2c, 0x84 | ||
1600 | .byte 0x16, 0x1e, 0x50 | ||
1601 | .byte 0x18, 0x1b, 0x64 | ||
1602 | .byte 0x21, 0x40, 0xa0 | ||
1603 | .byte 0x40, 0x1e, 0x84 | ||
1604 | .byte 0 | ||
1605 | .ascii "Everex/Trident" | ||
1606 | .byte 0 | ||
1607 | |||
1608 | # Genoa. | ||
1609 | genoa_test: | ||
1610 | leaw idgenoa, %si # Check Genoa 'clues' | ||
1611 | xorw %ax, %ax | ||
1612 | movb %es:(0x37), %al | ||
1613 | movw %ax, %di | ||
1614 | movw $0x04, %cx | ||
1615 | decw %si | ||
1616 | decw %di | ||
1617 | l1: incw %si | ||
1618 | incw %di | ||
1619 | movb (%si), %al | ||
1620 | testb %al, %al | ||
1621 | jz l2 | ||
1622 | |||
1623 | cmpb %es:(%di), %al | ||
1624 | l2: loope l1 | ||
1625 | orw %cx, %cx | ||
1626 | je isgen | ||
1627 | |||
1628 | xorw %bp, %bp | ||
1629 | isgen: ret | ||
1630 | |||
1631 | idgenoa: .byte 0x77, 0x00, 0x99, 0x66 | ||
1632 | |||
1633 | genoa_md: | ||
1634 | .byte 0x58, 0x20, 0x50 | ||
1635 | .byte 0x5a, 0x2a, 0x64 | ||
1636 | .byte 0x60, 0x19, 0x84 | ||
1637 | .byte 0x61, 0x1d, 0x84 | ||
1638 | .byte 0x62, 0x20, 0x84 | ||
1639 | .byte 0x63, 0x2c, 0x84 | ||
1640 | .byte 0x64, 0x3c, 0x84 | ||
1641 | .byte 0x6b, 0x4f, 0x64 | ||
1642 | .byte 0x72, 0x3c, 0x50 | ||
1643 | .byte 0x74, 0x42, 0x50 | ||
1644 | .byte 0x78, 0x4b, 0x64 | ||
1645 | .byte 0 | ||
1646 | .ascii "Genoa" | ||
1647 | .byte 0 | ||
1648 | |||
1649 | # OAK | ||
1650 | oak_test: | ||
1651 | leaw idoakvga, %si | ||
1652 | movw $0x08, %di | ||
1653 | movw $0x08, %cx | ||
1654 | repe | ||
1655 | cmpsb | ||
1656 | je isoak | ||
1657 | |||
1658 | xorw %bp, %bp | ||
1659 | isoak: ret | ||
1660 | |||
1661 | idoakvga: .ascii "OAK VGA " | ||
1662 | |||
1663 | oak_md: .byte 0x4e, 0x3c, 0x50 | ||
1664 | .byte 0x4f, 0x3c, 0x84 | ||
1665 | .byte 0x50, 0x19, 0x84 | ||
1666 | .byte 0x51, 0x2b, 0x84 | ||
1667 | .byte 0 | ||
1668 | .ascii "OAK" | ||
1669 | .byte 0 | ||
1670 | |||
1671 | # WD Paradise. | ||
1672 | paradise_test: | ||
1673 | leaw idparadise, %si | ||
1674 | movw $0x7d, %di | ||
1675 | movw $0x04, %cx | ||
1676 | repe | ||
1677 | cmpsb | ||
1678 | je ispara | ||
1679 | |||
1680 | xorw %bp, %bp | ||
1681 | ispara: ret | ||
1682 | |||
1683 | idparadise: .ascii "VGA=" | ||
1684 | |||
1685 | paradise_md: | ||
1686 | .byte 0x41, 0x22, 0x50 | ||
1687 | .byte 0x47, 0x1c, 0x84 | ||
1688 | .byte 0x55, 0x19, 0x84 | ||
1689 | .byte 0x54, 0x2c, 0x84 | ||
1690 | .byte 0 | ||
1691 | .ascii "Paradise" | ||
1692 | .byte 0 | ||
1693 | |||
1694 | # Trident. | ||
1695 | trident_test: | ||
1696 | movw $0x3c4, %dx | ||
1697 | movb $0x0e, %al | ||
1698 | outb %al, %dx | ||
1699 | incw %dx | ||
1700 | inb %dx, %al | ||
1701 | xchgb %al, %ah | ||
1702 | xorb %al, %al | ||
1703 | outb %al, %dx | ||
1704 | inb %dx, %al | ||
1705 | xchgb %ah, %al | ||
1706 | movb %al, %bl # Strange thing ... in the book this wasn't | ||
1707 | andb $0x02, %bl # necessary but it worked on my card which | ||
1708 | jz setb2 # is a trident. Without it the screen goes | ||
1709 | # blurred ... | ||
1710 | andb $0xfd, %al | ||
1711 | jmp clrb2 | ||
1712 | |||
1713 | setb2: orb $0x02, %al | ||
1714 | clrb2: outb %al, %dx | ||
1715 | andb $0x0f, %ah | ||
1716 | cmpb $0x02, %ah | ||
1717 | je istrid | ||
1718 | |||
1719 | xorw %bp, %bp | ||
1720 | istrid: ret | ||
1721 | |||
1722 | trident_md: | ||
1723 | .byte 0x50, 0x1e, 0x50 | ||
1724 | .byte 0x51, 0x2b, 0x50 | ||
1725 | .byte 0x52, 0x3c, 0x50 | ||
1726 | .byte 0x57, 0x19, 0x84 | ||
1727 | .byte 0x58, 0x1e, 0x84 | ||
1728 | .byte 0x59, 0x2b, 0x84 | ||
1729 | .byte 0x5a, 0x3c, 0x84 | ||
1730 | .byte 0 | ||
1731 | .ascii "Trident" | ||
1732 | .byte 0 | ||
1733 | |||
1734 | # Tseng. | ||
1735 | tseng_test: | ||
1736 | movw $0x3cd, %dx | ||
1737 | inb %dx, %al # Could things be this simple ! :-) | ||
1738 | movb %al, %bl | ||
1739 | movb $0x55, %al | ||
1740 | outb %al, %dx | ||
1741 | inb %dx, %al | ||
1742 | movb %al, %ah | ||
1743 | movb %bl, %al | ||
1744 | outb %al, %dx | ||
1745 | cmpb $0x55, %ah | ||
1746 | je istsen | ||
1747 | |||
1748 | isnot: xorw %bp, %bp | ||
1749 | istsen: ret | ||
1750 | |||
1751 | tseng_md: | ||
1752 | .byte 0x26, 0x3c, 0x50 | ||
1753 | .byte 0x2a, 0x28, 0x64 | ||
1754 | .byte 0x23, 0x19, 0x84 | ||
1755 | .byte 0x24, 0x1c, 0x84 | ||
1756 | .byte 0x22, 0x2c, 0x84 | ||
1757 | .byte 0x21, 0x3c, 0x84 | ||
1758 | .byte 0 | ||
1759 | .ascii "Tseng" | ||
1760 | .byte 0 | ||
1761 | |||
1762 | # Video7. | ||
1763 | video7_test: | ||
1764 | movw $0x3cc, %dx | ||
1765 | inb %dx, %al | ||
1766 | movw $0x3b4, %dx | ||
1767 | andb $0x01, %al | ||
1768 | jz even7 | ||
1769 | |||
1770 | movw $0x3d4, %dx | ||
1771 | even7: movb $0x0c, %al | ||
1772 | outb %al, %dx | ||
1773 | incw %dx | ||
1774 | inb %dx, %al | ||
1775 | movb %al, %bl | ||
1776 | movb $0x55, %al | ||
1777 | outb %al, %dx | ||
1778 | inb %dx, %al | ||
1779 | decw %dx | ||
1780 | movb $0x1f, %al | ||
1781 | outb %al, %dx | ||
1782 | incw %dx | ||
1783 | inb %dx, %al | ||
1784 | movb %al, %bh | ||
1785 | decw %dx | ||
1786 | movb $0x0c, %al | ||
1787 | outb %al, %dx | ||
1788 | incw %dx | ||
1789 | movb %bl, %al | ||
1790 | outb %al, %dx | ||
1791 | movb $0x55, %al | ||
1792 | xorb $0xea, %al | ||
1793 | cmpb %bh, %al | ||
1794 | jne isnot | ||
1795 | |||
1796 | movb $VIDEO_FIRST_V7>>8, svga_prefix # Use special mode switching | ||
1797 | ret | ||
1798 | |||
1799 | video7_md: | ||
1800 | .byte 0x40, 0x2b, 0x50 | ||
1801 | .byte 0x43, 0x3c, 0x50 | ||
1802 | .byte 0x44, 0x3c, 0x64 | ||
1803 | .byte 0x41, 0x19, 0x84 | ||
1804 | .byte 0x42, 0x2c, 0x84 | ||
1805 | .byte 0x45, 0x1c, 0x84 | ||
1806 | .byte 0 | ||
1807 | .ascii "Video 7" | ||
1808 | .byte 0 | ||
1809 | |||
1810 | # Realtek VGA | ||
1811 | realtek_test: | ||
1812 | leaw idrtvga, %si | ||
1813 | movw $0x45, %di | ||
1814 | movw $0x0b, %cx | ||
1815 | repe | ||
1816 | cmpsb | ||
1817 | je isrt | ||
1818 | |||
1819 | xorw %bp, %bp | ||
1820 | isrt: ret | ||
1821 | |||
1822 | idrtvga: .ascii "REALTEK VGA" | ||
1823 | |||
1824 | realtek_md: | ||
1825 | .byte 0x1a, 0x3c, 0x50 | ||
1826 | .byte 0x1b, 0x19, 0x84 | ||
1827 | .byte 0x1c, 0x1e, 0x84 | ||
1828 | .byte 0x1d, 0x2b, 0x84 | ||
1829 | .byte 0x1e, 0x3c, 0x84 | ||
1830 | .byte 0 | ||
1831 | .ascii "REALTEK" | ||
1832 | .byte 0 | ||
1833 | |||
1834 | #endif /* CONFIG_VIDEO_SVGA */ | ||
1835 | |||
1836 | # User-defined local mode table (VGA only) | ||
1837 | #ifdef CONFIG_VIDEO_LOCAL | ||
1838 | local_modes: | ||
1839 | leaw local_mode_table, %si | ||
1840 | locm1: lodsw | ||
1841 | orw %ax, %ax | ||
1842 | jz locm2 | ||
1843 | |||
1844 | stosw | ||
1845 | movsw | ||
1846 | jmp locm1 | ||
1847 | |||
1848 | locm2: ret | ||
1849 | |||
1850 | # This is the table of local video modes which can be supplied manually | ||
1851 | # by the user. Each entry consists of mode ID (word) and dimensions | ||
1852 | # (byte for column count and another byte for row count). These modes | ||
1853 | # are placed before all SVGA and VESA modes and override them if table | ||
1854 | # compacting is enabled. The table must end with a zero word followed | ||
1855 | # by NUL-terminated video adapter name. | ||
1856 | local_mode_table: | ||
1857 | .word 0x0100 # Example: 40x25 | ||
1858 | .byte 25,40 | ||
1859 | .word 0 | ||
1860 | .ascii "Local" | ||
1861 | .byte 0 | ||
1862 | #endif /* CONFIG_VIDEO_LOCAL */ | ||
1863 | |||
1864 | # Read a key and return the ASCII code in al, scan code in ah | ||
1865 | getkey: xorb %ah, %ah | ||
1866 | int $0x16 | ||
1867 | ret | ||
1868 | |||
1869 | # Read a key with a timeout of 30 seconds. | ||
1870 | # The hardware clock is used to get the time. | ||
1871 | getkt: call gettime | ||
1872 | addb $30, %al # Wait 30 seconds | ||
1873 | cmpb $60, %al | ||
1874 | jl lminute | ||
1875 | |||
1876 | subb $60, %al | ||
1877 | lminute: | ||
1878 | movb %al, %cl | ||
1879 | again: movb $0x01, %ah | ||
1880 | int $0x16 | ||
1881 | jnz getkey # key pressed, so get it | ||
1882 | |||
1883 | call gettime | ||
1884 | cmpb %cl, %al | ||
1885 | jne again | ||
1886 | |||
1887 | movb $0x20, %al # timeout, return `space' | ||
1888 | ret | ||
1889 | |||
1890 | # Flush the keyboard buffer | ||
1891 | flush: movb $0x01, %ah | ||
1892 | int $0x16 | ||
1893 | jz empty | ||
1894 | |||
1895 | xorb %ah, %ah | ||
1896 | int $0x16 | ||
1897 | jmp flush | ||
1898 | |||
1899 | empty: ret | ||
1900 | |||
1901 | # Print hexadecimal number. | ||
1902 | prthw: pushw %ax | ||
1903 | movb %ah, %al | ||
1904 | call prthb | ||
1905 | popw %ax | ||
1906 | prthb: pushw %ax | ||
1907 | shrb $4, %al | ||
1908 | call prthn | ||
1909 | popw %ax | ||
1910 | andb $0x0f, %al | ||
1911 | prthn: cmpb $0x0a, %al | ||
1912 | jc prth1 | ||
1913 | |||
1914 | addb $0x07, %al | ||
1915 | prth1: addb $0x30, %al | ||
1916 | jmp prtchr | ||
1917 | |||
1918 | # Print decimal number in al | ||
1919 | prtdec: pushw %ax | ||
1920 | pushw %cx | ||
1921 | xorb %ah, %ah | ||
1922 | movb $0x0a, %cl | ||
1923 | idivb %cl | ||
1924 | cmpb $0x09, %al | ||
1925 | jbe lt100 | ||
1926 | |||
1927 | call prtdec | ||
1928 | jmp skip10 | ||
1929 | |||
1930 | lt100: addb $0x30, %al | ||
1931 | call prtchr | ||
1932 | skip10: movb %ah, %al | ||
1933 | addb $0x30, %al | ||
1934 | call prtchr | ||
1935 | popw %cx | ||
1936 | popw %ax | ||
1937 | ret | ||
1938 | |||
1939 | store_edid: | ||
1940 | #ifdef CONFIG_FIRMWARE_EDID | ||
1941 | pushw %es # just save all registers | ||
1942 | pushw %ax | ||
1943 | pushw %bx | ||
1944 | pushw %cx | ||
1945 | pushw %dx | ||
1946 | pushw %di | ||
1947 | |||
1948 | pushw %fs | ||
1949 | popw %es | ||
1950 | |||
1951 | movl $0x13131313, %eax # memset block with 0x13 | ||
1952 | movw $32, %cx | ||
1953 | movw $0x140, %di | ||
1954 | cld | ||
1955 | rep | ||
1956 | stosl | ||
1957 | |||
1958 | cmpw $0x0200, vbe_version # only do EDID on >= VBE2.0 | ||
1959 | jl no_edid | ||
1960 | |||
1961 | pushw %es # save ES | ||
1962 | xorw %di, %di # Report Capability | ||
1963 | pushw %di | ||
1964 | popw %es # ES:DI must be 0:0 | ||
1965 | movw $0x4f15, %ax | ||
1966 | xorw %bx, %bx | ||
1967 | xorw %cx, %cx | ||
1968 | int $0x10 | ||
1969 | popw %es # restore ES | ||
1970 | |||
1971 | cmpb $0x00, %ah # call successful | ||
1972 | jne no_edid | ||
1973 | |||
1974 | cmpb $0x4f, %al # function supported | ||
1975 | jne no_edid | ||
1976 | |||
1977 | movw $0x4f15, %ax # do VBE/DDC | ||
1978 | movw $0x01, %bx | ||
1979 | movw $0x00, %cx | ||
1980 | movw $0x00, %dx | ||
1981 | movw $0x140, %di | ||
1982 | int $0x10 | ||
1983 | |||
1984 | no_edid: | ||
1985 | popw %di # restore all registers | ||
1986 | popw %dx | ||
1987 | popw %cx | ||
1988 | popw %bx | ||
1989 | popw %ax | ||
1990 | popw %es | ||
1991 | #endif | ||
1992 | ret | ||
1993 | |||
1994 | # VIDEO_SELECT-only variables | ||
1995 | mt_end: .word 0 # End of video mode table if built | ||
1996 | edit_buf: .space 6 # Line editor buffer | ||
1997 | card_name: .word 0 # Pointer to adapter name | ||
1998 | scanning: .byte 0 # Performing mode scan | ||
1999 | do_restore: .byte 0 # Screen contents altered during mode change | ||
2000 | svga_prefix: .byte VIDEO_FIRST_BIOS>>8 # Default prefix for BIOS modes | ||
2001 | graphic_mode: .byte 0 # Graphic mode with a linear frame buffer | ||
2002 | dac_size: .byte 6 # DAC bit depth | ||
2003 | vbe_version: .word 0 # VBE bios version | ||
2004 | |||
2005 | # Status messages | ||
2006 | keymsg: .ascii "Press <RETURN> to see video modes available, " | ||
2007 | .ascii "<SPACE> to continue or wait 30 secs" | ||
2008 | .byte 0x0d, 0x0a, 0 | ||
2009 | |||
2010 | listhdr: .byte 0x0d, 0x0a | ||
2011 | .ascii "Mode: COLSxROWS:" | ||
2012 | |||
2013 | crlft: .byte 0x0d, 0x0a, 0 | ||
2014 | |||
2015 | prompt: .byte 0x0d, 0x0a | ||
2016 | .asciz "Enter mode number or `scan': " | ||
2017 | |||
2018 | unknt: .asciz "Unknown mode ID. Try again." | ||
2019 | |||
2020 | badmdt: .ascii "You passed an undefined mode number." | ||
2021 | .byte 0x0d, 0x0a, 0 | ||
2022 | |||
2023 | vesaer: .ascii "Error: Scanning of VESA modes failed. Please " | ||
2024 | .ascii "report to <mj@ucw.cz>." | ||
2025 | .byte 0x0d, 0x0a, 0 | ||
2026 | |||
2027 | old_name: .asciz "CGA/MDA/HGA" | ||
2028 | |||
2029 | ega_name: .asciz "EGA" | ||
2030 | |||
2031 | svga_name: .ascii " " | ||
2032 | |||
2033 | vga_name: .asciz "VGA" | ||
2034 | |||
2035 | vesa_name: .asciz "VESA" | ||
2036 | |||
2037 | name_bann: .asciz "Video adapter: " | ||
2038 | #endif /* CONFIG_VIDEO_SELECT */ | ||
2039 | |||
2040 | # Other variables: | ||
2041 | adapter: .byte 0 # Video adapter: 0=CGA/MDA/HGA,1=EGA,2=VGA | ||
2042 | video_segment: .word 0xb800 # Video memory segment | ||
2043 | force_size: .word 0 # Use this size instead of the one in BIOS vars | ||
diff --git a/arch/i386/boot/video.c b/arch/i386/boot/video.c new file mode 100644 index 000000000000..3bb3573cd6a1 --- /dev/null +++ b/arch/i386/boot/video.c | |||
@@ -0,0 +1,456 @@ | |||
1 | /* -*- linux-c -*- ------------------------------------------------------- * | ||
2 | * | ||
3 | * Copyright (C) 1991, 1992 Linus Torvalds | ||
4 | * Copyright 2007 rPath, Inc. - All Rights Reserved | ||
5 | * | ||
6 | * This file is part of the Linux kernel, and is made available under | ||
7 | * the terms of the GNU General Public License version 2. | ||
8 | * | ||
9 | * ----------------------------------------------------------------------- */ | ||
10 | |||
11 | /* | ||
12 | * arch/i386/boot/video.c | ||
13 | * | ||
14 | * Select video mode | ||
15 | */ | ||
16 | |||
17 | #include "boot.h" | ||
18 | #include "video.h" | ||
19 | #include "vesa.h" | ||
20 | |||
21 | /* | ||
22 | * Mode list variables | ||
23 | */ | ||
24 | static struct card_info cards[]; /* List of cards to probe for */ | ||
25 | |||
26 | /* | ||
27 | * Common variables | ||
28 | */ | ||
29 | int adapter; /* 0=CGA/MDA/HGC, 1=EGA, 2=VGA+ */ | ||
30 | u16 video_segment; | ||
31 | int force_x, force_y; /* Don't query the BIOS for cols/rows */ | ||
32 | |||
33 | int do_restore = 0; /* Screen contents changed during mode flip */ | ||
34 | int graphic_mode; /* Graphic mode with linear frame buffer */ | ||
35 | |||
36 | static void store_cursor_position(void) | ||
37 | { | ||
38 | u16 curpos; | ||
39 | u16 ax, bx; | ||
40 | |||
41 | ax = 0x0300; | ||
42 | bx = 0; | ||
43 | asm(INT10 | ||
44 | : "=d" (curpos), "+a" (ax), "+b" (bx) | ||
45 | : : "ecx", "esi", "edi"); | ||
46 | |||
47 | boot_params.screen_info.orig_x = curpos; | ||
48 | boot_params.screen_info.orig_y = curpos >> 8; | ||
49 | } | ||
50 | |||
51 | static void store_video_mode(void) | ||
52 | { | ||
53 | u16 ax, page; | ||
54 | |||
55 | /* N.B.: the saving of the video page here is a bit silly, | ||
56 | since we pretty much assume page 0 everywhere. */ | ||
57 | ax = 0x0f00; | ||
58 | asm(INT10 | ||
59 | : "+a" (ax), "=b" (page) | ||
60 | : : "ecx", "edx", "esi", "edi"); | ||
61 | |||
62 | /* Not all BIOSes are clean with respect to the top bit */ | ||
63 | boot_params.screen_info.orig_video_mode = ax & 0x7f; | ||
64 | boot_params.screen_info.orig_video_page = page; | ||
65 | } | ||
66 | |||
67 | /* | ||
68 | * Store the video mode parameters for later usage by the kernel. | ||
69 | * This is done by asking the BIOS except for the rows/columns | ||
70 | * parameters in the default 80x25 mode -- these are set directly, | ||
71 | * because some very obscure BIOSes supply insane values. | ||
72 | */ | ||
73 | static void store_mode_params(void) | ||
74 | { | ||
75 | u16 font_size; | ||
76 | int x, y; | ||
77 | |||
78 | /* For graphics mode, it is up to the mode-setting driver | ||
79 | (currently only video-vesa.c) to store the parameters */ | ||
80 | if (graphic_mode) | ||
81 | return; | ||
82 | |||
83 | store_cursor_position(); | ||
84 | store_video_mode(); | ||
85 | |||
86 | if (boot_params.screen_info.orig_video_mode == 0x07) { | ||
87 | /* MDA, HGC, or VGA in monochrome mode */ | ||
88 | video_segment = 0xb000; | ||
89 | } else { | ||
90 | /* CGA, EGA, VGA and so forth */ | ||
91 | video_segment = 0xb800; | ||
92 | } | ||
93 | |||
94 | set_fs(0); | ||
95 | font_size = rdfs16(0x485); /* Font size, BIOS area */ | ||
96 | boot_params.screen_info.orig_video_points = font_size; | ||
97 | |||
98 | x = rdfs16(0x44a); | ||
99 | y = (adapter == ADAPTER_CGA) ? 25 : rdfs8(0x484)+1; | ||
100 | |||
101 | if (force_x) | ||
102 | x = force_x; | ||
103 | if (force_y) | ||
104 | y = force_y; | ||
105 | |||
106 | boot_params.screen_info.orig_video_cols = x; | ||
107 | boot_params.screen_info.orig_video_lines = y; | ||
108 | } | ||
109 | |||
110 | /* Probe the video drivers and have them generate their mode lists. */ | ||
111 | static void probe_cards(int unsafe) | ||
112 | { | ||
113 | struct card_info *card; | ||
114 | static u8 probed[2]; | ||
115 | |||
116 | if (probed[unsafe]) | ||
117 | return; | ||
118 | |||
119 | probed[unsafe] = 1; | ||
120 | |||
121 | for (card = video_cards; card < video_cards_end; card++) { | ||
122 | if (card->unsafe == unsafe) { | ||
123 | if (card->probe) | ||
124 | card->nmodes = card->probe(); | ||
125 | else | ||
126 | card->nmodes = 0; | ||
127 | } | ||
128 | } | ||
129 | } | ||
130 | |||
131 | /* Test if a mode is defined */ | ||
132 | int mode_defined(u16 mode) | ||
133 | { | ||
134 | struct card_info *card; | ||
135 | struct mode_info *mi; | ||
136 | int i; | ||
137 | |||
138 | for (card = video_cards; card < video_cards_end; card++) { | ||
139 | mi = card->modes; | ||
140 | for (i = 0; i < card->nmodes; i++, mi++) { | ||
141 | if (mi->mode == mode) | ||
142 | return 1; | ||
143 | } | ||
144 | } | ||
145 | |||
146 | return 0; | ||
147 | } | ||
148 | |||
149 | /* Set mode (without recalc) */ | ||
150 | static int raw_set_mode(u16 mode) | ||
151 | { | ||
152 | int nmode, i; | ||
153 | struct card_info *card; | ||
154 | struct mode_info *mi; | ||
155 | |||
156 | /* Drop the recalc bit if set */ | ||
157 | mode &= ~VIDEO_RECALC; | ||
158 | |||
159 | /* Scan for mode based on fixed ID, position, or resolution */ | ||
160 | nmode = 0; | ||
161 | for (card = video_cards; card < video_cards_end; card++) { | ||
162 | mi = card->modes; | ||
163 | for (i = 0; i < card->nmodes; i++, mi++) { | ||
164 | int visible = mi->x || mi->y; | ||
165 | |||
166 | if ((mode == nmode && visible) || | ||
167 | mode == mi->mode || | ||
168 | mode == (mi->y << 8)+mi->x) | ||
169 | return card->set_mode(mi); | ||
170 | |||
171 | if (visible) | ||
172 | nmode++; | ||
173 | } | ||
174 | } | ||
175 | |||
176 | /* Nothing found? Is it an "exceptional" (unprobed) mode? */ | ||
177 | for (card = video_cards; card < video_cards_end; card++) { | ||
178 | if (mode >= card->xmode_first && | ||
179 | mode < card->xmode_first+card->xmode_n) { | ||
180 | struct mode_info mix; | ||
181 | mix.mode = mode; | ||
182 | mix.x = mix.y = 0; | ||
183 | return card->set_mode(&mix); | ||
184 | } | ||
185 | } | ||
186 | |||
187 | /* Otherwise, failure... */ | ||
188 | return -1; | ||
189 | } | ||
190 | |||
191 | /* | ||
192 | * Recalculate the vertical video cutoff (hack!) | ||
193 | */ | ||
194 | static void vga_recalc_vertical(void) | ||
195 | { | ||
196 | unsigned int font_size, rows; | ||
197 | u16 crtc; | ||
198 | u8 ov; | ||
199 | |||
200 | set_fs(0); | ||
201 | font_size = rdfs8(0x485); /* BIOS: font size (pixels) */ | ||
202 | rows = force_y ? force_y : rdfs8(0x484)+1; /* Text rows */ | ||
203 | |||
204 | rows *= font_size; /* Visible scan lines */ | ||
205 | rows--; /* ... minus one */ | ||
206 | |||
207 | crtc = vga_crtc(); | ||
208 | |||
209 | out_idx((u8)rows, crtc, 0x12); /* Lower height register */ | ||
210 | ov = in_idx(crtc, 0x07); /* Overflow register */ | ||
211 | ov &= 0xbd; | ||
212 | ov |= (rows >> (8-1)) & 0x02; | ||
213 | ov |= (rows >> (9-6)) & 0x40; | ||
214 | out_idx(ov, crtc, 0x07); | ||
215 | } | ||
216 | |||
217 | /* Set mode (with recalc if specified) */ | ||
218 | static int set_mode(u16 mode) | ||
219 | { | ||
220 | int rv; | ||
221 | |||
222 | /* Very special mode numbers... */ | ||
223 | if (mode == VIDEO_CURRENT_MODE) | ||
224 | return 0; /* Nothing to do... */ | ||
225 | else if (mode == NORMAL_VGA) | ||
226 | mode = VIDEO_80x25; | ||
227 | else if (mode == EXTENDED_VGA) | ||
228 | mode = VIDEO_8POINT; | ||
229 | |||
230 | rv = raw_set_mode(mode); | ||
231 | if (rv) | ||
232 | return rv; | ||
233 | |||
234 | if (mode & VIDEO_RECALC) | ||
235 | vga_recalc_vertical(); | ||
236 | |||
237 | return 0; | ||
238 | } | ||
239 | |||
240 | static unsigned int get_entry(void) | ||
241 | { | ||
242 | char entry_buf[4]; | ||
243 | int i, len = 0; | ||
244 | int key; | ||
245 | unsigned int v; | ||
246 | |||
247 | do { | ||
248 | key = getchar(); | ||
249 | |||
250 | if (key == '\b') { | ||
251 | if (len > 0) { | ||
252 | puts("\b \b"); | ||
253 | len--; | ||
254 | } | ||
255 | } else if ((key >= '0' && key <= '9') || | ||
256 | (key >= 'A' && key <= 'Z') || | ||
257 | (key >= 'a' && key <= 'z')) { | ||
258 | if (len < sizeof entry_buf) { | ||
259 | entry_buf[len++] = key; | ||
260 | putchar(key); | ||
261 | } | ||
262 | } | ||
263 | } while (key != '\r'); | ||
264 | putchar('\n'); | ||
265 | |||
266 | if (len == 0) | ||
267 | return VIDEO_CURRENT_MODE; /* Default */ | ||
268 | |||
269 | v = 0; | ||
270 | for (i = 0; i < len; i++) { | ||
271 | v <<= 4; | ||
272 | key = entry_buf[i] | 0x20; | ||
273 | v += (key > '9') ? key-'a'+10 : key-'0'; | ||
274 | } | ||
275 | |||
276 | return v; | ||
277 | } | ||
278 | |||
279 | static void display_menu(void) | ||
280 | { | ||
281 | struct card_info *card; | ||
282 | struct mode_info *mi; | ||
283 | char ch; | ||
284 | int i; | ||
285 | |||
286 | puts("Mode: COLSxROWS:\n"); | ||
287 | |||
288 | ch = '0'; | ||
289 | for (card = video_cards; card < video_cards_end; card++) { | ||
290 | mi = card->modes; | ||
291 | for (i = 0; i < card->nmodes; i++, mi++) { | ||
292 | int visible = mi->x && mi->y; | ||
293 | u16 mode_id = mi->mode ? mi->mode : | ||
294 | (mi->y << 8)+mi->x; | ||
295 | |||
296 | if (!visible) | ||
297 | continue; /* Hidden mode */ | ||
298 | |||
299 | printf("%c %04X %3dx%-3d %s\n", | ||
300 | ch, mode_id, mi->x, mi->y, card->card_name); | ||
301 | |||
302 | if (ch == '9') | ||
303 | ch = 'a'; | ||
304 | else if (ch == 'z' || ch == ' ') | ||
305 | ch = ' '; /* Out of keys... */ | ||
306 | else | ||
307 | ch++; | ||
308 | } | ||
309 | } | ||
310 | } | ||
311 | |||
312 | #define H(x) ((x)-'a'+10) | ||
313 | #define SCAN ((H('s')<<12)+(H('c')<<8)+(H('a')<<4)+H('n')) | ||
314 | |||
315 | static unsigned int mode_menu(void) | ||
316 | { | ||
317 | int key; | ||
318 | unsigned int sel; | ||
319 | |||
320 | puts("Press <ENTER> to see video modes available, " | ||
321 | "<SPACE> to continue, or wait 30 sec\n"); | ||
322 | |||
323 | kbd_flush(); | ||
324 | while (1) { | ||
325 | key = getchar_timeout(); | ||
326 | if (key == ' ' || key == 0) | ||
327 | return VIDEO_CURRENT_MODE; /* Default */ | ||
328 | if (key == '\r') | ||
329 | break; | ||
330 | putchar('\a'); /* Beep! */ | ||
331 | } | ||
332 | |||
333 | |||
334 | for (;;) { | ||
335 | display_menu(); | ||
336 | |||
337 | puts("Enter a video mode or \"scan\" to scan for " | ||
338 | "additional modes: "); | ||
339 | sel = get_entry(); | ||
340 | if (sel != SCAN) | ||
341 | return sel; | ||
342 | |||
343 | probe_cards(1); | ||
344 | } | ||
345 | } | ||
346 | |||
347 | #ifdef CONFIG_VIDEO_RETAIN | ||
348 | /* Save screen content to the heap */ | ||
349 | struct saved_screen { | ||
350 | int x, y; | ||
351 | int curx, cury; | ||
352 | u16 *data; | ||
353 | } saved; | ||
354 | |||
355 | static void save_screen(void) | ||
356 | { | ||
357 | /* Should be called after store_mode_params() */ | ||
358 | saved.x = boot_params.screen_info.orig_video_cols; | ||
359 | saved.y = boot_params.screen_info.orig_video_lines; | ||
360 | saved.curx = boot_params.screen_info.orig_x; | ||
361 | saved.cury = boot_params.screen_info.orig_y; | ||
362 | |||
363 | if (heap_free() < saved.x*saved.y*sizeof(u16)+512) | ||
364 | return; /* Not enough heap to save the screen */ | ||
365 | |||
366 | saved.data = GET_HEAP(u16, saved.x*saved.y); | ||
367 | |||
368 | set_fs(video_segment); | ||
369 | copy_from_fs(saved.data, 0, saved.x*saved.y*sizeof(u16)); | ||
370 | } | ||
371 | |||
372 | static void restore_screen(void) | ||
373 | { | ||
374 | /* Should be called after store_mode_params() */ | ||
375 | int xs = boot_params.screen_info.orig_video_cols; | ||
376 | int ys = boot_params.screen_info.orig_video_lines; | ||
377 | int y; | ||
378 | addr_t dst = 0; | ||
379 | u16 *src = saved.data; | ||
380 | u16 ax, bx, dx; | ||
381 | |||
382 | if (graphic_mode) | ||
383 | return; /* Can't restore onto a graphic mode */ | ||
384 | |||
385 | if (!src) | ||
386 | return; /* No saved screen contents */ | ||
387 | |||
388 | /* Restore screen contents */ | ||
389 | |||
390 | set_fs(video_segment); | ||
391 | for (y = 0; y < ys; y++) { | ||
392 | int npad; | ||
393 | |||
394 | if (y < saved.y) { | ||
395 | int copy = (xs < saved.x) ? xs : saved.x; | ||
396 | copy_to_fs(dst, src, copy*sizeof(u16)); | ||
397 | dst += copy*sizeof(u16); | ||
398 | src += saved.x; | ||
399 | npad = (xs < saved.x) ? 0 : xs-saved.x; | ||
400 | } else { | ||
401 | npad = xs; | ||
402 | } | ||
403 | |||
404 | /* Writes "npad" blank characters to | ||
405 | video_segment:dst and advances dst */ | ||
406 | asm volatile("pushw %%es ; " | ||
407 | "movw %2,%%es ; " | ||
408 | "shrw %%cx ; " | ||
409 | "jnc 1f ; " | ||
410 | "stosw \n\t" | ||
411 | "1: rep;stosl ; " | ||
412 | "popw %%es" | ||
413 | : "+D" (dst), "+c" (npad) | ||
414 | : "bdSm" (video_segment), | ||
415 | "a" (0x07200720)); | ||
416 | } | ||
417 | |||
418 | /* Restore cursor position */ | ||
419 | ax = 0x0200; /* Set cursor position */ | ||
420 | bx = 0; /* Page number (<< 8) */ | ||
421 | dx = (saved.cury << 8)+saved.curx; | ||
422 | asm volatile(INT10 | ||
423 | : "+a" (ax), "+b" (bx), "+d" (dx) | ||
424 | : : "ecx", "esi", "edi"); | ||
425 | } | ||
426 | #else | ||
427 | #define save_screen() ((void)0) | ||
428 | #define restore_screen() ((void)0) | ||
429 | #endif | ||
430 | |||
431 | void set_video(void) | ||
432 | { | ||
433 | u16 mode = boot_params.hdr.vid_mode; | ||
434 | |||
435 | RESET_HEAP(); | ||
436 | |||
437 | store_mode_params(); | ||
438 | save_screen(); | ||
439 | probe_cards(0); | ||
440 | |||
441 | for (;;) { | ||
442 | if (mode == ASK_VGA) | ||
443 | mode = mode_menu(); | ||
444 | |||
445 | if (!set_mode(mode)) | ||
446 | break; | ||
447 | |||
448 | printf("Undefined video mode number: %x\n", mode); | ||
449 | mode = ASK_VGA; | ||
450 | } | ||
451 | vesa_store_edid(); | ||
452 | store_mode_params(); | ||
453 | |||
454 | if (do_restore) | ||
455 | restore_screen(); | ||
456 | } | ||
diff --git a/arch/i386/boot/video.h b/arch/i386/boot/video.h new file mode 100644 index 000000000000..29eca1710b2c --- /dev/null +++ b/arch/i386/boot/video.h | |||
@@ -0,0 +1,145 @@ | |||
1 | /* -*- linux-c -*- ------------------------------------------------------- * | ||
2 | * | ||
3 | * Copyright (C) 1991, 1992 Linus Torvalds | ||
4 | * Copyright 2007 rPath, Inc. - All Rights Reserved | ||
5 | * | ||
6 | * This file is part of the Linux kernel, and is made available under | ||
7 | * the terms of the GNU General Public License version 2. | ||
8 | * | ||
9 | * ----------------------------------------------------------------------- */ | ||
10 | |||
11 | /* | ||
12 | * arch/i386/boot/video.h | ||
13 | * | ||
14 | * Header file for the real-mode video probing code | ||
15 | */ | ||
16 | |||
17 | #ifndef BOOT_VIDEO_H | ||
18 | #define BOOT_VIDEO_H | ||
19 | |||
20 | #include <linux/types.h> | ||
21 | |||
22 | /* Enable autodetection of SVGA adapters and modes. */ | ||
23 | #undef CONFIG_VIDEO_SVGA | ||
24 | |||
25 | /* Enable autodetection of VESA modes */ | ||
26 | #define CONFIG_VIDEO_VESA | ||
27 | |||
28 | /* Retain screen contents when switching modes */ | ||
29 | #define CONFIG_VIDEO_RETAIN | ||
30 | |||
31 | /* Force 400 scan lines for standard modes (hack to fix bad BIOS behaviour */ | ||
32 | #undef CONFIG_VIDEO_400_HACK | ||
33 | |||
34 | /* This code uses an extended set of video mode numbers. These include: | ||
35 | * Aliases for standard modes | ||
36 | * NORMAL_VGA (-1) | ||
37 | * EXTENDED_VGA (-2) | ||
38 | * ASK_VGA (-3) | ||
39 | * Video modes numbered by menu position -- NOT RECOMMENDED because of lack | ||
40 | * of compatibility when extending the table. These are between 0x00 and 0xff. | ||
41 | */ | ||
42 | #define VIDEO_FIRST_MENU 0x0000 | ||
43 | |||
44 | /* Standard BIOS video modes (BIOS number + 0x0100) */ | ||
45 | #define VIDEO_FIRST_BIOS 0x0100 | ||
46 | |||
47 | /* VESA BIOS video modes (VESA number + 0x0200) */ | ||
48 | #define VIDEO_FIRST_VESA 0x0200 | ||
49 | |||
50 | /* Video7 special modes (BIOS number + 0x0900) */ | ||
51 | #define VIDEO_FIRST_V7 0x0900 | ||
52 | |||
53 | /* Special video modes */ | ||
54 | #define VIDEO_FIRST_SPECIAL 0x0f00 | ||
55 | #define VIDEO_80x25 0x0f00 | ||
56 | #define VIDEO_8POINT 0x0f01 | ||
57 | #define VIDEO_80x43 0x0f02 | ||
58 | #define VIDEO_80x28 0x0f03 | ||
59 | #define VIDEO_CURRENT_MODE 0x0f04 | ||
60 | #define VIDEO_80x30 0x0f05 | ||
61 | #define VIDEO_80x34 0x0f06 | ||
62 | #define VIDEO_80x60 0x0f07 | ||
63 | #define VIDEO_GFX_HACK 0x0f08 | ||
64 | #define VIDEO_LAST_SPECIAL 0x0f09 | ||
65 | |||
66 | /* Video modes given by resolution */ | ||
67 | #define VIDEO_FIRST_RESOLUTION 0x1000 | ||
68 | |||
69 | /* The "recalculate timings" flag */ | ||
70 | #define VIDEO_RECALC 0x8000 | ||
71 | |||
72 | /* Define DO_STORE according to CONFIG_VIDEO_RETAIN */ | ||
73 | #ifdef CONFIG_VIDEO_RETAIN | ||
74 | void store_screen(void); | ||
75 | #define DO_STORE() store_screen() | ||
76 | #else | ||
77 | #define DO_STORE() ((void)0) | ||
78 | #endif /* CONFIG_VIDEO_RETAIN */ | ||
79 | |||
80 | /* | ||
81 | * Mode table structures | ||
82 | */ | ||
83 | |||
84 | struct mode_info { | ||
85 | u16 mode; /* Mode number (vga= style) */ | ||
86 | u8 x, y; /* Width, height */ | ||
87 | }; | ||
88 | |||
89 | struct card_info { | ||
90 | const char *card_name; | ||
91 | int (*set_mode)(struct mode_info *mode); | ||
92 | int (*probe)(void); | ||
93 | struct mode_info *modes; | ||
94 | int nmodes; /* Number of probed modes so far */ | ||
95 | int unsafe; /* Probing is unsafe, only do after "scan" */ | ||
96 | u16 xmode_first; /* Unprobed modes to try to call anyway */ | ||
97 | u16 xmode_n; /* Size of unprobed mode range */ | ||
98 | }; | ||
99 | |||
100 | #define __videocard struct card_info __attribute__((section(".videocards"))) | ||
101 | extern struct card_info video_cards[], video_cards_end[]; | ||
102 | |||
103 | int mode_defined(u16 mode); /* video.c */ | ||
104 | |||
105 | /* Basic video information */ | ||
106 | #define ADAPTER_CGA 0 /* CGA/MDA/HGC */ | ||
107 | #define ADAPTER_EGA 1 | ||
108 | #define ADAPTER_VGA 2 | ||
109 | |||
110 | extern int adapter; | ||
111 | extern u16 video_segment; | ||
112 | extern int force_x, force_y; /* Don't query the BIOS for cols/rows */ | ||
113 | extern int do_restore; /* Restore screen contents */ | ||
114 | extern int graphic_mode; /* Graphics mode with linear frame buffer */ | ||
115 | |||
116 | /* | ||
117 | * int $0x10 is notorious for touching registers it shouldn't. | ||
118 | * gcc doesn't like %ebp being clobbered, so define it as a push/pop | ||
119 | * sequence here. | ||
120 | */ | ||
121 | #define INT10 "pushl %%ebp; int $0x10; popl %%ebp" | ||
122 | |||
123 | /* Accessing VGA indexed registers */ | ||
124 | static inline u8 in_idx(u16 port, u8 index) | ||
125 | { | ||
126 | outb(index, port); | ||
127 | return inb(port+1); | ||
128 | } | ||
129 | |||
130 | static inline void out_idx(u8 v, u16 port, u8 index) | ||
131 | { | ||
132 | outw(index+(v << 8), port); | ||
133 | } | ||
134 | |||
135 | /* Writes a value to an indexed port and then reads the port again */ | ||
136 | static inline u8 tst_idx(u8 v, u16 port, u8 index) | ||
137 | { | ||
138 | out_idx(port, index, v); | ||
139 | return in_idx(port, index); | ||
140 | } | ||
141 | |||
142 | /* Get the I/O port of the VGA CRTC */ | ||
143 | u16 vga_crtc(void); /* video-vga.c */ | ||
144 | |||
145 | #endif /* BOOT_VIDEO_H */ | ||
diff --git a/arch/i386/boot/voyager.c b/arch/i386/boot/voyager.c new file mode 100644 index 000000000000..9221614d0db8 --- /dev/null +++ b/arch/i386/boot/voyager.c | |||
@@ -0,0 +1,46 @@ | |||
1 | /* -*- linux-c -*- ------------------------------------------------------- * | ||
2 | * | ||
3 | * Copyright (C) 1991, 1992 Linus Torvalds | ||
4 | * Copyright 2007 rPath, Inc. - All Rights Reserved | ||
5 | * | ||
6 | * This file is part of the Linux kernel, and is made available under | ||
7 | * the terms of the GNU General Public License version 2. | ||
8 | * | ||
9 | * ----------------------------------------------------------------------- */ | ||
10 | |||
11 | /* | ||
12 | * arch/i386/boot/voyager.c | ||
13 | * | ||
14 | * Get the Voyager config information | ||
15 | */ | ||
16 | |||
17 | #include "boot.h" | ||
18 | |||
19 | #ifdef CONFIG_X86_VOYAGER | ||
20 | |||
21 | int query_voyager(void) | ||
22 | { | ||
23 | u8 err; | ||
24 | u16 es, di; | ||
25 | /* Abuse the apm_bios_info area for this */ | ||
26 | u8 *data_ptr = (u8 *)&boot_params.apm_bios_info; | ||
27 | |||
28 | data_ptr[0] = 0xff; /* Flag on config not found(?) */ | ||
29 | |||
30 | asm("pushw %%es ; " | ||
31 | "int $0x15 ; " | ||
32 | "setc %0 ; " | ||
33 | "movw %%es, %1 ; " | ||
34 | "popw %%es" | ||
35 | : "=qm" (err), "=rm" (es), "=D" (di) | ||
36 | : "a" (0xffc0)); | ||
37 | |||
38 | if (err) | ||
39 | return -1; /* Not Voyager */ | ||
40 | |||
41 | set_fs(es); | ||
42 | copy_from_fs(data_ptr, di, 7); /* Table is 7 bytes apparently */ | ||
43 | return 0; | ||
44 | } | ||
45 | |||
46 | #endif /* CONFIG_X86_VOYAGER */ | ||
diff --git a/arch/i386/kernel/cpu/Makefile b/arch/i386/kernel/cpu/Makefile index 74f27a463db0..0b6a8551e9e2 100644 --- a/arch/i386/kernel/cpu/Makefile +++ b/arch/i386/kernel/cpu/Makefile | |||
@@ -8,7 +8,7 @@ obj-y += amd.o | |||
8 | obj-y += cyrix.o | 8 | obj-y += cyrix.o |
9 | obj-y += centaur.o | 9 | obj-y += centaur.o |
10 | obj-y += transmeta.o | 10 | obj-y += transmeta.o |
11 | obj-y += intel.o intel_cacheinfo.o | 11 | obj-y += intel.o intel_cacheinfo.o addon_cpuid_features.o |
12 | obj-y += rise.o | 12 | obj-y += rise.o |
13 | obj-y += nexgen.o | 13 | obj-y += nexgen.o |
14 | obj-y += umc.o | 14 | obj-y += umc.o |
diff --git a/arch/i386/kernel/cpu/addon_cpuid_features.c b/arch/i386/kernel/cpu/addon_cpuid_features.c new file mode 100644 index 000000000000..3e91d3ee26ec --- /dev/null +++ b/arch/i386/kernel/cpu/addon_cpuid_features.c | |||
@@ -0,0 +1,50 @@ | |||
1 | |||
2 | /* | ||
3 | * Routines to indentify additional cpu features that are scattered in | ||
4 | * cpuid space. | ||
5 | */ | ||
6 | |||
7 | #include <linux/cpu.h> | ||
8 | |||
9 | #include <asm/processor.h> | ||
10 | |||
11 | struct cpuid_bit { | ||
12 | u16 feature; | ||
13 | u8 reg; | ||
14 | u8 bit; | ||
15 | u32 level; | ||
16 | }; | ||
17 | |||
18 | enum cpuid_regs { | ||
19 | CR_EAX = 0, | ||
20 | CR_ECX, | ||
21 | CR_EDX, | ||
22 | CR_EBX | ||
23 | }; | ||
24 | |||
25 | void __cpuinit init_scattered_cpuid_features(struct cpuinfo_x86 *c) | ||
26 | { | ||
27 | u32 max_level; | ||
28 | u32 regs[4]; | ||
29 | const struct cpuid_bit *cb; | ||
30 | |||
31 | static const struct cpuid_bit cpuid_bits[] = { | ||
32 | { X86_FEATURE_IDA, CR_EAX, 1, 0x00000006 }, | ||
33 | { 0, 0, 0, 0 } | ||
34 | }; | ||
35 | |||
36 | for (cb = cpuid_bits; cb->feature; cb++) { | ||
37 | |||
38 | /* Verify that the level is valid */ | ||
39 | max_level = cpuid_eax(cb->level & 0xffff0000); | ||
40 | if (max_level < cb->level || | ||
41 | max_level > (cb->level | 0xffff)) | ||
42 | continue; | ||
43 | |||
44 | cpuid(cb->level, ®s[CR_EAX], ®s[CR_EBX], | ||
45 | ®s[CR_ECX], ®s[CR_EDX]); | ||
46 | |||
47 | if (regs[cb->reg] & (1 << cb->bit)) | ||
48 | set_bit(cb->feature, c->x86_capability); | ||
49 | } | ||
50 | } | ||
diff --git a/arch/i386/kernel/cpu/common.c b/arch/i386/kernel/cpu/common.c index 794d593c47eb..e5419a9dec88 100644 --- a/arch/i386/kernel/cpu/common.c +++ b/arch/i386/kernel/cpu/common.c | |||
@@ -353,6 +353,8 @@ static void __cpuinit generic_identify(struct cpuinfo_x86 * c) | |||
353 | if ( xlvl >= 0x80000004 ) | 353 | if ( xlvl >= 0x80000004 ) |
354 | get_model_name(c); /* Default name */ | 354 | get_model_name(c); /* Default name */ |
355 | } | 355 | } |
356 | |||
357 | init_scattered_cpuid_features(c); | ||
356 | } | 358 | } |
357 | 359 | ||
358 | early_intel_workaround(c); | 360 | early_intel_workaround(c); |
diff --git a/arch/i386/kernel/cpu/proc.c b/arch/i386/kernel/cpu/proc.c index 89d91e6cc972..1e31b6caffb1 100644 --- a/arch/i386/kernel/cpu/proc.c +++ b/arch/i386/kernel/cpu/proc.c | |||
@@ -29,7 +29,8 @@ static int show_cpuinfo(struct seq_file *m, void *v) | |||
29 | NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, | 29 | NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, |
30 | NULL, NULL, NULL, "syscall", NULL, NULL, NULL, NULL, | 30 | NULL, NULL, NULL, "syscall", NULL, NULL, NULL, NULL, |
31 | NULL, NULL, NULL, "mp", "nx", NULL, "mmxext", NULL, | 31 | NULL, NULL, NULL, "mp", "nx", NULL, "mmxext", NULL, |
32 | NULL, "fxsr_opt", "pdpe1gb", "rdtscp", NULL, "lm", "3dnowext", "3dnow", | 32 | NULL, "fxsr_opt", "pdpe1gb", "rdtscp", NULL, "lm", |
33 | "3dnowext", "3dnow", | ||
33 | 34 | ||
34 | /* Transmeta-defined */ | 35 | /* Transmeta-defined */ |
35 | "recovery", "longrun", NULL, "lrti", NULL, NULL, NULL, NULL, | 36 | "recovery", "longrun", NULL, "lrti", NULL, NULL, NULL, NULL, |
@@ -40,8 +41,9 @@ static int show_cpuinfo(struct seq_file *m, void *v) | |||
40 | /* Other (Linux-defined) */ | 41 | /* Other (Linux-defined) */ |
41 | "cxmmx", "k6_mtrr", "cyrix_arr", "centaur_mcr", | 42 | "cxmmx", "k6_mtrr", "cyrix_arr", "centaur_mcr", |
42 | NULL, NULL, NULL, NULL, | 43 | NULL, NULL, NULL, NULL, |
43 | "constant_tsc", "up", NULL, NULL, NULL, NULL, NULL, NULL, | 44 | "constant_tsc", "up", NULL, "arch_perfmon", |
44 | NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, | 45 | "pebs", "bts", NULL, "sync_rdtsc", |
46 | "rep_good", NULL, NULL, NULL, NULL, NULL, NULL, NULL, | ||
45 | NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, | 47 | NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, |
46 | 48 | ||
47 | /* Intel-defined (#2) */ | 49 | /* Intel-defined (#2) */ |
@@ -57,9 +59,16 @@ static int show_cpuinfo(struct seq_file *m, void *v) | |||
57 | NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, | 59 | NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, |
58 | 60 | ||
59 | /* AMD-defined (#2) */ | 61 | /* AMD-defined (#2) */ |
60 | "lahf_lm", "cmp_legacy", "svm", "extapic", "cr8legacy", "abm", | 62 | "lahf_lm", "cmp_legacy", "svm", "extapic", "cr8_legacy", |
61 | "sse4a", "misalignsse", | 63 | "altmovcr8", "abm", "sse4a", |
62 | "3dnowprefetch", "osvw", "ibs", NULL, NULL, NULL, NULL, NULL, | 64 | "misalignsse", "3dnowprefetch", |
65 | "osvw", "ibs", NULL, NULL, NULL, NULL, | ||
66 | NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, | ||
67 | NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, | ||
68 | |||
69 | /* Auxiliary (Linux-defined) */ | ||
70 | "ida", NULL, NULL, NULL, NULL, NULL, NULL, NULL, | ||
71 | NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, | ||
63 | NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, | 72 | NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, |
64 | NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, | 73 | NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, |
65 | }; | 74 | }; |
diff --git a/arch/i386/kernel/e820.c b/arch/i386/kernel/e820.c index 9645bb51f76a..fc822a46897a 100644 --- a/arch/i386/kernel/e820.c +++ b/arch/i386/kernel/e820.c | |||
@@ -734,7 +734,7 @@ void __init print_memory_map(char *who) | |||
734 | case E820_NVS: | 734 | case E820_NVS: |
735 | printk("(ACPI NVS)\n"); | 735 | printk("(ACPI NVS)\n"); |
736 | break; | 736 | break; |
737 | default: printk("type %lu\n", e820.map[i].type); | 737 | default: printk("type %u\n", e820.map[i].type); |
738 | break; | 738 | break; |
739 | } | 739 | } |
740 | } | 740 | } |
diff --git a/arch/i386/kernel/setup.c b/arch/i386/kernel/setup.c index 698c24fe482e..2d61e65eeb50 100644 --- a/arch/i386/kernel/setup.c +++ b/arch/i386/kernel/setup.c | |||
@@ -102,19 +102,10 @@ static unsigned int highmem_pages = -1; | |||
102 | /* | 102 | /* |
103 | * Setup options | 103 | * Setup options |
104 | */ | 104 | */ |
105 | struct drive_info_struct { char dummy[32]; } drive_info; | ||
106 | #if defined(CONFIG_BLK_DEV_IDE) || defined(CONFIG_BLK_DEV_HD) || \ | ||
107 | defined(CONFIG_BLK_DEV_IDE_MODULE) || defined(CONFIG_BLK_DEV_HD_MODULE) | ||
108 | EXPORT_SYMBOL(drive_info); | ||
109 | #endif | ||
110 | struct screen_info screen_info; | 105 | struct screen_info screen_info; |
111 | EXPORT_SYMBOL(screen_info); | 106 | EXPORT_SYMBOL(screen_info); |
112 | struct apm_info apm_info; | 107 | struct apm_info apm_info; |
113 | EXPORT_SYMBOL(apm_info); | 108 | EXPORT_SYMBOL(apm_info); |
114 | struct sys_desc_table_struct { | ||
115 | unsigned short length; | ||
116 | unsigned char table[0]; | ||
117 | }; | ||
118 | struct edid_info edid_info; | 109 | struct edid_info edid_info; |
119 | EXPORT_SYMBOL_GPL(edid_info); | 110 | EXPORT_SYMBOL_GPL(edid_info); |
120 | struct ist_info ist_info; | 111 | struct ist_info ist_info; |
@@ -134,7 +125,7 @@ unsigned long saved_videomode; | |||
134 | 125 | ||
135 | static char __initdata command_line[COMMAND_LINE_SIZE]; | 126 | static char __initdata command_line[COMMAND_LINE_SIZE]; |
136 | 127 | ||
137 | unsigned char __initdata boot_params[PARAM_SIZE]; | 128 | struct boot_params __initdata boot_params; |
138 | 129 | ||
139 | #if defined(CONFIG_EDD) || defined(CONFIG_EDD_MODULE) | 130 | #if defined(CONFIG_EDD) || defined(CONFIG_EDD_MODULE) |
140 | struct edd edd; | 131 | struct edd edd; |
@@ -528,7 +519,6 @@ void __init setup_arch(char **cmdline_p) | |||
528 | #endif | 519 | #endif |
529 | 520 | ||
530 | ROOT_DEV = old_decode_dev(ORIG_ROOT_DEV); | 521 | ROOT_DEV = old_decode_dev(ORIG_ROOT_DEV); |
531 | drive_info = DRIVE_INFO; | ||
532 | screen_info = SCREEN_INFO; | 522 | screen_info = SCREEN_INFO; |
533 | edid_info = EDID_INFO; | 523 | edid_info = EDID_INFO; |
534 | apm_info.bios = APM_BIOS_INFO; | 524 | apm_info.bios = APM_BIOS_INFO; |
diff --git a/arch/i386/kernel/verify_cpu.S b/arch/i386/kernel/verify_cpu.S deleted file mode 100644 index f1d1eacf4ab0..000000000000 --- a/arch/i386/kernel/verify_cpu.S +++ /dev/null | |||
@@ -1,94 +0,0 @@ | |||
1 | /* Check if CPU has some minimum CPUID bits | ||
2 | This runs in 16bit mode so that the caller can still use the BIOS | ||
3 | to output errors on the screen */ | ||
4 | #include <asm/cpufeature.h> | ||
5 | #include <asm/msr.h> | ||
6 | |||
7 | verify_cpu: | ||
8 | pushfl # Save caller passed flags | ||
9 | pushl $0 # Kill any dangerous flags | ||
10 | popfl | ||
11 | |||
12 | #if CONFIG_X86_MINIMUM_CPU_MODEL >= 4 | ||
13 | pushfl | ||
14 | pop %eax | ||
15 | orl $(1<<18),%eax # try setting AC | ||
16 | push %eax | ||
17 | popfl | ||
18 | pushfl | ||
19 | popl %eax | ||
20 | testl $(1<<18),%eax | ||
21 | jz bad | ||
22 | #endif | ||
23 | #if REQUIRED_MASK1 != 0 | ||
24 | pushfl # standard way to check for cpuid | ||
25 | popl %eax | ||
26 | movl %eax,%ebx | ||
27 | xorl $0x200000,%eax | ||
28 | pushl %eax | ||
29 | popfl | ||
30 | pushfl | ||
31 | popl %eax | ||
32 | cmpl %eax,%ebx | ||
33 | pushfl # standard way to check for cpuid | ||
34 | popl %eax | ||
35 | movl %eax,%ebx | ||
36 | xorl $0x200000,%eax | ||
37 | pushl %eax | ||
38 | popfl | ||
39 | pushfl | ||
40 | popl %eax | ||
41 | cmpl %eax,%ebx | ||
42 | jz bad # REQUIRED_MASK1 != 0 requires CPUID | ||
43 | |||
44 | movl $0x0,%eax # See if cpuid 1 is implemented | ||
45 | cpuid | ||
46 | cmpl $0x1,%eax | ||
47 | jb bad # no cpuid 1 | ||
48 | |||
49 | #if REQUIRED_MASK1 & NEED_CMPXCHG64 | ||
50 | /* Some VIA C3s need magic MSRs to enable CX64. Do this here */ | ||
51 | cmpl $0x746e6543,%ebx # Cent | ||
52 | jne 1f | ||
53 | cmpl $0x48727561,%edx # aurH | ||
54 | jne 1f | ||
55 | cmpl $0x736c7561,%ecx # auls | ||
56 | jne 1f | ||
57 | movl $1,%eax # check model | ||
58 | cpuid | ||
59 | movl %eax,%ebx | ||
60 | shr $8,%ebx | ||
61 | andl $0xf,%ebx | ||
62 | cmp $6,%ebx # check family == 6 | ||
63 | jne 1f | ||
64 | shr $4,%eax | ||
65 | andl $0xf,%eax | ||
66 | cmpl $6,%eax # check model >= 6 | ||
67 | jb 1f | ||
68 | # assume models >= 6 all support this MSR | ||
69 | movl $MSR_VIA_FCR,%ecx | ||
70 | rdmsr | ||
71 | orl $((1<<1)|(1<<7)),%eax # enable CMPXCHG64 and PGE | ||
72 | wrmsr | ||
73 | 1: | ||
74 | #endif | ||
75 | movl $0x1,%eax # Does the cpu have what it takes | ||
76 | cpuid | ||
77 | |||
78 | #if CONFIG_X86_MINIMUM_CPU_MODEL > 4 | ||
79 | #error add proper model checking here | ||
80 | #endif | ||
81 | |||
82 | andl $REQUIRED_MASK1,%edx | ||
83 | xorl $REQUIRED_MASK1,%edx | ||
84 | jnz bad | ||
85 | #endif /* REQUIRED_MASK1 */ | ||
86 | |||
87 | popfl | ||
88 | xor %eax,%eax | ||
89 | ret | ||
90 | |||
91 | bad: | ||
92 | popfl | ||
93 | movl $1,%eax | ||
94 | ret | ||