cdi/cdi-misc.c

   1 #include <stdbool.h>
   2 #include <stdint.h>
   3 #include <cdi.h>
   4 #include <cdi/misc.h>
   5
   6 extern volatile uint64_t elapsed_milliseconds;
   7
   8 static bool irq_occured[16];
   9 static void (*irq_handlers[16])(struct cdi_device *);
  10 static struct cdi_device *irq_devices[16];
  11
  12 void cdi_try_handle_irq(int irq)
  13 {
  14     irq_occured[irq] = true;
  15
  16     if (irq_handlers[irq]) {
  17         irq_handlers[irq](irq_devices[irq]);
  18     }
  19 }
  20
  21 void cdi_register_irq(uint8_t irq, void (*handler)(struct cdi_device *), struct cdi_device *device)
  22 {
  23     irq_handlers[irq] = handler;
  24     irq_devices[irq] = device;
  25 }
  26
  27 int cdi_wait_irq(uint8_t irq, uint32_t timeout)
  28 {
  29     uint64_t ems_start = elapsed_milliseconds;
  30
  31     while (!irq_occured[irq] && timeout > elapsed_milliseconds - ems_start) {
  32         __asm__ __volatile__ ("hlt");
  33     }
  34
  35     return irq_occured[irq] ? 0 : -1;
  36 }
  37
  38 int cdi_reset_wait_irq(uint8_t irq)
  39 {
  40     irq_occured[irq] = false;
  41     return 0;
  42 }
  43
  44 int cdi_ioports_alloc(uint16_t start, uint16_t count)
  45 {
  46     (void)start;
  47     (void)count;
  48
  49     return 0;
  50 }
  51
  52 int cdi_ioports_free(uint16_t start, uint16_t count)
  53 {
  54     (void)start;
  55     (void)count;
  56
  57     return 0;
  58 }
  59
  60 void cdi_sleep_ms(uint32_t ms)
  61 {
  62     uint64_t ems_start = elapsed_milliseconds;
  63
  64     while (ms > elapsed_milliseconds - ems_start) {
  65         __asm__ __volatile__ ("hlt");
  66     }
  67 }