head_32.S 18 KB
Newer Older
Linus Torvalds's avatar
Linus Torvalds committed
1 2 3 4 5 6 7 8 9 10
/*
 *
 *  Copyright (C) 1991, 1992  Linus Torvalds
 *
 *  Enhanced CPU detection and feature setting code by Mike Jagdis
 *  and Martin Mares, November 1997.
 */

.text
#include <linux/threads.h>
11
#include <linux/init.h>
Linus Torvalds's avatar
Linus Torvalds committed
12 13
#include <linux/linkage.h>
#include <asm/segment.h>
14 15
#include <asm/page_types.h>
#include <asm/pgtable_types.h>
Linus Torvalds's avatar
Linus Torvalds committed
16 17
#include <asm/cache.h>
#include <asm/thread_info.h>
18
#include <asm/asm-offsets.h>
Linus Torvalds's avatar
Linus Torvalds committed
19
#include <asm/setup.h>
20
#include <asm/processor-flags.h>
21 22
#include <asm/msr-index.h>
#include <asm/cpufeature.h>
23
#include <asm/percpu.h>
24
#include <asm/nops.h>
25 26 27

/* Physical address */
#define pa(X) ((X) - __PAGE_OFFSET)
Linus Torvalds's avatar
Linus Torvalds committed
28 29 30 31 32 33 34 35 36 37 38 39 40 41 42

/*
 * References to members of the new_cpu_data structure.
 */

#define X86		new_cpu_data+CPUINFO_x86
#define X86_VENDOR	new_cpu_data+CPUINFO_x86_vendor
#define X86_MODEL	new_cpu_data+CPUINFO_x86_model
#define X86_MASK	new_cpu_data+CPUINFO_x86_mask
#define X86_HARD_MATH	new_cpu_data+CPUINFO_hard_math
#define X86_CPUID	new_cpu_data+CPUINFO_cpuid_level
#define X86_CAPABILITY	new_cpu_data+CPUINFO_x86_capability
#define X86_VENDOR_ID	new_cpu_data+CPUINFO_x86_vendor_id

/*
43 44
 * This is how much memory in addition to the memory covered up to
 * and including _end we need mapped initially.
45
 * We need:
46 47
 *     (KERNEL_IMAGE_SIZE/4096) / 1024 pages (worst case, non PAE)
 *     (KERNEL_IMAGE_SIZE/4096) / 512 + 4 pages (worst case for PAE)
Linus Torvalds's avatar
Linus Torvalds committed
48 49 50 51 52
 *
 * Modulo rounding, each megabyte assigned here requires a kilobyte of
 * memory, which is currently unreclaimed.
 *
 * This should be a multiple of a page.
53 54 55
 *
 * KERNEL_IMAGE_SIZE should be greater than pa(_end)
 * and small than max_low_pfn, otherwise will waste some page table entries
Linus Torvalds's avatar
Linus Torvalds committed
56 57
 */

58
#if PTRS_PER_PMD > 1
59
#define PAGE_TABLE_SIZE(pages) (((pages) / PTRS_PER_PMD) + PTRS_PER_PGD)
60
#else
61
#define PAGE_TABLE_SIZE(pages) ((pages) / PTRS_PER_PGD)
62 63
#endif

64 65 66
/* Number of possible pages in the lowmem region */
LOWMEM_PAGES = (((1<<32) - __PAGE_OFFSET) >> PAGE_SHIFT)
	
67
/* Enough space to fit pagetables for the low memory linear map */
68
MAPPING_BEYOND_END = PAGE_TABLE_SIZE(LOWMEM_PAGES) << PAGE_SHIFT
69 70 71

/*
 * Worst-case size of the kernel mapping we need to make:
72 73
 * a relocatable kernel can live anywhere in lowmem, so we need to be able
 * to map all of lowmem.
74
 */
75
KERNEL_PAGES = LOWMEM_PAGES
76

77
INIT_MAP_SIZE = PAGE_TABLE_SIZE(KERNEL_PAGES) * PAGE_SIZE
78
RESERVE_BRK(pagetables, INIT_MAP_SIZE)
79

Linus Torvalds's avatar
Linus Torvalds committed
80 81 82 83 84 85 86
/*
 * 32-bit kernel entrypoint; only used by the boot CPU.  On entry,
 * %esi points to the real-mode code as a 32-bit pointer.
 * CS and DS must be 4 GB flat segments, but we don't depend on
 * any particular GDT layout, because we load our own as soon as we
 * can.
 */
