mptable.c 30.5 KB
Newer Older
1
/*-
2
 * Copyright (c) 2003 John Baldwin <jhb@FreeBSD.org>
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
 * Copyright (c) 1996, by Steve Passe
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. The name of the developer may NOT be used to endorse or promote products
 *    derived from this software without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
 * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
 * SUCH DAMAGE.
 */

obrien's avatar
obrien committed
27
28
29
#include <sys/cdefs.h>
__FBSDID("$FreeBSD$");

30
#include "opt_mptable_force_htt.h"
bde's avatar
bde committed
31
#include <sys/param.h>
32
#include <sys/systm.h>
33
#include <sys/bus.h>
34
#include <sys/kernel.h>
35
#include <sys/limits.h>
36
#include <sys/malloc.h>
37
38
39
#ifdef NEW_PCIB
#include <sys/rman.h>
#endif
40

41
42
43
#include <vm/vm.h>
#include <vm/vm_param.h>
#include <vm/pmap.h>
44

45
46
47
48
#include <dev/pci/pcivar.h>
#ifdef NEW_PCIB
#include <dev/pci/pcib_private.h>
#endif
49
#include <x86/apicreg.h>
50
#include <x86/mptable.h>
51
52
53
54
#include <machine/frame.h>
#include <machine/intr_machdep.h>
#include <machine/apicvar.h>
#include <machine/md_var.h>
55
56
57
#ifdef NEW_PCIB
#include <machine/resource.h>
#endif
58
#include <machine/specialreg.h>
59

60
61
62
/* string defined by the Intel MP Spec as identifying the MP table */
#define	MP_SIG			0x5f504d5f	/* _MP_ */

63
64
65
#ifdef __amd64__
#define	MAX_LAPIC_ID		63	/* Max local APIC ID for HTT fixup */
#else
66
#define	MAX_LAPIC_ID		31	/* Max local APIC ID for HTT fixup */
67
#endif
68

69
70
71
72
#ifdef PC98
#define BIOS_BASE		(0xe8000)
#define BIOS_SIZE		(0x18000)
#else
73
74
#define BIOS_BASE		(0xf0000)
#define BIOS_SIZE		(0x10000)
75
#endif
76
#define BIOS_COUNT		(BIOS_SIZE/4)
77

78
typedef	void mptable_entry_handler(u_char *entry, void *arg);
79
typedef	void mptable_extended_entry_handler(ext_entry_ptr entry, void *arg);
fsmp's avatar
fsmp committed
80

81
82
83
84
85
86
87
88
static basetable_entry basetable_entry_types[] =
{
	{0, 20, "Processor"},
	{1, 8, "Bus"},
	{2, 8, "I/O APIC"},
	{3, 8, "I/O INT"},
	{4, 8, "Local INT"}
};
fsmp's avatar
fsmp committed
89

90
91
92
93
94
95
typedef struct BUSDATA {
	u_char  bus_id;
	enum busTypes bus_type;
}       bus_datum;

typedef struct INTDATA {
fsmp's avatar
fsmp committed
96
97
98
99
100
101
	u_char  int_type;
	u_short int_flags;
	u_char  src_bus_id;
	u_char  src_bus_irq;
	u_char  dst_apic_id;
	u_char  dst_apic_int;
102
103
	u_char	int_vector;
}       io_int, local_int;
fsmp's avatar
fsmp committed
104

105
typedef struct BUSTYPENAME {
fsmp's avatar
fsmp committed
106
	u_char  type;
107
108
	char    name[7];
}       bus_type_name;
109

110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
/* From MP spec v1.4, table 4-8. */
static bus_type_name bus_type_table[] =
{
	{UNKNOWN_BUSTYPE, "CBUS  "},
	{UNKNOWN_BUSTYPE, "CBUSII"},
	{EISA, "EISA  "},
	{UNKNOWN_BUSTYPE, "FUTURE"},
	{UNKNOWN_BUSTYPE, "INTERN"},
	{ISA, "ISA   "},
	{UNKNOWN_BUSTYPE, "MBI   "},
	{UNKNOWN_BUSTYPE, "MBII  "},
	{MCA, "MCA   "},
	{UNKNOWN_BUSTYPE, "MPI   "},
	{UNKNOWN_BUSTYPE, "MPSA  "},
	{UNKNOWN_BUSTYPE, "NUBUS "},
	{PCI, "PCI   "},
	{UNKNOWN_BUSTYPE, "PCMCIA"},
	{UNKNOWN_BUSTYPE, "TC    "},
	{UNKNOWN_BUSTYPE, "VL    "},
	{UNKNOWN_BUSTYPE, "VME   "},
	{UNKNOWN_BUSTYPE, "XPRESS"}
};
132

