Subversion Repositories HelenOS

Rev

Rev 3963 | Rev 4023 | Go to most recent revision | Only display areas with differences | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 3963 Rev 3982
1
/*
1
/*
2
 * Copyright (c) 2005 Jakub Jermar
2
 * Copyright (c) 2005 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
/** @addtogroup ia64
29
/** @addtogroup ia64
30
 * @{
30
 * @{
31
 */
31
 */
32
/** @file
32
/** @file
33
 */
33
 */
34
 
34
 
35
#include <arch.h>
35
#include <arch.h>
36
#include <arch/ski/ski.h>
36
#include <arch/ski/ski.h>
37
#include <arch/drivers/it.h>
37
#include <arch/drivers/it.h>
38
#include <arch/interrupt.h>
38
#include <arch/interrupt.h>
39
#include <arch/barrier.h>
39
#include <arch/barrier.h>
40
#include <arch/asm.h>
40
#include <arch/asm.h>
41
#include <arch/register.h>
41
#include <arch/register.h>
42
#include <arch/types.h>
42
#include <arch/types.h>
43
#include <arch/context.h>
43
#include <arch/context.h>
44
#include <arch/stack.h>
44
#include <arch/stack.h>
45
#include <arch/mm/page.h>
45
#include <arch/mm/page.h>
46
#include <mm/as.h>
46
#include <mm/as.h>
47
#include <config.h>
47
#include <config.h>
48
#include <userspace.h>
48
#include <userspace.h>
49
#include <console/console.h>
49
#include <console/console.h>
50
#include <proc/uarg.h>
50
#include <proc/uarg.h>
51
#include <syscall/syscall.h>
51
#include <syscall/syscall.h>
52
#include <ddi/irq.h>
52
#include <ddi/irq.h>
53
#include <ddi/device.h>
53
#include <ddi/device.h>
54
#include <arch/bootinfo.h>
54
#include <arch/bootinfo.h>
55
#include <genarch/drivers/legacy/ia32/io.h>
55
#include <genarch/drivers/legacy/ia32/io.h>
56
#include <genarch/drivers/ega/ega.h>
56
#include <genarch/drivers/ega/ega.h>
57
#include <genarch/kbd/i8042.h>
57
#include <genarch/kbd/i8042.h>
58
#include <genarch/kbd/ns16550.h>
58
#include <genarch/kbd/ns16550.h>
59
#include <smp/smp.h>
59
#include <smp/smp.h>
60
#include <smp/ipi.h>
60
#include <smp/ipi.h>
61
#include <arch/atomic.h>
61
#include <arch/atomic.h>
62
#include <panic.h>
62
#include <panic.h>
63
#include <print.h>
63
#include <print.h>
64
#include <sysinfo/sysinfo.h>
64
#include <sysinfo/sysinfo.h>
65
 
65
 
66
/* NS16550 as a COM 1 */
66
/* NS16550 as a COM 1 */
67
#define NS16550_IRQ (4 + LEGACY_INTERRUPT_BASE)
67
#define NS16550_IRQ (4 + LEGACY_INTERRUPT_BASE)
68
 
68
 
69
bootinfo_t *bootinfo;
69
bootinfo_t *bootinfo;
70
 
70
 
71
static uint64_t iosapic_base = 0xfec00000;
71
static uint64_t iosapic_base = 0xfec00000;
72
 
72
 
73
void arch_pre_main(void)
73
void arch_pre_main(void)
74
{
74
{
75
    /* Setup usermode init tasks. */
75
    /* Setup usermode init tasks. */
76
 
76
 
77
    unsigned int i;
77
    unsigned int i;
78
   
78
   
79
    init.cnt = bootinfo->taskmap.count;
79
    init.cnt = bootinfo->taskmap.count;
80
   
80
   
81
    for (i = 0; i < init.cnt; i++) {
81
    for (i = 0; i < init.cnt; i++) {
82
        init.tasks[i].addr =
82
        init.tasks[i].addr =
83
            ((unsigned long) bootinfo->taskmap.tasks[i].addr) |
83
            ((unsigned long) bootinfo->taskmap.tasks[i].addr) |
84
            VRN_MASK;
84
            VRN_MASK;
85
        init.tasks[i].size = bootinfo->taskmap.tasks[i].size;
85
        init.tasks[i].size = bootinfo->taskmap.tasks[i].size;
86
    }
86
    }
87
}
87
}
88
 
