This patch fixes the bug #702999 (oprofile failure on panda (omap4)). It is 
based on [1] that fixes the issue by enabling pmu events for omap4, which are 
routed from CTI. The patch attached is a modified version of [1] with removal 
of some CTI register reads that cause hang in the initial phase of booting. The 
patch has been verified on Panda board and the profile data could be generated 
that are shown by opreport. Although, there is a lockdep warning "possible 
circular locking dependency detected" when "opcontrol --start" is called for 
the first time.

Regards,
Avik

[1] http://lists.infradead.org/pipermail/linux-arm-kernel/2011-March/045283.html

Signed-off-by: Avik Sil <avik....@linaro.org>
---
 arch/arm/include/asm/cti.h                 |  157 ++++++++++++++++++++++++++++
 arch/arm/include/asm/pmu.h                 |   15 ++-
 arch/arm/kernel/perf_event.c               |   15 ++-
 arch/arm/mach-omap2/devices.c              |   82 ++++++++++++++-
 arch/arm/plat-omap/include/plat/omap44xx.h |    2 +
 5 files changed, 262 insertions(+), 9 deletions(-)
 create mode 100644 arch/arm/include/asm/cti.h

diff --git a/arch/arm/include/asm/cti.h b/arch/arm/include/asm/cti.h
new file mode 100644
index 0000000..26e7450
--- /dev/null
+++ b/arch/arm/include/asm/cti.h
@@ -0,0 +1,157 @@
+#ifndef __ASMARM_CTI_H
+#define __ASMARM_CTI_H
+
+#include       <asm/io.h>
+
+/* The registers' definition is from section 3.2 of
+ * Embedded Cross Trigger Revision: r0p0
+ */
+#define                CTICONTROL              0x000
+#define                CTISTATUS               0x004
+#define                CTILOCK                 0x008
+#define                CTIPROTECTION           0x00C
+#define                CTIINTACK               0x010
+#define                CTIAPPSET               0x014
+#define                CTIAPPCLEAR             0x018
+#define                CTIAPPPULSE             0x01c
+#define                CTIINEN                 0x020
+#define                CTIOUTEN                0x0A0
+#define                CTITRIGINSTATUS         0x130
+#define                CTITRIGOUTSTATUS        0x134
+#define                CTICHINSTATUS           0x138
+#define                CTICHOUTSTATUS          0x13c
+#define                CTIPERIPHID0            0xFE0
+#define                CTIPERIPHID1            0xFE4
+#define                CTIPERIPHID2            0xFE8
+#define                CTIPERIPHID3            0xFEC
+#define                CTIPCELLID0             0xFF0
+#define                CTIPCELLID1             0xFF4
+#define                CTIPCELLID2             0xFF8
+#define                CTIPCELLID3             0xFFC
+
+/* The below are from section 3.6.4 of
+ * CoreSight v1.0 Architecture Specification
+ */
+#define                LOCKACCESS              0xFB0
+#define                LOCKSTATUS              0xFB4
+
+/* write this value to LOCKACCESS will unlock the module, and
+ * other value will lock the module
+ */
+#define                LOCKCODE                0xC5ACCE55
+
+/**
+ * struct cti - cross trigger interface struct
+ * @base: mapped virtual address for the cti base
+ * @irq: irq number for the cti
+ * @trig_out_for_irq: triger out number which will cause
+ *     the @irq happen
+ *
+ * cti struct used to operate cti registers.
+ */
+struct cti {
+       void __iomem *base;
+       int irq;
+       int trig_out_for_irq;
+};
+
+/**
+ * cti_init - initialize the cti instance
+ * @cti: cti instance
+ * @base: mapped virtual address for the cti base
+ * @irq: irq number for the cti
+ * @trig_out: triger out number which will cause
+ *     the @irq happen
+ *
+ * called by machine code to pass the board dependent
+ * @base, @irq and @trig_out to cti.
+ */
+static inline void cti_init(struct cti *cti,
+       void __iomem *base, int irq, int trig_out)
+{
+       cti->base = base;
+       cti->irq  = irq;
+       cti->trig_out_for_irq = trig_out;
+}
+
+/**
+ * cti_map_trigger - use the @chan to map @trig_in to @trig_out
+ * @cti: cti instance
+ * @trig_in: trigger in number
+ * @trig_out: trigger out number
+ * @channel: channel number
+ *
+ * This function maps one trigger in of @trig_in to one trigger
+ * out of @trig_out using the channel @chan.
+ */
+static inline void cti_map_trigger(struct cti *cti,
+       int trig_in, int trig_out, int chan)
+{
+       void __iomem *base = cti->base;
+
+       __raw_writel(BIT(chan), base + CTIINEN + trig_in * 4);
+       __raw_writel(BIT(chan), base + CTIOUTEN + trig_out * 4);
+}
+
+/**
+ * cti_enable - enable the cti module
+ * @cti: cti instance
+ *
+ * enable the cti module
+ */
+static inline void cti_enable(struct cti *cti)
+{
+       __raw_writel(0x1, cti->base + CTICONTROL);
+}
+
+/**
+ * cti_disable - disable the cti module
+ * @cti: cti instance
+ *
+ * enable the cti module
+ */
+static inline void cti_disable(struct cti *cti)
+{
+       __raw_writel(0, cti->base + CTICONTROL);
+}
+
+/**
+ * cti_irq_ack - clear the cti irq
+ * @cti: cti instance
+ *
+ * clear the cti irq
+ */
+static inline void cti_irq_ack(struct cti *cti)
+{
+       void __iomem *base = cti->base;
+       unsigned long val;
+
+       val = __raw_readl(base + CTIINTACK);
+       val |= BIT(cti->trig_out_for_irq);
+       __raw_writel(val, base + CTIINTACK);
+}
+
+/**
+ * cti_unlock - unlock cti module
+ * @cti: cti instance
+ *
+ * unlock the cti module, or else any writes to the cti
+ * module is not allowed.
+ */
+static inline void cti_unlock(struct cti *cti)
+{
+       __raw_writel(LOCKCODE, cti->base + LOCKACCESS);
+}
+
+/**
+ * cti_lock - lock cti module
+ * @cti: cti instance
+ *
+ * lock the cti module, so any writes to the cti
+ * module will be not allowed.
+ */
+static inline void cti_lock(struct cti *cti)
+{
+       __raw_writel(~LOCKCODE, cti->base + LOCKACCESS);
+}
+#endif
diff --git a/arch/arm/include/asm/pmu.h b/arch/arm/include/asm/pmu.h
index 7544ce6..7ca3d15 100644
--- a/arch/arm/include/asm/pmu.h
+++ b/arch/arm/include/asm/pmu.h
@@ -22,13 +22,22 @@ enum arm_pmu_type {
 /*
  * struct arm_pmu_platdata - ARM PMU platform data
  *
- * @handle_irq: an optional handler which will be called from the interrupt and
- * passed the address of the low level handler, and can be used to implement
- * any platform specific handling before or after calling it.
+ * @handle_irq: an optional handler which will be called from the
+ *     interrupt and passed the address of the low level handler,
+ *     and can be used to implement any platform specific handling
+ *     before or after calling it.
+ * @enable_irq: an optional handler which will be called after
+ *     request_irq and be used to handle some platform specific
+ *     irq enablement
+ * @disable_irq: an optional handler which will be called before
+ *     free_irq and be used to handle some platform specific
+ *     irq disablement
  */
 struct arm_pmu_platdata {
        irqreturn_t (*handle_irq)(int irq, void *dev,
                                  irq_handler_t pmu_handler);
+       void (*enable_irq)(int irq);
+       void (*disable_irq)(int irq);
 };
 
 #ifdef CONFIG_CPU_HAS_PMU
diff --git a/arch/arm/kernel/perf_event.c b/arch/arm/kernel/perf_event.c
index 69cfee0..86db755 100644
--- a/arch/arm/kernel/perf_event.c
+++ b/arch/arm/kernel/perf_event.c
@@ -426,14 +426,18 @@ armpmu_reserve_hardware(void)
                        pr_warning("unable to request IRQ%d for ARM perf "
                                "counters\n", irq);
                        break;
-               }
+               } else if (plat->enable_irq)
+                       plat->enable_irq(irq);
        }
 
        if (err) {
                for (i = i - 1; i >= 0; --i) {
                        irq = platform_get_irq(pmu_device, i);
-                       if (irq >= 0)
+                       if (irq >= 0) {
+                               if (plat->disable_irq)
+                                       plat->disable_irq(irq);
                                free_irq(irq, NULL);
+                       }
                }
                release_pmu(pmu_device);
                pmu_device = NULL;
@@ -446,11 +450,16 @@ static void
 armpmu_release_hardware(void)
 {
        int i, irq;
+       struct arm_pmu_platdata *plat =
+               dev_get_platdata(&pmu_device->dev);
 
        for (i = pmu_device->num_resources - 1; i >= 0; --i) {
                irq = platform_get_irq(pmu_device, i);
-               if (irq >= 0)
+               if (irq >= 0) {
+                       if (plat->disable_irq)
+                               plat->disable_irq(irq);
                        free_irq(irq, NULL);
+               }
        }
        armpmu->stop();
 
diff --git a/arch/arm/mach-omap2/devices.c b/arch/arm/mach-omap2/devices.c
index d478f53..cbd6b35 100644
--- a/arch/arm/mach-omap2/devices.c
+++ b/arch/arm/mach-omap2/devices.c
@@ -22,6 +22,7 @@
 #include <asm/mach-types.h>
 #include <asm/mach/map.h>
 #include <asm/pmu.h>
+#include <asm/cti.h>
 
 #include <plat/tc.h>
 #include <plat/board.h>
@@ -386,20 +387,95 @@ static struct resource omap3_pmu_resource = {
        .flags  = IORESOURCE_IRQ,
 };
 
+static struct resource omap4_pmu_resource[] = {
+       {
+               .start  = OMAP44XX_IRQ_CTI0,
+               .end    = OMAP44XX_IRQ_CTI0,
+               .flags  = IORESOURCE_IRQ,
+       },
+       {
+               .start  = OMAP44XX_IRQ_CTI1,
+               .end    = OMAP44XX_IRQ_CTI1,
+               .flags  = IORESOURCE_IRQ,
+       }
+};
+
 static struct platform_device omap_pmu_device = {
        .name           = "arm-pmu",
        .id             = ARM_PMU_DEVICE_CPU,
        .num_resources  = 1,
 };
 
+static struct arm_pmu_platdata omap4_pmu_data;
+static struct cti omap4_cti[2];
+
+static void omap4_enable_cti(int irq)
+{
+       if (irq == OMAP44XX_IRQ_CTI0)
+               cti_enable(&omap4_cti[0]);
+       else if (irq == OMAP44XX_IRQ_CTI1)
+               cti_enable(&omap4_cti[1]);
+}
+
+static void omap4_disable_cti(int irq)
+{
+       if (irq == OMAP44XX_IRQ_CTI0)
+               cti_disable(&omap4_cti[0]);
+       else if (irq == OMAP44XX_IRQ_CTI1)
+               cti_disable(&omap4_cti[1]);
+}
+
+static irqreturn_t omap4_pmu_handler(int irq, void *dev, irq_handler_t handler)
+{
+       if (irq == OMAP44XX_IRQ_CTI0)
+               cti_irq_ack(&omap4_cti[0]);
+       else if (irq == OMAP44XX_IRQ_CTI1)
+               cti_irq_ack(&omap4_cti[1]);
+
+       return handler(irq, dev);
+}
+
+static void omap4_configure_pmu_irq(void)
+{
+       void __iomem *base0;
+       void __iomem *base1;
+
+       base0 = ioremap(OMAP44XX_CTI0_BASE, SZ_4K);
+       base1 = ioremap(OMAP44XX_CTI1_BASE, SZ_4K);
+       if (!base0 && !base1) {
+               pr_err("ioremap for OMAP4 CTI failed\n");
+               return;
+       }
+
+       /*configure CTI0 for pmu irq routing*/
+       cti_init(&omap4_cti[0], base0, OMAP44XX_IRQ_CTI0, 6);
+       cti_unlock(&omap4_cti[0]);
+       cti_map_trigger(&omap4_cti[0], 1, 6, 2);
+
+       /*configure CTI1 for pmu irq routing*/
+       cti_init(&omap4_cti[1], base1, OMAP44XX_IRQ_CTI1, 6);
+       cti_unlock(&omap4_cti[1]);
+       cti_map_trigger(&omap4_cti[1], 1, 6, 2);
+
+       omap4_pmu_data.handle_irq = omap4_pmu_handler;
+       omap4_pmu_data.enable_irq = omap4_enable_cti;
+       omap4_pmu_data.disable_irq = omap4_disable_cti;
+}
+
 static void omap_init_pmu(void)
 {
-       if (cpu_is_omap24xx())
+       if (cpu_is_omap24xx()) {
                omap_pmu_device.resource = &omap2_pmu_resource;
-       else if (cpu_is_omap34xx())
+       } else if (cpu_is_omap34xx()) {
                omap_pmu_device.resource = &omap3_pmu_resource;
-       else
+       } else if (cpu_is_omap44xx()) {
+               omap_pmu_device.resource = omap4_pmu_resource;
+               omap_pmu_device.num_resources = 2;
+               omap_pmu_device.dev.platform_data = &omap4_pmu_data;
+               omap4_configure_pmu_irq();
+       } else {
                return;
+       }
 
        platform_device_register(&omap_pmu_device);
 }
diff --git a/arch/arm/plat-omap/include/plat/omap44xx.h 
b/arch/arm/plat-omap/include/plat/omap44xx.h
index ea2b8a6..b127a16 100644
--- a/arch/arm/plat-omap/include/plat/omap44xx.h
+++ b/arch/arm/plat-omap/include/plat/omap44xx.h
@@ -57,5 +57,7 @@
 #define OMAP44XX_HSUSB_OHCI_BASE       (L4_44XX_BASE + 0x64800)
 #define OMAP44XX_HSUSB_EHCI_BASE       (L4_44XX_BASE + 0x64C00)
 
+#define OMAP44XX_CTI0_BASE             0x54148000
+#define OMAP44XX_CTI1_BASE             0x54149000
 #endif /* __ASM_ARCH_OMAP44XX_H */
 
-- 
1.7.0.4


_______________________________________________
linaro-dev mailing list
linaro-dev@lists.linaro.org
http://lists.linaro.org/mailman/listinfo/linaro-dev

Reply via email to