Add the rt linux 4.1.3-rt3 as base

[kvmfornfv.git] / kernel / arch / powerpc / platforms / 512x / pdm360ng.c

diff --git a/kernel/arch/powerpc/platforms/512x/pdm360ng.c b/kernel/arch/powerpc/platforms/512x/pdm360ng.c
new file mode 100644 (file)
index 0000000..116f232
--- /dev/null
+++ b/kernel/arch/powerpc/platforms/512x/pdm360ng.c
@@ -0,0 +1,131 @@
+/*
+ * Copyright (C) 2010 DENX Software Engineering
+ *
+ * Anatolij Gustschin, <agust@denx.de>
+ *
+ * PDM360NG board setup
+ *
+ * This 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.
+ *
+ */
+
+#include <linux/kernel.h>
+#include <linux/io.h>
+#include <linux/of_address.h>
+#include <linux/of_fdt.h>
+#include <linux/of_platform.h>
+
+#include <asm/machdep.h>
+#include <asm/ipic.h>
+
+#include "mpc512x.h"
+
+#if defined(CONFIG_TOUCHSCREEN_ADS7846) || \
+    defined(CONFIG_TOUCHSCREEN_ADS7846_MODULE)
+#include <linux/interrupt.h>
+#include <linux/spi/ads7846.h>
+#include <linux/spi/spi.h>
+#include <linux/notifier.h>
+
+static void *pdm360ng_gpio_base;
+
+static int pdm360ng_get_pendown_state(void)
+{
+       u32 reg;
+
+       reg = in_be32(pdm360ng_gpio_base + 0xc);
+       if (reg & 0x40)
+               setbits32(pdm360ng_gpio_base + 0xc, 0x40);
+
+       reg = in_be32(pdm360ng_gpio_base + 0x8);
+
+       /* return 1 if pen is down */
+       return (reg & 0x40) == 0;
+}
+
+static struct ads7846_platform_data pdm360ng_ads7846_pdata = {
+       .model                  = 7845,
+       .get_pendown_state      = pdm360ng_get_pendown_state,
+       .irq_flags              = IRQF_TRIGGER_LOW,
+};
+
+static int __init pdm360ng_penirq_init(void)
+{
+       struct device_node *np;
+
+       np = of_find_compatible_node(NULL, NULL, "fsl,mpc5121-gpio");
+       if (!np) {
+               pr_err("%s: Can't find 'mpc5121-gpio' node\n", __func__);
+               return -ENODEV;
+       }
+
+       pdm360ng_gpio_base = of_iomap(np, 0);
+       of_node_put(np);
+       if (!pdm360ng_gpio_base) {
+               pr_err("%s: Can't map gpio regs.\n", __func__);
+               return -ENODEV;
+       }
+       out_be32(pdm360ng_gpio_base + 0xc, 0xffffffff);
+       setbits32(pdm360ng_gpio_base + 0x18, 0x2000);
+       setbits32(pdm360ng_gpio_base + 0x10, 0x40);
+
+       return 0;
+}
+
+static int pdm360ng_touchscreen_notifier_call(struct notifier_block *nb,
+                                       unsigned long event, void *__dev)
+{
+       struct device *dev = __dev;
+
+       if ((event == BUS_NOTIFY_ADD_DEVICE) &&
+           of_device_is_compatible(dev->of_node, "ti,ads7846")) {
+               dev->platform_data = &pdm360ng_ads7846_pdata;
+               return NOTIFY_OK;
+       }
+       return NOTIFY_DONE;
+}
+
+static struct notifier_block pdm360ng_touchscreen_nb = {
+       .notifier_call = pdm360ng_touchscreen_notifier_call,
+};
+
+static void __init pdm360ng_touchscreen_init(void)
+{
+       if (pdm360ng_penirq_init())
+               return;
+
+       bus_register_notifier(&spi_bus_type, &pdm360ng_touchscreen_nb);
+}
+#else
+static inline void __init pdm360ng_touchscreen_init(void)
+{
+}
+#endif /* CONFIG_TOUCHSCREEN_ADS7846 */
+
+void __init pdm360ng_init(void)
+{
+       mpc512x_init();
+       pdm360ng_touchscreen_init();
+}
+
+static int __init pdm360ng_probe(void)
+{
+       unsigned long root = of_get_flat_dt_root();
+
+       return of_flat_dt_is_compatible(root, "ifm,pdm360ng");
+}
+
+define_machine(pdm360ng) {
+       .name                   = "PDM360NG",
+       .probe                  = pdm360ng_probe,
+       .setup_arch             = mpc512x_setup_arch,
+       .init                   = pdm360ng_init,
+       .init_early             = mpc512x_init_early,
+       .init_IRQ               = mpc512x_init_IRQ,
+       .get_irq                = ipic_get_irq,
+       .calibrate_decr         = generic_calibrate_decr,
+       .restart                = mpc512x_restart,
+};