Rev 1389 | Go to most recent revision | Details | Last modification | View Log | RSS feed
| Rev | Author | Line No. | Line |
|---|---|---|---|
| 1363 | mauro | 1 | |
| 2 | /* |
||
| 3 | * Project: S.Ha.R.K. |
||
| 4 | * |
||
| 5 | * Coordinators: Giorgio Buttazzo <giorgio@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://shark.sssup.it |
||
| 15 | */ |
||
| 16 | |||
| 17 | /* |
||
| 18 | * Copyright (C) 2000 Paolo Gai |
||
| 19 | * |
||
| 20 | * This program is free software; you can redistribute it and/or modify |
||
| 21 | * it under the terms of the GNU General Public License as published by |
||
| 22 | * the Free Software Foundation; either version 2 of the License, or |
||
| 23 | * (at your option) any later version. |
||
| 24 | * |
||
| 25 | * This program is distributed in the hope that it will be useful, |
||
| 26 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
||
| 27 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
||
| 28 | * GNU General Public License for more details. |
||
| 29 | * |
||
| 30 | * You should have received a copy of the GNU General Public License |
||
| 31 | * along with this program; if not, write to the Free Software |
||
| 32 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA |
||
| 33 | * |
||
| 34 | */ |
||
| 35 | |||
| 36 | #include <kernel/kern.h> |
||
| 37 | #include <kernel/func.h> |
||
| 38 | #include <stdlib.h> |
||
| 39 | #include <string.h> |
||
| 40 | |||
| 41 | #include <drivers/shark_linuxc26.h> |
||
| 42 | #include <drivers/shark_input26.h> |
||
| 43 | #include <drivers/shark_joy26.h> |
||
| 44 | |||
| 45 | //void my_sysclose(KEY_EVT *e) |
||
| 46 | void my_sysclose(void) |
||
| 47 | { |
||
| 48 | JOY26_close(); |
||
| 49 | INPUT26_close(); |
||
| 50 | |||
| 51 | kern_printf("S.Ha.R.K. closed.\n\n"); |
||
| 52 | sys_end(); |
||
| 53 | } |
||
| 54 | |||
| 55 | TASK my_getjoy(void *arg) { |
||
| 56 | |||
| 57 | int a0, a1, a2, a3, btn; |
||
| 58 | |||
| 59 | while (1) { |
||
| 60 | joy_getstatus(&a0, &a1, &a2, &a3, &btn); |
||
| 61 | printk ("(%6d %6d) %2x\n", a0, a1, btn); |
||
| 62 | task_endcycle(); |
||
| 63 | if (btn == 0xF) |
||
| 64 | my_sysclose(); |
||
| 65 | } |
||
| 66 | } |
||
| 67 | |||
| 68 | int main(int argc, char **argv) |
||
| 69 | { |
||
| 70 | SOFT_TASK_MODEL mp; |
||
| 71 | PID pid; |
||
| 72 | |||
| 73 | soft_task_default_model(mp); |
||
| 74 | soft_task_def_level(mp,2); |
||
| 75 | soft_task_def_ctrl_jet(mp); |
||
| 76 | soft_task_def_met(mp,700); |
||
| 77 | soft_task_def_period(mp,10000); |
||
| 78 | //soft_task_def_aperiodic(mp); |
||
| 79 | soft_task_def_usemath(mp); |
||
| 80 | pid = task_create("Joy_Print", my_getjoy, &mp, NULL); |
||
| 81 | if (pid == NIL) { |
||
| 82 | perror("Could not create task <Joy_Print>"); |
||
| 83 | sys_end(); |
||
| 84 | } else |
||
| 85 | task_activate(pid); |
||
| 86 | /*while ( (sys_gettime(NULL)/1000) < 20000); |
||
| 87 | my_sysclose();*/ |
||
| 88 | |||
| 89 | //while(1); |
||
| 90 | |||
| 91 | return 0; |
||
| 92 | } |