WebSVN – HelenOS-historic – Diff – /SPARTAN/trunk/arch/ia32/src/smp/apic.c


/*
 * Copyright (C) 2001-2004 Jakub Jermar
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 *
 * - Redistributions of source code must retain the above copyright
 *   notice, this list of conditions and the following disclaimer.
 * - Redistributions in binary form must reproduce the above copyright
 *   notice, this list of conditions and the following disclaimer in the
 *   documentation and/or other materials provided with the distribution.
 * - The name of the author 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 ``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 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.
 */
 
 
 
#include <arch/types.h>
#include <arch/smp/apic.h>
#include <arch/smp/ap.h>
#include <arch/smp/mp.h>
#include <mm/page.h>
#include <time/delay.h>
#include <arch/interrupt.h>
#include <print.h>
#include <arch/asm.h>
#include <arch.h>
 
#ifdef __SMP__
 
/*
 * This is functional, far-from-general-enough interface to the APIC.
 * Advanced Programmable Interrupt Controller for MP systems.
 * Tested on:
 *  Bochs 2.0.2 with 2-8 CPUs
 *  ASUS P/I-P65UP5 + ASUS C-P55T2D REV. 1.41 with 2x 200Mhz Pentium CPUs
 */
 
/*
 * These variables either stay configured as initilalized, or are changed by
 * the MP configuration code.
 *
 * Pay special attention to the volatile keyword. Without it, gcc -O2 would
 * optimize the code too much and accesses to l_apic and io_apic, that must
 * always be 32-bit, would use byte oriented instructions.
 */
volatile __u32 *l_apic = (__u32 *) 0xfee00000;
volatile __u32 *io_apic = (__u32 *) 0xfec00000;
 
__u32 apic_id_mask = 0;
 
int apic_poll_errors(void);
 
void apic_init(void)
{
    __u32 tmp, id, i;
 
    trap_register(VECTOR_APIC_SPUR, apic_spurious);
 
    enable_irqs_function = io_apic_enable_irqs;
    disable_irqs_function = io_apic_disable_irqs;
    eoi_function = l_apic_eoi;
   
    /*
     * Configure interrupt routing.
     * IRQ 0 remains masked as the time signal is generated by l_apic's themselves.
     * Other interrupts will be forwarded to the lowest priority CPU.
     */
    io_apic_disable_irqs(0xffff);
    trap_register(VECTOR_CLK, l_apic_timer_interrupt);
    for (i=1; i<16; i++) {
        int pin;
   
        if ((pin = mp_irq_to_pin(i)) != -1)
                io_apic_change_ioredtbl(pin,0xf,IVT_IRQBASE+i,LOPRI);
    }
   
 
    /*
     * Ensure that io_apic has unique ID.
     */
    tmp = io_apic_read(IOAPICID);
    id = (tmp >> 24) & 0xf;
    if ((1<<id) & apic_id_mask) {
        int i;
       
        for (i=0; i<15; i++) {
            if (!((1<<i) & apic_id_mask)) {
                io_apic_write(IOAPICID, (tmp & (~(0xf<<24))) | (i<<24));
                break;
            }
        }
    }
 
 
 
    /*
     * Configure the BSP's lapic.
     */
    l_apic_init();
    l_apic_debug();
}
 
void apic_spurious(__u8 n, __u32 stack[])
{
    printf("cpu%d: APIC spurious interrupt\n", CPU->id);
}
 
int apic_poll_errors(void)
{
    __u32 esr;
   
    esr = l_apic[ESR] & ~ESRClear;
   
    if ((esr>>0) & 1)
        printf("Send CS Error\n");
    if ((esr>>1) & 1)
        printf("Receive CS Error\n");
    if ((esr>>2) & 1)
        printf("Send Accept Error\n");
    if ((esr>>3) & 1)
        printf("Receive Accept Error\n");
    if ((esr>>5) & 1)
        printf("Send Illegal Vector\n");
    if ((esr>>6) & 1)
        printf("Received Illegal Vector\n");
    if ((esr>>7) & 1)
        printf("Illegal Register Address\n");
   
    return !esr;
}
 
/*
 * Send all CPUs excluding CPU IPI vector.
 */
int l_apic_broadcast_custom_ipi(__u8 vector)
{
    __u32 lo;
 
    /*
     * Read the ICR register in and zero all non-reserved fields.
     */
    lo = l_apic[ICRlo] & ICRloClear;
 
    lo |= DLVRMODE_FIXED | DESTMODE_LOGIC | LEVEL_ASSERT | SHORTHAND_EXCL | TRGRMODE_LEVEL | vector;
   
    l_apic[ICRlo] = lo;
 
    lo = l_apic[ICRlo] & ICRloClear;
    if (lo & SEND_PENDING)
        printf("IPI is pending.\n");
 
    return apic_poll_errors();
}
 
/*
 * Universal Start-up Algorithm for bringing up the AP processors.
 */
