Subversion Repositories HelenOS

/*

 * Copyright (c) 2005 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.

 */

/** @addtogroup ia64

 * @{

 */

/** @file

 */

#include <arch.h>

#include <arch/ski/ski.h>

#include <arch/drivers/it.h>

#include <arch/interrupt.h>

#include <arch/barrier.h>

#include <arch/asm.h>

#include <arch/register.h>

#include <arch/types.h>

#include <arch/context.h>

#include <arch/stack.h>

#include <arch/mm/page.h>

#include <mm/as.h>

#include <config.h>

#include <userspace.h>

#include <console/console.h>

#include <proc/uarg.h>

#include <syscall/syscall.h>

#include <ddi/irq.h>

#include <ddi/device.h>

#include <arch/drivers/ega.h>

#include <arch/bootinfo.h>

#include <genarch/kbd/i8042.h>

#include <genarch/kbd/ns16550.h>

#include <smp/smp.h>

#include <smp/ipi.h>

#include <arch/atomic.h>

#include <panic.h>

#include <print.h>

#include <sysinfo/sysinfo.h>

/*NS16550 as a COM 1*/

#define NS16550_IRQ (4+LAGACY_INTERRUPT_BASE)

#define NS16550_PORT 0x3f8

bootinfo_t *bootinfo;

static uint64_t iosapic_base=0xfec00000;

void arch_pre_main(void)

{

    /* Setup usermode init tasks. */

//#ifdef I460GX

    unsigned int i;

    init.cnt = bootinfo->taskmap.count;

    for (i = 0; i < init.cnt; i++) {

        init.tasks[i].addr = ((unsigned long) bootinfo->taskmap.tasks[i].addr) | VRN_MASK;

        init.tasks[i].size = bootinfo->taskmap.tasks[i].size;

    }

/*

#else  

    init.cnt = 8;

    init.tasks[0].addr = INIT0_ADDRESS;

    init.tasks[0].size = INIT0_SIZE;

    init.tasks[1].addr = INIT0_ADDRESS + 0x400000;

    init.tasks[1].size = INIT0_SIZE;

    init.tasks[2].addr = INIT0_ADDRESS + 0x800000;

    init.tasks[2].size = INIT0_SIZE;

    init.tasks[3].addr = INIT0_ADDRESS + 0xc00000;

    init.tasks[3].size = INIT0_SIZE;

    init.tasks[4].addr = INIT0_ADDRESS + 0x1000000;

    init.tasks[4].size = INIT0_SIZE;

    init.tasks[5].addr = INIT0_ADDRESS + 0x1400000;

    init.tasks[5].size = INIT0_SIZE;

    init.tasks[6].addr = INIT0_ADDRESS + 0x1800000;

    init.tasks[6].size = INIT0_SIZE;

    init.tasks[7].addr = INIT0_ADDRESS + 0x1c00000;

    init.tasks[7].size = INIT0_SIZE;

#endif*/

}

void arch_pre_mm_init(void)

{

    /* Set Interruption Vector Address (i.e. location of interruption vector table). */

    iva_write((uintptr_t) &ivt);

    srlz_d();

}

static void iosapic_init(void)

{

    uint64_t IOSAPIC = PA2KA((unative_t)(iosapic_base))|FW_OFFSET;

    int i;

    for(i=0;i<16;i++)

    {

        if(i==2) continue;   //Disable Cascade interrupt

        ((uint32_t*)(IOSAPIC+0x00))[0]=0x10+2*i;

        srlz_d();

        ((uint32_t*)(IOSAPIC+0x10))[0]=LAGACY_INTERRUPT_BASE+i;

        srlz_d();

        ((uint32_t*)(IOSAPIC+0x00))[0]=0x10+2*i+1;

        srlz_d();

        ((uint32_t*)(IOSAPIC+0x10))[0]=1<<(56-32);

        srlz_d();

    }

}

void arch_post_mm_init(void)

{

    if(config.cpu_active==1)

    {

        iosapic_init();

        irq_init(INR_COUNT, INR_COUNT);

#ifdef SKI

        ski_init_console();

#else   

        ega_init();

#endif  

    }

    it_init();

}

