Merge branch 'audit.b46' of git://git.kernel.org/pub/scm/linux/kernel/git/viro/audit...
[linux-2.6] / arch / x86 / boot / a20.c
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 }