1 files changed, 847 insertions, 0 deletions

diff --git a/arch/arm/mach-tegra/tegra3_actmon.c b/arch/arm/mach-tegra/tegra3_actmon.c
new file mode 100644
index 00000000000..43130f960ec
--- /dev/null
+++ b/arch/arm/mach-tegra/tegra3_actmon.c
@@ -0,0 +1,847 @@
+/*
+ * Copyright (c) 2011, NVIDIA Corporation.
+ *
+ * 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; version 2 of the License.
+ *
+ * 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.
+ *
+ * You should have received a copy of the GNU General Public License along
+ * with this program; if not, write to the Free Software Foundation, Inc.,
+ * 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, USA.
+ */
+
+#include <linux/kernel.h>
+#include <linux/spinlock.h>
+#include <linux/err.h>
+#include <linux/io.h>
+#include <linux/clk.h>
+#include <linux/interrupt.h>
+#include <linux/suspend.h>
+#include <linux/debugfs.h>
+#include <linux/seq_file.h>
+#include <linux/uaccess.h>
+
+#include <mach/iomap.h>
+#include <mach/irqs.h>
+#include <mach/clk.h>
+
+#include "clock.h"
+
+#define ACTMON_GLB_STATUS                       0x00
+#define ACTMON_GLB_PERIOD_CTRL                  0x04
+
+#define ACTMON_DEV_CTRL                         0x00
+#define ACTMON_DEV_CTRL_ENB                     (0x1 << 31)
+#define ACTMON_DEV_CTRL_UP_WMARK_ENB            (0x1 << 30)
+#define ACTMON_DEV_CTRL_DOWN_WMARK_ENB          (0x1 << 29)
+#define ACTMON_DEV_CTRL_UP_WMARK_NUM_SHIFT      26
+#define ACTMON_DEV_CTRL_UP_WMARK_NUM_MASK       (0x7 << 26)
+#define ACTMON_DEV_CTRL_DOWN_WMARK_NUM_SHIFT    23
+#define ACTMON_DEV_CTRL_DOWN_WMARK_NUM_MASK     (0x7 << 23)
+#define ACTMON_DEV_CTRL_AVG_UP_WMARK_ENB        (0x1 << 21)
+#define ACTMON_DEV_CTRL_AVG_DOWN_WMARK_ENB      (0x1 << 20)
+#define ACTMON_DEV_CTRL_PERIODIC_ENB            (0x1 << 18)
+#define ACTMON_DEV_CTRL_K_VAL_SHIFT             10
+#define ACTMON_DEV_CTRL_K_VAL_MASK              (0x7 << 10)
+
+#define ACTMON_DEV_UP_WMARK                     0x04
+#define ACTMON_DEV_DOWN_WMARK                   0x08
+#define ACTMON_DEV_INIT_AVG                     0x0c
+#define ACTMON_DEV_AVG_UP_WMARK                 0x10
+#define ACTMON_DEV_AVG_DOWN_WMARK                       0x14
+
+#define ACTMON_DEV_COUNT_WEGHT                  0x18
+#define ACTMON_DEV_COUNT                        0x1c
+#define ACTMON_DEV_AVG_COUNT                    0x20
+
+#define ACTMON_DEV_INTR_STATUS                  0x24
+#define ACTMON_DEV_INTR_UP_WMARK                (0x1 << 31)
+#define ACTMON_DEV_INTR_DOWN_WMARK              (0x1 << 30)
+#define ACTMON_DEV_INTR_AVG_DOWN_WMARK          (0x1 << 25)
+#define ACTMON_DEV_INTR_AVG_UP_WMARK            (0x1 << 24)
+
+#define ACTMON_DEFAULT_AVG_WINDOW_LOG2          6
+#define ACTMON_DEFAULT_AVG_BAND                 6       /* 1/10 of % */
+
+enum actmon_type {
+        ACTMON_LOAD_SAMPLER,
+        ACTMON_FREQ_SAMPLER,
+};
+
+enum actmon_state {
+        ACTMON_UNINITIALIZED = -1,
+        ACTMON_OFF = 0,
+        ACTMON_ON  = 1,
+        ACTMON_SUSPENDED = 2,
+};
+
+#define ACTMON_DEFAULT_SAMPLING_PERIOD          12
+static u8 actmon_sampling_period;
+
+static unsigned long actmon_clk_freq;
+
+
+/* Units:
+ * - frequency in kHz
+ * - coefficients, and thresholds in %
+ * - sampling period in ms
+ * - window in sample periods (value = setting + 1)
+ */
+struct actmon_dev {
+        u32             reg;
+        u32             glb_status_irq_mask;
+        const char      *dev_id;
+        const char      *con_id;
+        struct clk      *clk;
+
+        unsigned long   max_freq;
+        unsigned long   target_freq;
+        unsigned long   cur_freq;
+
+        unsigned long   avg_actv_freq;
+        unsigned long   avg_band_freq;
+        unsigned int    avg_sustain_coef;
+        u32             avg_count;
+
+        unsigned long   boost_freq;
+        unsigned long   boost_freq_step;
+        unsigned int    boost_up_coef;
+        unsigned int    boost_down_coef;
+        unsigned int    boost_up_threshold;
+        unsigned int    boost_down_threshold;
+
+        u8              up_wmark_window;
+        u8              down_wmark_window;
+        u8              avg_window_log2;
+        u32             count_weight;
+
+        enum actmon_type        type;
+        enum actmon_state       state;
+        enum actmon_state       saved_state;
+
+        spinlock_t      lock;
+
+        struct notifier_block   rate_change_nb;
+};
+
+static void __iomem *actmon_base = IO_ADDRESS(TEGRA_ACTMON_BASE);
+
+static inline u32 actmon_readl(u32 offset)
+{
+        return __raw_readl((u32)actmon_base + offset);
+}
+static inline void actmon_writel(u32 val, u32 offset)
+{
+        __raw_writel(val, (u32)actmon_base + offset);
+}
+static inline void actmon_wmb(void)
+{
+        wmb();
+        actmon_readl(ACTMON_GLB_STATUS);
+}
+
+#define offs(x)         (dev->reg + x)
+
+static inline unsigned long do_percent(unsigned long val, unsigned int pct)
+{
+        return val * pct / 100;
+}
+
+static inline void actmon_dev_up_wmark_set(struct actmon_dev *dev)
+{
+        u32 val;
+        unsigned long freq = (dev->type == ACTMON_FREQ_SAMPLER) ?
+                dev->cur_freq : actmon_clk_freq;
+
+        val = freq * actmon_sampling_period;
+        actmon_writel(do_percent(val, dev->boost_up_threshold),
+                      offs(ACTMON_DEV_UP_WMARK));
+}
+
+static inline void actmon_dev_down_wmark_set(struct actmon_dev *dev)
+{
+        u32 val;
+        unsigned long freq = (dev->type == ACTMON_FREQ_SAMPLER) ?
+                dev->cur_freq : actmon_clk_freq;
+
+        val = freq * actmon_sampling_period;
+        actmon_writel(do_percent(val, dev->boost_down_threshold),
+                      offs(ACTMON_DEV_DOWN_WMARK));
+}
+
+static inline void actmon_dev_wmark_set(struct actmon_dev *dev)
+{
+        u32 val;
+        unsigned long freq = (dev->type == ACTMON_FREQ_SAMPLER) ?
+                dev->cur_freq : actmon_clk_freq;
+
+        val = freq * actmon_sampling_period;
+        actmon_writel(do_percent(val, dev->boost_up_threshold),
+                      offs(ACTMON_DEV_UP_WMARK));
+        actmon_writel(do_percent(val, dev->boost_down_threshold),
+                      offs(ACTMON_DEV_DOWN_WMARK));
+}
+
+static inline void actmon_dev_avg_wmark_set(struct actmon_dev *dev)
+{
+        u32 avg = dev->avg_count;
+        u32 band = dev->avg_band_freq * actmon_sampling_period;
+
+        actmon_writel(avg + band, offs(ACTMON_DEV_AVG_UP_WMARK));
+        avg = max(avg, band);
+        actmon_writel(avg - band, offs(ACTMON_DEV_AVG_DOWN_WMARK));
+}
+
+static unsigned long actmon_dev_avg_freq_get(struct actmon_dev *dev)
+{
+        u64 val;
+
+        if (dev->type == ACTMON_FREQ_SAMPLER)
+                return dev->avg_count / actmon_sampling_period;
+
+        val = (u64)dev->avg_count * dev->cur_freq;
+        do_div(val, actmon_clk_freq * actmon_sampling_period);
+        return (u32)val;
+}
+
+/* Activity monitor sampling operations */
+irqreturn_t actmon_dev_isr(int irq, void *dev_id)