1 files changed, 54 insertions, 0 deletions
diff --git a/device/ds_routines.c b/device/ds_routines.c
index fc051e8f..78ff51fe 100644
--- a/device/ds_routines.c
+++ b/device/ds_routines.c
@@ -92,6 +92,7 @@
 #include <device/device_port.h>
 #include <device/device_reply.user.h>
 #include <device/device_emul.h>
+#include <device/intr.h>
 
 #include <machine/machspl.h>
 
@@ -319,6 +320,59 @@ ds_device_map (device_t dev, vm_prot_t prot, vm_offset_t offset,
 				offset, size, pager, unmap);
 }
 
+/* TODO: missing deregister support */
+io_return_t
+ds_device_intr_register (device_t dev, int id,
+                         int flags, ipc_port_t receive_port)
+{
+  kern_return_t err;
+  mach_device_t mdev = dev->emul_data;
+
+  /* Refuse if device is dead or not completely open.  */
+  if (dev == DEVICE_NULL)
+    return D_NO_SUCH_DEVICE;
+
+  /* No flag is defined for now */
+  if (flags != 0)
+    return D_INVALID_OPERATION;
+
+  /* Must be called on the irq device only */
+  if (! name_equal(mdev->dev_ops->d_name, 3, "irq"))
+    return D_INVALID_OPERATION;
+
+  user_intr_t *e = insert_intr_entry (&irqtab, id, receive_port);
+  if (!e)
+    return D_NO_MEMORY;
+
+  // TODO The original port should be replaced
+  // when the same device driver calls it again,
+  // in order to handle the case that the device driver crashes and restarts.
+  err = install_user_intr_handler (&irqtab, id, flags, e);
+  if (err == D_SUCCESS)
+    {
+      /* If the port is installed successfully, increase its reference by 1.
+       * Thus, the port won't be destroyed after its task is terminated. */
+      ip_reference (receive_port);
+    }
+  return err;
+}
+
+kern_return_t
+ds_device_intr_ack (device_t dev, ipc_port_t receive_port)
+{
+  mach_device_t mdev = dev->emul_data;
+
+  /* Refuse if device is dead or not completely open.  */
+  if (dev == DEVICE_NULL)
+    return D_NO_SUCH_DEVICE;
+
+  /* Must be called on the irq device only */
+  if (! name_equal(mdev->dev_ops->d_name, 3, "irq"))
+    return D_INVALID_OPERATION;
+
+  return irq_acknowledge(receive_port);
+}
+
 boolean_t
 ds_notify (mach_msg_header_t *msg)
 {