void arch_post_cpu_init(void)

{

}

void arch_pre_smp_init(void)

{

}

#ifdef I460GX

#define POLL_INTERVAL       50000       /* 50 ms */

/** Kernel thread for polling keyboard. */

static void i8042_kkbdpoll(void *arg)

{

    while (1) {

        i8042_poll();

#ifdef CONFIG_NS16550

    #ifndef CONFIG_NS16550_INTERRUPT_DRIVEN

        ns16550_poll();

    #endif  

#endif

        thread_usleep(POLL_INTERVAL);

    }

}

#endif

static void end_of_irq_void(void *cir_arg __attribute__((unused)),inr_t inr __attribute__((unused)))

{

    return;

}

void arch_post_smp_init(void)

{

    {

        /*

         * Create thread that polls keyboard.

         */

#ifdef SKI

        thread_t *t;

        t = thread_create(kkbdpoll, NULL, TASK, 0, "kkbdpoll", true);

        if (!t)

            panic("cannot create kkbdpoll\n");

        thread_ready(t);

#endif      

#ifdef I460GX

        devno_t kbd = device_assign_devno();

        devno_t mouse = device_assign_devno();

        /* keyboard controller */

        i8042_init(kbd, IRQ_KBD, mouse, IRQ_MOUSE);

#ifdef CONFIG_NS16550

        ns16550_init(kbd, NS16550_IRQ, NS16550_PORT,end_of_irq_void,NULL); // as a COM 1

#else

#endif

        thread_t *t;

        t = thread_create(i8042_kkbdpoll, NULL, TASK, 0, "kkbdpoll", true);

        if (!t)

            panic("cannot create kkbdpoll\n");

        thread_ready(t);

#endif

    }

    sysinfo_set_item_val("ia64_iospace", NULL, true);

    sysinfo_set_item_val("ia64_iospace.address", NULL, true);

    sysinfo_set_item_val("ia64_iospace.address.virtual", NULL, IO_OFFSET);

}

/** Enter userspace and never return. */

void userspace(uspace_arg_t *kernel_uarg)

{

    psr_t psr;

    rsc_t rsc;

    psr.value = psr_read();

    psr.cpl = PL_USER;

    psr.i = true;               /* start with interrupts enabled */

    psr.ic = true;

    psr.ri = 0;             /* start with instruction #0 */

    psr.bn = 1;             /* start in bank 0 */

    asm volatile ("mov %0 = ar.rsc\n" : "=r" (rsc.value));

    rsc.loadrs = 0;

    rsc.be = false;

    rsc.pl = PL_USER;

    rsc.mode = 3;               /* eager mode */

    switch_to_userspace((uintptr_t) kernel_uarg->uspace_entry,

                ((uintptr_t) kernel_uarg->uspace_stack)+PAGE_SIZE-ALIGN_UP(STACK_ITEM_SIZE, STACK_ALIGNMENT),

                ((uintptr_t) kernel_uarg->uspace_stack)+PAGE_SIZE,

                (uintptr_t) kernel_uarg->uspace_uarg,

                psr.value, rsc.value);

    while (1) {

        ;

    }

}

/** Set thread-local-storage pointer.

 *

 * We use r13 (a.k.a. tp) for this purpose.

 */

unative_t sys_tls_set(unative_t addr)

{

        return 0;

}

/** Acquire console back for kernel

 *

 */

void arch_grab_console(void)

{

#ifdef SKI

    ski_kbd_grab();

#else

    i8042_grab();

    #ifdef CONFIG_NS16550

        ns16550_grab();

    #endif  

#endif  

}

/** Return console to userspace

 *

 */

void arch_release_console(void)

{

#ifdef SKI

    ski_kbd_release();

    i8042_release();

#else   

    #ifdef CONFIG_NS16550

        ns16550_release();

    #endif  

#endif

}

void arch_reboot(void)

{

    outb(0x64,0xfe);

    while (1);

}

/** @}

 */