Subversion Repositories HelenOS

Rev

Rev 3675 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 3675 Rev 4377
Line 31... Line 31...
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/drivers/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>
Line 48... Line 48...
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>
-
 
54
#include <arch/drivers/ega.h>
-
 
55
#include <arch/bootinfo.h>
53
#include <arch/bootinfo.h>
-
 
54
#include <genarch/drivers/legacy/ia32/io.h>
-
 
55
#include <genarch/drivers/ega/ega.h>
56
#include <genarch/kbd/i8042.h>
56
#include <genarch/kbrd/kbrd.h>
57
#include <genarch/kbd/ns16550.h>
57
#include <genarch/srln/srln.h>
-
 
58
#include <genarch/drivers/i8042/i8042.h>
-
 
59
#include <genarch/drivers/ns16550/ns16550.h>
-
 
60
#include <arch/drivers/kbd.h>
58
#include <smp/smp.h>
61
#include <smp/smp.h>
59
#include <smp/ipi.h>
62
#include <smp/ipi.h>
60
#include <arch/atomic.h>
63
#include <arch/atomic.h>
61
#include <panic.h>
64
#include <panic.h>
62
#include <print.h>
65
#include <print.h>
63
#include <sysinfo/sysinfo.h>
66
#include <sysinfo/sysinfo.h>
-
 
67
#include <string.h>
64
 
68
 
65
/*NS16550 as a COM 1*/
69
/* NS16550 as a COM 1 */
66
#define NS16550_IRQ (4+LAGACY_INTERRUPT_BASE)
70
#define NS16550_IRQ  (4 + LEGACY_INTERRUPT_BASE)
67
#define NS16550_PORT 0x3f8
-
 
68
 
71
 
69
bootinfo_t *bootinfo;
72
bootinfo_t *bootinfo;
70
 
73
 
71
static uint64_t iosapic_base=0xfec00000;
74
static uint64_t iosapic_base = 0xfec00000;
72
 
75
 
-
 
76
/** Performs ia64-specific initialization before main_bsp() is called. */
73
void arch_pre_main(void)
77
void arch_pre_main(void)
74
{
78
{
75
    /* Setup usermode init tasks. */
79
    /* Setup usermode init tasks. */
76
 
80
 
77
//#ifdef I460GX
-
 
78
    unsigned int i;
81
    unsigned int i;
79
   
82
   
80
    init.cnt = bootinfo->taskmap.count;
83
    init.cnt = bootinfo->taskmap.count;
81
   
84
   
82
    for (i = 0; i < init.cnt; i++) {
85
    for (i = 0; i < init.cnt; i++) {
-
 
86
        init.tasks[i].addr =
83
        init.tasks[i].addr = ((unsigned long) bootinfo->taskmap.tasks[i].addr) | VRN_MASK;
87
            ((unsigned long) bootinfo->taskmap.tasks[i].addr) |
-
 
88
            VRN_MASK;
84
        init.tasks[i].size = bootinfo->taskmap.tasks[i].size;
89
        init.tasks[i].size = bootinfo->taskmap.tasks[i].size;
-
 
90
        str_cpy(init.tasks[i].name, CONFIG_TASK_NAME_BUFLEN,
-
 
91
            bootinfo->taskmap.tasks[i].name);
85
    }
92
    }
86
/*
-
 
87
#else  
-
 
88
    init.cnt = 8;
-
 
89
    init.tasks[0].addr = INIT0_ADDRESS;
-
 
90
    init.tasks[0].size = INIT0_SIZE;
-
 
91
    init.tasks[1].addr = INIT0_ADDRESS + 0x400000;
-
 
92
    init.tasks[1].size = INIT0_SIZE;
-
 
93
    init.tasks[2].addr = INIT0_ADDRESS + 0x800000;
-
 
94
    init.tasks[2].size = INIT0_SIZE;
-
 
95
    init.tasks[3].addr = INIT0_ADDRESS + 0xc00000;
-
 
96
    init.tasks[3].size = INIT0_SIZE;
-
 
97
    init.tasks[4].addr = INIT0_ADDRESS + 0x1000000;
-
 
98
    init.tasks[4].size = INIT0_SIZE;
-
 
99
    init.tasks[5].addr = INIT0_ADDRESS + 0x1400000;
-
 
100
    init.tasks[5].size = INIT0_SIZE;
-
 
101
    init.tasks[6].addr = INIT0_ADDRESS + 0x1800000;
-
 
102
    init.tasks[6].size = INIT0_SIZE;
-
 
103
    init.tasks[7].addr = INIT0_ADDRESS + 0x1c00000;
-
 
104
    init.tasks[7].size = INIT0_SIZE;
-
 
105
#endif*/
-
 
106
}
93
}
107
 