88
 
89
void arch_pre_mm_init(void)
89
void arch_pre_mm_init(void)
90
{
90
{
91
    /*
91
    /*
92
     * Set Interruption Vector Address (i.e. location of interruption vector
92
     * Set Interruption Vector Address (i.e. location of interruption vector
93
     * table).
93
     * table).
94
     */
94
     */
95
    iva_write((uintptr_t) &ivt);
95
    iva_write((uintptr_t) &ivt);
96
    srlz_d();
96
    srlz_d();
97
   
97
   
98
}
98
}
99
 
99
 
100
static void iosapic_init(void)
100
static void iosapic_init(void)
101
{
101
{
102
    uint64_t IOSAPIC = PA2KA((unative_t)(iosapic_base)) | FW_OFFSET;
102
    uint64_t IOSAPIC = PA2KA((unative_t)(iosapic_base)) | FW_OFFSET;
103
    int i;
103
    int i;
104
   
104
   
105
    int myid, myeid;
105
    int myid, myeid;
106
   
106
   
107
    myid = ia64_get_cpu_id();
107
    myid = ia64_get_cpu_id();
108
    myeid = ia64_get_cpu_eid();
108
    myeid = ia64_get_cpu_eid();
109
 
109
 
110
    for (i = 0; i < 16; i++) {
110
    for (i = 0; i < 16; i++) {
111
        if (i == 2)
111
        if (i == 2)
112
            continue;    /* Disable Cascade interrupt */
112
            continue;    /* Disable Cascade interrupt */
113
        ((uint32_t *)(IOSAPIC + 0x00))[0] = 0x10 + 2 * i;
113
        ((uint32_t *)(IOSAPIC + 0x00))[0] = 0x10 + 2 * i;
114
        srlz_d();
114
        srlz_d();
115
        ((uint32_t *)(IOSAPIC + 0x10))[0] = LEGACY_INTERRUPT_BASE + i;
115
        ((uint32_t *)(IOSAPIC + 0x10))[0] = LEGACY_INTERRUPT_BASE + i;
116
        srlz_d();
116
        srlz_d();
117
        ((uint32_t *)(IOSAPIC + 0x00))[0] = 0x10 + 2 * i + 1;
117
        ((uint32_t *)(IOSAPIC + 0x00))[0] = 0x10 + 2 * i + 1;
118
        srlz_d();
118
        srlz_d();
119
        ((uint32_t *)(IOSAPIC + 0x10))[0] = myid << (56 - 32) |
119
        ((uint32_t *)(IOSAPIC + 0x10))[0] = myid << (56 - 32) |
120
            myeid << (48 - 32);
120
            myeid << (48 - 32);
121
        srlz_d();
121
        srlz_d();
122
    }
122
    }
123
 
123
 
124
}
124
}
125
 
125
 
126
 
126
 
127
void arch_post_mm_init(void)
127
void arch_post_mm_init(void)
128
{
128
{
129
    if (config.cpu_active == 1) {
129
    if (config.cpu_active == 1) {
130
        iosapic_init();
130
        iosapic_init();
131
        irq_init(INR_COUNT, INR_COUNT);
131
        irq_init(INR_COUNT, INR_COUNT);
132
#ifdef SKI
132
#ifdef SKI
133
        ski_init_console();
133
        ski_init_console();
134
#else
134
#else
135
        ega_init(EGA_BASE, EGA_VIDEORAM);
135
        ega_init(EGA_BASE, EGA_VIDEORAM);
136
#endif
136
#endif
137
    }
137
    }
138
    it_init();
138
    it_init();
139
       
139
       
140
}
140
}
141
 
141
 
142
void arch_post_cpu_init(void)
142
void arch_post_cpu_init(void)
143
{
143
{
144
}
144
}
145
 
145
 
146
void arch_pre_smp_init(void)
146
void arch_pre_smp_init(void)
147
{
147
{
148
}
148
}
149
 
