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@xxxxxxxxxxxxxx> --- .../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 -- To unsubscribe from this list: send the line "unsubscribe devicetree" in the body of a message to majordomo@xxxxxxxxxxxxxxx More majordomo info at http://vger.kernel.org/majordomo-info.html