87
__HEAD
Linus Torvalds's avatar
Linus Torvalds committed
88
ENTRY(startup_32)
89 90
	movl pa(stack_start),%ecx
	
Rusty Russell's avatar
Rusty Russell committed
91 92 93 94
	/* test KEEP_SEGMENTS flag to see if the bootloader is asking
		us to not reload segments */
	testb $(1<<6), BP_loadflags(%esi)
	jnz 2f
Linus Torvalds's avatar
Linus Torvalds committed
95 96 97 98

/*
 * Set segments to known values.
 */
99
	lgdt pa(boot_gdt_descr)
Linus Torvalds's avatar
Linus Torvalds committed
100 101 102 103 104
	movl $(__BOOT_DS),%eax
	movl %eax,%ds
	movl %eax,%es
	movl %eax,%fs
	movl %eax,%gs
105
	movl %eax,%ss
Rusty Russell's avatar
Rusty Russell committed
106
2:
107
	leal -__PAGE_OFFSET(%ecx),%esp
Linus Torvalds's avatar
Linus Torvalds committed
108 109 110 111

/*
 * Clear BSS first so that there are no surprises...
 */
Rusty Russell's avatar
Rusty Russell committed
112
	cld
Linus Torvalds's avatar
Linus Torvalds committed
113
	xorl %eax,%eax
114 115
	movl $pa(__bss_start),%edi
	movl $pa(__bss_stop),%ecx
Linus Torvalds's avatar
Linus Torvalds committed
116 117 118
	subl %edi,%ecx
	shrl $2,%ecx
	rep ; stosl
119 120 121 122 123 124 125 126
/*
 * Copy bootup parameters out of the way.
 * Note: %esi still has the pointer to the real-mode data.
 * With the kexec as boot loader, parameter segment might be loaded beyond
 * kernel image and might not even be addressable by early boot page tables.
 * (kexec on panic case). Hence copy out the parameters before initializing
 * page tables.
 */
127
	movl $pa(boot_params),%edi
128 129 130 131
	movl $(PARAM_SIZE/4),%ecx
	cld
	rep
	movsl
132
	movl pa(boot_params) + NEW_CL_POINTER,%esi
133
	andl %esi,%esi
134
	jz 1f			# No command line
135
	movl $pa(boot_command_line),%edi
136 137 138 139
	movl $(COMMAND_LINE_SIZE/4),%ecx
	rep
	movsl
1:
Linus Torvalds's avatar
Linus Torvalds committed
140

141
#ifdef CONFIG_OLPC
142 143 144 145 146
	/* save OFW's pgdir table for later use when calling into OFW */
	movl %cr3, %eax
	movl %eax, pa(olpc_ofw_pgd)
#endif

147 148 149 150 151
#ifdef CONFIG_MICROCODE_EARLY
	/* Early load ucode on BSP. */
	call load_ucode_bsp
#endif

Linus Torvalds's avatar
Linus Torvalds committed
152 153
/*
 * Initialize page tables.  This creates a PDE and a set of page
154
 * tables, which are located immediately beyond __brk_base.  The variable
155
 * _brk_end is set up to point to the first "safe" location.
Linus Torvalds's avatar
Linus Torvalds committed
156
 * Mappings are created both at virtual address 0 (identity mapping)
157
 * and PAGE_OFFSET for up to _end.
Linus Torvalds's avatar
Linus Torvalds committed
158
 */
159 160 161
#ifdef CONFIG_X86_PAE

	/*
162 163 164 165
	 * In PAE mode initial_page_table is statically defined to contain
	 * enough entries to cover the VMSPLIT option (that is the top 1, 2 or 3
	 * entries). The identity mapping is handled by pointing two PGD entries
	 * to the first kernel PMD.
166
	 *
167
	 * Note the upper half of each PMD or PTE are always zero at this stage.
168 169
	 */

170
#define KPMDS (((-__PAGE_OFFSET) >> 30) & 3) /* Number of kernel PMDs */
171 172 173

	xorl %ebx,%ebx				/* %ebx is kept at zero */

174
	movl $pa(__brk_base), %edi
175
	movl $pa(initial_pg_pmd), %edx