133
134
135
136
137
138
139
140
141
142
143
144
/* From MP spec v1.4, table 5-1. */
static int default_data[7][5] =
{
/*   nbus, id0, type0, id1, type1 */
	{1, 0, ISA, 255, NOBUS},
	{1, 0, EISA, 255, NOBUS},
	{1, 0, EISA, 255, NOBUS},
	{1, 0, MCA, 255, NOBUS},
	{2, 0, ISA, 1, PCI},
	{2, 0, EISA, 1, PCI},
	{2, 0, MCA, 1, PCI}
};
145

146
147
148
149
struct pci_probe_table_args {
	u_char bus;
	u_char found;
};
150

151
152
153
154
155
struct pci_route_interrupt_args {
	u_char bus;		/* Source bus. */
	u_char irq;		/* Source slot:pin. */
	int vector;		/* Return value. */
};
156

157
158
static mpfps_t mpfps;
static mpcth_t mpct;
159
static ext_entry_ptr mpet;
160
static void *ioapics[MAX_APIC_ID + 1];
161
162
163
164
static bus_datum *busses;
static int mptable_nioapics, mptable_nbusses, mptable_maxbusid;
static int pci0 = -1;

165
static MALLOC_DEFINE(M_MPTABLE, "mptable", "MP Table Items");
166

167
168
169
170
171
static enum intr_polarity conforming_polarity(u_char src_bus,
	    u_char src_bus_irq);
static enum intr_trigger conforming_trigger(u_char src_bus, u_char src_bus_irq);
static enum intr_polarity intentry_polarity(int_entry_ptr intr);
static enum intr_trigger intentry_trigger(int_entry_ptr intr);
172
173
174
static int	lookup_bus_type(char *name);
static void	mptable_count_items(void);
static void	mptable_count_items_handler(u_char *entry, void *arg);
175
#ifdef MPTABLE_FORCE_HTT
176
static void	mptable_hyperthread_fixup(u_int id_mask);
177
#endif
178
179
180
static void	mptable_parse_apics_and_busses(void);
static void	mptable_parse_apics_and_busses_handler(u_char *entry,
    void *arg);
181
static void	mptable_parse_default_config_ints(void);
182
183
184
185
186
187
188
189
190
191
192
193
194
static void	mptable_parse_ints(void);
static void	mptable_parse_ints_handler(u_char *entry, void *arg);
static void	mptable_parse_io_int(int_entry_ptr intr);
static void	mptable_parse_local_int(int_entry_ptr intr);
static void	mptable_pci_probe_table_handler(u_char *entry, void *arg);
static void	mptable_pci_route_interrupt_handler(u_char *entry, void *arg);
static void	mptable_pci_setup(void);
static int	mptable_probe(void);
static int	mptable_probe_cpus(void);
static void	mptable_probe_cpus_handler(u_char *entry, void *arg __unused);
static void	mptable_register(void *dummy);
static int	mptable_setup_local(void);
static int	mptable_setup_io(void);
jhb's avatar
jhb committed
195
#ifdef NEW_PCIB
196
197
static void	mptable_walk_extended_table(
    mptable_extended_entry_handler *handler, void *arg);
jhb's avatar
jhb committed
198
#endif
199
static void	mptable_walk_table(mptable_entry_handler *handler, void *arg);
fsmp's avatar
fsmp committed
200
201
static int	search_for_sig(u_int32_t target, int count);

202
203
204
205
206
207
208
static struct apic_enumerator mptable_enumerator = {
	"MPTable",
	mptable_probe,
	mptable_probe_cpus,
	mptable_setup_local,
	mptable_setup_io
};
ps's avatar
ps committed
209

210
/*
211
 * look for the MP spec signature
212
213
 */

214
215
static int
search_for_sig(u_int32_t target, int count)
216
{
217
218
	int     x;
	u_int32_t *addr = (u_int32_t *) (KERNBASE + target);
219

220
221
222
223
224
	for (x = 0; x < count; x += 4)
		if (addr[x] == MP_SIG)
			/* make array index a byte index */
			return (target + (x * sizeof(u_int32_t)));
	return (-1);
225
226
}

227
228
static int
lookup_bus_type(char *name)
229
{
230
	int     x;
231

232
233
234
	for (x = 0; x < MAX_BUSTYPE; ++x)
		if (strncmp(bus_type_table[x].name, name, 6) == 0)
			return (bus_type_table[x].type);
235

236
	return (UNKNOWN_BUSTYPE);
237
238
}

fsmp's avatar
fsmp committed
239
240
241
/*
 * Look for an Intel MP spec table (ie, SMP capable hardware).
 */
