Rev 1018 |
Rev 1023 |
Go to most recent revision |
Blame |
Compare with Previous |
Last modification |
View Log
| RSS feed
/*
* 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);
TRACER_LOGEVENT(FTrace_EVT_user_event_1, no, 0);
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;
}
TRACER_LOGEVENT(FTrace_EVT_user_event_2, res, 0);
#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)
{
HARD_TASK_MODEL ht;
hard_task_default_model(ht);
hard_task_def_wcet(ht, wcet);
hard_task_def_interrupt(ht);
hard_task_def_system(ht);
hard_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;
}