vserver 1.9.3
[linux-2.6.git] / arch / i386 / kernel / head.S
1 /*
2  *  linux/arch/i386/kernel/head.S -- the 32-bit startup code.
3  *
4  *  Copyright (C) 1991, 1992  Linus Torvalds
5  *
6  *  Enhanced CPU detection and feature setting code by Mike Jagdis
7  *  and Martin Mares, November 1997.
8  */
9
10 .text
11 #include <linux/config.h>
12 #include <linux/threads.h>
13 #include <linux/linkage.h>
14 #include <asm/segment.h>
15 #include <asm/page.h>
16 #include <asm/pgtable.h>
17 #include <asm/desc.h>
18 #include <asm/cache.h>
19 #include <asm/thread_info.h>
20 #include <asm/asm_offsets.h>
21 #include <asm/setup.h>
22
23 /*
24  * References to members of the new_cpu_data structure.
25  */
26
27 #define X86             new_cpu_data+CPUINFO_x86
28 #define X86_VENDOR      new_cpu_data+CPUINFO_x86_vendor
29 #define X86_MODEL       new_cpu_data+CPUINFO_x86_model
30 #define X86_MASK        new_cpu_data+CPUINFO_x86_mask
31 #define X86_HARD_MATH   new_cpu_data+CPUINFO_hard_math
32 #define X86_CPUID       new_cpu_data+CPUINFO_cpuid_level
33 #define X86_CAPABILITY  new_cpu_data+CPUINFO_x86_capability
34 #define X86_VENDOR_ID   new_cpu_data+CPUINFO_x86_vendor_id
35
36 /*
37  * This is how much memory *in addition to the memory covered up to
38  * and including _end* we need mapped initially.  We need one bit for
39  * each possible page, but only in low memory, which means
40  * 2^32/4096/8 = 128K worst case (4G/4G split.)
41  *
42  * Modulo rounding, each megabyte assigned here requires a kilobyte of
43  * memory, which is currently unreclaimed.
44  *
45  * This should be a multiple of a page.
46  */
47 #define INIT_MAP_BEYOND_END     (128*1024)
48
49
50 /*
51  * 32-bit kernel entrypoint; only used by the boot CPU.  On entry,
52  * %esi points to the real-mode code as a 32-bit pointer.
53  * CS and DS must be 4 GB flat segments, but we don't depend on
54  * any particular GDT layout, because we load our own as soon as we
55  * can.
56  */
57 ENTRY(startup_32)
58
59 /*
60  * Set segments to known values.
61  */
62         cld
63         lgdt boot_gdt_descr - __PAGE_OFFSET
64         movl $(__BOOT_DS),%eax
65         movl %eax,%ds
66         movl %eax,%es
67         movl %eax,%fs
68         movl %eax,%gs
69
70 /*
71  * Clear BSS first so that there are no surprises...
72  * No need to cld as DF is already clear from cld above...
73  */
74         xorl %eax,%eax
75         movl $__bss_start - __PAGE_OFFSET,%edi
76         movl $__bss_stop - __PAGE_OFFSET,%ecx
77         subl %edi,%ecx
78         shrl $2,%ecx
79         rep ; stosl
80
81 /*
82  * Initialize page tables.  This creates a PDE and a set of page
83  * tables, which are located immediately beyond _end.  The variable
84  * init_pg_tables_end is set up to point to the first "safe" location.
85  * Mappings are created both at virtual address 0 (identity mapping)
86  * and PAGE_OFFSET for up to _end+sizeof(page tables)+INIT_MAP_BEYOND_END.
87  *
88  * Warning: don't use %esi or the stack in this code.  However, %esp
89  * can be used as a GPR if you really need it...
90  */
91 page_pde_offset = (__PAGE_OFFSET >> 20);
92
93         movl $(pg0 - __PAGE_OFFSET), %edi
94         movl $(swapper_pg_dir - __PAGE_OFFSET), %edx
95         movl $0x007, %eax                       /* 0x007 = PRESENT+RW+USER */
96 10:
97         leal 0x007(%edi),%ecx                   /* Create PDE entry */
98         movl %ecx,(%edx)                        /* Store identity PDE entry */
99         movl %ecx,page_pde_offset(%edx)         /* Store kernel PDE entry */
100         addl $4,%edx
101         movl $1024, %ecx
102 11:
103         stosl
104         addl $0x1000,%eax
105         loop 11b
106         /* End condition: we must map up to and including INIT_MAP_BEYOND_END */
107         /* bytes beyond the end of our own page tables; the +0x007 is the attribute bits */
108         leal (INIT_MAP_BEYOND_END+0x007)(%edi),%ebp
109         cmpl %ebp,%eax
110         jb 10b
111         movl %edi,(init_pg_tables_end - __PAGE_OFFSET)
112
113 #ifdef CONFIG_SMP
114         xorl %ebx,%ebx                          /* This is the boot CPU (BSP) */
115         jmp 3f
116
117 /*
118  * Non-boot CPU entry point; entered from trampoline.S
119  * We can't lgdt here, because lgdt itself uses a data segment, but
120  * we know the trampoline has already loaded the boot_gdt_table GDT
121  * for us.
122  */
123 ENTRY(startup_32_smp)
124         cld
125         movl $(__BOOT_DS),%eax
126         movl %eax,%ds
127         movl %eax,%es
128         movl %eax,%fs
129         movl %eax,%gs
130
131         xorl %ebx,%ebx
132         incl %ebx                               /* This is a secondary processor (AP) */
133
134 /*
135  *      New page tables may be in 4Mbyte page mode and may
136  *      be using the global pages. 
137  *
138  *      NOTE! If we are on a 486 we may have no cr4 at all!
139  *      So we do not try to touch it unless we really have
140  *      some bits in it to set.  This won't work if the BSP
141  *      implements cr4 but this AP does not -- very unlikely
142  *      but be warned!  The same applies to the pse feature
143  *      if not equally supported. --macro
144  *
145  *      NOTE! We have to correct for the fact that we're
146  *      not yet offset PAGE_OFFSET..
147  */
148 #define cr4_bits mmu_cr4_features-__PAGE_OFFSET
149         movl cr4_bits,%edx
150         andl %edx,%edx
151         jz 3f
152         movl %cr4,%eax          # Turn on paging options (PSE,PAE,..)
153         orl %edx,%eax
154         movl %eax,%cr4
155
156         btl $5, %eax            # check if PAE is enabled
157         jnc 6f
158
159         /* Check if extended functions are implemented */
160         movl $0x80000000, %eax
161         cpuid
162         cmpl $0x80000000, %eax
163         jbe 6f
164         mov $0x80000001, %eax
165         cpuid
166         /* Execute Disable bit supported? */
167         btl $20, %edx
168         jnc 6f
169
170         /* Setup EFER (Extended Feature Enable Register) */
171         movl $0xc0000080, %ecx
172         rdmsr
173
174         btsl $11, %eax
175         /* Make changes effective */
176         wrmsr
177
178 6:
179         /* cpuid clobbered ebx, set it up again: */
180         xorl %ebx,%ebx
181         incl %ebx
182 3:
183 #endif /* CONFIG_SMP */
184
185 /*
186  * Enable paging
187  */
188         movl $swapper_pg_dir-__PAGE_OFFSET,%eax
189         movl %eax,%cr3          /* set the page table pointer.. */
190         movl %cr0,%eax
191         orl $0x80000000,%eax
192         movl %eax,%cr0          /* ..and set paging (PG) bit */
193         ljmp $__BOOT_CS,$1f     /* Clear prefetch and normalize %eip */
194 1:
195         /* Set up the stack pointer */
196         lss stack_start,%esp
197
198 /*
199  * Initialize eflags.  Some BIOS's leave bits like NT set.  This would
200  * confuse the debugger if this code is traced.
201  * XXX - best to initialize before switching to protected mode.
202  */
203         pushl $0
204         popfl
205
206 #ifdef CONFIG_SMP
207         andl %ebx,%ebx
208         jz  1f                          /* Initial CPU cleans BSS */
209         jmp checkCPUtype
210 1:
211 #endif /* CONFIG_SMP */
212
213 /*
214  * start system 32-bit setup. We need to re-do some of the things done
215  * in 16-bit mode for the "real" operations.
216  */
217         call setup_idt
218
219 /*
220  * Copy bootup parameters out of the way.
221  * Note: %esi still has the pointer to the real-mode data.
222  */
223         movl $boot_params,%edi
224         movl $(PARAM_SIZE/4),%ecx
225         cld
226         rep
227         movsl
228         movl boot_params+NEW_CL_POINTER,%esi
229         andl %esi,%esi
230         jnz 2f                  # New command line protocol
231         cmpw $(OLD_CL_MAGIC),OLD_CL_MAGIC_ADDR
232         jne 1f
233         movzwl OLD_CL_OFFSET,%esi
234         addl $(OLD_CL_BASE_ADDR),%esi
235 2:
236         movl $saved_command_line,%edi
237         movl $(COMMAND_LINE_SIZE/4),%ecx
238         rep
239         movsl
240 1:
241 checkCPUtype:
242
243         movl $-1,X86_CPUID              #  -1 for no CPUID initially
244
245 /* check if it is 486 or 386. */
246 /*
247  * XXX - this does a lot of unnecessary setup.  Alignment checks don't
248  * apply at our cpl of 0 and the stack ought to be aligned already, and
249  * we don't need to preserve eflags.
250  */
251
252         movb $3,X86             # at least 386
253         pushfl                  # push EFLAGS
254         popl %eax               # get EFLAGS
255         movl %eax,%ecx          # save original EFLAGS
256         xorl $0x240000,%eax     # flip AC and ID bits in EFLAGS
257         pushl %eax              # copy to EFLAGS
258         popfl                   # set EFLAGS
259         pushfl                  # get new EFLAGS
260         popl %eax               # put it in eax
261         xorl %ecx,%eax          # change in flags
262         pushl %ecx              # restore original EFLAGS
263         popfl
264         testl $0x40000,%eax     # check if AC bit changed
265         je is386
266
267         movb $4,X86             # at least 486
268         testl $0x200000,%eax    # check if ID bit changed
269         je is486
270
271         /* get vendor info */
272         xorl %eax,%eax                  # call CPUID with 0 -> return vendor ID
273         cpuid
274         movl %eax,X86_CPUID             # save CPUID level
275         movl %ebx,X86_VENDOR_ID         # lo 4 chars
276         movl %edx,X86_VENDOR_ID+4       # next 4 chars
277         movl %ecx,X86_VENDOR_ID+8       # last 4 chars
278
279         orl %eax,%eax                   # do we have processor info as well?
280         je is486
281
282         movl $1,%eax            # Use the CPUID instruction to get CPU type
283         cpuid
284         movb %al,%cl            # save reg for future use
285         andb $0x0f,%ah          # mask processor family
286         movb %ah,X86
287         andb $0xf0,%al          # mask model
288         shrb $4,%al
289         movb %al,X86_MODEL
290         andb $0x0f,%cl          # mask mask revision
291         movb %cl,X86_MASK
292         movl %edx,X86_CAPABILITY
293
294 is486:  movl $0x50022,%ecx      # set AM, WP, NE and MP
295         jmp 2f
296
297 is386:  movl $2,%ecx            # set MP
298 2:      movl %cr0,%eax
299         andl $0x80000011,%eax   # Save PG,PE,ET
300         orl %ecx,%eax
301         movl %eax,%cr0
302
303         call check_x87
304         incb ready
305         lgdt cpu_gdt_descr
306         lidt idt_descr
307         ljmp $(__KERNEL_CS),$1f
308 1:      movl $(__KERNEL_DS),%eax        # reload all the segment registers
309         movl %eax,%ss                   # after changing gdt.
310
311         movl $(__USER_DS),%eax          # DS/ES contains default USER segment
312         movl %eax,%ds
313         movl %eax,%es
314
315         xorl %eax,%eax                  # Clear FS/GS and LDT
316         movl %eax,%fs
317         movl %eax,%gs
318         lldt %ax
319         cld                     # gcc2 wants the direction flag cleared at all times
320 #ifdef CONFIG_SMP
321         movb ready, %cl 
322         cmpb $1,%cl
323         je 1f                   # the first CPU calls start_kernel
324                                 # all other CPUs call initialize_secondary
325         call initialize_secondary
326         jmp L6
327 1:
328 #endif /* CONFIG_SMP */
329         call start_kernel
330 L6:
331         jmp L6                  # main should never return here, but
332                                 # just in case, we know what happens.
333
334 /*
335  * We depend on ET to be correct. This checks for 287/387.
336  */
337 check_x87:
338         movb $0,X86_HARD_MATH
339         clts
340         fninit
341         fstsw %ax
342         cmpb $0,%al
343         je 1f
344         movl %cr0,%eax          /* no coprocessor: have to set bits */
345         xorl $4,%eax            /* set EM */
346         movl %eax,%cr0
347         ret
348         ALIGN
349 1:      movb $1,X86_HARD_MATH
350         .byte 0xDB,0xE4         /* fsetpm for 287, ignored by 387 */
351         ret
352
353 /*
354  *  setup_idt
355  *
356  *  sets up a idt with 256 entries pointing to
357  *  ignore_int, interrupt gates. It doesn't actually load
358  *  idt - that can be done only after paging has been enabled
359  *  and the kernel moved to PAGE_OFFSET. Interrupts
360  *  are enabled elsewhere, when we can be relatively
361  *  sure everything is ok.
362  *
363  *  Warning: %esi is live across this function.
364  */
365 setup_idt:
366         lea ignore_int,%edx
367         movl $(__KERNEL_CS << 16),%eax
368         movw %dx,%ax            /* selector = 0x0010 = cs */
369         movw $0x8E00,%dx        /* interrupt gate - dpl=0, present */
370
371         lea idt_table,%edi
372         mov $256,%ecx
373 rp_sidt:
374         movl %eax,(%edi)
375         movl %edx,4(%edi)
376         addl $8,%edi
377         dec %ecx
378         jne rp_sidt
379         ret
380
381 /* This is the default interrupt "handler" :-) */
382         ALIGN
383 ignore_int:
384         cld
385         pushl %eax
386         pushl %ecx
387         pushl %edx
388         pushl %es
389         pushl %ds
390         movl $(__KERNEL_DS),%eax
391         movl %eax,%ds
392         movl %eax,%es
393         pushl 16(%esp)
394         pushl 24(%esp)
395         pushl 32(%esp)
396         pushl 40(%esp)
397         pushl $int_msg
398         call printk
399         addl $(5*4),%esp
400         popl %ds
401         popl %es
402         popl %edx
403         popl %ecx
404         popl %eax
405         iret
406
407 /*
408  * Real beginning of normal "text" segment
409  */
410 ENTRY(stext)
411 ENTRY(_stext)
412
413 /*
414  * BSS section
415  */
416 .section ".bss.page_aligned","w"
417 ENTRY(swapper_pg_dir)
418         .fill 1024,4,0
419 ENTRY(empty_zero_page)
420         .fill 4096,1,0
421
422 /*
423  * This starts the data section.
424  */
425 .data
426
427 ENTRY(stack_start)
428         .long init_thread_union+THREAD_SIZE
429         .long __BOOT_DS
430
431 ready:  .byte 0
432
433 int_msg:
434         .asciz "Unknown interrupt or fault at EIP %p %p %p\n"
435
436 /*
437  * The IDT and GDT 'descriptors' are a strange 48-bit object
438  * only used by the lidt and lgdt instructions. They are not
439  * like usual segment descriptors - they consist of a 16-bit
440  * segment size, and 32-bit linear address value:
441  */
442
443 .globl boot_gdt_descr
444 .globl idt_descr
445 .globl cpu_gdt_descr
446
447         ALIGN
448 # early boot GDT descriptor (must use 1:1 address mapping)
449         .word 0                         # 32 bit align gdt_desc.address
450 boot_gdt_descr:
451         .word __BOOT_DS+7
452         .long boot_gdt_table - __PAGE_OFFSET
453
454         .word 0                         # 32-bit align idt_desc.address
455 idt_descr:
456         .word IDT_ENTRIES*8-1           # idt contains 256 entries
457         .long idt_table
458
459 # boot GDT descriptor (later on used by CPU#0):
460         .word 0                         # 32 bit align gdt_desc.address
461 cpu_gdt_descr:
462         .word GDT_ENTRIES*8-1
463         .long cpu_gdt_table
464
465         .fill NR_CPUS-1,8,0             # space for the other GDT descriptors
466
467 /*
468  * The boot_gdt_table must mirror the equivalent in setup.S and is
469  * used only for booting.
470  */
471         .align L1_CACHE_BYTES
472 ENTRY(boot_gdt_table)
473         .fill GDT_ENTRY_BOOT_CS,8,0
474         .quad 0x00cf9a000000ffff        /* kernel 4GB code at 0x00000000 */
475         .quad 0x00cf92000000ffff        /* kernel 4GB data at 0x00000000 */
476
477 /*
478  * The Global Descriptor Table contains 28 quadwords, per-CPU.
479  */
480         .align PAGE_SIZE_asm
481 ENTRY(cpu_gdt_table)
482         .quad 0x0000000000000000        /* NULL descriptor */
483         .quad 0x0000000000000000        /* 0x0b reserved */
484         .quad 0x0000000000000000        /* 0x13 reserved */
485         .quad 0x0000000000000000        /* 0x1b reserved */
486         .quad 0x0000000000000000        /* 0x20 unused */
487         .quad 0x0000000000000000        /* 0x28 unused */
488         .quad 0x0000000000000000        /* 0x33 TLS entry 1 */
489         .quad 0x0000000000000000        /* 0x3b TLS entry 2 */
490         .quad 0x0000000000000000        /* 0x43 TLS entry 3 */
491         .quad 0x0000000000000000        /* 0x4b reserved */
492         .quad 0x0000000000000000        /* 0x53 reserved */
493         .quad 0x0000000000000000        /* 0x5b reserved */
494
495         .quad 0x00cf9a000000ffff        /* 0x60 kernel 4GB code at 0x00000000 */
496         .quad 0x00cf92000000ffff        /* 0x68 kernel 4GB data at 0x00000000 */
497         .quad 0x00cffa000000ffff        /* 0x73 user 4GB code at 0x00000000 */
498         .quad 0x00cff2000000ffff        /* 0x7b user 4GB data at 0x00000000 */
499
500         .quad 0x0000000000000000        /* 0x80 TSS descriptor */
501         .quad 0x0000000000000000        /* 0x88 LDT descriptor */
502
503         /* Segments used for calling PnP BIOS */
504         .quad 0x00c09a0000000000        /* 0x90 32-bit code */
505         .quad 0x00809a0000000000        /* 0x98 16-bit code */
506         .quad 0x0080920000000000        /* 0xa0 16-bit data */
507         .quad 0x0080920000000000        /* 0xa8 16-bit data */
508         .quad 0x0080920000000000        /* 0xb0 16-bit data */
509         /*
510          * The APM segments have byte granularity and their bases
511          * and limits are set at run time.
512          */
513         .quad 0x00409a0000000000        /* 0xb8 APM CS    code */
514         .quad 0x00009a0000000000        /* 0xc0 APM CS 16 code (16 bit) */
515         .quad 0x0040920000000000        /* 0xc8 APM DS    data */
516
517         .quad 0x0000000000000000        /* 0xd0 - unused */
518         .quad 0x0000000000000000        /* 0xd8 - unused */
519         .quad 0x0000000000000000        /* 0xe0 - unused */
520         .quad 0x0000000000000000        /* 0xe8 - unused */
521         .quad 0x0000000000000000        /* 0xf0 - unused */
522         .quad 0x0000000000000000        /* 0xf8 - GDT entry 31: double-fault TSS */
523