mart/ex10/ex10dslave.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
  15 RT_TASK task;
  16
  17 void taskf(void *arg)
  18 {
  19         RT_INTR intr;
  20         rt_printf("success creation: %d\n", rt_intr_create(&intr, "lpt1 handler", LPT1IRQ, I_PROPAGATE));
  21
  22         while(1){
  23                 rt_printf("Waiting for interrupt\n");
  24                 rt_intr_wait(&intr, TM_INFINITE);
  25                 rt_printf("Setting bit to 0\n");
  26                 outb(inb(0x378) & 0xEF, 0x378);
  27                 rt_printf("Setting bit to 1\n");
  28                 outb(inb(0x378) | 0x01, 0x378);
  29         }
  30 }
  31
  32 int main(int argc, char* argv[])
  33 {
  34         rt_print_auto_init(1);
  35         mlockall(MCL_CURRENT | MCL_FUTURE);
  36
  37         ioperm(0x37A, 1, 1);
  38         ioperm(0x378, 1, 1);
  39         outb(inb(0x37A) | 0x01, 0x37A);
  40 //      outb(inb(0x378) | 0x01, 0x378);
  41
  42         rt_task_create(&task, "task", 0, 50, 0);
  43         rt_task_start(&task, &taskf, 0);
  44
  45         rt_printf("CRTL+C to quit\n");
  46         pause();
  47 }