On Mon, 11 Aug 2014, Bjorn Andersson wrote: > Driver for the Resource Power Manager (RPM) found in Qualcomm 8660, 8960 > and 8064 based devices. The driver exposes resources that child drivers > can operate on; to implementing regulator, clock and bus frequency > drivers. > > Signed-off-by: Bjorn Andersson <bjorn.andersson@xxxxxxxxxxxxxx> > --- > drivers/mfd/Kconfig | 15 ++ > drivers/mfd/Makefile | 1 + > drivers/mfd/qcom_rpm.c | 596 +++++++++++++++++++++++++++++++++++++++++++ > include/linux/mfd/qcom_rpm.h | 12 + > 4 files changed, 624 insertions(+) > create mode 100644 drivers/mfd/qcom_rpm.c > create mode 100644 include/linux/mfd/qcom_rpm.h > > diff --git a/drivers/mfd/Kconfig b/drivers/mfd/Kconfig > index 6cc4b6a..7a8584a 100644 > --- a/drivers/mfd/Kconfig > +++ b/drivers/mfd/Kconfig > @@ -524,6 +524,21 @@ config MFD_PM8921_CORE > Say M here if you want to include support for PM8921 chip as a module. > This will build a module called "pm8921-core". > > +config MFD_QCOM_RPM > + tristate "Qualcomm Resource Power Manager (RPM)" > + depends on ARCH_QCOM && OF > + select MFD_SYSCON > + help > + If you say yes to this option, support will be included for the > + Resource Power Manager system found in the Qualcomm 8660, 8960 and > + 8064 based devices. > + > + This is required to access many regulators, clocks and bus > + frequencies controlled by the RPM on these devices. > + > + Say M here if you want to include support for the Qualcomm RPM as a > + module. This will build a module called "qcom_rpm". > + > config MFD_RDC321X > tristate "RDC R-321x southbridge" > select MFD_CORE > diff --git a/drivers/mfd/Makefile b/drivers/mfd/Makefile > index 8afedba..fce4a7d 100644 > --- a/drivers/mfd/Makefile > +++ b/drivers/mfd/Makefile > @@ -153,6 +153,7 @@ obj-$(CONFIG_MFD_SI476X_CORE) += si476x-core.o > obj-$(CONFIG_MFD_CS5535) += cs5535-mfd.o > obj-$(CONFIG_MFD_OMAP_USB_HOST) += omap-usb-host.o omap-usb-tll.o > obj-$(CONFIG_MFD_PM8921_CORE) += pm8921-core.o ssbi.o > +obj-$(CONFIG_MFD_QCOM_RPM) += qcom_rpm.o > obj-$(CONFIG_TPS65911_COMPARATOR) += tps65911-comparator.o > obj-$(CONFIG_MFD_TPS65090) += tps65090.o > obj-$(CONFIG_MFD_AAT2870_CORE) += aat2870-core.o > diff --git a/drivers/mfd/qcom_rpm.c b/drivers/mfd/qcom_rpm.c > new file mode 100644 > index 0000000..7cc0513 > --- /dev/null > +++ b/drivers/mfd/qcom_rpm.c > @@ -0,0 +1,596 @@ > +/* > + * Copyright (c) 2014, Sony Mobile Communications AB. > + * Copyright (c) 2013, 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. > + */ [...] > +static const struct qcom_rpm_data msm8660_template = { > + .version = -1, -1? > + .resource_table = msm8660_rpm_resource_table, > + .n_resources = ARRAY_SIZE(msm8660_rpm_resource_table), > +}; [...] > +struct qcom_rpm *dev_get_qcom_rpm(struct device *dev) > +{ > + return dev_get_drvdata(dev); > +} > +EXPORT_SYMBOL(dev_get_qcom_rpm); No need for this at all. Use dev_get_drvdata() direct instead. [...] > +static int qcom_rpm_probe(struct platform_device *pdev) > +{ > + const struct of_device_id *match; > + struct device_node *syscon_np; > + struct resource *res; > + struct qcom_rpm *rpm; > + u32 fw_version[3]; > + int irq_wakeup; > + int irq_ack; > + int irq_err; > + int ret; > + > + rpm = devm_kzalloc(&pdev->dev, sizeof(*rpm), GFP_KERNEL); > + if (!rpm) { > + dev_err(&pdev->dev, "Can't allocate qcom_rpm\n"); No need for error messages on OOM. > + return -ENOMEM; > + } '\n' here. > + rpm->dev = &pdev->dev; > + mutex_init(&rpm->lock); > + init_completion(&rpm->ack); > + > + irq_ack = platform_get_irq_byname(pdev, "ack"); > + if (irq_ack < 0) { > + dev_err(&pdev->dev, "required ack interrupt missing\n"); > + return irq_ack; > + } > + > + irq_err = platform_get_irq_byname(pdev, "err"); > + if (irq_err < 0) { > + dev_err(&pdev->dev, "required err interrupt missing\n"); > + return irq_err; > + } > + > + irq_wakeup = platform_get_irq_byname(pdev, "wakeup"); > + if (irq_wakeup < 0) { > + dev_err(&pdev->dev, "required wakeup interrupt missing\n"); > + return irq_wakeup; > + } > + > + match = of_match_device(qcom_rpm_of_match, &pdev->dev); > + rpm->data = match->data; > + > + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); > + rpm->status_regs = devm_ioremap_resource(&pdev->dev, res); > + rpm->ctrl_regs = rpm->status_regs + 0x400; > + rpm->req_regs = rpm->status_regs + 0x600; > + if (IS_ERR(rpm->status_regs)) > + return PTR_ERR(rpm->status_regs); You should probably do this _before_ using it above. > + syscon_np = of_parse_phandle(pdev->dev.of_node, "qcom,ipc", 0); > + if (!syscon_np) { > + dev_err(&pdev->dev, "no qcom,ipc node\n"); > + return -ENODEV; > + } > + > + rpm->ipc_regmap = syscon_node_to_regmap(syscon_np); > + if (IS_ERR(rpm->ipc_regmap)) > + return PTR_ERR(rpm->ipc_regmap); > + > + ret = of_property_read_u32_index(pdev->dev.of_node, "qcom,ipc", 1, > + &rpm->ipc_offset); > + if (ret < 0) { > + dev_err(&pdev->dev, "no offset in qcom,ipc\n"); > + return -EINVAL; > + } > + > + ret = of_property_read_u32_index(pdev->dev.of_node, "qcom,ipc", 2, > + &rpm->ipc_bit); > + if (ret < 0) { > + dev_err(&pdev->dev, "no bit in qcom,ipc\n"); > + return -EINVAL; > + } > + > + dev_set_drvdata(&pdev->dev, rpm); > + > + fw_version[0] = readl(RPM_STATUS_REG(rpm, 0)); > + fw_version[1] = readl(RPM_STATUS_REG(rpm, 1)); > + fw_version[2] = readl(RPM_STATUS_REG(rpm, 2)); > + if (fw_version[0] != rpm->data->version) { > + dev_err(&pdev->dev, > + "RPM version %u.%u.%u incompatible with driver version %u", > + fw_version[0], > + fw_version[1], > + fw_version[2], > + rpm->data->version); > + return -EFAULT; > + } > + > + dev_info(&pdev->dev, "RPM firmware %u.%u.%u\n", fw_version[0], > + fw_version[1], > + fw_version[2]); > + > + writel(fw_version[0], RPM_CTRL_REG(rpm, 0)); > + writel(fw_version[1], RPM_CTRL_REG(rpm, 1)); > + writel(fw_version[2], RPM_CTRL_REG(rpm, 2)); A comment documenting what this is doing would be helpful here. > + ret = devm_request_irq(&pdev->dev, > + irq_ack, > + qcom_rpm_ack_interrupt, > + IRQF_TRIGGER_RISING | IRQF_NO_SUSPEND, > + "qcom_rpm_ack", > + rpm); > + if (ret) { > + dev_err(&pdev->dev, "failed to request ack interrupt\n"); > + return ret; > + } > + > + ret = irq_set_irq_wake(irq_ack, 1); > + if (ret) > + dev_warn(&pdev->dev, "failed to mark ack irq as wakeup\n"); > + > + ret = devm_request_irq(&pdev->dev, > + irq_err, > + qcom_rpm_err_interrupt, > + IRQF_TRIGGER_RISING, > + "qcom_rpm_err", > + rpm); > + if (ret) { > + dev_err(&pdev->dev, "failed to request err interrupt\n"); > + return ret; > + } > + > + ret = devm_request_irq(&pdev->dev, > + irq_wakeup, > + qcom_rpm_wakeup_interrupt, > + IRQF_TRIGGER_RISING, > + "qcom_rpm_wakeup", > + rpm); > + if (ret) { > + dev_err(&pdev->dev, "failed to request wakeup interrupt\n"); > + return ret; > + } > + > + ret = irq_set_irq_wake(irq_wakeup, 1); > + if (ret) > + dev_warn(&pdev->dev, "failed to mark wakeup irq as wakeup\n"); > + > + return of_platform_populate(pdev->dev.of_node, NULL, NULL, &pdev->dev); > +} > + > +static int qcom_rpm_remove_child(struct device *dev, void *unused) > +{ > + platform_device_unregister(to_platform_device(dev)); > + return 0; > +} > + > +static int qcom_rpm_remove(struct platform_device *pdev) > +{ > + device_for_each_child(&pdev->dev, NULL, qcom_rpm_remove_child); of_platform_depopulate()? > + return 0; > +} > + > +static struct platform_driver qcom_rpm_driver = { > + .probe = qcom_rpm_probe, > + .remove = qcom_rpm_remove, > + .driver = { > + .name = "qcom_rpm", > + .owner = THIS_MODULE, Remove this line, it's taken care of for you. > + .of_match_table = qcom_rpm_of_match, > + }, > +}; > + > +static int __init qcom_rpm_init(void) > +{ > + return platform_driver_register(&qcom_rpm_driver); > +} > +arch_initcall(qcom_rpm_init); > + > +static void __exit qcom_rpm_exit(void) > +{ > + platform_driver_unregister(&qcom_rpm_driver); > +} > +module_exit(qcom_rpm_exit) > + > +MODULE_DESCRIPTION("Qualcomm Resource Power Manager driver"); > +MODULE_LICENSE("GPL v2"); No one authored this driver? > diff --git a/include/linux/mfd/qcom_rpm.h b/include/linux/mfd/qcom_rpm.h > new file mode 100644 > index 0000000..a52bc37 > --- /dev/null > +++ b/include/linux/mfd/qcom_rpm.h > @@ -0,0 +1,12 @@ > +#ifndef __QCOM_RPM_H__ > +#define __QCOM_RPM_H__ > + > +#include <linux/types.h> > + > +struct device; > +struct qcom_rpm; > + > +struct qcom_rpm *dev_get_qcom_rpm(struct device *dev); > +int qcom_rpm_write(struct qcom_rpm *rpm, int resource, u32 *buf, size_t count); > + > +#endif -- Lee Jones Linaro STMicroelectronics Landing Team Lead Linaro.org │ Open source software for ARM SoCs Follow Linaro: Facebook | Twitter | Blog -- To unsubscribe from this list: send the line "unsubscribe linux-arm-msm" in the body of a message to majordomo@xxxxxxxxxxxxxxx More majordomo info at http://vger.kernel.org/majordomo-info.html