149
 
150
void arch_post_smp_init(void)
150
void arch_post_smp_init(void)
151
{
151
{
152
    /*
152
    /*
153
     * Create thread that polls keyboard.
153
     * Create thread that polls keyboard.
154
     */
154
     */
155
#ifdef SKI
155
#ifdef SKI
156
    thread_t *t = thread_create(kkbdpoll, NULL, TASK, 0, "kkbdpoll", true);
156
    thread_t *t = thread_create(kkbdpoll, NULL, TASK, 0, "kkbdpoll", true);
157
    if (!t)
157
    if (!t)
158
        panic("Cannot create kkbdpoll.");
158
        panic("Cannot create kkbdpoll.");
159
    thread_ready(t);
159
    thread_ready(t);
160
#endif      
160
#endif      
161
 
161
 
162
#ifdef I460GX
162
#ifdef I460GX
163
    devno_t kbd = device_assign_devno();
163
    devno_t devno = device_assign_devno();
-
 
164
    inr_t inr;
164
 
165
 
165
#ifdef CONFIG_NS16550
166
#ifdef CONFIG_NS16550
-
 
167
    inr = NS16550_IRQ;
166
    (void) ns16550_init((ns16550_t *)NS16550_BASE, kbd, NS16550_IRQ, NULL,
168
    (void) ns16550_init((ns16550_t *)NS16550_BASE, devno, inr, NULL, NULL);
167
         NULL);
169
    sysinfo_set_item_val("kbd.type", NULL, KBD_NS16550);
-
 
170
    sysinfo_set_item_val("kbd.port", NULL, (uintptr_t)NS16550_BASE);
168
#else
171
#else
-
 
172
    inr = IRQ_KBD;
169
    (void) i8042_init((i8042_t *)I8042_BASE, kbd, IRQ_KBD);
173
    (void) i8042_init((i8042_t *)I8042_BASE, devno, inr);
-
 
174
    sysinfo_set_item_val("kbd.type", NULL, KBD_LEGACY);
170
#endif
175
#endif
-
 
176
    sysinfo_set_item_val("kbd", NULL, true);
-
 
177
    sysinfo_set_item_val("kbd.devno", NULL, devno);
-
 
178
    sysinfo_set_item_val("kbd.inr", NULL, inr);
171
#endif
179
#endif
172
 
180
 
173
    sysinfo_set_item_val("ia64_iospace", NULL, true);
181
    sysinfo_set_item_val("ia64_iospace", NULL, true);
174
    sysinfo_set_item_val("ia64_iospace.address", NULL, true);
182
    sysinfo_set_item_val("ia64_iospace.address", NULL, true);
175
    sysinfo_set_item_val("ia64_iospace.address.virtual", NULL, IO_OFFSET);
183
    sysinfo_set_item_val("ia64_iospace.address.virtual", NULL, IO_OFFSET);
176
}
184
}
177
 
185
 
178
 
186
 