242
243
static int
mptable_probe(void)
fsmp's avatar
fsmp committed
244
245
246
247
248
249
{
	int     x;
	u_long  segment;
	u_int32_t target;

	/* see if EBDA exists */
250
	if ((segment = (u_long) * (u_short *) (KERNBASE + 0x40e)) != 0) {
fsmp's avatar
fsmp committed
251
252
253
254
255
256
		/* search first 1K of EBDA */
		target = (u_int32_t) (segment << 4);
		if ((x = search_for_sig(target, 1024 / 4)) >= 0)
			goto found;
	} else {
		/* last 1K of base memory, effective 'top of base' passed in */
257
		target = (u_int32_t) ((basemem * 1024) - 0x400);
fsmp's avatar
fsmp committed
258
259
260
261
262
263
264
265
266
267
		if ((x = search_for_sig(target, 1024 / 4)) >= 0)
			goto found;
	}

	/* search the BIOS */
	target = (u_int32_t) BIOS_BASE;
	if ((x = search_for_sig(target, BIOS_COUNT)) >= 0)
		goto found;

	/* nothing found */
268
	return (ENXIO);
fsmp's avatar
fsmp committed
269

fsmp's avatar
fsmp committed
270
found:
271
	mpfps = (mpfps_t)(KERNBASE + x);
fsmp's avatar
fsmp committed
272

273
	/* Map in the configuration table if it exists. */
274
275
276
277
278
279
280
281
282
283
284
	if (mpfps->config_type != 0) {
		if (bootverbose)
			printf(
		"MP Table version 1.%d found using Default Configuration %d\n",
			    mpfps->spec_rev, mpfps->config_type);
		if (mpfps->config_type != 5 && mpfps->config_type != 6) {
			printf(
			"MP Table Default Configuration %d is unsupported\n",
			    mpfps->config_type);
			return (ENXIO);
		}
285
		mpct = NULL;
286
	} else {
287
288
289
290
291
292
293
294
295
296
297
298
		if ((uintptr_t)mpfps->pap >= 1024 * 1024) {
			printf("%s: Unable to map MP Configuration Table\n",
			    __func__);
			return (ENXIO);
		}
		mpct = (mpcth_t)(KERNBASE + (uintptr_t)mpfps->pap);
		if (mpct->base_table_length + (uintptr_t)mpfps->pap >=
		    1024 * 1024) {
			printf("%s: Unable to map end of MP Config Table\n",
			    __func__);
			return (ENXIO);
		}
299
300
301
302
303
		if (mpct->extended_table_length != 0 &&
		    mpct->extended_table_length + mpct->base_table_length +
		    (uintptr_t)mpfps->pap < 1024 * 1024)
			mpet = (ext_entry_ptr)((char *)mpct +
			    mpct->base_table_length);
304
305
306
307
308
309
310
311
312
313
314
315
		if (mpct->signature[0] != 'P' || mpct->signature[1] != 'C' ||
		    mpct->signature[2] != 'M' || mpct->signature[3] != 'P') {
			printf("%s: MP Config Table has bad signature: %c%c%c%c\n",
			    __func__, mpct->signature[0], mpct->signature[1],
			    mpct->signature[2], mpct->signature[3]);
			return (ENXIO);
		}
		if (bootverbose)
			printf(
			"MP Configuration Table version 1.%d found at %p\n",
			    mpct->spec_rev, mpct);
	}
316

317
	return (-100);
318
}
fsmp's avatar
fsmp committed
319

320
/*
321
 * Run through the MP table enumerating CPUs.
322
 */
323
324
static int
mptable_probe_cpus(void)
325
{
326
	u_int cpu_mask;
327

328
329
330
331
332
333
334
	/* Is this a pre-defined config? */
	if (mpfps->config_type != 0) {
		lapic_create(0, 1);
		lapic_create(1, 0);
	} else {
		cpu_mask = 0;
		mptable_walk_table(mptable_probe_cpus_handler, &cpu_mask);
335
#ifdef MPTABLE_FORCE_HTT
336
		mptable_hyperthread_fixup(cpu_mask);
337
#endif
338
339
	}
	return (0);
340
341
342
}

/*
343
 * Initialize the local APIC on the BSP.
344
 */
345
346
static int
mptable_setup_local(void)
347
{
348
	vm_paddr_t addr;
349

350
351
352
	/* Is this a pre-defined config? */
	printf("MPTable: <");
	if (mpfps->config_type != 0) {
353
		addr = DEFAULT_APIC_BASE;
354
		printf("Default Configuration %d", mpfps->config_type);
355
	} else {
356
		addr = mpct->apic_address;
357
358
		printf("%.*s %.*s", (int)sizeof(mpct->oem_id), mpct->oem_id,
		    (int)sizeof(mpct->product_id), mpct->product_id);
359
	}
360
	printf(">\n");
361
	lapic_init(addr);
362
	return (0);
363
364
365
}

/*
366
 * Run through the MP table enumerating I/O APICs.
367
 */