176
	movl $PTE_IDENT_ATTR, %eax
177
10:
178
	leal PDE_IDENT_ATTR(%edi),%ecx		/* Create PMD entry */
179 180 181 182 183 184 185 186 187 188 189 190 191
	movl %ecx,(%edx)			/* Store PMD entry */
						/* Upper half already zero */
	addl $8,%edx
	movl $512,%ecx
11:
	stosl
	xchgl %eax,%ebx
	stosl
	xchgl %eax,%ebx
	addl $0x1000,%eax
	loop 11b

	/*
192
	 * End condition: we must map up to the end + MAPPING_BEYOND_END.
193
	 */
194
	movl $pa(_end) + MAPPING_BEYOND_END + PTE_IDENT_ATTR, %ebp
195 196 197
	cmpl %ebp,%eax
	jb 10b
1:
198 199
	addl $__PAGE_OFFSET, %edi
	movl %edi, pa(_brk_end)
200 201
	shrl $12, %eax
	movl %eax, pa(max_pfn_mapped)
202 203

	/* Do early initialization of the fixmap area */
204 205
	movl $pa(initial_pg_fixmap)+PDE_IDENT_ATTR,%eax
	movl %eax,pa(initial_pg_pmd+0x1000*KPMDS-8)
206 207 208 209
#else	/* Not PAE */

page_pde_offset = (__PAGE_OFFSET >> 20);

210
	movl $pa(__brk_base), %edi
211
	movl $pa(initial_page_table), %edx
212
	movl $PTE_IDENT_ATTR, %eax
Linus Torvalds's avatar
Linus Torvalds committed
213
10:
214
	leal PDE_IDENT_ATTR(%edi),%ecx		/* Create PDE entry */
Linus Torvalds's avatar
Linus Torvalds committed
215 216 217 218 219 220 221 222
	movl %ecx,(%edx)			/* Store identity PDE entry */
	movl %ecx,page_pde_offset(%edx)		/* Store kernel PDE entry */
	addl $4,%edx
	movl $1024, %ecx
11:
	stosl
	addl $0x1000,%eax
	loop 11b
223
	/*
224
	 * End condition: we must map up to the end + MAPPING_BEYOND_END.
225
	 */
226
	movl $pa(_end) + MAPPING_BEYOND_END + PTE_IDENT_ATTR, %ebp
Linus Torvalds's avatar
Linus Torvalds committed
227 228
	cmpl %ebp,%eax
	jb 10b
229 230
	addl $__PAGE_OFFSET, %edi
	movl %edi, pa(_brk_end)
231 232
	shrl $12, %eax
	movl %eax, pa(max_pfn_mapped)
233

234
	/* Do early initialization of the fixmap area */
235 236
	movl $pa(initial_pg_fixmap)+PDE_IDENT_ATTR,%eax
	movl %eax,pa(initial_page_table+0xffc)
237
#endif
238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273

#ifdef CONFIG_PARAVIRT
	/* This is can only trip for a broken bootloader... */
	cmpw $0x207, pa(boot_params + BP_version)
	jb default_entry

	/* Paravirt-compatible boot parameters.  Look to see what architecture
		we're booting under. */
	movl pa(boot_params + BP_hardware_subarch), %eax
	cmpl $num_subarch_entries, %eax
	jae bad_subarch

	movl pa(subarch_entries)(,%eax,4), %eax
	subl $__PAGE_OFFSET, %eax
	jmp *%eax

bad_subarch:
WEAK(lguest_entry)
WEAK(xen_entry)
	/* Unknown implementation; there's really
	   nothing we can do at this point. */
	ud2a

	__INITDATA

subarch_entries:
	.long default_entry		/* normal x86/PC */
	.long lguest_entry		/* lguest hypervisor */
	.long xen_entry			/* Xen hypervisor */
	.long default_entry		/* Moorestown MID */
num_subarch_entries = (. - subarch_entries) / 4
.previous
#else
	jmp default_entry
#endif /* CONFIG_PARAVIRT */

274 275 276 277 278 279 280 281 282 283 284 285 286
#ifdef CONFIG_HOTPLUG_CPU
/*
 * Boot CPU0 entry point. It's called from play_dead(). Everything has been set
 * up already except stack. We just set up stack here. Then call
 * start_secondary().
 */