94
 
108
void arch_pre_mm_init(void)
95
void arch_pre_mm_init(void)
109
{
96
{
-
 
97
    /*
110
    /* Set Interruption Vector Address (i.e. location of interruption vector table). */
98
     * Set Interruption Vector Address (i.e. location of interruption vector
-
 
99
     * table).
-
 
100
     */
111
    iva_write((uintptr_t) &ivt);
101
    iva_write((uintptr_t) &ivt);
112
    srlz_d();
102
    srlz_d();
113
   
103
   
114
}
104
}
115
 
105
 
116
static void iosapic_init(void)
106
static void iosapic_init(void)
117
{
107
{
118
 
-
 
119
    uint64_t IOSAPIC = PA2KA((unative_t)(iosapic_base))|FW_OFFSET;
108
    uint64_t IOSAPIC = PA2KA((unative_t)(iosapic_base)) | FW_OFFSET;
120
    int i;
109
    int i;
121
   
110
   
122
    int myid,myeid;
111
    int myid, myeid;
123
   
112
   
124
    myid=ia64_get_cpu_id();
113
    myid = ia64_get_cpu_id();
125
    myeid=ia64_get_cpu_eid();
114
    myeid = ia64_get_cpu_eid();
126
 
115
 
127
    for(i=0;i<16;i++)
116
    for (i = 0; i < 16; i++) {
128
    {
117
        if (i == 2)
129
   
-
 
130
        if(i==2) continue;   //Disable Cascade interrupt
118
            continue;    /* Disable Cascade interrupt */
131
        ((uint32_t*)(IOSAPIC+0x00))[0]=0x10+2*i;
119
        ((uint32_t *)(IOSAPIC + 0x00))[0] = 0x10 + 2 * i;
132
        srlz_d();
120
        srlz_d();
133
        ((uint32_t*)(IOSAPIC+0x10))[0]=LAGACY_INTERRUPT_BASE+i;
121
        ((uint32_t *)(IOSAPIC + 0x10))[0] = LEGACY_INTERRUPT_BASE + i;
134
        srlz_d();
122
        srlz_d();
135
        ((uint32_t*)(IOSAPIC+0x00))[0]=0x10+2*i+1;
123
        ((uint32_t *)(IOSAPIC + 0x00))[0] = 0x10 + 2 * i + 1;
136
        srlz_d();
124
        srlz_d();
137
        ((uint32_t*)(IOSAPIC+0x10))[0]=myid<<(56-32) | myeid<<(48-32);
125
        ((uint32_t *)(IOSAPIC + 0x10))[0] = myid << (56 - 32) |
-
 
126
            myeid << (48 - 32);
138
        srlz_d();
127
        srlz_d();
139
    }
128
    }
140
 
129
 
141
}
130
}
142
 
131
 
143
 
-
 
144
void arch_post_mm_init(void)
132
void arch_post_mm_init(void)
145
{
133
{
146
    if(config.cpu_active==1)
134
    if (config.cpu_active == 1) {
147
    {
-
 
148
        iosapic_init();
135
        iosapic_init();
149
   
-
 
150
        irq_init(INR_COUNT, INR_COUNT);
136
        irq_init(INR_COUNT, INR_COUNT);
151
#ifdef SKI
-
 
152
        ski_init_console();
-
 
153
#else   
-
 
154
        ega_init();
-
 
155
#endif  
-
 
156
    }
137
    }
157
    it_init();
138
    it_init(); 
158
       
-
 
159
}
139
}
160
 