368
369
static int
mptable_setup_io(void)
370
{
371
372
	int i;
	u_char byte;
373

374
375
376
377
378
379
	/* First, we count individual items and allocate arrays. */
	mptable_count_items();
	busses = malloc((mptable_maxbusid + 1) * sizeof(bus_datum), M_MPTABLE,
	    M_WAITOK);
	for (i = 0; i <= mptable_maxbusid; i++)
		busses[i].bus_type = NOBUS;
380

381
382
	/* Second, we run through adding I/O APIC's and busses. */
	mptable_parse_apics_and_busses();	
383

384
385
	/* Third, we run through the table tweaking interrupt sources. */
	mptable_parse_ints();
386

387
	/* Fourth, we register all the I/O APIC's. */
388
	for (i = 0; i <= MAX_APIC_ID; i++)
389
390
		if (ioapics[i] != NULL)
			ioapic_register(ioapics[i]);
391

392
393
	/* Fifth, we setup data structures to handle PCI interrupt routing. */
	mptable_pci_setup();
394

395
396
	/* Finally, we throw the switch to enable the I/O APIC's. */
	if (mpfps->mpfb2 & MPFB2_IMCR_PRESENT) {
397
398
		outb(0x22, 0x70);	/* select IMCR */
		byte = inb(0x23);	/* current contents */
fsmp's avatar
fsmp committed
399
		byte |= 0x01;		/* mask external INTR */
400
401
		outb(0x23, byte);	/* disconnect 8259s/NMI */
	}
fsmp's avatar
fsmp committed
402

403
	return (0);
404
405
}

406
407
408
static void
mptable_register(void *dummy __unused)
{
409

410
411
	apic_register_enumerator(&mptable_enumerator);
}
412
SYSINIT(mptable_register, SI_SUB_TUNABLES - 1, SI_ORDER_FIRST, mptable_register,
413
    NULL);
414
415

/*
416
 * Call the handler routine for each entry in the MP config base table.
417
418
 */
static void
419
420
421
422
423
424
425
426
427
428
429
430
431
432
433
434
435
436
437
438
439
440
mptable_walk_table(mptable_entry_handler *handler, void *arg)
{
	u_int i;
	u_char *entry;

	entry = (u_char *)(mpct + 1);
	for (i = 0; i < mpct->entry_count; i++) {
		switch (*entry) {
		case MPCT_ENTRY_PROCESSOR:
		case MPCT_ENTRY_IOAPIC:
		case MPCT_ENTRY_BUS:
		case MPCT_ENTRY_INT:
		case MPCT_ENTRY_LOCAL_INT:
			break;
		default:
			panic("%s: Unknown MP Config Entry %d\n", __func__,
			    (int)*entry);
		}
		handler(entry, arg);
		entry += basetable_entry_types[*entry].length;
	}
}
441

jhb's avatar
jhb committed
442
#ifdef NEW_PCIB
443
444
445
446
447
448
449
450
451
452
453
454
455
456
457
458
459
460
/*
 * Call the handler routine for each entry in the MP config extended
 * table.
 */
static void
mptable_walk_extended_table(mptable_extended_entry_handler *handler, void *arg)
{
	ext_entry_ptr end, entry;

	if (mpet == NULL)
		return;
	entry = mpet;
	end = (ext_entry_ptr)((char *)mpet + mpct->extended_table_length);
	while (entry < end) {
		handler(entry, arg);
		entry = (ext_entry_ptr)((char *)entry + entry->length);
	}
}
jhb's avatar
jhb committed
461
#endif
462

463
464
465
466
467
468
469
470
471
472
473
474
static void
mptable_probe_cpus_handler(u_char *entry, void *arg)
{
	proc_entry_ptr proc;
	u_int *cpu_mask;

	switch (*entry) {
	case MPCT_ENTRY_PROCESSOR:
		proc = (proc_entry_ptr)entry;
		if (proc->cpu_flags & PROCENTRY_FLAG_EN) {
			lapic_create(proc->apic_id, proc->cpu_flags &
			    PROCENTRY_FLAG_BP);
475
476
477
478
			if (proc->apic_id < MAX_LAPIC_ID) {
				cpu_mask = (u_int *)arg;
				*cpu_mask |= (1ul << proc->apic_id);
			}
479
480
481
482
		}
		break;
	}
}
483

484
485
486
487
488
static void
mptable_count_items_handler(u_char *entry, void *arg __unused)
{
	io_apic_entry_ptr apic;
	bus_entry_ptr bus;
489

490
491
492
493
494
495
496
497
498
499
500
501
502
503
	switch (*entry) {
	case MPCT_ENTRY_BUS:
		bus = (bus_entry_ptr)entry;
		mptable_nbusses++;
		if (bus->bus_id > mptable_maxbusid)
			mptable_maxbusid = bus->bus_id;
		break;
	case MPCT_ENTRY_IOAPIC:
		apic = (io_apic_entry_ptr)entry;
		if (apic->apic_flags & IOAPICENTRY_FLAG_EN)
			mptable_nioapics++;
		break;
	}
}
504

