1 files changed, 111 insertions, 0 deletions

diff --git a/arch/arm/mach-tegra/wakeups-t2.c b/arch/arm/mach-tegra/wakeups-t2.c
new file mode 100644
index 00000000000..7c5d12ac60d
--- /dev/null
+++ b/arch/arm/mach-tegra/wakeups-t2.c
@@ -0,0 +1,111 @@
+/*
+ * Copyright (c) 2011, Google, Inc.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful, but WITHOUT
+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
+ * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
+ * more details.
+ */
+
+#include <linux/kernel.h>
+#include <linux/gpio.h>
+#include <linux/init.h>
+#include <linux/io.h>
+
+#include <mach/iomap.h>
+#include <mach/irqs.h>
+#include <mach/gpio.h>
+
+#include "gpio-names.h"
+
+static int tegra_wake_event_irq[] = {
+        [0]  = TEGRA_GPIO_TO_IRQ(TEGRA_GPIO_PO5),
+        [1]  = TEGRA_GPIO_TO_IRQ(TEGRA_GPIO_PV3),
+        [2]  = TEGRA_GPIO_TO_IRQ(TEGRA_GPIO_PL1),
+        [3]  = TEGRA_GPIO_TO_IRQ(TEGRA_GPIO_PB6),
+        [4]  = TEGRA_GPIO_TO_IRQ(TEGRA_GPIO_PN7),
+        [5]  = TEGRA_GPIO_TO_IRQ(TEGRA_GPIO_PA0),
+        [6]  = TEGRA_GPIO_TO_IRQ(TEGRA_GPIO_PU5),
+        [7]  = TEGRA_GPIO_TO_IRQ(TEGRA_GPIO_PU6),
+        [8]  = TEGRA_GPIO_TO_IRQ(TEGRA_GPIO_PC7),
+        [9]  = TEGRA_GPIO_TO_IRQ(TEGRA_GPIO_PS2),
+        [10] = TEGRA_GPIO_TO_IRQ(TEGRA_GPIO_PAA1),
+        [11] = TEGRA_GPIO_TO_IRQ(TEGRA_GPIO_PW3),
+        [12] = TEGRA_GPIO_TO_IRQ(TEGRA_GPIO_PW2),
+        [13] = TEGRA_GPIO_TO_IRQ(TEGRA_GPIO_PY6),
+        [14] = TEGRA_GPIO_TO_IRQ(TEGRA_GPIO_PV6),
+        [15] = TEGRA_GPIO_TO_IRQ(TEGRA_GPIO_PJ7),
+        [16] = INT_RTC,
+        [17] = INT_KBC,
+        [18] = INT_EXTERNAL_PMU,
+        [19] = -EINVAL, /* TEGRA_USB1_VBUS, */
+        [20] = -EINVAL, /* TEGRA_USB3_VBUS, */
+        [21] = -EINVAL, /* TEGRA_USB1_ID, */
+        [22] = -EINVAL, /* TEGRA_USB3_ID, */
+        [23] = TEGRA_GPIO_TO_IRQ(TEGRA_GPIO_PI5),
+        [24] = TEGRA_GPIO_TO_IRQ(TEGRA_GPIO_PV2),
+        [25] = TEGRA_GPIO_TO_IRQ(TEGRA_GPIO_PS4),
+        [26] = TEGRA_GPIO_TO_IRQ(TEGRA_GPIO_PS5),
+        [27] = TEGRA_GPIO_TO_IRQ(TEGRA_GPIO_PS0),
+        [28] = TEGRA_GPIO_TO_IRQ(TEGRA_GPIO_PQ6),
+        [29] = TEGRA_GPIO_TO_IRQ(TEGRA_GPIO_PQ7),
+        [30] = TEGRA_GPIO_TO_IRQ(TEGRA_GPIO_PN2),
+};
+
+int tegra_irq_to_wake(int irq)
+{
+        int i;
+        int wake_irq;
+        int search_gpio;
+        static int last_wake = -1;
+
+        /* Two level wake irq search for gpio based wakeups -
+         * 1. check for GPIO irq(based on tegra_wake_event_irq table)
+         * e.g. for a board, wake7 based on GPIO PU6 and irq==358 done first
+         * 2. check for gpio bank irq assuming search for GPIO irq
+         *    preceded this search.
+         * e.g. in this step check for gpio bank irq GPIO6 irq==119
+         */
+        for (i = 0; i < ARRAY_SIZE(tegra_wake_event_irq); i++) {
+                /* return if step 1 matches */
+                if (tegra_wake_event_irq[i] == irq) {
+                        pr_info("Wake%d for irq=%d\n", i, irq);
+                        last_wake = i;
+                        return i;
+                }
+
+                /* step 2 below uses saved last_wake from step 1
+                 * in previous call */
+                search_gpio = irq_to_gpio(
+                        tegra_wake_event_irq[i]);
+                if (search_gpio < 0)
+                        continue;
+                wake_irq = tegra_gpio_get_bank_int_nr(search_gpio);
+                if (wake_irq < 0)
+                        continue;
+                if ((last_wake == i) &&
+                        (wake_irq == irq)) {
+                        pr_info("gpio bank wake found: wake%d for irq=%d\n",
+                                i, irq);
+                        return i;
+                }
+        }
+
+        return -EINVAL;
+}
+
+int tegra_wake_to_irq(int wake)
+{
+        if (wake < 0)
+                return -EINVAL;
+
+        if (wake >= ARRAY_SIZE(tegra_wake_event_irq))
+                return -EINVAL;
+
+        return tegra_wake_event_irq[wake];
+}