140
 
161
void arch_post_cpu_init(void)
141
void arch_post_cpu_init(void)
162
{
142
{
163
}
143
}
164
 
144
 
165
void arch_pre_smp_init(void)
145
void arch_pre_smp_init(void)
166
{
146
{
167
}
147
}
168
 
148
 
169
 
-
 
170
#ifdef I460GX
-
 
171
#define POLL_INTERVAL       50000       /* 50 ms */
-
 
172
/** Kernel thread for polling keyboard. */
-
 
173
static void i8042_kkbdpoll(void *arg)
149
void arch_post_smp_init(void)
174
{
150
{
175
    while (1) {
-
 
176
#ifdef CONFIG_NS16550
151
#ifdef MACHINE_ski
177
    #ifndef CONFIG_NS16550_INTERRUPT_DRIVEN
152
    ski_instance_t *ski_instance = skiin_init();
178
        ns16550_poll();
153
    if (ski_instance) {
179
    #endif  
-
 
180
#else
-
 
181
    #ifndef CONFIG_I8042_INTERRUPT_DRIVEN
154
        srln_instance_t *srln_instance = srln_init();
182
        i8042_poll();
155
        if (srln_instance) {
183
    #endif  
156
            indev_t *sink = stdin_wire();
184
#endif
157
            indev_t *srln = srln_wire(srln_instance, sink);
185
        thread_usleep(POLL_INTERVAL);
158
            skiin_wire(ski_instance, srln);
-
 
159
        }
186
    }
160
    }
187
}
161
   
-
 
162
    skiout_init();
188
#endif
163
#endif
189
 
-
 
190
 
-
 
191
void end_of_irq_void(void *cir_arg __attribute__((unused)),inr_t inr __attribute__((unused)));
-
 
192
void end_of_irq_void(void *cir_arg __attribute__((unused)),inr_t inr __attribute__((unused)))
-
 
193
{
-
 
194
    return;
-
 
195
}
-
 
196
 
-
 
197
 
-
 
198
void arch_post_smp_init(void)
-
 
199
{
-
 
200
 
-
 
201
    {
164
   
202
        /*
-
 
203
         * Create thread that polls keyboard.
-
 
204
         */
-
 
205
#ifdef SKI
-
 
206
        thread_t *t;
-
 
207
        t = thread_create(kkbdpoll, NULL, TASK, 0, "kkbdpoll", true);
-
 
208
        if (!t)
-
 
209
            panic("cannot create kkbdpoll\n");
-
 
210
        thread_ready(t);
-
 
211
#endif      
-
 
212
 
-
 
213
#ifdef I460GX
-
 
214
        devno_t kbd = device_assign_devno();
-
 
215
        /* keyboard controller */
-
 
216
 
-
 
217
#ifdef CONFIG_NS16550
165
#ifdef CONFIG_EGA
218
        ns16550_init(kbd, NS16550_PORT, NS16550_IRQ,end_of_irq_void,NULL); // as a COM 1
-
 
219
#else
-
 
220
        devno_t mouse = device_assign_devno();
-
 
221
        i8042_init(kbd, IRQ_KBD, mouse, IRQ_MOUSE);
166
    ega_init(EGA_BASE, EGA_VIDEORAM);
222
#endif
167
#endif
-
 
168
   
223
        thread_t *t;
169
#ifdef CONFIG_NS16550
-
 
170
    ns16550_instance_t *ns16550_instance
224
        t = thread_create(i8042_kkbdpoll, NULL, TASK, 0, "kkbdpoll", true);
171
        = ns16550_init((ns16550_t *) NS16550_BASE, NS16550_IRQ, NULL, NULL);
225
        if (!t)
172
    if (ns16550_instance) {
226
            panic("cannot create kkbdpoll\n");
173
        srln_instance_t *srln_instance = srln_init();
227
        thread_ready(t);
174
        if (srln_instance) {
-
 
175
            indev_t *sink = stdin_wire();
-
 
176
            indev_t *srln = srln_wire(srln_instance, sink);
-
 
177
            ns16550_wire(ns16550_instance, srln);
-
 
178
        }
-
 
179
    }
228
 
180
   
-
 
181
    sysinfo_set_item_val("kbd", NULL, true);
-
 
182
    sysinfo_set_item_val("kbd.inr", NULL, NS16550_IRQ);
-
 
183
    sysinfo_set_item_val("kbd.type", NULL, KBD_NS16550);
-
 
184
    sysinfo_set_item_val("kbd.address.physical", NULL,
-
 
185
        (uintptr_t) NS16550_BASE);
-
 
186
    sysinfo_set_item_val("kbd.address.kernel", NULL,
-
 
187
        (uintptr_t) NS16550_BASE);
229
#endif
188
#endif
230
 
189
   
-
 
190
#ifdef CONFIG_I8042
-
 
191
    i8042_instance_t *i8042_instance = i8042_init((i8042_t *) I8042_BASE, IRQ_KBD);
-
 
192
    if (i8042_instance) {
-
 
193
        kbrd_instance_t *kbrd_instance = kbrd_init();
-
 
194
        if (kbrd_instance) {
-
 
195
            indev_t *sink = stdin_wire();
-
 
196
            indev_t *kbrd = kbrd_wire(kbrd_instance, sink);
-
 
197
            i8042_wire(i8042_instance, kbrd);
-
 
198
        }
231
    }
199
    }
232
   
200
   
-
 
201
    sysinfo_set_item_val("kbd", NULL, true);
-
 
202
    sysinfo_set_item_val("kbd.inr", NULL, IRQ_KBD);
-
 
203
    sysinfo_set_item_val("kbd.type", NULL, KBD_LEGACY);
-
 
204
    sysinfo_set_item_val("kbd.address.physical", NULL,
-
 
205
        (uintptr_t) I8042_BASE);
-
 
206
    sysinfo_set_item_val("kbd.address.kernel", NULL,
-
 
207
        (uintptr_t) I8042_BASE);
-
 
208
#endif
-
 
209
   
233
    sysinfo_set_item_val("ia64_iospace", NULL, true);
210
    sysinfo_set_item_val("ia64_iospace", NULL, true);
234
    sysinfo_set_item_val("ia64_iospace.address", NULL, true);
211
    sysinfo_set_item_val("ia64_iospace.address", NULL, true);
235
    sysinfo_set_item_val("ia64_iospace.address.virtual", NULL, IO_OFFSET);
212
    sysinfo_set_item_val("ia64_iospace.address.virtual", NULL, IO_OFFSET);
236
 
-
 
237
 
-
 
238
 
-
 
239
 
-
 
240
 
-
 
241
}
213
}
242
 