int l_apic_send_init_ipi(__u8 apicid)
{
    __u32 lo, hi;
    int i;
 
    /*
     * Read the ICR register in and zero all non-reserved fields.
     */
    lo = l_apic[ICRlo] & ICRloClear;
    hi = l_apic[ICRhi] & ICRhiClear;
   
    lo |= DLVRMODE_INIT | DESTMODE_PHYS | LEVEL_ASSERT | SHORTHAND_DEST | TRGRMODE_LEVEL;
    hi |= apicid << 24;
   
    l_apic[ICRhi] = hi;
    l_apic[ICRlo] = lo;
   
    /*
     * According to MP Specification, 20us should be enough to
     * deliver the IPI.
     */
    delay(20);
 
    if (!apic_poll_errors()) return 0;
 
    lo = l_apic[ICRlo] & ICRloClear;
    if (lo & SEND_PENDING)
        printf("IPI is pending.\n");
   
    l_apic[ICRlo] = lo | DLVRMODE_INIT | DESTMODE_PHYS | LEVEL_DEASSERT | SHORTHAND_DEST | TRGRMODE_LEVEL;
 
    /*
     * Wait 10ms as MP Specification specifies.
     */
    delay(10000);
 
    /*
     * MP specification says this should not be done for 82489DX-based
     * l_apic's. However, everything is ok as long as STARTUP IPI is ignored
     * by 8249DX.
     */
    for (i = 0; i < 2; i++) {
        lo = l_apic[ICRlo] & ICRloClear;
        lo |= ((__address) ap_boot) / 4096; /* calculate the reset vector */
        l_apic[ICRlo] = lo | DLVRMODE_STUP | DESTMODE_PHYS | LEVEL_ASSERT | SHORTHAND_DEST |  TRGRMODE_LEVEL;
        delay(200);
    }
   
    return apic_poll_errors();
}
 
void l_apic_init(void)
{
    __u32 tmp, t1, t2;
    int cpu_id = config.cpu_active - 1;
   
 
    /*
     * Here we set local APIC ID's so that they match operating system's CPU ID's
     * This operation is dangerous as it is model specific.
     * TODO: some care should be taken.
     * NOTE: CPU may not be used to define APIC ID
     */
    if (l_apic_id() != cpu_id) {
        l_apic[L_APIC_ID] &= L_APIC_IDClear;
        l_apic[L_APIC_ID] |= (l_apic[L_APIC_ID]&L_APIC_IDClear)|((cpu_id)<<L_APIC_IDShift);
    }
 
    l_apic[LVT_Err] |= (1<<16);
    l_apic[LVT_LINT0] |= (1<<16);
    l_apic[LVT_LINT1] |= (1<<16);
 
    tmp = l_apic[SVR] & SVRClear;
    l_apic[SVR] = tmp | (1<<8) | (VECTOR_APIC_SPUR);
 
    l_apic[TPR] &= TPRClear;
 
    if (CPU->arch.family >= 6)
        enable_l_apic_in_msr();
   
    tmp = l_apic[ICRlo] & ICRloClear;
    l_apic[ICRlo] = tmp | DLVRMODE_INIT | DESTMODE_PHYS | LEVEL_DEASSERT | SHORTHAND_INCL | TRGRMODE_LEVEL;
   
    /*
     * Program the timer for periodic mode and respective vector.
     */
 
    l_apic[TDCR] &= TDCRClear;
    l_apic[TDCR] |= 0xb;
    tmp = l_apic[LVT_Tm] | (1<<17) | (VECTOR_CLK);
    l_apic[LVT_Tm] = tmp & ~(1<<16);
 
    t1 = l_apic[CCRT];
    l_apic[ICRT] = 0xffffffff;
 
    while (l_apic[CCRT] == t1)
        ;
       
    t1 = l_apic[CCRT];
    delay(1000);
    t2 = l_apic[CCRT];
   
    l_apic[ICRT] = t1-t2;
}
 
void l_apic_eoi(void)
{
    l_apic[EOI] = 0;
}
 
void l_apic_debug(void)
{
#ifdef LAPIC_VERBOSE
    int i, lint;
 
    printf("LVT on cpu%d, LAPIC ID: %d\n", CPU->id, l_apic_id());
 
    printf("LVT_Tm: ");
    if (l_apic[LVT_Tm] & (1<<17)) printf("periodic"); else printf("one-shot"); putchar(',');   
    if (l_apic[LVT_Tm] & (1<<16)) printf("masked"); else printf("not masked"); putchar(',');
    if (l_apic[LVT_Tm] & (1<<12)) printf("send pending"); else printf("idle"); putchar(',');
    printf("%B\n", l_apic[LVT_Tm] & 0xff);
   
    for (i=0; i<2; i++) {
        lint = i ? LVT_LINT1 : LVT_LINT0;
        printf("LVT_LINT%d: ", i);
        if (l_apic[lint] & (1<<16)) printf("masked"); else printf("not masked"); putchar(',');
        if (l_apic[lint] & (1<<15)) printf("level"); else printf("edge"); putchar(',');
        printf("%d", l_apic[lint] & (1<<14)); putchar(',');
        printf("%d", l_apic[lint] & (1<<13)); putchar(',');
        if (l_apic[lint] & (1<<12)) printf("send pending"); else printf("idle"); putchar(',');
   
        switch ((l_apic[lint]>>8)&7) {
            case 0: printf("fixed"); break;
            case 4: printf("NMI"); break;
            case 7: printf("ExtINT"); break;
        }
        putchar(',');
        printf("%B\n", l_apic[lint] & 0xff);   
    }
 
    printf("LVT_Err: ");
    if (l_apic[LVT_Err] & (1<<16)) printf("masked"); else printf("not masked"); putchar(',');
    if (l_apic[LVT_Err] & (1<<12)) printf("send pending"); else printf("idle"); putchar(',');
    printf("%B\n", l_apic[LVT_Err] & 0xff);
 
    /*
     * This register is supported only on P6 and higher.
     */
    if (CPU->arch.family > 5) {
        printf("LVT_PCINT: ");
        if (l_apic[LVT_PCINT] & (1<<16)) printf("masked"); else printf("not masked"); putchar(',');
        if (l_apic[LVT_PCINT] & (1<<12)) printf("send pending"); else printf("idle"); putchar(',');
        switch ((l_apic[LVT_PCINT] >> 8)&7) {
            case 0: printf("fixed"); break;
            case 4: printf("NMI"); break;
            case 7: printf("ExtINT"); break;
        }
        putchar(',');
        printf("%B\n", l_apic[LVT_PCINT] & 0xff);
    }
#endif
}
 