505
506
507
508
509
510
/*
 * Count items in the table.
 */
static void
mptable_count_items(void)
{
511

512
513
514
515
516
517
518
519
520
521
522
523
524
525
526
527
528
529
530
531
532
533
534
	/* Is this a pre-defined config? */
	if (mpfps->config_type != 0) {
		mptable_nioapics = 1;
		switch (mpfps->config_type) {
		case 1:
		case 2:
		case 3:
		case 4:
			mptable_nbusses = 1;
			break;
		case 5:
		case 6:
		case 7:
			mptable_nbusses = 2;
			break;
		default:
			panic("Unknown pre-defined MP Table config type %d",
			    mpfps->config_type);
		}
		mptable_maxbusid = mptable_nbusses - 1;
	} else
		mptable_walk_table(mptable_count_items_handler, NULL);
}
535

536
537
538
539
540
541
542
543
544
545
546
547
548
549
550
551
552
553
554
555
556
557
558
559
560
561
562
563
564
/*
 * Add a bus or I/O APIC from an entry in the table.
 */
static void
mptable_parse_apics_and_busses_handler(u_char *entry, void *arg __unused)
{
	io_apic_entry_ptr apic;
	bus_entry_ptr bus;
	enum busTypes bus_type;
	int i;


	switch (*entry) {
	case MPCT_ENTRY_BUS:
		bus = (bus_entry_ptr)entry;
		bus_type = lookup_bus_type(bus->bus_type);
		if (bus_type == UNKNOWN_BUSTYPE) {
			printf("MPTable: Unknown bus %d type \"", bus->bus_id);
			for (i = 0; i < 6; i++)
				printf("%c", bus->bus_type[i]);
			printf("\"\n");
		}
		busses[bus->bus_id].bus_id = bus->bus_id;
		busses[bus->bus_id].bus_type = bus_type;
		break;
	case MPCT_ENTRY_IOAPIC:
		apic = (io_apic_entry_ptr)entry;
		if (!(apic->apic_flags & IOAPICENTRY_FLAG_EN))
			break;
565
		if (apic->apic_id > MAX_APIC_ID)
566
567
568
569
570
			panic("%s: I/O APIC ID %d too high", __func__,
			    apic->apic_id);
		if (ioapics[apic->apic_id] != NULL)
			panic("%s: Double APIC ID %d", __func__,
			    apic->apic_id);
571
572
		ioapics[apic->apic_id] = ioapic_create(apic->apic_address,
		    apic->apic_id, -1);
573
574
575
		break;
	default:
		break;
576
	}
577
}
578

579
580
581
582
583
584
585
586
587
/*
 * Enumerate I/O APIC's and busses.
 */
static void
mptable_parse_apics_and_busses(void)
{

	/* Is this a pre-defined config? */
	if (mpfps->config_type != 0) {
588
		ioapics[2] = ioapic_create(DEFAULT_IO_APIC_BASE, 2, 0);
589
		busses[0].bus_id = 0;
590
		busses[0].bus_type = default_data[mpfps->config_type - 1][2];
591
592
593
		if (mptable_nbusses > 1) {
			busses[1].bus_id = 1;
			busses[1].bus_type =
594
			    default_data[mpfps->config_type - 1][4];
595
596
597
598
599
		}
	} else
		mptable_walk_table(mptable_parse_apics_and_busses_handler,
		    NULL);
}
600

601
602
603
/*
 * Determine conforming polarity for a given bus type.
 */
604
605
static enum intr_polarity
conforming_polarity(u_char src_bus, u_char src_bus_irq)
606
{
607

608
609
610
	KASSERT(src_bus <= mptable_maxbusid, ("bus id %d too large", src_bus));
	switch (busses[src_bus].bus_type) {
	case ISA:
611
	case EISA:
612
		return (INTR_POLARITY_HIGH);
613
	case PCI:
614
		return (INTR_POLARITY_LOW);
615
616
617
618
619
	default:
		panic("%s: unknown bus type %d", __func__,
		    busses[src_bus].bus_type);
	}
}
620

621
622
623
/*
 * Determine conforming trigger for a given bus type.
 */
624
static enum intr_trigger
625
626
conforming_trigger(u_char src_bus, u_char src_bus_irq)
{
627

628
629
630
	KASSERT(src_bus <= mptable_maxbusid, ("bus id %d too large", src_bus));
	switch (busses[src_bus].bus_type) {
	case ISA:
631
632
633
634
635
636
#ifndef PC98
		if (elcr_found)
			return (elcr_read_trigger(src_bus_irq));
		else
#endif
			return (INTR_TRIGGER_EDGE);
637
	case PCI:
638
		return (INTR_TRIGGER_LEVEL);
nyan's avatar
nyan committed
639
#ifndef PC98
640
641
	case EISA:
		KASSERT(src_bus_irq < 16, ("Invalid EISA IRQ %d", src_bus_irq));
642
		KASSERT(elcr_found, ("Missing ELCR"));
643
		return (elcr_read_trigger(src_bus_irq));
nyan's avatar
nyan committed
644
#endif
645
646
647
648
649
	default:
		panic("%s: unknown bus type %d", __func__,
		    busses[src_bus].bus_type);
	}
}
650

