mart/ex10/ex10dmaster.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 lpt1_handler(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(0x37A) & 0xEF, 0x37A);
  29         outb(inb(0x37A) | 0x01, 0x37A);
  30         // Signal other machine
  31         rt_intr_wait(&intr, TM_INFINITE);
  32         times[i] = rt_timer_read()-times[i];
  33                 rt_task_wait_period(NULL);
  34         }
  35
  36         FILE *file;
  37         file = fopen("ex10d.csv", "w");
  38         for(i = 0; i<SAMPLES; i++){
  39                 fprintf(file, "%u,%llu\n", i, times[i]);
  40         }
  41         fclose(file);
  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) | 0x01, 0x37A);
  51
  52         rt_task_create(&task, "task", 0, 50, 0);
  53         rt_task_start(&task, &lpt1_handler, 0);
  54
  55     sleep(5);
  56 }