[PATCH 1/2] power: reset: Add qcom reboot mode driver

[Xiaogang Cui <xiaogang@codeaurora.org>]

This is a initial version so it's very similar with syscon
reboot mode driver. We will add more functionalities in the
further after dependency is ready.

Signed-off-by: Xiaogang Cui <xiaogang@codeaurora.org>
---
 .../bindings/power_supply/qcom-reboot-mode.txt     |  23 +++++
 drivers/power/reset/Kconfig                        |  10 ++
 drivers/power/reset/Makefile                       |   1 +
 drivers/power/reset/qcom-reboot-mode.c             | 109 +++++++++++++++++++++
 4 files changed, 143 insertions(+)
 create mode 100644 Documentation/devicetree/bindings/power_supply/qcom-reboot-mode.txt
 create mode 100644 drivers/power/reset/qcom-reboot-mode.c

diff --git a/Documentation/devicetree/bindings/power_supply/qcom-reboot-mode.txt b/Documentation/devicetree/bindings/power_supply/qcom-reboot-mode.txt
new file mode 100644
index 0000000..8b33592
--- /dev/null
+++ b/Documentation/devicetree/bindings/power_supply/qcom-reboot-mode.txt
@@ -0,0 +1,23 @@
+Qualcomm Reboot Mode Driver
+
+Qualcomm reboot mode driver based on reboot mode framework to update
+SPMI specific bits.
+
+Required Properties:
+-compatible: "qcom,reboot-mode"
+-offset: offset of the SPMI reboot mode register
+
+Optional Properties:
+-mask: mask of reboot mode
+-mode-xxx: magic of reboot mode
+
+Example:
+	qcom,reboot-mode@88f {
+		compatible = "qcom,reboot-mode";
+		offset = <0x88f>;
+		mode-normal = <0x00>;
+		mode-recovery = <0x04>;
+		mode-bootloader = <0x08>;
+		mode-rtc = <0x0C>;
+	};
+
diff --git a/drivers/power/reset/Kconfig b/drivers/power/reset/Kconfig
index c74c3f6..bdcf6d3f 100644
--- a/drivers/power/reset/Kconfig
+++ b/drivers/power/reset/Kconfig
@@ -208,5 +208,15 @@ config SYSCON_REBOOT_MODE
 	  register, then the bootloader can read it to take different
 	  action according to the mode.
 
+config QCOM_REBOOT_MODE
+	tristate "Qualcomm reboot mode driver"
+	depends on MFD_SPMI_PMIC
+	select REBOOT_MODE
+	help
+	  Say y here will enable Qualcomm reboot mode driver. This will
+	  get reboot mode arguments and store it in SPMI PMIC register,
+	  then the bootloader can read it to take different action
+	  according to the mode.
+
 endif
 
diff --git a/drivers/power/reset/Makefile b/drivers/power/reset/Makefile
index 1be307c..06e010f 100644
--- a/drivers/power/reset/Makefile
+++ b/drivers/power/reset/Makefile
@@ -24,3 +24,4 @@ obj-$(CONFIG_POWER_RESET_RMOBILE) += rmobile-reset.o
 obj-$(CONFIG_POWER_RESET_ZX) += zx-reboot.o
 obj-$(CONFIG_REBOOT_MODE) += reboot-mode.o
 obj-$(CONFIG_SYSCON_REBOOT_MODE) += syscon-reboot-mode.o
+obj-$(CONFIG_QCOM_REBOOT_MODE) += qcom-reboot-mode.o
diff --git a/drivers/power/reset/qcom-reboot-mode.c b/drivers/power/reset/qcom-reboot-mode.c
new file mode 100644
index 0000000..37bb635
--- /dev/null
+++ b/drivers/power/reset/qcom-reboot-mode.c
@@ -0,0 +1,109 @@
+/* Copyright (c) 2016, The Linux Foundation. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 and
+ * only version 2 as published by the Free Software Foundation.
+ *
+ * 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/init.h>
+#include <linux/module.h>
+#include <linux/kernel.h>
+#include <linux/of.h>
+#include <linux/platform_device.h>
+#include <linux/reboot.h>
+#include <linux/regmap.h>
+#include "reboot-mode.h"
+
+struct qcom_reboot_mode {
+	struct regmap *map;
+	struct reboot_mode_driver reboot;
+	u32 offset;
+	u32 mask;
+};
+
+static int qcom_reboot_mode_write(struct reboot_mode_driver *reboot,
+				    unsigned int magic)
+{
+	struct qcom_reboot_mode *qrm;
+	int ret;
+
+	qrm = container_of(reboot, struct qcom_reboot_mode, reboot);
+
+	/* update reboot magic */
+	ret = regmap_update_bits(qrm->map, qrm->offset, qrm->mask, magic);
+	if (ret < 0) {
+		dev_err(reboot->dev, "Failed to update reboot mode bits\n");
+		return ret;
+	}
+
+	return 0;
+}
+
+static int qcom_reboot_mode_probe(struct platform_device *pdev)
+{
+	struct qcom_reboot_mode *qrm;
+	struct device *dev = &pdev->dev;
+	int ret;
+
+	qrm = devm_kzalloc(&pdev->dev, sizeof(*qrm), GFP_KERNEL);
+	if (!qrm)
+		return -ENOMEM;
+
+	qrm->reboot.dev = dev;
+	qrm->reboot.write = qcom_reboot_mode_write;
+	qrm->mask = 0xffffffff;
+
+	qrm->map = dev_get_regmap(dev->parent, NULL);
+	if (IS_ERR_OR_NULL(qrm->map))
+		return -EINVAL;
+
+	if (of_property_read_u32(dev->of_node, "offset", &qrm->offset))
+		return -EINVAL;
+
+	of_property_read_u32(dev->of_node, "mask", &qrm->mask);
+
+	ret = reboot_mode_register(&qrm->reboot);
+	if (ret)
+		dev_err(dev, "Failed to register reboot mode\n");
+
+	dev_set_drvdata(dev, qrm);
+	return ret;
+}
+
+static int qcom_reboot_mode_remove(struct platform_device *pdev)
+{
+	struct qcom_reboot_mode *qrm;
+
+	qrm = dev_get_drvdata(&pdev->dev);
+	return reboot_mode_unregister(&qrm->reboot);
+}
+
+static const struct of_device_id of_qcom_reboot_mode_match[] = {
+	{ .compatible = "qcom,reboot-mode" },
+	{}
+};
+MODULE_DEVICE_TABLE(of, of_qcom_reboot_mode_match);
+
+static struct platform_driver qcom_reboot_mode_driver = {
+	.probe = qcom_reboot_mode_probe,
+	.remove = qcom_reboot_mode_remove,
+	.driver = {
+		.name = "qcom-reboot-mode",
+		.of_match_table = of_match_ptr(of_qcom_reboot_mode_match),
+	},
+};
+
+static int __init qcom_reboot_mode_init(void)
+{
+	return platform_driver_register(&qcom_reboot_mode_driver);
+}
+device_initcall(qcom_reboot_mode_init);
+
+MODULE_DESCRIPTION("QCOM Reboot Mode Driver");
+MODULE_LICENSE("GPL v2");
-- 
The Qualcomm Innovation Center, Inc. is a member of the Code Aurora Forum,
a Linux Foundation Collaborative Project