651
static enum intr_polarity
652
653
intentry_polarity(int_entry_ptr intr)
{
fsmp's avatar
fsmp committed
654

655
656
	switch (intr->int_flags & INTENTRY_FLAGS_POLARITY) {
	case INTENTRY_FLAGS_POLARITY_CONFORM:
657
658
		return (conforming_polarity(intr->src_bus_id,
			    intr->src_bus_irq));
659
	case INTENTRY_FLAGS_POLARITY_ACTIVEHI:
660
		return (INTR_POLARITY_HIGH);
661
	case INTENTRY_FLAGS_POLARITY_ACTIVELO:
662
		return (INTR_POLARITY_LOW);
663
664
665
	default:
		panic("Bogus interrupt flags");
	}
666
667
}

668
static enum intr_trigger
669
670
671
672
673
674
675
676
intentry_trigger(int_entry_ptr intr)
{

	switch (intr->int_flags & INTENTRY_FLAGS_TRIGGER) {
	case INTENTRY_FLAGS_TRIGGER_CONFORM:
		return (conforming_trigger(intr->src_bus_id,
			    intr->src_bus_irq));
	case INTENTRY_FLAGS_TRIGGER_EDGE:
677
		return (INTR_TRIGGER_EDGE);
678
	case INTENTRY_FLAGS_TRIGGER_LEVEL:
679
		return (INTR_TRIGGER_LEVEL);
680
681
682
683
	default:
		panic("Bogus interrupt flags");
	}
}
684
685

/*
686
 * Parse an interrupt entry for an I/O interrupt routed to a pin on an I/O APIC.
687
 */
688
689
static void
mptable_parse_io_int(int_entry_ptr intr)
690
{
691
	void *ioapic;
692
	u_int pin, apic_id;
693

694
	apic_id = intr->dst_apic_id;
695
	if (intr->dst_apic_id == 0xff) {
696
697
698
699
700
701
702
703
704
705
706
707
708
709
710
711
712
		/*
		 * An APIC ID of 0xff means that the interrupt is connected
		 * to the specified pin on all I/O APICs in the system.  If
		 * there is only one I/O APIC, then use that APIC to route
		 * the interrupts.  If there is more than one I/O APIC, then
		 * punt.
		 */
		if (mptable_nioapics == 1) {
			apic_id = 0;
			while (ioapics[apic_id] == NULL)
				apic_id++;
		} else {
			printf(
			"MPTable: Ignoring global interrupt entry for pin %d\n",
			    intr->dst_apic_int);
			return;
		}
713
	}
714
	if (apic_id > MAX_APIC_ID) {
715
716
717
718
		printf("MPTable: Ignoring interrupt entry for ioapic%d\n",
		    intr->dst_apic_id);
		return;
	}
719
	ioapic = ioapics[apic_id];
720
721
722
	if (ioapic == NULL) {
		printf(
	"MPTable: Ignoring interrupt entry for missing ioapic%d\n",
723
		    apic_id);
724
725
726
727
728
		return;
	}
	pin = intr->dst_apic_int;
	switch (intr->int_type) {
	case INTENTRY_TYPE_INT:
729
730
		switch (busses[intr->src_bus_id].bus_type) {
		case NOBUS:
731
			panic("interrupt from missing bus");
732
733
734
735
736
737
738
739
		case ISA:
		case EISA:
			if (busses[intr->src_bus_id].bus_type == ISA)
				ioapic_set_bus(ioapic, pin, APIC_BUS_ISA);
			else
				ioapic_set_bus(ioapic, pin, APIC_BUS_EISA);
			if (intr->src_bus_irq == pin)
				break;
740
			ioapic_remap_vector(ioapic, pin, intr->src_bus_irq);
741
742
743
			if (ioapic_get_vector(ioapic, intr->src_bus_irq) ==
			    intr->src_bus_irq)
				ioapic_disable_pin(ioapic, intr->src_bus_irq);
744
745
746
747
748
749
750
			break;
		case PCI:
			ioapic_set_bus(ioapic, pin, APIC_BUS_PCI);
			break;
		default:
			ioapic_set_bus(ioapic, pin, APIC_BUS_UNKNOWN);
			break;
751
		}
752
753
754
755
756
757
758
759
760
761
762
763
764
765
766
767
768
769
770
771
772
773
		break;
	case INTENTRY_TYPE_NMI:
		ioapic_set_nmi(ioapic, pin);
		break;
	case INTENTRY_TYPE_SMI:
		ioapic_set_smi(ioapic, pin);
		break;
	case INTENTRY_TYPE_EXTINT:
		ioapic_set_extint(ioapic, pin);
		break;
	default:
		panic("%s: invalid interrupt entry type %d\n", __func__,
		    intr->int_type);
	}
	if (intr->int_type == INTENTRY_TYPE_INT ||
	    (intr->int_flags & INTENTRY_FLAGS_TRIGGER) !=
	    INTENTRY_FLAGS_TRIGGER_CONFORM)
		ioapic_set_triggermode(ioapic, pin, intentry_trigger(intr));
	if (intr->int_type == INTENTRY_TYPE_INT ||
	    (intr->int_flags & INTENTRY_FLAGS_POLARITY) !=
	    INTENTRY_FLAGS_POLARITY_CONFORM)
		ioapic_set_polarity(ioapic, pin, intentry_polarity(intr));
774
775
}