ENTRY(start_cpu0)
	movl stack_start, %ecx
	movl %ecx, %esp
	jmp  *(initial_code)
ENDPROC(start_cpu0)
#endif

Linus Torvalds's avatar
Linus Torvalds committed
287 288 289
/*
 * Non-boot CPU entry point; entered from trampoline.S
 * We can't lgdt here, because lgdt itself uses a data segment, but
290
 * we know the trampoline has already loaded the boot_gdt for us.
291 292 293
 *
 * If cpu hotplug is not supported then this code can go in init section
 * which will be freed later
Linus Torvalds's avatar
Linus Torvalds committed
294 295 296 297 298 299 300 301
 */
ENTRY(startup_32_smp)
	cld
	movl $(__BOOT_DS),%eax
	movl %eax,%ds
	movl %eax,%es
	movl %eax,%fs
	movl %eax,%gs
302 303 304
	movl pa(stack_start),%ecx
	movl %eax,%ss
	leal -__PAGE_OFFSET(%ecx),%esp
305

306 307 308 309 310 311
#ifdef CONFIG_MICROCODE_EARLY
	/* Early load ucode on AP. */
	call load_ucode_ap
#endif


312
default_entry:
313 314 315 316 317 318
#define CR0_STATE	(X86_CR0_PE | X86_CR0_MP | X86_CR0_ET | \
			 X86_CR0_NE | X86_CR0_WP | X86_CR0_AM | \
			 X86_CR0_PG)
	movl $(CR0_STATE & ~X86_CR0_PG),%eax
	movl %eax,%cr0

Linus Torvalds's avatar
Linus Torvalds committed
319
/*
320 321 322 323 324 325 326 327 328 329 330
 * We want to start out with EFLAGS unambiguously cleared. Some BIOSes leave
 * bits like NT set. This would confuse the debugger if this code is traced. So
 * initialize them properly now before switching to protected mode. That means
 * DF in particular (even though we have cleared it earlier after copying the
 * command line) because GCC expects it.
 */
	pushl $0
	popfl

/*
 * New page tables may be in 4Mbyte page mode and may be using the global pages.
Linus Torvalds's avatar
Linus Torvalds committed
331
 *
332 333
 * NOTE! If we are on a 486 we may have no cr4 at all! Specifically, cr4 exists
 * if and only if CPUID exists and has flags other than the FPU flag set.
Linus Torvalds's avatar
Linus Torvalds committed
334
 */
335
	movl $-1,pa(X86_CPUID)		# preset CPUID level
336 337
	movl $X86_EFLAGS_ID,%ecx
	pushl %ecx
338
	popfl				# set EFLAGS=ID
339
	pushfl
340 341
	popl %eax			# get EFLAGS
	testl $X86_EFLAGS_ID,%eax	# did EFLAGS.ID remained set?
342
	jz enable_paging		# hw disallowed setting of ID bit
343 344 345 346 347
					# which means no CPUID and no CR4

	xorl %eax,%eax
	cpuid
	movl %eax,pa(X86_CPUID)		# save largest std CPUID function
348

349 350
	movl $1,%eax
	cpuid
351
	andl $~1,%edx			# Ignore CPUID.FPU
352
	jz enable_paging		# No flags or only CPUID.FPU = no CR4
353

354
	movl pa(mmu_cr4_features),%eax
Linus Torvalds's avatar
Linus Torvalds committed
355 356
	movl %eax,%cr4

357
	testb $X86_CR4_PAE, %al		# check if PAE is enabled
358
	jz enable_paging
Linus Torvalds's avatar
Linus Torvalds committed
359 360 361 362

	/* Check if extended functions are implemented */
	movl $0x80000000, %eax
	cpuid
363 364 365
	/* Value must be in the range 0x80000001 to 0x8000ffff */
	subl $0x80000001, %eax
	cmpl $(0x8000ffff-0x80000001), %eax
366
	ja enable_paging
367 368 369 370

	/* Clear bogus XD_DISABLE bits */
	call verify_cpu

Linus Torvalds's avatar
Linus Torvalds committed
371 372 373
	mov $0x80000001, %eax
	cpuid
	/* Execute Disable bit supported? */
374
	btl $(X86_FEATURE_NX & 31), %edx
375
	jnc enable_paging
Linus Torvalds's avatar
Linus Torvalds committed
376 377

	/* Setup EFER (Extended Feature Enable Register) */
