Subversion Repositories shark

/*

 * Project: S.Ha.R.K.

 *

 * Coordinators:

 *   Giorgio Buttazzo    <giorgio@sssup.it>

 *   Paolo Gai           <pj@gandalf.sssup.it>

 *

 * Authors     :

 *   ...         <......>

 *   (see the web pages for full authors list)

 *

 * ReTiS Lab (Scuola Superiore S.Anna - Pisa - Italy)

 *

 * http://www.sssup.it

 * http://retis.sssup.it

 * http://shark.sssup.it

 */

/*

 * Copyright (C) 2000,2002 Paolo Gai

 *

 * This program is free software; you can redistribute it and/or modify

 * it under the terms of the GNU General Public License as published by

 * the Free Software Foundation; either version 2 of the License, or

 * (at your option) any later version.

 *

 * This program is distributed in the hope that it will be useful,

 * but WITHOUT ANY WARRANTY; without even the implied warranty of

 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the

 * GNU General Public License for more details.

 *

 * You should have received a copy of the GNU General Public License

 * along with this program; if not, write to the Free Software

 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA

 *

 */

/* Interrupt Driver Module */

#include <kernel/int_sem.h>

#include <stdlib.h>

#include <kernel/func.h>

#include <ll/sys/ll/event.h>

#include <ll/i386/pic.h>

#include <tracer.h>

#include <intdrive/intdrive/inttask.h>

//#define DEBUG_SHARK_GLUE

PID intr_server = NIL;

void (*noint_handler)(int n);

#define MAX_INT_LIST 50

int int_list[MAX_INT_LIST];

int next_free_int = 0;

int next_execute_int = 0;

int n_intact = 0, n_lost = 0;

/* FIFO add job */

int add_interrupt_job(int no)

{

        int old_free_int = next_free_int;

#ifdef DEBUG_SHARK_GLUE

        kern_printf("(add_interrupt_job: %d)", no);

#endif

        if (no<16)

                irq_mask(no);

#ifdef DEBUG_SHARK_GLUE

        TRACER_LOGEVENT(FTrace_EVT_user_event_1, no, 0);

#endif

        int_list[next_free_int] = no;

        next_free_int++;

        if (next_free_int == MAX_INT_LIST) next_free_int = 0;

        if (next_free_int == next_execute_int) {

                next_free_int = old_free_int;

                n_lost++;

                //Raise an exception?!?

                return -1;

        }

        if (intr_server!=NIL)

                task_activate(intr_server);

        return 0;

}

/* FIFO get job */

int get_interrupt_job()

{

        int res = -1;

        if (next_free_int != next_execute_int) {

                res = int_list[next_execute_int];

                next_execute_int++;

                if (next_execute_int == MAX_INT_LIST) next_execute_int = 0;

        }

#ifdef DEBUG_SHARK_GLUE

        TRACER_LOGEVENT(FTrace_EVT_user_event_2, res, 0);

#endif

#ifdef DEBUG_SHARK_GLUE

        kern_printf("(get_interrupt_job: %d)", res);

#endif

        return res;

}

/* The Interrupt TASK is an aperiodic task designed for

        the INTDRIVE module. */

void interrupt_job()

{

        void (*tmp_fast)(int n);

        int no;

        n_intact++;

        no = get_interrupt_job();

#ifdef DEBUG_SHARK_GLUE

        kern_printf("(interrupt_job: no %d)",no);

#endif

        if (no != -1 && no < 16) {

                tmp_fast = handler_get_intdrive(no);

                /*extern void linux_intr(int irq);

                linux_intr(no);*/

                (tmp_fast)(no);

                irq_unmask(no);

        }

        if (no != -1 && no >= 16) {

                (noint_handler)(no);

        }

}

TASK Interrupt_Server(void *arg)

{

        while(1) {

                interrupt_job();

                task_endcycle();

        }

}

TASK Interrupt_Server_Prot(void *arg)

{

        while(1) {

                task_nopreempt();

                interrupt_job();

                task_preempt();

                task_endcycle();

        }

}

int intdrive_taskinit(int level, int wcet)

{

        INTERRUPT_TASK_MODEL ht;

        interrupt_task_default_model(ht);

        interrupt_task_def_wcet(ht, wcet);

        interrupt_task_def_system(ht);

        interrupt_task_def_nokill(ht);

        if (level > 0)

                intr_server = task_create("Interrupt Server (Protected)",Interrupt_Server_Prot,&ht,NULL);

        else

                intr_server = task_create("Interrupt Server",Interrupt_Server,&ht,NULL);

        if (intr_server == NIL)

                return -1;

        return 0;

}

void set_noint_handler(void * new_handler)

{

        noint_handler = new_handler;

}