void l_apic_timer_interrupt(__u8 n, __u32 stack[])
{
    l_apic_eoi();
    clock();
}
 
__u8 l_apic_id(void)
{
    return (l_apic[L_APIC_ID] >> L_APIC_IDShift)&L_APIC_IDMask;
}
 
__u32 io_apic_read(__u8 address)
{
    __u32 tmp;
   
    tmp = io_apic[IOREGSEL] & ~0xf;
    io_apic[IOREGSEL] = tmp | address;
    return io_apic[IOWIN];
}
 
void io_apic_write(__u8 address, __u32 x)
{
    __u32 tmp;
 
    tmp = io_apic[IOREGSEL] & ~0xf;
    io_apic[IOREGSEL] = tmp | address;
    io_apic[IOWIN] = x;
}
 
void io_apic_change_ioredtbl(int signal, int dest, __u8 v, int flags)
{
    __u32 reglo, reghi;
    int dlvr = 0;
   
    if (flags & LOPRI)
        dlvr = 1;
   
    reglo = io_apic_read(IOREDTBL + signal*2);
    reghi = io_apic_read(IOREDTBL + signal*2 + 1);
   
    reghi &= ~0x0f000000;
    reghi |= (dest<<24);
 
    reglo &= (~0x1ffff) | (1<<16); /* don't touch the mask */
    reglo |= (0<<15) | (0<<13) | (0<<11) | (dlvr<<8) | v;
 
    io_apic_write(IOREDTBL + signal*2, reglo);     
    io_apic_write(IOREDTBL + signal*2 + 1, reghi);
}
 
void io_apic_disable_irqs(__u16 irqmask)
{
    int i,pin;
    __u32 reglo;
   
    for (i=0;i<16;i++) {
        if ((irqmask>>i) & 1) {
            /*
             * Mask the signal input in IO APIC if there is a
             * mapping for the respective IRQ number.
             */
            pin = mp_irq_to_pin(i);
            if (pin != -1) {
                reglo = io_apic_read(IOREDTBL + pin*2);
                reglo |= (1<<16);
                io_apic_write(IOREDTBL + pin*2,reglo);
            }
           
        }
    }
}
 
void io_apic_enable_irqs(__u16 irqmask)
{
    int i,pin;
    __u32 reglo;
   
    for (i=0;i<16;i++) {
        if ((irqmask>>i) & 1) {
            /*
             * Unmask the signal input in IO APIC if there is a
             * mapping for the respective IRQ number.
             */
            pin = mp_irq_to_pin(i);
            if (pin != -1) {
                reglo = io_apic_read(IOREDTBL + pin*2);
                reglo &= ~(1<<16);
                io_apic_write(IOREDTBL + pin*2,reglo);
            }
           
        }
    }
 
}
 
#endif /* __SMP__ */
 