378
	movl $MSR_EFER, %ecx
Linus Torvalds's avatar
Linus Torvalds committed
379 380
	rdmsr

381
	btsl $_EFER_NX, %eax
Linus Torvalds's avatar
Linus Torvalds committed
382 383 384
	/* Make changes effective */
	wrmsr

385
enable_paging:
Linus Torvalds's avatar
Linus Torvalds committed
386 387 388 389

/*
 * Enable paging
 */
390
	movl $pa(initial_page_table), %eax
Linus Torvalds's avatar
Linus Torvalds committed
391
	movl %eax,%cr3		/* set the page table pointer.. */
392
	movl $CR0_STATE,%eax
Linus Torvalds's avatar
Linus Torvalds committed
393 394 395
	movl %eax,%cr0		/* ..and set paging (PG) bit */
	ljmp $__BOOT_CS,$1f	/* Clear prefetch and normalize %eip */
1:
396 397
	/* Shift the stack pointer to a virtual address */
	addl $__PAGE_OFFSET, %esp
Linus Torvalds's avatar
Linus Torvalds committed
398 399 400 401 402

/*
 * start system 32-bit setup. We need to re-do some of the things done
 * in 16-bit mode for the "real" operations.
 */
403 404 405 406 407
	movl setup_once_ref,%eax
	andl %eax,%eax
	jz 1f				# Did we do this already?
	call *%eax
1:
408

Linus Torvalds's avatar
Linus Torvalds committed
409
/*
410
 * Check if it is 486
Linus Torvalds's avatar
Linus Torvalds committed
411
 */
412
	movb $4,X86			# at least 486
413
	cmpl $-1,X86_CPUID
Linus Torvalds's avatar
Linus Torvalds committed
414 415 416 417 418 419 420 421 422 423 424 425 426 427 428 429 430 431 432 433 434 435 436 437 438
	je is486

	/* get vendor info */
	xorl %eax,%eax			# call CPUID with 0 -> return vendor ID
	cpuid
	movl %eax,X86_CPUID		# save CPUID level
	movl %ebx,X86_VENDOR_ID		# lo 4 chars
	movl %edx,X86_VENDOR_ID+4	# next 4 chars
	movl %ecx,X86_VENDOR_ID+8	# last 4 chars

	orl %eax,%eax			# do we have processor info as well?
	je is486

	movl $1,%eax		# Use the CPUID instruction to get CPU type
	cpuid
	movb %al,%cl		# save reg for future use
	andb $0x0f,%ah		# mask processor family
	movb %ah,X86
	andb $0xf0,%al		# mask model
	shrb $4,%al
	movb %al,X86_MODEL
	andb $0x0f,%cl		# mask mask revision
	movb %cl,X86_MASK
	movl %edx,X86_CAPABILITY

439 440
is486:
	movl $0x50022,%ecx	# set AM, WP, NE and MP
441
	movl %cr0,%eax
Linus Torvalds's avatar
Linus Torvalds committed
442 443 444 445
	andl $0x80000011,%eax	# Save PG,PE,ET
	orl %ecx,%eax
	movl %eax,%cr0

446
	lgdt early_gdt_descr
Linus Torvalds's avatar
Linus Torvalds committed
447 448 449 450 451 452 453 454 455
	lidt idt_descr
	ljmp $(__KERNEL_CS),$1f
1:	movl $(__KERNEL_DS),%eax	# reload all the segment registers
	movl %eax,%ss			# after changing gdt.

	movl $(__USER_DS),%eax		# DS/ES contains default USER segment
	movl %eax,%ds
	movl %eax,%es

456 457 458
	movl $(__KERNEL_PERCPU), %eax
	movl %eax,%fs			# set this cpu's percpu

459
	movl $(__KERNEL_STACK_CANARY),%eax
460
	movl %eax,%gs
461 462

	xorl %eax,%eax			# Clear LDT
Linus Torvalds's avatar
Linus Torvalds committed
463
	lldt %ax
464

465
	pushl $0		# fake return address for unwinder
466
	jmp *(initial_code)
Linus Torvalds's avatar
Linus Torvalds committed
467

468 469
#include "verify_cpu.S"

