mart/xenomai/ex10/ex10d1.c

   1 #include <stdio.h>
   2 #include <signal.h>
   3 #include <unistd.h>
   4 #include <sys/mman.h>
   5 #include <sys/io.h>
   6
   7 #include <native/task.h>
   8 #include <native/timer.h>
   9 #include <native/intr.h>
  10
  11 #include <rtdk.h>
  12
  13 #define LPT1IRQ 7
  14 #define SAMPLES 10000
  15
  16 RT_TASK task;
  17 RTIME times[SAMPLES];
  18
  19 void taskf(void *arg)
  20 {
  21         RT_INTR intr;
  22         rt_intr_create(&intr, "lpt1 handler", LPT1IRQ, 0);
  23         rt_task_set_periodic(NULL, TM_NOW, 1e5);
  24
  25         unsigned int i;
  26         for(i = 0; i<SAMPLES; i++){
  27                 times[i] = rt_timer_read();
  28                 outb(inb(0x378) & 0xFE, 0x378);
  29                 outb(inb(0x378) | 0x01, 0x378);
  30                 rt_intr_wait(&intr, TM_INFINITE);
  31                 times[i] = rt_timer_read()-times[i];
  32                 rt_task_wait_period(NULL);
  33         }
  34
  35         FILE *file;
  36         file = fopen("ex10d.csv", "w");
  37         for(i = 0; i<SAMPLES; i++){
  38                 fprintf(file, "%u,%llu\n", i, times[i]);
  39         }
  40         fclose(file);
  41         rt_printf("Done, you can press CRTL+C now\n");
  42 }
  43
  44 int main(int argc, char* argv[])
  45 {
  46         rt_print_auto_init(1);
  47         mlockall(MCL_CURRENT | MCL_FUTURE);
  48
  49         ioperm(0x37A, 1, 1);
  50         outb(inb(0x37A) | 0x10, 0x37A);
  51         ioperm(0x378, 1, 1);
  52         outb(inb(0x378) | 0x01, 0x378);
  53
  54         rt_task_create(&task, "task", 0, 50, 0);
  55         rt_task_start(&task, &taskf, 0);
  56
  57         pause();
  58         outb(inb(0x37A) & 0xEF, 0x37A);
  59 }