179
/** Enter userspace and never return. */
187
/** Enter userspace and never return. */
180
void userspace(uspace_arg_t *kernel_uarg)
188
void userspace(uspace_arg_t *kernel_uarg)
181
{
189
{
182
    psr_t psr;
190
    psr_t psr;
183
    rsc_t rsc;
191
    rsc_t rsc;
184
 
192
 
185
    psr.value = psr_read();
193
    psr.value = psr_read();
186
    psr.cpl = PL_USER;
194
    psr.cpl = PL_USER;
187
    psr.i = true;           /* start with interrupts enabled */
195
    psr.i = true;           /* start with interrupts enabled */
188
    psr.ic = true;
196
    psr.ic = true;
189
    psr.ri = 0;         /* start with instruction #0 */
197
    psr.ri = 0;         /* start with instruction #0 */
190
    psr.bn = 1;         /* start in bank 0 */
198
    psr.bn = 1;         /* start in bank 0 */
191
 
199
 
192
    asm volatile ("mov %0 = ar.rsc\n" : "=r" (rsc.value));
200
    asm volatile ("mov %0 = ar.rsc\n" : "=r" (rsc.value));
193
    rsc.loadrs = 0;
201
    rsc.loadrs = 0;
194
    rsc.be = false;
202
    rsc.be = false;
195
    rsc.pl = PL_USER;
203
    rsc.pl = PL_USER;
196
    rsc.mode = 3;           /* eager mode */
204
    rsc.mode = 3;           /* eager mode */
197
 
205
 
198
    switch_to_userspace((uintptr_t) kernel_uarg->uspace_entry,
206
    switch_to_userspace((uintptr_t) kernel_uarg->uspace_entry,
199
        ((uintptr_t) kernel_uarg->uspace_stack) + PAGE_SIZE -
207
        ((uintptr_t) kernel_uarg->uspace_stack) + PAGE_SIZE -
200
        ALIGN_UP(STACK_ITEM_SIZE, STACK_ALIGNMENT),
208
        ALIGN_UP(STACK_ITEM_SIZE, STACK_ALIGNMENT),
201
        ((uintptr_t) kernel_uarg->uspace_stack) + PAGE_SIZE,
209
        ((uintptr_t) kernel_uarg->uspace_stack) + PAGE_SIZE,
202
        (uintptr_t) kernel_uarg->uspace_uarg, psr.value, rsc.value);
210
        (uintptr_t) kernel_uarg->uspace_uarg, psr.value, rsc.value);
203
 
211
 
204
    while (1)
212
    while (1)
205
        ;
213
        ;
206
}
214
}
207
 
215
 
208
/** Set thread-local-storage pointer.
216
/** Set thread-local-storage pointer.
209
 *
217
 *
210
 * We use r13 (a.k.a. tp) for this purpose.
218
 * We use r13 (a.k.a. tp) for this purpose.
211
 */
219
 */
212
unative_t sys_tls_set(unative_t addr)
220
unative_t sys_tls_set(unative_t addr)
213
{
221
{
214
        return 0;
222
        return 0;
215
}
223
}
216
 
224
 
217
/** Acquire console back for kernel
225
/** Acquire console back for kernel
218
 *
226
 *
219
 */
227
 */
220
void arch_grab_console(void)
228
void arch_grab_console(void)
221
{
229
{
222
#ifdef SKI
230
#ifdef SKI
223
    ski_kbd_grab();
231
    ski_kbd_grab();
224
#endif
232
#endif
225
}
233
}
226
 
234
 
227
/** Return console to userspace
235
/** Return console to userspace
228
 *
236
 *
229
 */
237
 */
230
void arch_release_console(void)
238
void arch_release_console(void)
231
{
239
{
232
#ifdef SKI
240
#ifdef SKI
233
    ski_kbd_release();
241
    ski_kbd_release();
234
#endif
242
#endif
235
}
243
}
236
 
244
 
237
void arch_reboot(void)
245
void arch_reboot(void)
238
{
246
{
239
    pio_write_8((ioport8_t *)0x64, 0xfe);
247
    pio_write_8((ioport8_t *)0x64, 0xfe);
240
    while (1)
248
    while (1)
241
        ;
249
        ;
242
}
250
}
243
 
251
 
244
/** Construct function pointer
252
/** Construct function pointer
245
 *
253
 *
246
 * @param fptr   function pointer structure
254
 * @param fptr   function pointer structure
247
 * @param addr   function address
255
 * @param addr   function address
248
 * @param caller calling function address
256
 * @param caller calling function address
249
 *
257
 *
250
 * @return address of the function pointer
258
 * @return address of the function pointer
251
 *
259
 *
252
 */
260
 */
253
void *arch_construct_function(fncptr_t *fptr, void *addr, void *caller)
261
void *arch_construct_function(fncptr_t *fptr, void *addr, void *caller)
254
{
262
{
255
    fptr->fnc = (unative_t) addr;
263
    fptr->fnc = (unative_t) addr;
256
    fptr->gp = ((unative_t *) caller)[1];
264
    fptr->gp = ((unative_t *) caller)[1];
257
   
265
   
258
    return (void *) fptr;
266
    return (void *) fptr;
259
}
267
}
260
 
268
 
261
/** @}
269
/** @}
262
 */
270
 */
263
 
271