Linus Torvalds's avatar
Linus Torvalds committed
470
/*
471
 *  setup_once
Linus Torvalds's avatar
Linus Torvalds committed
472
 *
473
 *  The setup work we only want to run on the BSP.
Linus Torvalds's avatar
Linus Torvalds committed
474 475 476
 *
 *  Warning: %esi is live across this function.
 */
477 478 479
__INIT
setup_once:
	/*
480 481 482 483 484
	 * Set up a idt with 256 interrupt gates that push zero if there
	 * is no error code and then jump to early_idt_handler_common.
	 * It doesn't actually load the idt - that needs to be done on
	 * each CPU. Interrupts are enabled elsewhere, when we can be
	 * relatively sure everything is ok.
485
	 */
Linus Torvalds's avatar
Linus Torvalds committed
486

487
	movl $idt_table,%edi
488
	movl $early_idt_handler_array,%eax
489 490
	movl $NUM_EXCEPTION_VECTORS,%ecx
1:
Linus Torvalds's avatar
Linus Torvalds committed
491
	movl %eax,(%edi)
492 493 494
	movl %eax,4(%edi)
	/* interrupt gate, dpl=0, present */
	movl $(0x8E000000 + __KERNEL_CS),2(%edi)
495
	addl $EARLY_IDT_HANDLER_SIZE,%eax
Linus Torvalds's avatar
Linus Torvalds committed
496
	addl $8,%edi
497
	loop 1b
498

499 500
	movl $256 - NUM_EXCEPTION_VECTORS,%ecx
	movl $ignore_int,%edx
501
	movl $(__KERNEL_CS << 16),%eax
502
	movw %dx,%ax		/* selector = 0x0010 = cs */
503
	movw $0x8E00,%dx	/* interrupt gate - dpl=0, present */
504 505 506 507 508
2:
	movl %eax,(%edi)
	movl %edx,4(%edi)
	addl $8,%edi
	loop 2b
509

510 511 512 513 514 515 516 517 518 519 520 521 522
#ifdef CONFIG_CC_STACKPROTECTOR
	/*
	 * Configure the stack canary. The linker can't handle this by
	 * relocation.  Manually set base address in stack canary
	 * segment descriptor.
	 */
	movl $gdt_page,%eax
	movl $stack_canary,%ecx
	movw %cx, 8 * GDT_ENTRY_STACK_CANARY + 2(%eax)
	shrl $16, %ecx
	movb %cl, 8 * GDT_ENTRY_STACK_CANARY + 4(%eax)
	movb %ch, 8 * GDT_ENTRY_STACK_CANARY + 7(%eax)
#endif
523

524
	andl $0,setup_once_ref	/* Once is enough, thanks */
Linus Torvalds's avatar
Linus Torvalds committed
525 526
	ret

527
ENTRY(early_idt_handler_array)
528 529 530 531 532 533
	# 36(%esp) %eflags
	# 32(%esp) %cs
	# 28(%esp) %eip
	# 24(%rsp) error code
	i = 0
	.rept NUM_EXCEPTION_VECTORS
534
	.ifeq (EXCEPTION_ERRCODE_MASK >> i) & 1
535 536 537
	pushl $0		# Dummy error code, to make stack frame uniform
	.endif
	pushl $i		# 20(%esp) Vector number
538
	jmp early_idt_handler_common
539
	i = i + 1
540
	.fill early_idt_handler_array + i*EARLY_IDT_HANDLER_SIZE - ., 1, 0xcc
541
	.endr
542
ENDPROC(early_idt_handler_array)
543
	
544 545 546 547 548
early_idt_handler_common:
	/*
	 * The stack is the hardware frame, an error code or zero, and the
	 * vector number.
	 */
549
	cld
550

551
	cmpl $2,(%esp)		# X86_TRAP_NMI
552 553
	je is_nmi		# Ignore NMI

554 555 556
	cmpl $2,%ss:early_recursion_flag
	je hlt_loop
	incl %ss:early_recursion_flag
557

558 559 560 561 562 563 564 565
	push %eax		# 16(%esp)
	push %ecx		# 12(%esp)
	push %edx		#  8(%esp)
	push %ds		#  4(%esp)
	push %es		#  0(%esp)
	movl $(__KERNEL_DS),%eax
	movl %eax,%ds
	movl %eax,%es
566

567 568
	cmpl $(__KERNEL_CS),32(%esp)
	jne 10f
569

