From bb04db9093f77dd4056a4c9275792fe84fb404f7 Mon Sep 17 00:00:00 2001
From: Wang Dongsheng <dongsheng.wang@freescale.com>
Date: Thu, 19 Mar 2015 14:37:13 +0800
Subject: powerpc/fsl: add power_off support for fsl platform

QIXIS System Logic FPGA support to manage system power. So we
through QIXIS to power off freescale SOC.

Signed-off-by: Wang Dongsheng <dongsheng.wang@freescale.com>
Change-Id: I7478cca11dcd23c8d9580c3f52c46946375573c4
Reviewed-on: http://git.am.freescale.net:8181/33082
Tested-by: Review Code-CDREVIEW <CDREVIEW@freescale.com>
Reviewed-by: Honghua Yin <Hong-Hua.Yin@freescale.com>

diff --git a/drivers/soc/fsl/Kconfig b/drivers/soc/fsl/Kconfig
index 72df9b3..df26cf1 100644
--- a/drivers/soc/fsl/Kconfig
+++ b/drivers/soc/fsl/Kconfig
@@ -1,3 +1,11 @@
 if ARM
 source "drivers/soc/fsl/Kconfig.arm"
 endif
+
+config FSL_QIXIS
+	tristate "QIXIS system controller driver"
+	depends on FSL_SOC_DRIVERS
+	default n
+	help
+	  Say y here to enable QIXIS system controller api.  The qixis driver
+	  provides FPGA functions to control system.
diff --git a/drivers/soc/fsl/Makefile b/drivers/soc/fsl/Makefile
index 5ca0e1c..311eb95 100644
--- a/drivers/soc/fsl/Makefile
+++ b/drivers/soc/fsl/Makefile
@@ -2,4 +2,6 @@
 # Makefile for ls1 Soc specific device drivers.
 #
 
+obj-$(CONFIG_FSL_QIXIS) += qixis_ctrl.o
+
 obj-$(CONFIG_LS1_SOC_DRIVERS) += ls1/
diff --git a/drivers/soc/fsl/qixis_ctrl.c b/drivers/soc/fsl/qixis_ctrl.c
new file mode 100644
index 0000000..9c8c519
--- /dev/null
+++ b/drivers/soc/fsl/qixis_ctrl.c
@@ -0,0 +1,104 @@
+/*
+ * Freescale QIXIS system controller driver.
+ *
+ * Copyright 2015 Freescale Semiconductor, 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.
+ */
+
+#include <linux/device.h>
+#include <linux/err.h>
+#include <linux/io.h>
+#include <linux/module.h>
+#include <linux/of_address.h>
+#include <linux/platform_device.h>
+#include <linux/pm.h>
+#include <linux/fsl/qixis_ctrl.h>
+
+#ifdef CONFIG_PPC
+#include <asm/machdep.h>
+#endif
+
+static struct fsl_qixis_regs __iomem *qixis;
+
+/* QIXIS Power Management Control*/
+#define QIXIS_PWR_CTL2_PWR	0x80
+static void fsl_qixis_power_off(void)
+{
+	local_irq_disable();
+
+	iowrite8(ioread8(&qixis->pwr_ctrl2) | QIXIS_PWR_CTL2_PWR,
+		 &qixis->pwr_ctrl2);
+
+	while (1)
+		;
+}
+
+static void fsl_qixis_pm_init(void)
+{
+#if defined(CONFIG_PPC)
+	ppc_md.power_off = fsl_qixis_power_off;
+	ppc_md.halt = fsl_qixis_power_off;
+#elif defined(CONFIG_ARM)
+	pm_power_off = fsl_qixis_power_off;
+#endif
+}
+
+static void fsl_qixis_pm_release(void)
+{
+#if defined(CONFIG_PPC)
+	ppc_md.power_off = NULL;
+	ppc_md.halt = NULL;
+#elif defined(CONFIG_ARM)
+	pm_power_off = NULL;
+#endif
+}
+
+static int fsl_qixis_probe(struct platform_device *pdev)
+{
+	struct resource *res;
+
+	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
+	qixis = devm_ioremap_resource(&pdev->dev, res);
+	if (IS_ERR(qixis)) {
+		pr_err("%s: Could not map qixis registers\n", __func__);
+		return PTR_ERR(qixis);
+	}
+
+	fsl_qixis_pm_init();
+
+	return 0;
+}
+
+static int fsl_qixis_remove(struct platform_device *pdev)
+{
+	fsl_qixis_pm_release();
+
+	iounmap(qixis);
+
+	return 0;
+}
+
+static const struct of_device_id fsl_qixis_table[] = {
+	{ .compatible = "fsl,fpga-qixis", },
+	{ .compatible = "fsl,ls1021aqds-fpga", },
+	{},
+};
+
+static struct platform_driver fsl_qixis_driver = {
+	.driver = {
+		.name = "fsl-qixis",
+		.owner = THIS_MODULE,
+		.of_match_table = fsl_qixis_table,
+	},
+	.probe = fsl_qixis_probe,
+	.remove = fsl_qixis_remove,
+};
+module_platform_driver(fsl_qixis_driver);
+
+MODULE_AUTHOR("Wang Dongsheng <dongsheng.wang@freescale.com>");
+MODULE_DESCRIPTION("Freescale QIXIS system controller driver");
+MODULE_LICENSE("GPL v2");
diff --git a/include/linux/fsl/qixis_ctrl.h b/include/linux/fsl/qixis_ctrl.h
new file mode 100644
index 0000000..1907bf9
--- /dev/null
+++ b/include/linux/fsl/qixis_ctrl.h
@@ -0,0 +1,24 @@
+/*
+ * include/linux/fsl/qixis_ctrl.h
+ *
+ * Definitions for Freescale QIXIS system controller.
+ *
+ * Copyright 2015 Freescale Semiconductor, 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.
+ */
+
+#ifndef _FSL_QIXIS_CTRL_H_
+#define _FSL_QIXIS_CTRL_H_
+
+/* QIXIS MAP */
+struct fsl_qixis_regs {
+	u8		version;	/* Identification Registers */
+	u8		reserved1[0x20];
+	u8		pwr_ctrl2;	/* Power Control 2 Register */
+};
+
+#endif
-- 
cgit v0.10.2