Rev 15	Rev 16
1	/*	1	/*
2	* Copyright (C) 2001-2004 Jakub Jermar	2	* Copyright (C) 2001-2004 Jakub Jermar
3	* All rights reserved.	3	* All rights reserved.
4	*	4	*
5	* Redistribution and use in source and binary forms, with or without	5	* Redistribution and use in source and binary forms, with or without
6	* modification, are permitted provided that the following conditions	6	* modification, are permitted provided that the following conditions
7	* are met:	7	* are met:
8	*	8	*
9	* - Redistributions of source code must retain the above copyright	9	* - Redistributions of source code must retain the above copyright
10	* notice, this list of conditions and the following disclaimer.	10	* notice, this list of conditions and the following disclaimer.
11	* - Redistributions in binary form must reproduce the above copyright	11	* - Redistributions in binary form must reproduce the above copyright
12	* notice, this list of conditions and the following disclaimer in the	12	* notice, this list of conditions and the following disclaimer in the
13	* documentation and/or other materials provided with the distribution.	13	* documentation and/or other materials provided with the distribution.
14	* - The name of the author may not be used to endorse or promote products	14	* - The name of the author may not be used to endorse or promote products
15	* derived from this software without specific prior written permission.	15	* derived from this software without specific prior written permission.
16	*	16	*
17	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR	17	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES	18	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.	19	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,	20	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT	21	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,	22	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY	23	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT	24	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF	25	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.	26	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27	*/	27	*/
28		28
29	#ifdef __SMP__	-
30		-
31	#include <arch/types.h>	29	#include <arch/types.h>
32	#include <arch/smp/apic.h>	30	#include <arch/smp/apic.h>
33	#include <arch/smp/ap.h>	31	#include <arch/smp/ap.h>
34	#include <arch/smp/mp.h>	32	#include <arch/smp/mp.h>
35	#include <mm/page.h>	33	#include <mm/page.h>
36	#include <time/delay.h>	34	#include <time/delay.h>
37	#include <arch/interrupt.h>	35	#include <arch/interrupt.h>
38	#include <print.h>	36	#include <print.h>
39	#include <arch/asm.h>	37	#include <arch/asm.h>
40	#include <arch.h>	38	#include <arch.h>
41		39
-		40	#ifdef __SMP__
-		41
42	/*	42	/*
43	* This is functional, far-from-general-enough interface to the APIC.	43	* This is functional, far-from-general-enough interface to the APIC.
44	* Advanced Programmable Interrupt Controller for MP systems.	44	* Advanced Programmable Interrupt Controller for MP systems.
45	* Tested on:	45	* Tested on:
46	* Bochs 2.0.2 with 2-8 CPUs	46	* Bochs 2.0.2 with 2-8 CPUs
47	* ASUS P/I-P65UP5 + ASUS C-P55T2D REV. 1.41 with 2x 200Mhz Pentium CPUs	47	* ASUS P/I-P65UP5 + ASUS C-P55T2D REV. 1.41 with 2x 200Mhz Pentium CPUs
48	*/	48	*/
49		49
50	/*	50	/*
51	* These variables either stay configured as initilalized, or are changed by	51	* These variables either stay configured as initilalized, or are changed by
52	* the MP configuration code.	52	* the MP configuration code.
53	*	53	*
54	* Pay special attention to the volatile keyword. Without it, gcc -O2 would	54	* Pay special attention to the volatile keyword. Without it, gcc -O2 would
55	* optimize the code too much and accesses to l_apic and io_apic, that must	55	* optimize the code too much and accesses to l_apic and io_apic, that must
56	* always be 32-bit, would use byte oriented instructions.	56	* always be 32-bit, would use byte oriented instructions.
57	*/	57	*/
58	volatile __u32 l_apic = (__u32 ) 0xfee00000;	58	volatile __u32 l_apic = (__u32 ) 0xfee00000;
59	volatile __u32 io_apic = (__u32 ) 0xfec00000;	59	volatile __u32 io_apic = (__u32 ) 0xfec00000;
60		60
61	__u32 apic_id_mask = 0;	61	__u32 apic_id_mask = 0;
62		62
63	int apic_poll_errors(void);	63	int apic_poll_errors(void);
64		64
65	void apic_init(void)	65	void apic_init(void)
66	{	66	{
67	__u32 tmp, id, i;	67	__u32 tmp, id, i;
68		68
69	trap_register(VECTOR_APIC_SPUR, apic_spurious);	69	trap_register(VECTOR_APIC_SPUR, apic_spurious);
70		70
71	enable_irqs_function = io_apic_enable_irqs;	71	enable_irqs_function = io_apic_enable_irqs;
72	disable_irqs_function = io_apic_disable_irqs;	72	disable_irqs_function = io_apic_disable_irqs;
73	eoi_function = l_apic_eoi;	73	eoi_function = l_apic_eoi;
74		74
75	/*	75	/*
76	* Configure interrupt routing.	76	* Configure interrupt routing.
77	* IRQ 0 remains masked as the time signal is generated by l_apic's themselves.	77	* IRQ 0 remains masked as the time signal is generated by l_apic's themselves.
78	* Other interrupts will be forwarded to the lowest priority CPU.	78	* Other interrupts will be forwarded to the lowest priority CPU.
79	*/	79	*/
80	io_apic_disable_irqs(0xffff);	80	io_apic_disable_irqs(0xffff);
81	trap_register(VECTOR_CLK, l_apic_timer_interrupt);	81	trap_register(VECTOR_CLK, l_apic_timer_interrupt);
82	for (i=1; i<16; i++) {	82	for (i=1; i<16; i++) {
83	int pin;	83	int pin;
84		84
85	if ((pin = mp_irq_to_pin(i)) != -1)	85	if ((pin = mp_irq_to_pin(i)) != -1)
86	io_apic_change_ioredtbl(pin,0xf,IVT_IRQBASE+i,LOPRI);	86	io_apic_change_ioredtbl(pin,0xf,IVT_IRQBASE+i,LOPRI);
87	}	87	}
88		88
89		89
90	/*	90	/*
91	* Ensure that io_apic has unique ID.	91	* Ensure that io_apic has unique ID.
92	*/	92	*/
93	tmp = io_apic_read(IOAPICID);	93	tmp = io_apic_read(IOAPICID);
94	id = (tmp >> 24) & 0xf;	94	id = (tmp >> 24) & 0xf;
95	if ((1<<id) & apic_id_mask) {	95	if ((1<<id) & apic_id_mask) {
96	int i;	96	int i;
97		97
98	for (i=0; i<15; i++) {	98	for (i=0; i<15; i++) {
99	if (!((1<<i) & apic_id_mask)) {	99	if (!((1<<i) & apic_id_mask)) {
100	io_apic_write(IOAPICID, (tmp & (~(0xf<<24))) \| (i<<24));	100	io_apic_write(IOAPICID, (tmp & (~(0xf<<24))) \| (i<<24));
101	break;	101	break;
102	}	102	}
103	}	103	}
104	}	104	}
105		105
106		106
107		107
108	/*	108	/*
109	* Configure the BSP's lapic.	109	* Configure the BSP's lapic.
110	*/	110	*/
111	l_apic_init();	111	l_apic_init();
112	l_apic_debug();	112	l_apic_debug();
113	}	113	}
114		114
115	void apic_spurious(__u8 n, __u32 stack[])	115	void apic_spurious(__u8 n, __u32 stack[])
116	{	116	{
117	printf("cpu%d: APIC spurious interrupt\n", CPU->id);	117	printf("cpu%d: APIC spurious interrupt\n", CPU->id);
118	}	118	}
119		119
120	int apic_poll_errors(void)	120	int apic_poll_errors(void)
121	{	121	{
122	__u32 esr;	122	__u32 esr;
123		123
124	esr = l_apic[ESR] & ~ESRClear;	124	esr = l_apic[ESR] & ~ESRClear;
125		125
126	if ((esr>>0) & 1)	126	if ((esr>>0) & 1)
127	printf("Send CS Error\n");	127	printf("Send CS Error\n");
128	if ((esr>>1) & 1)	128	if ((esr>>1) & 1)
129	printf("Receive CS Error\n");	129	printf("Receive CS Error\n");
130	if ((esr>>2) & 1)	130	if ((esr>>2) & 1)
131	printf("Send Accept Error\n");	131	printf("Send Accept Error\n");
132	if ((esr>>3) & 1)	132	if ((esr>>3) & 1)
133	printf("Receive Accept Error\n");	133	printf("Receive Accept Error\n");
134	if ((esr>>5) & 1)	134	if ((esr>>5) & 1)
135	printf("Send Illegal Vector\n");	135	printf("Send Illegal Vector\n");
136	if ((esr>>6) & 1)	136	if ((esr>>6) & 1)
137	printf("Received Illegal Vector\n");	137	printf("Received Illegal Vector\n");
138	if ((esr>>7) & 1)	138	if ((esr>>7) & 1)
139	printf("Illegal Register Address\n");	139	printf("Illegal Register Address\n");
140		140
141	return !esr;	141	return !esr;
142	}	142	}
143		143
144	/*	144	/*
145	* Send all CPUs excluding CPU IPI vector.	145	* Send all CPUs excluding CPU IPI vector.
146	*/	146	*/
147	int l_apic_broadcast_custom_ipi(__u8 vector)	147	int l_apic_broadcast_custom_ipi(__u8 vector)
148	{	148	{
149	__u32 lo;	149	__u32 lo;
150		150
151	/*	151	/*
152	* Read the ICR register in and zero all non-reserved fields.	152	* Read the ICR register in and zero all non-reserved fields.
153	*/	153	*/
154	lo = l_apic[ICRlo] & ICRloClear;	154	lo = l_apic[ICRlo] & ICRloClear;
155		155
156	lo \|= DLVRMODE_FIXED \| DESTMODE_LOGIC \| LEVEL_ASSERT \| SHORTHAND_EXCL \| TRGRMODE_LEVEL \| vector;	156	lo \|= DLVRMODE_FIXED \| DESTMODE_LOGIC \| LEVEL_ASSERT \| SHORTHAND_EXCL \| TRGRMODE_LEVEL \| vector;
157		157
158	l_apic[ICRlo] = lo;	158	l_apic[ICRlo] = lo;
159		159
160	lo = l_apic[ICRlo] & ICRloClear;	160	lo = l_apic[ICRlo] & ICRloClear;
161	if (lo & SEND_PENDING)	161	if (lo & SEND_PENDING)
162	printf("IPI is pending.\n");	162	printf("IPI is pending.\n");
163		163
164	return apic_poll_errors();	164	return apic_poll_errors();
165	}	165	}
166		166
167	/*	167	/*
168	* Universal Start-up Algorithm for bringing up the AP processors.	168	* Universal Start-up Algorithm for bringing up the AP processors.
169	*/	169	*/
170	int l_apic_send_init_ipi(__u8 apicid)	170	int l_apic_send_init_ipi(__u8 apicid)
171	{	171	{
172	__u32 lo, hi;	172	__u32 lo, hi;
173	int i;	173	int i;
174		174
175	/*	175	/*
176	* Read the ICR register in and zero all non-reserved fields.	176	* Read the ICR register in and zero all non-reserved fields.
177	*/	177	*/
178	lo = l_apic[ICRlo] & ICRloClear;	178	lo = l_apic[ICRlo] & ICRloClear;
179	hi = l_apic[ICRhi] & ICRhiClear;	179	hi = l_apic[ICRhi] & ICRhiClear;
180		180
181	lo \|= DLVRMODE_INIT \| DESTMODE_PHYS \| LEVEL_ASSERT \| SHORTHAND_DEST \| TRGRMODE_LEVEL;	181	lo \|= DLVRMODE_INIT \| DESTMODE_PHYS \| LEVEL_ASSERT \| SHORTHAND_DEST \| TRGRMODE_LEVEL;
182	hi \|= apicid << 24;	182	hi \|= apicid << 24;
183		183
184	l_apic[ICRhi] = hi;	184	l_apic[ICRhi] = hi;
185	l_apic[ICRlo] = lo;	185	l_apic[ICRlo] = lo;
186		186
187	/*	187	/*
188	* According to MP Specification, 20us should be enough to	188	* According to MP Specification, 20us should be enough to
189	* deliver the IPI.	189	* deliver the IPI.
190	*/	190	*/
191	delay(20);	191	delay(20);
192		192
193	if (!apic_poll_errors()) return 0;	193	if (!apic_poll_errors()) return 0;
194		194
195	lo = l_apic[ICRlo] & ICRloClear;	195	lo = l_apic[ICRlo] & ICRloClear;
196	if (lo & SEND_PENDING)	196	if (lo & SEND_PENDING)
197	printf("IPI is pending.\n");	197	printf("IPI is pending.\n");
198		198
199	l_apic[ICRlo] = lo \| DLVRMODE_INIT \| DESTMODE_PHYS \| LEVEL_DEASSERT \| SHORTHAND_DEST \| TRGRMODE_LEVEL;	199	l_apic[ICRlo] = lo \| DLVRMODE_INIT \| DESTMODE_PHYS \| LEVEL_DEASSERT \| SHORTHAND_DEST \| TRGRMODE_LEVEL;
200		200
201	/*	201	/*
202	* Wait 10ms as MP Specification specifies.	202	* Wait 10ms as MP Specification specifies.
203	*/	203	*/
204	delay(10000);	204	delay(10000);
205		205
206	/*	206	/*
207	* MP specification says this should not be done for 82489DX-based	207	* MP specification says this should not be done for 82489DX-based
208	* l_apic's. However, everything is ok as long as STARTUP IPI is ignored	208	* l_apic's. However, everything is ok as long as STARTUP IPI is ignored
209	* by 8249DX.	209	* by 8249DX.
210	*/	210	*/
211	for (i = 0; i < 2; i++) {	211	for (i = 0; i < 2; i++) {
212	lo = l_apic[ICRlo] & ICRloClear;	212	lo = l_apic[ICRlo] & ICRloClear;
213	lo \|= ((__address) ap_boot) / 4096; /* calculate the reset vector */	213	lo \|= ((__address) ap_boot) / 4096; /* calculate the reset vector */
214	l_apic[ICRlo] = lo \| DLVRMODE_STUP \| DESTMODE_PHYS \| LEVEL_ASSERT \| SHORTHAND_DEST \| TRGRMODE_LEVEL;	214	l_apic[ICRlo] = lo \| DLVRMODE_STUP \| DESTMODE_PHYS \| LEVEL_ASSERT \| SHORTHAND_DEST \| TRGRMODE_LEVEL;
215	delay(200);	215	delay(200);
216	}	216	}
217		217
218	return apic_poll_errors();	218	return apic_poll_errors();
219	}	219	}
220		220
221	void l_apic_init(void)	221	void l_apic_init(void)
222	{	222	{
223	__u32 tmp, t1, t2;	223	__u32 tmp, t1, t2;
-		224	int cpu_id = config.cpu_active - 1;
224		225
225		226
-		227	/*
-		228	* Here we set local APIC ID's so that they match operating system's CPU ID's
-		229	* This operation is dangerous as it is model specific.
-		230	* TODO: some care should be taken.
-		231	* NOTE: CPU may not be used to define APIC ID
-		232	*/
-		233	if (l_apic_id() != cpu_id) {
-		234	l_apic[L_APIC_ID] &= L_APIC_IDClear;
-		235	l_apic[L_APIC_ID] \|= (l_apic[L_APIC_ID]&L_APIC_IDClear)\|((cpu_id)<<L_APIC_IDShift);
-		236	}
-		237
226	l_apic[LVT_Err] \|= (1<<16);	238	l_apic[LVT_Err] \|= (1<<16);
227	l_apic[LVT_LINT0] \|= (1<<16);	239	l_apic[LVT_LINT0] \|= (1<<16);
228	l_apic[LVT_LINT1] \|= (1<<16);	240	l_apic[LVT_LINT1] \|= (1<<16);
229		241
230	tmp = l_apic[SVR] & SVRClear;	242	tmp = l_apic[SVR] & SVRClear;
231	l_apic[SVR] = tmp \| (1<<8) \| (VECTOR_APIC_SPUR);	243	l_apic[SVR] = tmp \| (1<<8) \| (VECTOR_APIC_SPUR);
232		244
233	l_apic[TPR] &= TPRClear;	245	l_apic[TPR] &= TPRClear;
234		246
235	if (CPU->arch.family >= 6)	247	if (CPU->arch.family >= 6)
236	enable_l_apic_in_msr();	248	enable_l_apic_in_msr();
237		249
238	tmp = l_apic[ICRlo] & ICRloClear;	250	tmp = l_apic[ICRlo] & ICRloClear;
239	l_apic[ICRlo] = tmp \| DLVRMODE_INIT \| DESTMODE_PHYS \| LEVEL_DEASSERT \| SHORTHAND_INCL \| TRGRMODE_LEVEL;	251	l_apic[ICRlo] = tmp \| DLVRMODE_INIT \| DESTMODE_PHYS \| LEVEL_DEASSERT \| SHORTHAND_INCL \| TRGRMODE_LEVEL;
240		252
241	/*	253	/*
242	* Program the timer for periodic mode and respective vector.	254	* Program the timer for periodic mode and respective vector.
243	*/	255	*/
244		256
245	l_apic[TDCR] &= TDCRClear;	257	l_apic[TDCR] &= TDCRClear;
246	l_apic[TDCR] \|= 0xb;	258	l_apic[TDCR] \|= 0xb;
247	tmp = l_apic[LVT_Tm] \| (1<<17) \| (VECTOR_CLK);	259	tmp = l_apic[LVT_Tm] \| (1<<17) \| (VECTOR_CLK);
248	l_apic[LVT_Tm] = tmp & ~(1<<16);	260	l_apic[LVT_Tm] = tmp & ~(1<<16);
249		261
250	t1 = l_apic[CCRT];	262	t1 = l_apic[CCRT];
251	l_apic[ICRT] = 0xffffffff;	263	l_apic[ICRT] = 0xffffffff;
252		264
253	while (l_apic[CCRT] == t1)	265	while (l_apic[CCRT] == t1)
254	;	266	;
255		267
256	t1 = l_apic[CCRT];	268	t1 = l_apic[CCRT];
257	delay(1000);	269	delay(1000);
258	t2 = l_apic[CCRT];	270	t2 = l_apic[CCRT];
259		271
260	l_apic[ICRT] = t1-t2;	272	l_apic[ICRT] = t1-t2;
261	}	273	}
262		274
263	void l_apic_eoi(void)	275	void l_apic_eoi(void)
264	{	276	{
265	l_apic[EOI] = 0;	277	l_apic[EOI] = 0;
266	}	278	}
267		279
268	void l_apic_debug(void)	280	void l_apic_debug(void)
269	{	281	{
270	#ifdef LAPIC_VERBOSE	282	#ifdef LAPIC_VERBOSE
271	int i, lint;	283	int i, lint;
272		284
273	printf("LVT on cpu%d, LAPIC ID: %d\n", CPU->id, (l_apic[L_APIC_ID] >> 24)&0xf);	285	printf("LVT on cpu%d, LAPIC ID: %d\n", CPU->id, l_apic_id());
274		286
275	printf("LVT_Tm: ");	287	printf("LVT_Tm: ");
276	if (l_apic[LVT_Tm] & (1<<17)) printf("periodic"); else printf("one-shot"); putchar(',');	288	if (l_apic[LVT_Tm] & (1<<17)) printf("periodic"); else printf("one-shot"); putchar(',');
277	if (l_apic[LVT_Tm] & (1<<16)) printf("masked"); else printf("not masked"); putchar(',');	289	if (l_apic[LVT_Tm] & (1<<16)) printf("masked"); else printf("not masked"); putchar(',');
278	if (l_apic[LVT_Tm] & (1<<12)) printf("send pending"); else printf("idle"); putchar(',');	290	if (l_apic[LVT_Tm] & (1<<12)) printf("send pending"); else printf("idle"); putchar(',');
279	printf("%B\n", l_apic[LVT_Tm] & 0xff);	291	printf("%B\n", l_apic[LVT_Tm] & 0xff);
280		292
281	for (i=0; i<2; i++) {	293	for (i=0; i<2; i++) {
282	lint = i ? LVT_LINT1 : LVT_LINT0;	294	lint = i ? LVT_LINT1 : LVT_LINT0;
283	printf("LVT_LINT%d: ", i);	295	printf("LVT_LINT%d: ", i);
284	if (l_apic[lint] & (1<<16)) printf("masked"); else printf("not masked"); putchar(',');	296	if (l_apic[lint] & (1<<16)) printf("masked"); else printf("not masked"); putchar(',');
285	if (l_apic[lint] & (1<<15)) printf("level"); else printf("edge"); putchar(',');	297	if (l_apic[lint] & (1<<15)) printf("level"); else printf("edge"); putchar(',');
286	printf("%d", l_apic[lint] & (1<<14)); putchar(',');	298	printf("%d", l_apic[lint] & (1<<14)); putchar(',');
287	printf("%d", l_apic[lint] & (1<<13)); putchar(',');	299	printf("%d", l_apic[lint] & (1<<13)); putchar(',');
288	if (l_apic[lint] & (1<<12)) printf("send pending"); else printf("idle"); putchar(',');	300	if (l_apic[lint] & (1<<12)) printf("send pending"); else printf("idle"); putchar(',');
289		301
290	switch ((l_apic[lint]>>8)&7) {	302	switch ((l_apic[lint]>>8)&7) {
291	case 0: printf("fixed"); break;	303	case 0: printf("fixed"); break;
292	case 4: printf("NMI"); break;	304	case 4: printf("NMI"); break;
293	case 7: printf("ExtINT"); break;	305	case 7: printf("ExtINT"); break;
294	}	306	}
295	putchar(',');	307	putchar(',');
296	printf("%B\n", l_apic[lint] & 0xff);	308	printf("%B\n", l_apic[lint] & 0xff);
297	}	309	}
298		310
299	printf("LVT_Err: ");	311	printf("LVT_Err: ");
300	if (l_apic[LVT_Err] & (1<<16)) printf("masked"); else printf("not masked"); putchar(',');	312	if (l_apic[LVT_Err] & (1<<16)) printf("masked"); else printf("not masked"); putchar(',');
301	if (l_apic[LVT_Err] & (1<<12)) printf("send pending"); else printf("idle"); putchar(',');	313	if (l_apic[LVT_Err] & (1<<12)) printf("send pending"); else printf("idle"); putchar(',');
302	printf("%B\n", l_apic[LVT_Err] & 0xff);	314	printf("%B\n", l_apic[LVT_Err] & 0xff);
303		315
304	/*	316	/*
305	* This register is supported only on P6 and higher.	317	* This register is supported only on P6 and higher.
306	*/	318	*/
307	if (CPU->family > 5) {	319	if (CPU->arch.family > 5) {
308	printf("LVT_PCINT: ");	320	printf("LVT_PCINT: ");
309	if (l_apic[LVT_PCINT] & (1<<16)) printf("masked"); else printf("not masked"); putchar(',');	321	if (l_apic[LVT_PCINT] & (1<<16)) printf("masked"); else printf("not masked"); putchar(',');
310	if (l_apic[LVT_PCINT] & (1<<12)) printf("send pending"); else printf("idle"); putchar(',');	322	if (l_apic[LVT_PCINT] & (1<<12)) printf("send pending"); else printf("idle"); putchar(',');
311	switch ((l_apic[LVT_PCINT] >> 8)&7) {	323	switch ((l_apic[LVT_PCINT] >> 8)&7) {
312	case 0: printf("fixed"); break;	324	case 0: printf("fixed"); break;
313	case 4: printf("NMI"); break;	325	case 4: printf("NMI"); break;
314	case 7: printf("ExtINT"); break;	326	case 7: printf("ExtINT"); break;
315	}	327	}
316	putchar(',');	328	putchar(',');
317	printf("%B\n", l_apic[LVT_PCINT] & 0xff);	329	printf("%B\n", l_apic[LVT_PCINT] & 0xff);
318	}	330	}
319	#endif	331	#endif
320	}	332	}
321		333
322	void l_apic_timer_interrupt(__u8 n, __u32 stack[])	334	void l_apic_timer_interrupt(__u8 n, __u32 stack[])
323	{	335	{
324	l_apic_eoi();	336	l_apic_eoi();
325	clock();	337	clock();
326	}	338	}
-		339
-		340	__u8 l_apic_id(void)
-		341	{
-		342	return (l_apic[L_APIC_ID] >> L_APIC_IDShift)&L_APIC_IDMask;
-		343	}
327		344
328	__u32 io_apic_read(__u8 address)	345	__u32 io_apic_read(__u8 address)
329	{	346	{
330	__u32 tmp;	347	__u32 tmp;
331		348
332	tmp = io_apic[IOREGSEL] & ~0xf;	349	tmp = io_apic[IOREGSEL] & ~0xf;
333	io_apic[IOREGSEL] = tmp \| address;	350	io_apic[IOREGSEL] = tmp \| address;
334	return io_apic[IOWIN];	351	return io_apic[IOWIN];
335	}	352	}
336		353
337	void io_apic_write(__u8 address, __u32 x)	354	void io_apic_write(__u8 address, __u32 x)
338	{	355	{
339	__u32 tmp;	356	__u32 tmp;
340		357
341	tmp = io_apic[IOREGSEL] & ~0xf;	358	tmp = io_apic[IOREGSEL] & ~0xf;
342	io_apic[IOREGSEL] = tmp \| address;	359	io_apic[IOREGSEL] = tmp \| address;
343	io_apic[IOWIN] = x;	360	io_apic[IOWIN] = x;
344	}	361	}
345		362
346	void io_apic_change_ioredtbl(int signal, int dest, __u8 v, int flags)	363	void io_apic_change_ioredtbl(int signal, int dest, __u8 v, int flags)
347	{	364	{
348	__u32 reglo, reghi;	365	__u32 reglo, reghi;
349	int dlvr = 0;	366	int dlvr = 0;
350		367
351	if (flags & LOPRI)	368	if (flags & LOPRI)
352	dlvr = 1;	369	dlvr = 1;
353		370
354	reglo = io_apic_read(IOREDTBL + signal*2);	371	reglo = io_apic_read(IOREDTBL + signal*2);
355	reghi = io_apic_read(IOREDTBL + signal*2 + 1);	372	reghi = io_apic_read(IOREDTBL + signal*2 + 1);
356		373
357	reghi &= ~0x0f000000;	374	reghi &= ~0x0f000000;
358	reghi \|= (dest<<24);	375	reghi \|= (dest<<24);
359		376
360	reglo &= (~0x1ffff) \| (1<<16); /* don't touch the mask */	377	reglo &= (~0x1ffff) \| (1<<16); /* don't touch the mask */
361	reglo \|= (0<<15) \| (0<<13) \| (0<<11) \| (dlvr<<8) \| v;	378	reglo \|= (0<<15) \| (0<<13) \| (0<<11) \| (dlvr<<8) \| v;
362		379
363	io_apic_write(IOREDTBL + signal*2, reglo);	380	io_apic_write(IOREDTBL + signal*2, reglo);
364	io_apic_write(IOREDTBL + signal*2 + 1, reghi);	381	io_apic_write(IOREDTBL + signal*2 + 1, reghi);
365	}	382	}
366		383
367	void io_apic_disable_irqs(__u16 irqmask)	384	void io_apic_disable_irqs(__u16 irqmask)
368	{	385	{
369	int i,pin;	386	int i,pin;
370	__u32 reglo;	387	__u32 reglo;
371		388
372	for (i=0;i<16;i++) {	389	for (i=0;i<16;i++) {
373	if ((irqmask>>i) & 1) {	390	if ((irqmask>>i) & 1) {
374	/*	391	/*
375	* Mask the signal input in IO APIC if there is a	392	* Mask the signal input in IO APIC if there is a
376	* mapping for the respective IRQ number.	393	* mapping for the respective IRQ number.
377	*/	394	*/
378	pin = mp_irq_to_pin(i);	395	pin = mp_irq_to_pin(i);
379	if (pin != -1) {	396	if (pin != -1) {
380	reglo = io_apic_read(IOREDTBL + pin*2);	397	reglo = io_apic_read(IOREDTBL + pin*2);
381	reglo \|= (1<<16);	398	reglo \|= (1<<16);
382	io_apic_write(IOREDTBL + pin*2,reglo);	399	io_apic_write(IOREDTBL + pin*2,reglo);
383	}	400	}
384		401
385	}	402	}
386	}	403	}
387	}	404	}
388		405
389	void io_apic_enable_irqs(__u16 irqmask)	406	void io_apic_enable_irqs(__u16 irqmask)
390	{	407	{
391	int i,pin;	408	int i,pin;
392	__u32 reglo;	409	__u32 reglo;
393		410
394	for (i=0;i<16;i++) {	411	for (i=0;i<16;i++) {
395	if ((irqmask>>i) & 1) {	412	if ((irqmask>>i) & 1) {
396	/*	413	/*
397	* Unmask the signal input in IO APIC if there is a	414	* Unmask the signal input in IO APIC if there is a
398	* mapping for the respective IRQ number.	415	* mapping for the respective IRQ number.
399	*/	416	*/
400	pin = mp_irq_to_pin(i);	417	pin = mp_irq_to_pin(i);
401	if (pin != -1) {	418	if (pin != -1) {
402	reglo = io_apic_read(IOREDTBL + pin*2);	419	reglo = io_apic_read(IOREDTBL + pin*2);
403	reglo &= ~(1<<16);	420	reglo &= ~(1<<16);
404	io_apic_write(IOREDTBL + pin*2,reglo);	421	io_apic_write(IOREDTBL + pin*2,reglo);
405	}	422	}
406		423
407	}	424	}
408	}	425	}
409		426
410	}	427	}
411		428
412	#endif /* __SMP__ */	429	#endif /* __SMP__ */
413		430

Subversion Repositories HelenOS-historic

(root)/SPARTAN/trunk/arch/ia32/src/smp/apic.c @ 184 – Rev 15 → 16