570 571 572 573
	leal 28(%esp),%eax	# Pointer to %eip
	call early_fixup_exception
	andl %eax,%eax
	jnz ex_entry		/* found an exception entry */
574

575
10:
576
#ifdef CONFIG_PRINTK
577 578 579 580 581 582 583 584 585 586
	xorl %eax,%eax
	movw %ax,2(%esp)	/* clean up the segment values on some cpus */
	movw %ax,6(%esp)
	movw %ax,34(%esp)
	leal  40(%esp),%eax
	pushl %eax		/* %esp before the exception */
	pushl %ebx
	pushl %ebp
	pushl %esi
	pushl %edi
587 588
	movl %cr2,%eax
	pushl %eax
589
	pushl (20+6*4)(%esp)	/* trapno */
590 591 592
	pushl $fault_msg
	call printk
#endif
593
	call dump_stack
594 595 596 597
hlt_loop:
	hlt
	jmp hlt_loop

598 599 600 601 602 603 604
ex_entry:
	pop %es
	pop %ds
	pop %edx
	pop %ecx
	pop %eax
	decl %ss:early_recursion_flag
605 606
is_nmi:
	addl $8,%esp		/* drop vector number and error code */
607
	iret
608
ENDPROC(early_idt_handler_common)
609

Linus Torvalds's avatar
Linus Torvalds committed
610 611 612 613
/* This is the default interrupt "handler" :-) */
	ALIGN
ignore_int:
	cld
614
#ifdef CONFIG_PRINTK
Linus Torvalds's avatar
Linus Torvalds committed
615 616 617 618 619 620 621 622
	pushl %eax
	pushl %ecx
	pushl %edx
	pushl %es
	pushl %ds
	movl $(__KERNEL_DS),%eax
	movl %eax,%ds
	movl %eax,%es
623 624 625
	cmpl $2,early_recursion_flag
	je hlt_loop
	incl early_recursion_flag
Linus Torvalds's avatar
Linus Torvalds committed
626 627 628 629 630 631
	pushl 16(%esp)
	pushl 24(%esp)
	pushl 32(%esp)
	pushl 40(%esp)
	pushl $int_msg
	call printk
632 633 634

	call dump_stack

Linus Torvalds's avatar
Linus Torvalds committed
635 636 637 638 639 640
	addl $(5*4),%esp
	popl %ds
	popl %es
	popl %edx
	popl %ecx
	popl %eax
641
#endif
Linus Torvalds's avatar
Linus Torvalds committed
642
	iret
643 644 645 646 647
ENDPROC(ignore_int)
__INITDATA
	.align 4
early_recursion_flag:
	.long 0
Linus Torvalds's avatar
Linus Torvalds committed
648

649 650
__REFDATA
	.align 4
651 652
ENTRY(initial_code)
	.long i386_start_kernel
653 654
ENTRY(setup_once_ref)
	.long setup_once
655

Linus Torvalds's avatar
Linus Torvalds committed
656 657 658
/*
 * BSS section
 */
659
__PAGE_ALIGNED_BSS
660
	.align PAGE_SIZE
661
#ifdef CONFIG_X86_PAE
662
initial_pg_pmd:
663 664
	.fill 1024*KPMDS,4,0
#else
665
ENTRY(initial_page_table)
Linus Torvalds's avatar
Linus Torvalds committed
666
	.fill 1024,4,0
667
#endif
668
initial_pg_fixmap:
669
	.fill 1024,4,0
Linus Torvalds's avatar
Linus Torvalds committed
670 671
ENTRY(empty_zero_page)
	.fill 4096,1,0
672 673
ENTRY(swapper_pg_dir)
	.fill 1024,4,0
674

Linus Torvalds's avatar
Linus Torvalds committed
675 676 677
/*
 * This starts the data section.
 */
678
#ifdef CONFIG_X86_PAE
679
__PAGE_ALIGNED_DATA
680
	/* Page-aligned for the benefit of paravirt? */
681
	.align PAGE_SIZE
682 683
ENTRY(initial_page_table)
	.long	pa(initial_pg_pmd+PGD_IDENT_ATTR),0	/* low identity map */
684
# if KPMDS == 3
685 686 687
	.long	pa(initial_pg_pmd+PGD_IDENT_ATTR),0
	.long	pa(initial_pg_pmd+PGD_IDENT_ATTR+0x1000),0
	.long	pa(initial_pg_pmd+PGD_IDENT_ATTR+0x2000),0