214
 
243
 
215
 
244
/** Enter userspace and never return. */
216
/** Enter userspace and never return. */
245
void userspace(uspace_arg_t *kernel_uarg)
217
void userspace(uspace_arg_t *kernel_uarg)
Line 247... Line 219...
247
    psr_t psr;
219
    psr_t psr;
248
    rsc_t rsc;
220
    rsc_t rsc;
249
 
221
 
250
    psr.value = psr_read();
222
    psr.value = psr_read();
251
    psr.cpl = PL_USER;
223
    psr.cpl = PL_USER;
252
    psr.i = true;               /* start with interrupts enabled */
224
    psr.i = true;           /* start with interrupts enabled */
253
    psr.ic = true;
225
    psr.ic = true;
254
    psr.ri = 0;             /* start with instruction #0 */
226
    psr.ri = 0;         /* start with instruction #0 */
255
    psr.bn = 1;             /* start in bank 0 */
227
    psr.bn = 1;         /* start in bank 0 */
256
 
228
 
257
    asm volatile ("mov %0 = ar.rsc\n" : "=r" (rsc.value));
229
    asm volatile ("mov %0 = ar.rsc\n" : "=r" (rsc.value));
258
    rsc.loadrs = 0;
230
    rsc.loadrs = 0;
259
    rsc.be = false;
