Subversion Repositories shark

Rev

Rev 1550 | Go to most recent revision | Details | Compare with Previous | Last modification | View Log | RSS feed

Rev Author Line No. Line
1363 mauro 1
/*
2
 * Project: HARTIK (HA-rd R-eal TI-me K-ernel)
3
 *
4
 * Coordinators: Giorgio Buttazzo <giorgio@sssup.it>
5
 *               Gerardo Lamastra <gerardo@sssup.it>
6
 *
7
 * Authors     : Mauro Marinoni <mauro.marinoni@unipv.it>
8
 * (see authors.txt for full list of hartik's authors)
9
 *
10
 * ReTiS Lab (Scuola Superiore S.Anna - Pisa - Italy)
11
 *
12
 * http://www.sssup.it
13
 * http://retis.sssup.it
14
 * http://hartik.sssup.it
15
 */
16
 
17
/*
18
 * This program is free software; you can redistribute it and/or modify
19
 * it under the terms of the GNU General Public License as published by
20
 * the Free Software Foundation; either version 2 of the License, or
21
 * (at your option) any later version.
22
 *
23
 * This program is distributed in the hope that it will be useful,
24
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
25
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
26
 * GNU General Public License for more details.
27
 *
28
 * You should have received a copy of the GNU General Public License
29
 * along with this program; if not, write to the Free Software
30
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
31
 */
32
 
33
#include <kernel/kern.h>
34
 
1552 pj 35
#include "edf/edf/edf.h"
36
#include "cbs/cbs/cbs.h"
37
#include "rr/rr/rr.h"
38
#include "dummy/dummy/dummy.h"
39
#include "intdrive/intdrive/intdrive.h"
1363 mauro 40
 
1552 pj 41
#include "sem/sem/sem.h"
42
#include "hartport/hartport/hartport.h"
1363 mauro 43
 
44
#include <drivers/shark_linuxc26.h>
45
#include <drivers/shark_input26.h>
46
#include <drivers/shark_joy26.h>
47
 
48
/*+ sysyem tick in us +*/
49
#define TICK 0
50
 
51
/*+ RR tick in us +*/
52
#define RRTICK 10000
53
 
1389 mauro 54
/*+ Interrupt Server +*/
55
#define INTDRIVE_Q 1000
56
#define INTDRIVE_T 10000
57
#define INTDRIVE_FLAG 0
1363 mauro 58
 
1389 mauro 59
PID shutdown_task_PID = 1;
1363 mauro 60
 
61
TIME __kernel_register_levels__(void *arg)
62
{
63
        struct multiboot_info *mb = (struct multiboot_info *)arg;
64
 
1389 mauro 65
        INTDRIVE_register_level(INTDRIVE_Q, INTDRIVE_T, INTDRIVE_FLAG);
1363 mauro 66
        EDF_register_level(EDF_ENABLE_ALL);
67
        CBS_register_level(CBS_ENABLE_ALL, 1);
68
        RR_register_level(RRTICK, RR_MAIN_YES, mb);
69
        dummy_register_level();
70
 
71
        SEM_register_module();
72
 
73
        return TICK;
74
}
75
 
1389 mauro 76
int device_drivers_close() {
77
 
78
        JOY26_close();
79
        INPUT26_close();
80
 
81
        return 0;                                                                                                                        
82
}
83
 
84
int device_drivers_init() {
85
 
1363 mauro 86
        LINUXC26_register_module();
87
        INPUT26_init();
1389 mauro 88
 
1363 mauro 89
        JOY26_init();
90
 
1389 mauro 91
        return 0;
92
 
93
}
94
 
95
TASK shutdown_task_body(void *arg) {
96
 
97
        device_drivers_close();
98
        sys_shutdown_message("-- S.Ha.R.K. Closed --\n");
99
        return NULL;
100
}
101
 
102
void set_shutdown_task() {
103
 
104
        NRT_TASK_MODEL nrt;
105
 
106
        nrt_task_default_model(nrt);
107
        nrt_task_def_system(nrt);
108
 
109
        shutdown_task_PID = task_create("Shutdown Task", shutdown_task_body, &nrt, NULL);
110
        if (shutdown_task_PID == NIL) {
111
                sys_shutdown_message("Error: Cannot create shutdown task\n");
1550 pj 112
                exit(1);
1389 mauro 113
        }
114
 
115
}
116
 
1399 giacomo 117
#define SHUTDOWN_TIMEOUT_SEC 3
118
 
1389 mauro 119
void call_shutdown_task(void *arg) {
1399 giacomo 120
        struct timespec t;
121
 
122
        sys_gettime(&t);
123
        t.tv_sec += SHUTDOWN_TIMEOUT_SEC;
124
 
125
        /* Emergency timeout to exit from RUNLEVEL_SHUTDOWN */
126
        kern_event_post(&t,(void *)((void *)sys_abort_shutdown),(void *)0);
127
 
1389 mauro 128
        task_activate(shutdown_task_PID);
129
}
130
 
131
TASK __init__(void *arg)
132
{
133
        struct multiboot_info *mb = (struct multiboot_info *)arg;
134
 
135
        HARTPORT_init();
136
 
137
        set_shutdown_task();
138
 
139
        device_drivers_init();
140
 
141
        sys_atrunlevel(call_shutdown_task, NULL, RUNLEVEL_SHUTDOWN);
142
 
1363 mauro 143
        __call_main__(mb);
144
 
145
        return (void *)0;
146
}