drivers: power: report battery voltage in AOSP compatible format
[GitHub/mt8127/android_kernel_alcatel_ttab.git] / arch / x86 / kernel / head_32.S
CommitLineData
1da177e4 1/*
1da177e4
LT
2 *
3 * Copyright (C) 1991, 1992 Linus Torvalds
4 *
5 * Enhanced CPU detection and feature setting code by Mike Jagdis
6 * and Martin Mares, November 1997.
7 */
8
9.text
1da177e4 10#include <linux/threads.h>
8b2f7fff 11#include <linux/init.h>
1da177e4
LT
12#include <linux/linkage.h>
13#include <asm/segment.h>
0341c14d
JF
14#include <asm/page_types.h>
15#include <asm/pgtable_types.h>
1da177e4
LT
16#include <asm/cache.h>
17#include <asm/thread_info.h>
86feeaa8 18#include <asm/asm-offsets.h>
1da177e4 19#include <asm/setup.h>
551889a6 20#include <asm/processor-flags.h>
8a50e513
PA
21#include <asm/msr-index.h>
22#include <asm/cpufeature.h>
60a5317f 23#include <asm/percpu.h>
4c5023a3 24#include <asm/nops.h>
551889a6
IC
25
26/* Physical address */
27#define pa(X) ((X) - __PAGE_OFFSET)
1da177e4
LT
28
29/*
30 * References to members of the new_cpu_data structure.
31 */
32
33#define X86 new_cpu_data+CPUINFO_x86
34#define X86_VENDOR new_cpu_data+CPUINFO_x86_vendor
35#define X86_MODEL new_cpu_data+CPUINFO_x86_model
36#define X86_MASK new_cpu_data+CPUINFO_x86_mask
37#define X86_HARD_MATH new_cpu_data+CPUINFO_hard_math
38#define X86_CPUID new_cpu_data+CPUINFO_cpuid_level
39#define X86_CAPABILITY new_cpu_data+CPUINFO_x86_capability
40#define X86_VENDOR_ID new_cpu_data+CPUINFO_x86_vendor_id
41
42/*
c090f532
JF
43 * This is how much memory in addition to the memory covered up to
44 * and including _end we need mapped initially.
9ce8c2ed 45 * We need:
2bd2753f
YL
46 * (KERNEL_IMAGE_SIZE/4096) / 1024 pages (worst case, non PAE)
47 * (KERNEL_IMAGE_SIZE/4096) / 512 + 4 pages (worst case for PAE)
1da177e4
LT
48 *
49 * Modulo rounding, each megabyte assigned here requires a kilobyte of
50 * memory, which is currently unreclaimed.
51 *
52 * This should be a multiple of a page.
2bd2753f
YL
53 *
54 * KERNEL_IMAGE_SIZE should be greater than pa(_end)
55 * and small than max_low_pfn, otherwise will waste some page table entries
1da177e4 56 */
1da177e4 57
9ce8c2ed 58#if PTRS_PER_PMD > 1
c090f532 59#define PAGE_TABLE_SIZE(pages) (((pages) / PTRS_PER_PMD) + PTRS_PER_PGD)
9ce8c2ed 60#else
c090f532 61#define PAGE_TABLE_SIZE(pages) ((pages) / PTRS_PER_PGD)
9ce8c2ed 62#endif
9ce8c2ed 63
147dd561
PA
64/* Number of possible pages in the lowmem region */
65LOWMEM_PAGES = (((1<<32) - __PAGE_OFFSET) >> PAGE_SHIFT)
66
c090f532 67/* Enough space to fit pagetables for the low memory linear map */
147dd561 68MAPPING_BEYOND_END = PAGE_TABLE_SIZE(LOWMEM_PAGES) << PAGE_SHIFT
c090f532
JF
69
70/*
71 * Worst-case size of the kernel mapping we need to make:
147dd561
PA
72 * a relocatable kernel can live anywhere in lowmem, so we need to be able
73 * to map all of lowmem.
c090f532 74 */
147dd561 75KERNEL_PAGES = LOWMEM_PAGES
c090f532 76
7bf04be8 77INIT_MAP_SIZE = PAGE_TABLE_SIZE(KERNEL_PAGES) * PAGE_SIZE
2bd2753f 78RESERVE_BRK(pagetables, INIT_MAP_SIZE)
796216a5 79
1da177e4
LT
80/*
81 * 32-bit kernel entrypoint; only used by the boot CPU. On entry,
82 * %esi points to the real-mode code as a 32-bit pointer.
83 * CS and DS must be 4 GB flat segments, but we don't depend on
84 * any particular GDT layout, because we load our own as soon as we
85 * can.
86 */
4ae59b91 87__HEAD
1da177e4 88ENTRY(startup_32)
11d4c3f9
PA
89 movl pa(stack_start),%ecx
90
a24e7851
RR
91 /* test KEEP_SEGMENTS flag to see if the bootloader is asking
92 us to not reload segments */
93 testb $(1<<6), BP_loadflags(%esi)
94 jnz 2f
1da177e4
LT
95
96/*
97 * Set segments to known values.
98 */
551889a6 99 lgdt pa(boot_gdt_descr)
1da177e4
LT
100 movl $(__BOOT_DS),%eax
101 movl %eax,%ds
102 movl %eax,%es
103 movl %eax,%fs
104 movl %eax,%gs
11d4c3f9 105 movl %eax,%ss
a24e7851 1062:
11d4c3f9 107 leal -__PAGE_OFFSET(%ecx),%esp
1da177e4
LT
108
109/*
110 * Clear BSS first so that there are no surprises...
1da177e4 111 */
a24e7851 112 cld
1da177e4 113 xorl %eax,%eax
551889a6
IC
114 movl $pa(__bss_start),%edi
115 movl $pa(__bss_stop),%ecx
1da177e4
LT
116 subl %edi,%ecx
117 shrl $2,%ecx
118 rep ; stosl
484b90c4
VG
119/*
120 * Copy bootup parameters out of the way.
121 * Note: %esi still has the pointer to the real-mode data.
122 * With the kexec as boot loader, parameter segment might be loaded beyond
123 * kernel image and might not even be addressable by early boot page tables.
124 * (kexec on panic case). Hence copy out the parameters before initializing
125 * page tables.
126 */
551889a6 127 movl $pa(boot_params),%edi
484b90c4
VG
128 movl $(PARAM_SIZE/4),%ecx
129 cld
130 rep
131 movsl
551889a6 132 movl pa(boot_params) + NEW_CL_POINTER,%esi
484b90c4 133 andl %esi,%esi
b595076a 134 jz 1f # No command line
551889a6 135 movl $pa(boot_command_line),%edi
484b90c4
VG
136 movl $(COMMAND_LINE_SIZE/4),%ecx
137 rep
138 movsl
1391:
1da177e4 140
dc3119e7 141#ifdef CONFIG_OLPC
fd699c76
AS
142 /* save OFW's pgdir table for later use when calling into OFW */
143 movl %cr3, %eax
144 movl %eax, pa(olpc_ofw_pgd)
145#endif
146
63b553c6
FY
147#ifdef CONFIG_MICROCODE_EARLY
148 /* Early load ucode on BSP. */
149 call load_ucode_bsp
150#endif
151
1da177e4
LT
152/*
153 * Initialize page tables. This creates a PDE and a set of page
2bd2753f 154 * tables, which are located immediately beyond __brk_base. The variable
ccf3fe02 155 * _brk_end is set up to point to the first "safe" location.
1da177e4 156 * Mappings are created both at virtual address 0 (identity mapping)
2bd2753f 157 * and PAGE_OFFSET for up to _end.
1da177e4 158 */
551889a6
IC
159#ifdef CONFIG_X86_PAE
160
161 /*
b40827fa
BP
162 * In PAE mode initial_page_table is statically defined to contain
163 * enough entries to cover the VMSPLIT option (that is the top 1, 2 or 3
164 * entries). The identity mapping is handled by pointing two PGD entries
165 * to the first kernel PMD.
551889a6 166 *
b40827fa 167 * Note the upper half of each PMD or PTE are always zero at this stage.
551889a6
IC
168 */
169
86b2b70e 170#define KPMDS (((-__PAGE_OFFSET) >> 30) & 3) /* Number of kernel PMDs */
551889a6
IC
171
172 xorl %ebx,%ebx /* %ebx is kept at zero */
173
ccf3fe02 174 movl $pa(__brk_base), %edi
b40827fa 175 movl $pa(initial_pg_pmd), %edx
b2bc2731 176 movl $PTE_IDENT_ATTR, %eax
551889a6 17710:
b2bc2731 178 leal PDE_IDENT_ATTR(%edi),%ecx /* Create PMD entry */
551889a6
IC
179 movl %ecx,(%edx) /* Store PMD entry */
180 /* Upper half already zero */
181 addl $8,%edx
182 movl $512,%ecx
18311:
184 stosl
185 xchgl %eax,%ebx
186 stosl
187 xchgl %eax,%ebx
188 addl $0x1000,%eax
189 loop 11b
190
191 /*
c090f532 192 * End condition: we must map up to the end + MAPPING_BEYOND_END.
551889a6 193 */
c090f532 194 movl $pa(_end) + MAPPING_BEYOND_END + PTE_IDENT_ATTR, %ebp
551889a6
IC
195 cmpl %ebp,%eax
196 jb 10b
1971:
ccf3fe02
JF
198 addl $__PAGE_OFFSET, %edi
199 movl %edi, pa(_brk_end)
6af61a76
YL
200 shrl $12, %eax
201 movl %eax, pa(max_pfn_mapped)
551889a6
IC
202
203 /* Do early initialization of the fixmap area */
b40827fa
BP
204 movl $pa(initial_pg_fixmap)+PDE_IDENT_ATTR,%eax
205 movl %eax,pa(initial_pg_pmd+0x1000*KPMDS-8)
551889a6
IC
206#else /* Not PAE */
207
208page_pde_offset = (__PAGE_OFFSET >> 20);
209
ccf3fe02 210 movl $pa(__brk_base), %edi
b40827fa 211 movl $pa(initial_page_table), %edx
b2bc2731 212 movl $PTE_IDENT_ATTR, %eax
1da177e4 21310:
b2bc2731 214 leal PDE_IDENT_ATTR(%edi),%ecx /* Create PDE entry */
1da177e4
LT
215 movl %ecx,(%edx) /* Store identity PDE entry */
216 movl %ecx,page_pde_offset(%edx) /* Store kernel PDE entry */
217 addl $4,%edx
218 movl $1024, %ecx
21911:
220 stosl
221 addl $0x1000,%eax
222 loop 11b
551889a6 223 /*
c090f532 224 * End condition: we must map up to the end + MAPPING_BEYOND_END.
551889a6 225 */
c090f532 226 movl $pa(_end) + MAPPING_BEYOND_END + PTE_IDENT_ATTR, %ebp
1da177e4
LT
227 cmpl %ebp,%eax
228 jb 10b
ccf3fe02
JF
229 addl $__PAGE_OFFSET, %edi
230 movl %edi, pa(_brk_end)
6af61a76
YL
231 shrl $12, %eax
232 movl %eax, pa(max_pfn_mapped)
17d57a92 233
551889a6 234 /* Do early initialization of the fixmap area */
b40827fa
BP
235 movl $pa(initial_pg_fixmap)+PDE_IDENT_ATTR,%eax
236 movl %eax,pa(initial_page_table+0xffc)
551889a6 237#endif
d50d8fe1
RR
238
239#ifdef CONFIG_PARAVIRT
240 /* This is can only trip for a broken bootloader... */
241 cmpw $0x207, pa(boot_params + BP_version)
242 jb default_entry
243
244 /* Paravirt-compatible boot parameters. Look to see what architecture
245 we're booting under. */
246 movl pa(boot_params + BP_hardware_subarch), %eax
247 cmpl $num_subarch_entries, %eax
248 jae bad_subarch
249
250 movl pa(subarch_entries)(,%eax,4), %eax
251 subl $__PAGE_OFFSET, %eax
252 jmp *%eax
253
254bad_subarch:
255WEAK(lguest_entry)
256WEAK(xen_entry)
257 /* Unknown implementation; there's really
258 nothing we can do at this point. */
259 ud2a
260
261 __INITDATA
262
263subarch_entries:
264 .long default_entry /* normal x86/PC */
265 .long lguest_entry /* lguest hypervisor */
266 .long xen_entry /* Xen hypervisor */
267 .long default_entry /* Moorestown MID */
268num_subarch_entries = (. - subarch_entries) / 4
269.previous
270#else
271 jmp default_entry
272#endif /* CONFIG_PARAVIRT */
273
3e2a0cc3
FY
274#ifdef CONFIG_HOTPLUG_CPU
275/*
276 * Boot CPU0 entry point. It's called from play_dead(). Everything has been set
277 * up already except stack. We just set up stack here. Then call
278 * start_secondary().
279 */
280ENTRY(start_cpu0)
281 movl stack_start, %ecx
282 movl %ecx, %esp
283 jmp *(initial_code)
284ENDPROC(start_cpu0)
285#endif
286
1da177e4
LT
287/*
288 * Non-boot CPU entry point; entered from trampoline.S
289 * We can't lgdt here, because lgdt itself uses a data segment, but
52de74dd 290 * we know the trampoline has already loaded the boot_gdt for us.
f8657e1b
VG
291 *
292 * If cpu hotplug is not supported then this code can go in init section
293 * which will be freed later
1da177e4 294 */
78b89ecd 295__CPUINIT
1da177e4
LT
296ENTRY(startup_32_smp)
297 cld
298 movl $(__BOOT_DS),%eax
299 movl %eax,%ds
300 movl %eax,%es
301 movl %eax,%fs
302 movl %eax,%gs
11d4c3f9
PA
303 movl pa(stack_start),%ecx
304 movl %eax,%ss
305 leal -__PAGE_OFFSET(%ecx),%esp
48927bbb 306
63b553c6
FY
307#ifdef CONFIG_MICROCODE_EARLY
308 /* Early load ucode on AP. */
309 call load_ucode_ap
310#endif
311
312
d50d8fe1 313default_entry:
021ef050
PA
314#define CR0_STATE (X86_CR0_PE | X86_CR0_MP | X86_CR0_ET | \
315 X86_CR0_NE | X86_CR0_WP | X86_CR0_AM | \
316 X86_CR0_PG)
317 movl $(CR0_STATE & ~X86_CR0_PG),%eax
318 movl %eax,%cr0
319
1da177e4 320/*
9efb58de
BP
321 * We want to start out with EFLAGS unambiguously cleared. Some BIOSes leave
322 * bits like NT set. This would confuse the debugger if this code is traced. So
323 * initialize them properly now before switching to protected mode. That means
324 * DF in particular (even though we have cleared it earlier after copying the
325 * command line) because GCC expects it.
326 */
327 pushl $0
328 popfl
329
330/*
331 * New page tables may be in 4Mbyte page mode and may be using the global pages.
1da177e4 332 *
9efb58de
BP
333 * NOTE! If we are on a 486 we may have no cr4 at all! Specifically, cr4 exists
334 * if and only if CPUID exists and has flags other than the FPU flag set.
1da177e4 335 */
9efb58de 336 movl $-1,pa(X86_CPUID) # preset CPUID level
5a5a51db
PA
337 movl $X86_EFLAGS_ID,%ecx
338 pushl %ecx
9efb58de 339 popfl # set EFLAGS=ID
5a5a51db 340 pushfl
9efb58de
BP
341 popl %eax # get EFLAGS
342 testl $X86_EFLAGS_ID,%eax # did EFLAGS.ID remained set?
5e2a044d 343 jz enable_paging # hw disallowed setting of ID bit
9efb58de
BP
344 # which means no CPUID and no CR4
345
346 xorl %eax,%eax
347 cpuid
348 movl %eax,pa(X86_CPUID) # save largest std CPUID function
5a5a51db 349
6662c34f
PA
350 movl $1,%eax
351 cpuid
9efb58de 352 andl $~1,%edx # Ignore CPUID.FPU
5e2a044d 353 jz enable_paging # No flags or only CPUID.FPU = no CR4
6662c34f 354
5a5a51db 355 movl pa(mmu_cr4_features),%eax
1da177e4
LT
356 movl %eax,%cr4
357
8a50e513 358 testb $X86_CR4_PAE, %al # check if PAE is enabled
5e2a044d 359 jz enable_paging
1da177e4
LT
360
361 /* Check if extended functions are implemented */
362 movl $0x80000000, %eax
363 cpuid
8a50e513
PA
364 /* Value must be in the range 0x80000001 to 0x8000ffff */
365 subl $0x80000001, %eax
366 cmpl $(0x8000ffff-0x80000001), %eax
5e2a044d 367 ja enable_paging
ebba638a
KC
368
369 /* Clear bogus XD_DISABLE bits */
370 call verify_cpu
371
1da177e4
LT
372 mov $0x80000001, %eax
373 cpuid
374 /* Execute Disable bit supported? */
8a50e513 375 btl $(X86_FEATURE_NX & 31), %edx
5e2a044d 376 jnc enable_paging
1da177e4
LT
377
378 /* Setup EFER (Extended Feature Enable Register) */
8a50e513 379 movl $MSR_EFER, %ecx
1da177e4
LT
380 rdmsr
381
8a50e513 382 btsl $_EFER_NX, %eax
1da177e4
LT
383 /* Make changes effective */
384 wrmsr
385
5e2a044d 386enable_paging:
1da177e4
LT
387
388/*
389 * Enable paging
390 */
b40827fa 391 movl $pa(initial_page_table), %eax
1da177e4 392 movl %eax,%cr3 /* set the page table pointer.. */
021ef050 393 movl $CR0_STATE,%eax
1da177e4
LT
394 movl %eax,%cr0 /* ..and set paging (PG) bit */
395 ljmp $__BOOT_CS,$1f /* Clear prefetch and normalize %eip */
3961:
11d4c3f9
PA
397 /* Shift the stack pointer to a virtual address */
398 addl $__PAGE_OFFSET, %esp
1da177e4 399
1da177e4
LT
400/*
401 * start system 32-bit setup. We need to re-do some of the things done
402 * in 16-bit mode for the "real" operations.
403 */
4c5023a3
PA
404 movl setup_once_ref,%eax
405 andl %eax,%eax
406 jz 1f # Did we do this already?
407 call *%eax
4081:
166df91d 409
1da177e4 410/*
166df91d 411 * Check if it is 486
1da177e4 412 */
c3a22a26 413 cmpl $-1,X86_CPUID
1da177e4
LT
414 je is486
415
416 /* get vendor info */
417 xorl %eax,%eax # call CPUID with 0 -> return vendor ID
418 cpuid
419 movl %eax,X86_CPUID # save CPUID level
420 movl %ebx,X86_VENDOR_ID # lo 4 chars
421 movl %edx,X86_VENDOR_ID+4 # next 4 chars
422 movl %ecx,X86_VENDOR_ID+8 # last 4 chars
423
424 orl %eax,%eax # do we have processor info as well?
425 je is486
426
427 movl $1,%eax # Use the CPUID instruction to get CPU type
428 cpuid
429 movb %al,%cl # save reg for future use
430 andb $0x0f,%ah # mask processor family
431 movb %ah,X86
432 andb $0xf0,%al # mask model
433 shrb $4,%al
434 movb %al,X86_MODEL
435 andb $0x0f,%cl # mask mask revision
436 movb %cl,X86_MASK
437 movl %edx,X86_CAPABILITY
438
c3a22a26
BP
439is486:
440 movb $4,X86
441 movl $0x50022,%ecx # set AM, WP, NE and MP
166df91d 442 movl %cr0,%eax
1da177e4
LT
443 andl $0x80000011,%eax # Save PG,PE,ET
444 orl %ecx,%eax
445 movl %eax,%cr0
446
447 call check_x87
2a57ff1a 448 lgdt early_gdt_descr
1da177e4
LT
449 lidt idt_descr
450 ljmp $(__KERNEL_CS),$1f
4511: movl $(__KERNEL_DS),%eax # reload all the segment registers
452 movl %eax,%ss # after changing gdt.
453
454 movl $(__USER_DS),%eax # DS/ES contains default USER segment
455 movl %eax,%ds
456 movl %eax,%es
457
0dd76d73
BG
458 movl $(__KERNEL_PERCPU), %eax
459 movl %eax,%fs # set this cpu's percpu
460
60a5317f 461 movl $(__KERNEL_STACK_CANARY),%eax
464d1a78 462 movl %eax,%gs
60a5317f
TH
463
464 xorl %eax,%eax # Clear LDT
1da177e4 465 lldt %ax
f95d47ca 466
26fd5e08 467 pushl $0 # fake return address for unwinder
e3f77edf 468 jmp *(initial_code)
1da177e4
LT
469
470/*
471 * We depend on ET to be correct. This checks for 287/387.
472 */
473check_x87:
474 movb $0,X86_HARD_MATH
475 clts
476 fninit
477 fstsw %ax
478 cmpb $0,%al
479 je 1f
480 movl %cr0,%eax /* no coprocessor: have to set bits */
481 xorl $4,%eax /* set EM */
482 movl %eax,%cr0
483 ret
484 ALIGN
4851: movb $1,X86_HARD_MATH
486 .byte 0xDB,0xE4 /* fsetpm for 287, ignored by 387 */
487 ret
488
4c5023a3
PA
489
490#include "verify_cpu.S"
491
1da177e4 492/*
4c5023a3 493 * setup_once
1da177e4 494 *
4c5023a3 495 * The setup work we only want to run on the BSP.
1da177e4
LT
496 *
497 * Warning: %esi is live across this function.
498 */
4c5023a3
PA
499__INIT
500setup_once:
501 /*
4800af91
AL
502 * Set up a idt with 256 interrupt gates that push zero if there
503 * is no error code and then jump to early_idt_handler_common.
504 * It doesn't actually load the idt - that needs to be done on
505 * each CPU. Interrupts are enabled elsewhere, when we can be
506 * relatively sure everything is ok.
4c5023a3 507 */
1da177e4 508
4c5023a3 509 movl $idt_table,%edi
4800af91 510 movl $early_idt_handler_array,%eax
4c5023a3
PA
511 movl $NUM_EXCEPTION_VECTORS,%ecx
5121:
1da177e4 513 movl %eax,(%edi)
4c5023a3
PA
514 movl %eax,4(%edi)
515 /* interrupt gate, dpl=0, present */
516 movl $(0x8E000000 + __KERNEL_CS),2(%edi)
4800af91 517 addl $EARLY_IDT_HANDLER_SIZE,%eax
1da177e4 518 addl $8,%edi
4c5023a3 519 loop 1b
ec5c0926 520
4c5023a3
PA
521 movl $256 - NUM_EXCEPTION_VECTORS,%ecx
522 movl $ignore_int,%edx
ec5c0926 523 movl $(__KERNEL_CS << 16),%eax
4c5023a3 524 movw %dx,%ax /* selector = 0x0010 = cs */
ec5c0926 525 movw $0x8E00,%dx /* interrupt gate - dpl=0, present */
4c5023a3
PA
5262:
527 movl %eax,(%edi)
528 movl %edx,4(%edi)
529 addl $8,%edi
530 loop 2b
ec5c0926 531
4c5023a3
PA
532#ifdef CONFIG_CC_STACKPROTECTOR
533 /*
534 * Configure the stack canary. The linker can't handle this by
535 * relocation. Manually set base address in stack canary
536 * segment descriptor.
537 */
538 movl $gdt_page,%eax
539 movl $stack_canary,%ecx
540 movw %cx, 8 * GDT_ENTRY_STACK_CANARY + 2(%eax)
541 shrl $16, %ecx
542 movb %cl, 8 * GDT_ENTRY_STACK_CANARY + 4(%eax)
543 movb %ch, 8 * GDT_ENTRY_STACK_CANARY + 7(%eax)
544#endif
ec5c0926 545
4c5023a3 546 andl $0,setup_once_ref /* Once is enough, thanks */
1da177e4
LT
547 ret
548
4800af91 549ENTRY(early_idt_handler_array)
4c5023a3
PA
550 # 36(%esp) %eflags
551 # 32(%esp) %cs
552 # 28(%esp) %eip
553 # 24(%rsp) error code
554 i = 0
555 .rept NUM_EXCEPTION_VECTORS
4800af91 556 .ifeq (EXCEPTION_ERRCODE_MASK >> i) & 1
4c5023a3
PA
557 pushl $0 # Dummy error code, to make stack frame uniform
558 .endif
559 pushl $i # 20(%esp) Vector number
4800af91 560 jmp early_idt_handler_common
4c5023a3 561 i = i + 1
4800af91 562 .fill early_idt_handler_array + i*EARLY_IDT_HANDLER_SIZE - ., 1, 0xcc
4c5023a3 563 .endr
4800af91 564ENDPROC(early_idt_handler_array)
4c5023a3 565
4800af91
AL
566early_idt_handler_common:
567 /*
568 * The stack is the hardware frame, an error code or zero, and the
569 * vector number.
570 */
4c5023a3 571 cld
a56c57c0 572
4a24592b 573 cmpl $2,(%esp) # X86_TRAP_NMI
a56c57c0
PA
574 je is_nmi # Ignore NMI
575
4c5023a3
PA
576 cmpl $2,%ss:early_recursion_flag
577 je hlt_loop
578 incl %ss:early_recursion_flag
ec5c0926 579
4c5023a3
PA
580 push %eax # 16(%esp)
581 push %ecx # 12(%esp)
582 push %edx # 8(%esp)
583 push %ds # 4(%esp)
584 push %es # 0(%esp)
585 movl $(__KERNEL_DS),%eax
586 movl %eax,%ds
587 movl %eax,%es
ec5c0926 588
213060d9 589 cmpw $(__KERNEL_CS),32(%esp)
4c5023a3 590 jne 10f
ec5c0926 591
4c5023a3
PA
592 leal 28(%esp),%eax # Pointer to %eip
593 call early_fixup_exception
594 andl %eax,%eax
595 jnz ex_entry /* found an exception entry */
ec5c0926 596
4c5023a3 59710:
ec5c0926 598#ifdef CONFIG_PRINTK
4c5023a3
PA
599 xorl %eax,%eax
600 movw %ax,2(%esp) /* clean up the segment values on some cpus */
601 movw %ax,6(%esp)
602 movw %ax,34(%esp)
603 leal 40(%esp),%eax
604 pushl %eax /* %esp before the exception */
605 pushl %ebx
606 pushl %ebp
607 pushl %esi
608 pushl %edi
ec5c0926
CE
609 movl %cr2,%eax
610 pushl %eax
4c5023a3 611 pushl (20+6*4)(%esp) /* trapno */
ec5c0926 612 pushl $fault_msg
ec5c0926 613 call printk
ec5c0926 614#endif
94878efd 615 call dump_stack
ec5c0926
CE
616hlt_loop:
617 hlt
618 jmp hlt_loop
619
4c5023a3
PA
620ex_entry:
621 pop %es
622 pop %ds
623 pop %edx
624 pop %ecx
625 pop %eax
4c5023a3 626 decl %ss:early_recursion_flag
a56c57c0
PA
627is_nmi:
628 addl $8,%esp /* drop vector number and error code */
4c5023a3 629 iret
4800af91 630ENDPROC(early_idt_handler_common)
4c5023a3 631
1da177e4
LT
632/* This is the default interrupt "handler" :-) */
633 ALIGN
634ignore_int:
635 cld
d59745ce 636#ifdef CONFIG_PRINTK
1da177e4
LT
637 pushl %eax
638 pushl %ecx
639 pushl %edx
640 pushl %es
641 pushl %ds
642 movl $(__KERNEL_DS),%eax
643 movl %eax,%ds
644 movl %eax,%es
ec5c0926
CE
645 cmpl $2,early_recursion_flag
646 je hlt_loop
647 incl early_recursion_flag
1da177e4
LT
648 pushl 16(%esp)
649 pushl 24(%esp)
650 pushl 32(%esp)
651 pushl 40(%esp)
652 pushl $int_msg
653 call printk
d5e397cb
IM
654
655 call dump_stack
656
1da177e4
LT
657 addl $(5*4),%esp
658 popl %ds
659 popl %es
660 popl %edx
661 popl %ecx
662 popl %eax
d59745ce 663#endif
1da177e4 664 iret
4c5023a3
PA
665ENDPROC(ignore_int)
666__INITDATA
667 .align 4
668early_recursion_flag:
669 .long 0
1da177e4 670
4c5023a3
PA
671__REFDATA
672 .align 4
583323b9
TG
673ENTRY(initial_code)
674 .long i386_start_kernel
4c5023a3
PA
675ENTRY(setup_once_ref)
676 .long setup_once
583323b9 677
1da177e4
LT
678/*
679 * BSS section
680 */
02b7da37 681__PAGE_ALIGNED_BSS
7bf04be8 682 .align PAGE_SIZE
551889a6 683#ifdef CONFIG_X86_PAE
d50d8fe1 684initial_pg_pmd:
551889a6
IC
685 .fill 1024*KPMDS,4,0
686#else
b40827fa 687ENTRY(initial_page_table)
1da177e4 688 .fill 1024,4,0
551889a6 689#endif
d50d8fe1 690initial_pg_fixmap:
b1c931e3 691 .fill 1024,4,0
1da177e4
LT
692ENTRY(empty_zero_page)
693 .fill 4096,1,0
b40827fa
BP
694ENTRY(swapper_pg_dir)
695 .fill 1024,4,0
2bd2753f 696
1da177e4
LT
697/*
698 * This starts the data section.
699 */
551889a6 700#ifdef CONFIG_X86_PAE
abe1ee3a 701__PAGE_ALIGNED_DATA
551889a6 702 /* Page-aligned for the benefit of paravirt? */
7bf04be8 703 .align PAGE_SIZE
b40827fa
BP
704ENTRY(initial_page_table)
705 .long pa(initial_pg_pmd+PGD_IDENT_ATTR),0 /* low identity map */
551889a6 706# if KPMDS == 3
b40827fa
BP
707 .long pa(initial_pg_pmd+PGD_IDENT_ATTR),0
708 .long pa(initial_pg_pmd+PGD_IDENT_ATTR+0x1000),0
709 .long pa(initial_pg_pmd+PGD_IDENT_ATTR+0x2000),0
551889a6
IC
710# elif KPMDS == 2
711 .long 0,0
b40827fa
BP
712 .long pa(initial_pg_pmd+PGD_IDENT_ATTR),0
713 .long pa(initial_pg_pmd+PGD_IDENT_ATTR+0x1000),0
551889a6
IC
714# elif KPMDS == 1
715 .long 0,0
716 .long 0,0
b40827fa 717 .long pa(initial_pg_pmd+PGD_IDENT_ATTR),0
551889a6
IC
718# else
719# error "Kernel PMDs should be 1, 2 or 3"
720# endif
7bf04be8 721 .align PAGE_SIZE /* needs to be page-sized too */
551889a6
IC
722#endif
723
1da177e4 724.data
11d4c3f9 725.balign 4
1da177e4
LT
726ENTRY(stack_start)
727 .long init_thread_union+THREAD_SIZE
1da177e4 728
4c5023a3 729__INITRODATA
1da177e4 730int_msg:
d5e397cb 731 .asciz "Unknown interrupt or fault at: %p %p %p\n"
1da177e4 732
ec5c0926 733fault_msg:
575ca735
VN
734/* fault info: */
735 .ascii "BUG: Int %d: CR2 %p\n"
4c5023a3
PA
736/* regs pushed in early_idt_handler: */
737 .ascii " EDI %p ESI %p EBP %p EBX %p\n"
738 .ascii " ESP %p ES %p DS %p\n"
739 .ascii " EDX %p ECX %p EAX %p\n"
575ca735 740/* fault frame: */
4c5023a3 741 .ascii " vec %p err %p EIP %p CS %p flg %p\n"
575ca735
VN
742 .ascii "Stack: %p %p %p %p %p %p %p %p\n"
743 .ascii " %p %p %p %p %p %p %p %p\n"
744 .asciz " %p %p %p %p %p %p %p %p\n"
ec5c0926 745
9702785a 746#include "../../x86/xen/xen-head.S"
5ead97c8 747
1da177e4
LT
748/*
749 * The IDT and GDT 'descriptors' are a strange 48-bit object
750 * only used by the lidt and lgdt instructions. They are not
751 * like usual segment descriptors - they consist of a 16-bit
752 * segment size, and 32-bit linear address value:
753 */
754
4c5023a3 755 .data
1da177e4
LT
756.globl boot_gdt_descr
757.globl idt_descr
1da177e4
LT
758
759 ALIGN
760# early boot GDT descriptor (must use 1:1 address mapping)
761 .word 0 # 32 bit align gdt_desc.address
762boot_gdt_descr:
763 .word __BOOT_DS+7
52de74dd 764 .long boot_gdt - __PAGE_OFFSET
1da177e4
LT
765
766 .word 0 # 32-bit align idt_desc.address
767idt_descr:
768 .word IDT_ENTRIES*8-1 # idt contains 256 entries
769 .long idt_table
770
771# boot GDT descriptor (later on used by CPU#0):
772 .word 0 # 32 bit align gdt_desc.address
2a57ff1a 773ENTRY(early_gdt_descr)
1da177e4 774 .word GDT_ENTRIES*8-1
dd17c8f7 775 .long gdt_page /* Overwritten for secondary CPUs */
1da177e4 776
1da177e4 777/*
52de74dd 778 * The boot_gdt must mirror the equivalent in setup.S and is
1da177e4
LT
779 * used only for booting.
780 */
781 .align L1_CACHE_BYTES
52de74dd 782ENTRY(boot_gdt)
1da177e4
LT
783 .fill GDT_ENTRY_BOOT_CS,8,0
784 .quad 0x00cf9a000000ffff /* kernel 4GB code at 0x00000000 */
785 .quad 0x00cf92000000ffff /* kernel 4GB data at 0x00000000 */