Hi, Andy:

在 2016-10-14 10:41,Andy Yan 写道:
Hi Xiaogang:


On 2016年10月14日 10:02, Xiaogang Cui wrote:
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 <xiaog...@codeaurora.org>
---

    As your commit messages said, "it's very similar with syscon
reboot mode driver", so maybe we can try to reuse the syscon reboot
mode driver, and extend your new function on it.

Since it will heavily depend on Qualcomm qpnp and download mode driver.
I prefer to add a new driver for this.

  .../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");

Reply via email to