20,6 → 20,14 |
#include "modules/sem.h" |
#include "modules/hartport.h" |
|
#include <drivers/shark_linuxc26.h> |
#include <drivers/shark_pci26.h> |
#include <drivers/shark_input26.h> |
#include <drivers/shark_keyb26.h> |
#include <drivers/shark_fb26.h> |
|
#define FRAME_BUFFER_DEVICE 0 |
|
/*+ sysyem tick in us +*/ |
#define TICK 0 |
|
31,6 → 39,14 |
#define INTDRIVE_T 10000 |
#define INTDRIVE_FLAG 0 |
|
void call_shutdown_task(void *arg); |
int device_drivers_init(); |
int device_drivers_close(); |
void set_shutdown_task(); |
TASK shutdown_task_body(void *arg); |
|
PID shutdown_task_PID = -1; |
|
TIME __kernel_register_levels__(void *arg) |
{ |
struct multiboot_info *mb = (struct multiboot_info *)arg; |
52,7 → 68,100 |
|
HARTPORT_init(); |
|
set_shutdown_task(); |
|
device_drivers_init(); |
|
sys_atrunlevel(call_shutdown_task, NULL, RUNLEVEL_SHUTDOWN); |
|
__call_main__(mb); |
|
return (void *)0; |
} |
|
void set_shutdown_task() { |
|
NRT_TASK_MODEL nrt; |
|
nrt_task_default_model(nrt); |
nrt_task_def_system(nrt); |
|
shutdown_task_PID = task_create("Shutdown Task",shutdown_task_body,&nrt,NULL); |
if (shutdown_task_PID == NIL) { |
sys_shutdown_message("Error: Cannot create shutdown task\n"); |
sys_end(); |
} |
|
} |
|
int device_drivers_init() { |
|
int res; |
KEYB_PARMS kparms = BASE_KEYB; |
|
LINUXC26_register_module(); |
|
PCI26_init(); |
|
INPUT26_init(); |
|
keyb_def_ctrlC(kparms, NULL); |
|
KEYB26_init(&kparms); |
|
FB26_init(); |
|
res = FB26_open(FRAME_BUFFER_DEVICE); |
if (res) { |
cprintf("Error: Cannot open graphical mode\n"); |
KEYB26_close(); |
INPUT26_close(); |
sys_end(); |
} |
|
FB26_use_grx(FRAME_BUFFER_DEVICE); |
|
FB26_setmode(FRAME_BUFFER_DEVICE,"640x480-16"); |
|
return 0; |
|
} |
|
int device_drivers_close() { |
|
FB26_close(FRAME_BUFFER_DEVICE); |
|
KEYB26_close(); |
|
INPUT26_close(); |
|
return 0; |
|
} |
|
#define SHUTDOWN_TIMEOUT_SEC 3 |
|
void call_shutdown_task(void *arg) |
{ |
struct timespec t; |
|
sys_gettime(&t); |
t.tv_sec += SHUTDOWN_TIMEOUT_SEC; |
|
/* Emergency timeout to exit from RUNLEVEL_SHUTDOWN */ |
kern_event_post(&t,(void *)((void *)sys_abort_shutdown),(void *)0); |
|
task_activate(shutdown_task_PID); |
} |
|
TASK shutdown_task_body(void *arg) { |
|
device_drivers_close(); |
|
sys_shutdown_message("-- S.Ha.R.K. Closed --\n"); |
|
sys_abort_shutdown(0); |
|
return NULL; |
|
} |