From 4726bc33139016df50411ab850e2044f0f134bf5 Mon Sep 17 00:00:00 2001
From: Ricardo de Almeida Gonzaga <ricardo.gonzaga@intel.com>
Date: Tue, 20 Oct 2015 11:28:31 -0200
Subject: [PATCH] x86: Add Intel Quark X1000 GPIO Controller (non-legacy)
 interrupt support

Since Galileo pinmux is available, this patch adds interrupt support
for GPIO Controller (non-legacy).
---
 cpu/x86/drivers/quarkX1000/gpio.c | 86 ++++++++++++++++++++++++++++---
 cpu/x86/drivers/quarkX1000/gpio.h |  4 ++
 2 files changed, 82 insertions(+), 8 deletions(-)

diff --git a/cpu/x86/drivers/quarkX1000/gpio.c b/cpu/x86/drivers/quarkX1000/gpio.c
index aa9932681..45bcae711 100644
--- a/cpu/x86/drivers/quarkX1000/gpio.c
+++ b/cpu/x86/drivers/quarkX1000/gpio.c
@@ -30,6 +30,8 @@
 
 #include "gpio.h"
 #include "helpers.h"
+#include "interrupt.h"
+#include "pic.h"
 
 /* GPIO Controler Registers */
 #define SWPORTA_DR    0x00
@@ -47,8 +49,12 @@
 
 #define PINS 8
 
+#define GPIO_IRQ 10
+#define GPIO_INT PIC_INT(GPIO_IRQ)
+
 struct gpio_internal_data {
   pci_driver_t pci;
+  quarkX1000_gpio_callback callback;
 };
 
 static struct gpio_internal_data data;
@@ -79,6 +85,44 @@ set_bit(uint32_t base_addr, uint32_t offset, uint32_t bit, uint32_t value)
   write(base_addr, offset, reg);
 }
 
+static void
+gpio_isr(void)
+{
+  uint32_t int_status;
+
+  int_status = read(data.pci.mmio, INTSTATUS);
+
+  if (data.callback)
+    data.callback(int_status);
+
+  write(data.pci.mmio, PORTA_EOI, -1);
+}
+
+static void
+gpio_interrupt_config(uint8_t pin, int flags)
+{
+  /* set as input */
+  set_bit(data.pci.mmio, SWPORTA_DDR, pin, 0);
+
+  /* set interrupt enabled */
+  set_bit(data.pci.mmio, INTEN, pin, 1);
+
+  /* unmask interrupt */
+  set_bit(data.pci.mmio, INTMASK, pin, 0);
+
+  /* set active high/low */
+  set_bit(data.pci.mmio, INT_POLARITY, pin, !!(flags & QUARKX1000_GPIO_ACTIVE_HIGH));
+
+  /* set level/edge */
+  set_bit(data.pci.mmio, INTTYPE_LEVEL, pin, !!(flags & QUARKX1000_GPIO_EDGE));
+
+  /* set debounce */
+  set_bit(data.pci.mmio, DEBOUNCE, pin, !!(flags & QUARKX1000_GPIO_DEBOUNCE));
+
+  /* set clock synchronous */
+  set_bit(data.pci.mmio, LS_SYNC, 0, !!(flags & QUARKX1000_GPIO_CLOCK_SYNC));
+}
+
 int
 quarkX1000_gpio_config(uint8_t pin, int flags)
 {
@@ -87,15 +131,15 @@ quarkX1000_gpio_config(uint8_t pin, int flags)
     return -1;
   }
 
-  /* interrupts are not supported yet */
-  if (flags & QUARKX1000_GPIO_INT)
-    return -1;
+  if (flags & QUARKX1000_GPIO_INT) {
+    gpio_interrupt_config(pin, flags);
+  } else {
+    /* set direction */
+    set_bit(data.pci.mmio, SWPORTA_DDR, pin, !!(flags & QUARKX1000_GPIO_OUT));
 
-  /* set direction */
-  set_bit(data.pci.mmio, SWPORTA_DDR, pin, !!(flags & QUARKX1000_GPIO_OUT));
-
-  /* set interrupt disabled */
-  set_bit(data.pci.mmio, INTEN, pin, 0);
+    /* set interrupt disabled */
+    set_bit(data.pci.mmio, INTEN, pin, 0);
+  }
 
   return 0;
 }
@@ -146,6 +190,13 @@ quarkX1000_gpio_write_port(uint8_t value)
   return 0;
 }
 
+int
+quarkX1000_gpio_set_callback(quarkX1000_gpio_callback callback)
+{
+  data.callback = callback;
+  return 0;
+}
+
 void
 quarkX1000_gpio_clock_enable(void)
 {
@@ -158,6 +209,14 @@ quarkX1000_gpio_clock_disable(void)
   set_bit(data.pci.mmio, LS_SYNC, 0, 0);
 }
 
+static void
+gpio_handler(void)
+{
+  gpio_isr();
+
+  pic_eoi(GPIO_IRQ);
+}
+
 int
 quarkX1000_gpio_init(void)
 {
@@ -171,8 +230,17 @@ quarkX1000_gpio_init(void)
 
   pci_command_enable(pci_addr, PCI_CMD_1_MEM_SPACE_EN);
 
+  SET_INTERRUPT_HANDLER(GPIO_INT, 0, gpio_handler);
+
+  if (pci_irq_agent_set_pirq(IRQAGENT3, INTA, PIRQC) < 0)
+    return -1;
+
+  pci_pirq_set_irq(PIRQC, GPIO_IRQ, 1);
+
   pci_init(&data.pci, pci_addr, 0);
 
+  data.callback = 0;
+
   quarkX1000_gpio_clock_enable();
 
   /* clear registers */
@@ -180,5 +248,7 @@ quarkX1000_gpio_init(void)
   write(data.pci.mmio, INTMASK, 0);
   write(data.pci.mmio, PORTA_EOI, 0);
 
+  pic_unmask_irq(GPIO_IRQ);
+
   return 0;
 }
diff --git a/cpu/x86/drivers/quarkX1000/gpio.h b/cpu/x86/drivers/quarkX1000/gpio.h
index c63e6dc91..61ef11aab 100644
--- a/cpu/x86/drivers/quarkX1000/gpio.h
+++ b/cpu/x86/drivers/quarkX1000/gpio.h
@@ -54,6 +54,8 @@
 #define QUARKX1000_GPIO_POL_MASK        (1 << 6)
 #define QUARKX1000_GPIO_PUD_MASK        (3 << 7)
 
+typedef void (*quarkX1000_gpio_callback)(uint32_t);
+
 int quarkX1000_gpio_init(void);
 
 int quarkX1000_gpio_config(uint8_t pin, int flags);
@@ -64,6 +66,8 @@ int quarkX1000_gpio_config_port(int flags);
 int quarkX1000_gpio_read_port(uint8_t *value);
 int quarkX1000_gpio_write_port(uint8_t value);
 
+int quarkX1000_gpio_set_callback(quarkX1000_gpio_callback callback);
+
 void quarkX1000_gpio_clock_enable(void);
 void quarkX1000_gpio_clock_disable(void);