231
    rsc.be = false;
260
    rsc.pl = PL_USER;
232
    rsc.pl = PL_USER;
261
    rsc.mode = 3;               /* eager mode */
233
    rsc.mode = 3;           /* eager mode */
262
 
234
 
263
    switch_to_userspace((uintptr_t) kernel_uarg->uspace_entry,
235
    switch_to_userspace((uintptr_t) kernel_uarg->uspace_entry,
264
                ((uintptr_t) kernel_uarg->uspace_stack)+PAGE_SIZE-ALIGN_UP(STACK_ITEM_SIZE, STACK_ALIGNMENT),
236
        ((uintptr_t) kernel_uarg->uspace_stack) + PAGE_SIZE -
265
                ((uintptr_t) kernel_uarg->uspace_stack)+PAGE_SIZE,
237
        ALIGN_UP(STACK_ITEM_SIZE, STACK_ALIGNMENT),
266
                (uintptr_t) kernel_uarg->uspace_uarg,
238
        ((uintptr_t) kernel_uarg->uspace_stack) + PAGE_SIZE,
267
                psr.value, rsc.value);
239
        (uintptr_t) kernel_uarg->uspace_uarg, psr.value, rsc.value);
268
 
240
 
269
    while (1) {
241
    while (1)
270
        ;
242
        ;
271
    }
-
 
272
}
243
}
273
 
244
 
274
/** Set thread-local-storage pointer.
245
/** Set thread-local-storage pointer.
275
 *
246
 *
276
 * We use r13 (a.k.a. tp) for this purpose.
247
 * We use r13 (a.k.a. tp) for this purpose.
Line 283... Line 254...
283
/** Acquire console back for kernel
254
/** Acquire console back for kernel
284
 *
255
 *
285
 */
256
 */
286
void arch_grab_console(void)
257
void arch_grab_console(void)
287
{
258
{
288
#ifdef SKI
259
#ifdef MACHINE_ski
289
    ski_kbd_grab();
260
    ski_kbd_grab();
290
#else
-
 
291
    #ifdef CONFIG_NS16550
-
 
292
        ns16550_grab();
-
 
293
    #else
-
 
294
        i8042_grab();
-
 
295
    #endif  
-
 
296
#endif  
261
#endif
297
}
262
}
-
 
263
 
298
/** Return console to userspace
264
/** Return console to userspace
299
 *
265
 *
300
 */
266
 */
301
void arch_release_console(void)
267
void arch_release_console(void)
302
{
268
{
303
#ifdef SKI
269
#ifdef MACHINE_ski
304
    ski_kbd_release();
270
    ski_kbd_release();
305
#else   
-
 
306
    #ifdef CONFIG_NS16550
-
 
307
        ns16550_release();
-
 
308
    #else   
-
 
309
        i8042_release();
-
 
310
    #endif  
-
 
311
 
-
 
312
#endif
271
#endif
313
}
272
}
314
 
273
 
315
void arch_reboot(void)
274
void arch_reboot(void)
316
{
275
{
317
    outb(0x64,0xfe);
276
    pio_write_8((ioport8_t *)0x64, 0xfe);
318
    while (1);
277
    while (1)
-
 
278
        ;
-
 
279
}
-
 
280
 
-
 
281
/** Construct function pointer
-
 
282
 *
-
 
283
 * @param fptr   function pointer structure
-
 
284
 * @param addr   function address
-
 
285
 * @param caller calling function address
-
 
286
 *
-
 
287
 * @return address of the function pointer
-
 
288
 *
-
 
289
 */
-
 
290
void *arch_construct_function(fncptr_t *fptr, void *addr, void *caller)
-
 
291
{
-
 
292
    fptr->fnc = (unative_t) addr;
-
 
293
    fptr->gp = ((unative_t *) caller)[1];
-
 
294
   
-
 
295
    return (void *) fptr;
319
}
296
}
320
 
297
 
321
/** @}
298
/** @}
322
 */
299
 */