776
777
778
779
780
/*
 * Parse an interrupt entry for a local APIC LVT pin.
 */
static void
mptable_parse_local_int(int_entry_ptr intr)
781
{
782
	u_int apic_id, pin;
783

784
785
786
787
788
	if (intr->dst_apic_id == 0xff)
		apic_id = APIC_ID_ALL;
	else
		apic_id = intr->dst_apic_id;
	if (intr->dst_apic_int == 0)
789
		pin = APIC_LVT_LINT0;
790
	else
791
		pin = APIC_LVT_LINT1;
792
793
794
795
796
797
798
799
800
801
802
803
804
805
806
807
808
809
810
811
812
813
814
815
816
817
818
819
820
821
822
823
	switch (intr->int_type) {
	case INTENTRY_TYPE_INT:
#if 1
		printf(
	"MPTable: Ignoring vectored local interrupt for LINTIN%d vector %d\n",
		    intr->dst_apic_int, intr->src_bus_irq);
		return;
#else
		lapic_set_lvt_mode(apic_id, pin, APIC_LVT_DM_FIXED);
		break;
#endif
	case INTENTRY_TYPE_NMI:
		lapic_set_lvt_mode(apic_id, pin, APIC_LVT_DM_NMI);
		break;
	case INTENTRY_TYPE_SMI:
		lapic_set_lvt_mode(apic_id, pin, APIC_LVT_DM_SMI);
		break;
	case INTENTRY_TYPE_EXTINT:
		lapic_set_lvt_mode(apic_id, pin, APIC_LVT_DM_EXTINT);
		break;
	default:
		panic("%s: invalid interrupt entry type %d\n", __func__,
		    intr->int_type);
	}
	if ((intr->int_flags & INTENTRY_FLAGS_TRIGGER) !=
	    INTENTRY_FLAGS_TRIGGER_CONFORM)
		lapic_set_lvt_triggermode(apic_id, pin,
		    intentry_trigger(intr));
	if ((intr->int_flags & INTENTRY_FLAGS_POLARITY) !=
	    INTENTRY_FLAGS_POLARITY_CONFORM)
		lapic_set_lvt_polarity(apic_id, pin, intentry_polarity(intr));
}
824
825

/*
826
 * Parse interrupt entries.
827
 */
828
static void
829
mptable_parse_ints_handler(u_char *entry, void *arg __unused)
830
{
831
	int_entry_ptr intr;
832

833
834
835
836
837
838
839
840
	intr = (int_entry_ptr)entry;
	switch (*entry) {
	case MPCT_ENTRY_INT:
		mptable_parse_io_int(intr);
		break;
	case MPCT_ENTRY_LOCAL_INT:
		mptable_parse_local_int(intr);
		break;
841
842
	}
}
843
844
845
846
847
848
849
850
851
852
853
854
855
856
857
858
859
860
861
862
863
864
865
866
867
868
869
870
871
872
873
874
875
876
877
878
879
880
881
882
883
884
885
886
887
888
889
890
891
892
893
894

/*
 * Configure interrupt pins for a default configuration.  For details see
 * Table 5-2 in Section 5 of the MP Table specification.
 */