688 689
# elif KPMDS == 2
	.long	0,0
690 691
	.long	pa(initial_pg_pmd+PGD_IDENT_ATTR),0
	.long	pa(initial_pg_pmd+PGD_IDENT_ATTR+0x1000),0
692 693 694
# elif KPMDS == 1
	.long	0,0
	.long	0,0
695
	.long	pa(initial_pg_pmd+PGD_IDENT_ATTR),0
696 697 698
# else
#  error "Kernel PMDs should be 1, 2 or 3"
# endif
699
	.align PAGE_SIZE		/* needs to be page-sized too */
700 701
#endif

Linus Torvalds's avatar
Linus Torvalds committed
702
.data
703
.balign 4
Linus Torvalds's avatar
Linus Torvalds committed
704 705 706
ENTRY(stack_start)
	.long init_thread_union+THREAD_SIZE

707
__INITRODATA
Linus Torvalds's avatar
Linus Torvalds committed
708
int_msg:
709
	.asciz "Unknown interrupt or fault at: %p %p %p\n"
Linus Torvalds's avatar
Linus Torvalds committed
710

711
fault_msg:
Vegard Nossum's avatar
Vegard Nossum committed
712 713
/* fault info: */
	.ascii "BUG: Int %d: CR2 %p\n"
714 715 716 717
/* regs pushed in early_idt_handler: */
	.ascii "     EDI %p  ESI %p  EBP %p  EBX %p\n"
	.ascii "     ESP %p   ES %p   DS %p\n"
	.ascii "     EDX %p  ECX %p  EAX %p\n"
Vegard Nossum's avatar
Vegard Nossum committed
718
/* fault frame: */
719
	.ascii "     vec %p  err %p  EIP %p   CS %p  flg %p\n"
Vegard Nossum's avatar
Vegard Nossum committed
720 721 722
	.ascii "Stack: %p %p %p %p %p %p %p %p\n"
	.ascii "       %p %p %p %p %p %p %p %p\n"
	.asciz "       %p %p %p %p %p %p %p %p\n"
723

Thomas Gleixner's avatar
Thomas Gleixner committed
724
#include "../../x86/xen/xen-head.S"
725

Linus Torvalds's avatar
Linus Torvalds committed
726 727 728 729 730 731 732
/*
 * The IDT and GDT 'descriptors' are a strange 48-bit object
 * only used by the lidt and lgdt instructions. They are not
 * like usual segment descriptors - they consist of a 16-bit
 * segment size, and 32-bit linear address value:
 */

733
	.data
Linus Torvalds's avatar
Linus Torvalds committed
734 735 736 737 738 739 740 741
.globl boot_gdt_descr
.globl idt_descr

	ALIGN
# early boot GDT descriptor (must use 1:1 address mapping)
	.word 0				# 32 bit align gdt_desc.address
boot_gdt_descr:
	.word __BOOT_DS+7
742
	.long boot_gdt - __PAGE_OFFSET
Linus Torvalds's avatar
Linus Torvalds committed
743 744 745 746 747 748 749 750

	.word 0				# 32-bit align idt_desc.address
idt_descr:
	.word IDT_ENTRIES*8-1		# idt contains 256 entries
	.long idt_table

# boot GDT descriptor (later on used by CPU#0):
	.word 0				# 32 bit align gdt_desc.address
751
ENTRY(early_gdt_descr)
Linus Torvalds's avatar
Linus Torvalds committed
752
	.word GDT_ENTRIES*8-1
753
	.long gdt_page			/* Overwritten for secondary CPUs */
Linus Torvalds's avatar
Linus Torvalds committed
754 755

/*
756
 * The boot_gdt must mirror the equivalent in setup.S and is
Linus Torvalds's avatar
Linus Torvalds committed
757 758 759
 * used only for booting.
 */
	.align L1_CACHE_BYTES
760
ENTRY(boot_gdt)
Linus Torvalds's avatar
Linus Torvalds committed
761 762 763
	.fill GDT_ENTRY_BOOT_CS,8,0
	.quad 0x00cf9a000000ffff	/* kernel 4GB code at 0x00000000 */
	.quad 0x00cf92000000ffff	/* kernel 4GB data at 0x00000000 */