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
	 */

Joe Korty's avatar
Joe Korty committed
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
Glauber Costa's avatar
Glauber Costa committed
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:
	/*
Dragos Tarcatu's avatar
Dragos Tarcatu committed
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
Dragos Tarcatu's avatar
Dragos Tarcatu committed
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)
Dragos Tarcatu's avatar
Dragos Tarcatu committed
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

Dragos Tarcatu's avatar
Dragos Tarcatu committed
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
Dragos Tarcatu's avatar
Dragos Tarcatu committed
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
Dragos Tarcatu's avatar
Dragos Tarcatu committed
538
	jmp early_idt_handler_common
539
	i = i + 1
Dragos Tarcatu's avatar
Dragos Tarcatu committed
540
	.fill early_idt_handler_array + i*EARLY_IDT_HANDLER_SIZE - ., 1, 0xcc
541
	.endr
Dragos Tarcatu's avatar
Dragos Tarcatu committed
542
ENDPROC(early_idt_handler_array)
543
	
Dragos Tarcatu's avatar
Dragos Tarcatu committed
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
Dragos Tarcatu's avatar
Dragos Tarcatu committed
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:
Eric W. Biderman's avatar
Eric W. Biderman committed
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 */