static void
mptable_parse_default_config_ints(void)
{
	struct INTENTRY entry;
	int pin;

	/*
	 * All default configs route IRQs from bus 0 to the first 16 pins
	 * of the first I/O APIC with an APIC ID of 2.
	 */
	entry.type = MPCT_ENTRY_INT;
	entry.int_flags = INTENTRY_FLAGS_POLARITY_CONFORM |
	    INTENTRY_FLAGS_TRIGGER_CONFORM;
	entry.src_bus_id = 0;
	entry.dst_apic_id = 2;

	/* Run through all 16 pins. */
	for (pin = 0; pin < 16; pin++) {
		entry.dst_apic_int = pin;
		switch (pin) {
		case 0:
			/* Pin 0 is an ExtINT pin. */
			entry.int_type = INTENTRY_TYPE_EXTINT;
			break;
		case 2:
			/* IRQ 0 is routed to pin 2. */
			entry.int_type = INTENTRY_TYPE_INT;
			entry.src_bus_irq = 0;
			break;
		default:
			/* All other pins are identity mapped. */
			entry.int_type = INTENTRY_TYPE_INT;
			entry.src_bus_irq = pin;
			break;
		}
		mptable_parse_io_int(&entry);
	}

	/* Certain configs disable certain pins. */
	if (mpfps->config_type == 7)
		ioapic_disable_pin(ioapics[2], 0);
	if (mpfps->config_type == 2) {
		ioapic_disable_pin(ioapics[2], 2);
		ioapic_disable_pin(ioapics[2], 13);
	}
}

895
/*
896
 * Configure the interrupt pins
897
 */
898
899
static void
mptable_parse_ints(void)
900
{
901

902
903
904
	/* Is this a pre-defined config? */
	if (mpfps->config_type != 0) {
		/* Configure LINT pins. */
905
906
907
		lapic_set_lvt_mode(APIC_ID_ALL, APIC_LVT_LINT0,
		    APIC_LVT_DM_EXTINT);
		lapic_set_lvt_mode(APIC_ID_ALL, APIC_LVT_LINT1, APIC_LVT_DM_NMI);
908

909
		/* Configure I/O APIC pins. */
910
		mptable_parse_default_config_ints();
911
912
	} else
		mptable_walk_table(mptable_parse_ints_handler, NULL);
913
914
}

915
#ifdef MPTABLE_FORCE_HTT
916
/*
917
918
 * Perform a hyperthreading "fix-up" to enumerate any logical CPU's
 * that aren't already listed in the table.
919
920
921
922
923
924
925
926
927
928
929
 *
 * XXX: We assume that all of the physical CPUs in the
 * system have the same number of logical CPUs.
 *
 * XXX: We assume that APIC ID's are allocated such that
 * the APIC ID's for a physical processor are aligned
 * with the number of logical CPU's in the processor.
 */
static void
mptable_hyperthread_fixup(u_int id_mask)
{
930
	u_int i, id, logical_cpus;
931
932
933
934

	/* Nothing to do if there is no HTT support. */
	if ((cpu_feature & CPUID_HTT) == 0)
		return;
935
	logical_cpus = (cpu_procinfo & CPUID_HTT_CORES) >> 16;
936
937
938
939
940
941
942
943
944
	if (logical_cpus <= 1)
		return;

	/*
	 * For each APIC ID of a CPU that is set in the mask,
	 * scan the other candidate APIC ID's for this
	 * physical processor.  If any of those ID's are
	 * already in the table, then kill the fixup.
	 */
945
	for (id = 0; id <= MAX_LAPIC_ID; id++) {
946
947
948
949
950
951
952
953
954
955
956
		if ((id_mask & 1 << id) == 0)
			continue;
		/* First, make sure we are on a logical_cpus boundary. */
		if (id % logical_cpus != 0)
			return;
		for (i = id + 1; i < id + logical_cpus; i++)
			if ((id_mask & 1 << i) != 0)
				return;
	}

	/*
957
958
	 * Ok, the ID's checked out, so perform the fixup by
	 * adding the logical CPUs.
959
	 */
960
961
962
963
964
965
966
967
968
969
	while ((id = ffs(id_mask)) != 0) {
		id--;
		for (i = id + 1; i < id + logical_cpus; i++) {
			if (bootverbose)
				printf(
			"MPTable: Adding logical CPU %d from main CPU %d\n",
				    i, id);
			lapic_create(i, 0);
		}
		id_mask &= ~(1 << id);
970
971
	}
}
972
#endif /* MPTABLE_FORCE_HTT */
973

974
/*
975
 * Support code for routing PCI interrupts using the MP Table.
976
977
 */
static void
978
mptable_pci_setup(void)
979
{
980
	int i;
981

fsmp's avatar
fsmp committed
982
	/*
983
984
	 * Find the first pci bus and call it 0.  Panic if pci0 is not
	 * bus zero and there are multiple PCI busses.
985
	 */
986
987
988
989
990
991
992
	for (i = 0; i <= mptable_maxbusid; i++)
		if (busses[i].bus_type == PCI) {
			if (pci0 == -1)
				pci0 = i;
			else if (pci0 != 0)
				panic(
		"MPTable contains multiple PCI busses but no PCI bus 0");
993
		}
994
995
}

996
static void
997
mptable_pci_probe_table_handler(u_char *entry, void *arg)
998
{
999
1000
	struct pci_probe_table_args *args;
	int_entry_ptr intr;
For faster browsing, not all history is shown. View entire blame