From: Pavel Pisa <ppisa@pikron.com>

Signed-off-by: Pavel Pisa <ppisa@pikron.com>
---
 c/src/lib/libcpu/arm/mc9328mxl/irq/irq.c |   10 ++++++++++
 1 file changed, 10 insertions(+)

diff --git a/c/src/lib/libcpu/arm/mc9328mxl/irq/irq.c b/c/src/lib/libcpu/arm/mc9328mxl/irq/irq.c
index 7c58a89..d3bde4c 100644
--- a/c/src/lib/libcpu/arm/mc9328mxl/irq/irq.c
+++ b/c/src/lib/libcpu/arm/mc9328mxl/irq/irq.c
@@ -28,11 +28,21 @@ void bsp_interrupt_dispatch(void)
 
 rtems_status_code bsp_interrupt_vector_enable(rtems_vector_number vector)
 {
+  if (vector >= MC9328MXL_NUM_INTS)
+     return RTEMS_INVALID_ID;
+
+  MC9328MXL_AITC_INTENNUM = vector;
+
   return RTEMS_SUCCESSFUL;
 }
 
 rtems_status_code bsp_interrupt_vector_disable(rtems_vector_number vector)
 {
+  if (vector >= MC9328MXL_NUM_INTS)
+     return RTEMS_INVALID_ID;
+
+  MC9328MXL_AITC_INTDISNUM = vector;
+
   return RTEMS_SUCCESSFUL;
 }
 
-- 
1.7.10.4

