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     rt_printf("Sending\n");
  25
  26         unsigned int i;
  27         for(i = 0; i<SAMPLES; i++){
  28                 times[i] = rt_timer_read();
  29         outb(inb(0x378) & 0xEF, 0x378);
  30         outb(inb(0x378) | 0x01, 0x378);
  31         // Signal other machine
  32         rt_intr_wait(&intr, TM_INFINITE);
  33         times[i] = rt_timer_read()-times[i];
  34                 rt_task_wait_period(NULL);
  35         }
  36
  37         FILE *file;
  38         file = fopen("ex10d.csv", "w");
  39         for(i = 0; i<SAMPLES; i++){
  40                 fprintf(file, "%u,%llu\n", i, times[i]);
  41         }
  42         fclose(file);
  43     rt_printf("Done, you can press CRTL+C now\n");
  44 }
  45
  46 int main(int argc, char* argv[])
  47 {
  48         rt_print_auto_init(1);
  49         mlockall(MCL_CURRENT | MCL_FUTURE);
  50
  51     ioperm(0x37A, 1, 1);
  52     ioperm(0x378, 1, 1);
  53     outb(inb(0x37A) | 0x01, 0x37A);
  54     outb(inb(0x378) | 0x01, 0x378);
  55
  56         rt_task_create(&task, "task", 0, 50, 0);
  57         rt_task_start(&task, &lpt1_handler, 0);
  58
  59     pause();
  60     outb(inb(0x37A) & 0xEF, 0x37A);
  61 }