634 lines
17 KiB
Diff
634 lines
17 KiB
Diff
From 69ed3aa4864f05afff66ffd7596de3b45d739360 Mon Sep 17 00:00:00 2001
|
|
From: Romuald JEANNE <romuald.jeanne@st.com>
|
|
Date: Thu, 3 Nov 2022 15:55:56 +0100
|
|
Subject: [PATCH 12/22] v5.15-stm32mp-r2 MFD
|
|
|
|
Signed-off-by: Romuald JEANNE <romuald.jeanne@st.com>
|
|
---
|
|
.../bindings/mfd/st,stm32-lptimer.yaml | 3 +
|
|
.../bindings/mfd/st,stm32mp1-pwr.txt | 57 +++
|
|
drivers/mfd/Kconfig | 10 +
|
|
drivers/mfd/Makefile | 1 +
|
|
drivers/mfd/stm32-pwr.c | 423 ++++++++++++++++++
|
|
drivers/mfd/stmfx.c | 2 -
|
|
drivers/mfd/stpmic1.c | 6 +
|
|
drivers/mfd/wm8994-core.c | 6 +
|
|
include/linux/mfd/stm32-timers.h | 1 +
|
|
9 files changed, 507 insertions(+), 2 deletions(-)
|
|
create mode 100644 Documentation/devicetree/bindings/mfd/st,stm32mp1-pwr.txt
|
|
create mode 100644 drivers/mfd/stm32-pwr.c
|
|
|
|
diff --git a/Documentation/devicetree/bindings/mfd/st,stm32-lptimer.yaml b/Documentation/devicetree/bindings/mfd/st,stm32-lptimer.yaml
|
|
index 8bcea8dd7d90..6e518ae12e7f 100644
|
|
--- a/Documentation/devicetree/bindings/mfd/st,stm32-lptimer.yaml
|
|
+++ b/Documentation/devicetree/bindings/mfd/st,stm32-lptimer.yaml
|
|
@@ -44,6 +44,9 @@ properties:
|
|
|
|
wakeup-source: true
|
|
|
|
+ power-domains:
|
|
+ maxItems: 1
|
|
+
|
|
pwm:
|
|
type: object
|
|
|
|
diff --git a/Documentation/devicetree/bindings/mfd/st,stm32mp1-pwr.txt b/Documentation/devicetree/bindings/mfd/st,stm32mp1-pwr.txt
|
|
new file mode 100644
|
|
index 000000000000..b5f414a19120
|
|
--- /dev/null
|
|
+++ b/Documentation/devicetree/bindings/mfd/st,stm32mp1-pwr.txt
|
|
@@ -0,0 +1,57 @@
|
|
+STMicroelectronics STM32MP1 Power Management Controller
|
|
+=======================================================
|
|
+
|
|
+The PWR IP is responsible for handling the power related resources such as
|
|
+clocks, power supplies and resets. It provides 6 wake-up pins that are handled
|
|
+by an interrupt-controller. Wake-up pin can be used to wake-up from STANDBY SoC state.
|
|
+
|
|
+Required properties:
|
|
+- compatible should be: "st,stm32mp1-pwr"
|
|
+- reg: should be register base and length as documented in the
|
|
+ datasheet
|
|
+- interrupts: contains the reference to the gic wake-up pin interrupt
|
|
+- interrupt-controller; Enable interrupt controller for wake-up pins.
|
|
+- #interrupt-cells = <3>
|
|
+- st,wakeup-pins: contains a list of GPIO spec describing each wake-up pin.
|
|
+
|
|
+Optional Properties:
|
|
+- pwr-supply: main soc power supply
|
|
+
|
|
+Interrupt consumers have to specify 3 cells:
|
|
+ - cell 1: wake-up pin id from 0 to 5
|
|
+ - cell 2: IRQ_TYPE_EDGE_FALLING or IRQ_TYPE_EDGE_RISING
|
|
+ - cell 3: Pull config: 0 = No Pull, 1=Pull Up, 2=Pull Down
|
|
+
|
|
+
|
|
+Example:
|
|
+
|
|
+ pwr: pwr@50001000 {
|
|
+ compatible = "st,stm32mp1-pwr", "simple-mfd";
|
|
+ reg = <0x50001000 0x400>;
|
|
+ interrupts = <GIC_SPI 149 IRQ_TYPE_NONE>;
|
|
+ interrupt-controller;
|
|
+ #interrupt-cells = <3>;
|
|
+
|
|
+ st,wakeup-pins = <&gpioa 0 0>, <&gpioa 2 0>,
|
|
+ <&gpioc 13 0>, <&gpioi 8 0>,
|
|
+ <&gpioi 11 0>, <&gpioc 1 0>;
|
|
+
|
|
+ pwr-supply = <&vdd>;
|
|
+ };
|
|
+
|
|
+
|
|
+Example of interrupt user:
|
|
+gpio_keys {
|
|
+ compatible = "gpio-keys";
|
|
+ #address-cells = <1>;
|
|
+ #size-cells = <0>;
|
|
+
|
|
+ button@4 {
|
|
+ label = "WakeUp4";
|
|
+ linux,code = <BTN_4>;
|
|
+ interrupt-parent = <&pwr>;
|
|
+ interrupts = <3 IRQ_TYPE_EDGE_FALLING 1>;
|
|
+ wakeup-source;
|
|
+ };
|
|
+};
|
|
+
|
|
diff --git a/drivers/mfd/Kconfig b/drivers/mfd/Kconfig
|
|
index d2f345245538..181730a693a1 100644
|
|
--- a/drivers/mfd/Kconfig
|
|
+++ b/drivers/mfd/Kconfig
|
|
@@ -2042,6 +2042,16 @@ config MFD_STPMIC1
|
|
To compile this driver as a module, choose M here: the
|
|
module will be called stpmic1.
|
|
|
|
+config MFD_STM32MP1_PWR
|
|
+ bool "STM32MP1 wake-up pins"
|
|
+ depends on MACH_STM32MP157
|
|
+ default y
|
|
+ help
|
|
+ Select this option to enable STM32 PWR Wake-up pins driver.
|
|
+
|
|
+ This driver provides interruptions that can be used to wake-up from
|
|
+ suspend.
|
|
+
|
|
config MFD_STMFX
|
|
tristate "Support for STMicroelectronics Multi-Function eXpander (STMFX)"
|
|
depends on I2C
|
|
diff --git a/drivers/mfd/Makefile b/drivers/mfd/Makefile
|
|
index 2ba6646e874c..68201ea8e037 100644
|
|
--- a/drivers/mfd/Makefile
|
|
+++ b/drivers/mfd/Makefile
|
|
@@ -255,6 +255,7 @@ obj-$(CONFIG_MFD_SUN4I_GPADC) += sun4i-gpadc.o
|
|
|
|
obj-$(CONFIG_MFD_STM32_LPTIMER) += stm32-lptimer.o
|
|
obj-$(CONFIG_MFD_STM32_TIMERS) += stm32-timers.o
|
|
+obj-$(CONFIG_MFD_STM32MP1_PWR) += stm32-pwr.o
|
|
obj-$(CONFIG_MFD_MXS_LRADC) += mxs-lradc.o
|
|
obj-$(CONFIG_MFD_SC27XX_PMIC) += sprd-sc27xx-spi.o
|
|
obj-$(CONFIG_RAVE_SP_CORE) += rave-sp.o
|
|
diff --git a/drivers/mfd/stm32-pwr.c b/drivers/mfd/stm32-pwr.c
|
|
new file mode 100644
|
|
index 000000000000..c06e2fb6c0eb
|
|
--- /dev/null
|
|
+++ b/drivers/mfd/stm32-pwr.c
|
|
@@ -0,0 +1,423 @@
|
|
+// SPDX-License-Identifier: GPL-2.0
|
|
+/*
|
|
+ * Copyright (C) STMicroelectronics 2017 - All Rights Reserved
|
|
+ * Author: Pascal Paillet <p.paillet@st.com> for STMicroelectronics.
|
|
+ */
|
|
+
|
|
+#include <linux/arm-smccc.h>
|
|
+#include <linux/gpio.h>
|
|
+#include <linux/gpio/consumer.h>
|
|
+#include <linux/irqchip.h>
|
|
+#include <linux/irqchip/chained_irq.h>
|
|
+#include <linux/module.h>
|
|
+#include <linux/of_address.h>
|
|
+#include <linux/of_gpio.h>
|
|
+#include <linux/of_irq.h>
|
|
+#include <linux/platform_device.h>
|
|
+#include <asm/exception.h>
|
|
+
|
|
+#define NB_WAKEUPPINS 6
|
|
+
|
|
+#define STM32_SVC_PWR 0x82001001
|
|
+#define STM32_WRITE 0x1
|
|
+#define STM32_SET_BITS 0x2
|
|
+#define STM32_CLEAR_BITS 0x3
|
|
+
|
|
+#define PWR_WKUP_OFFSET 0x20
|
|
+// PWR Registers
|
|
+#define WKUPCR 0x0
|
|
+#define WKUPFR 0x4
|
|
+#define MPUWKUPENR 0x8
|
|
+
|
|
+#define WKUP_FLAGS_MASK GENMASK(5, 0)
|
|
+
|
|
+// WKUPCR bits definition
|
|
+#define WKUP_EDGE_SHIFT 8
|
|
+#define WKUP_PULL_SHIFT 16
|
|
+#define WKUP_PULL_MASK GENMASK(1, 0)
|
|
+
|
|
+enum wkup_pull_setting {
|
|
+ WKUP_NO_PULL = 0,
|
|
+ WKUP_PULL_UP,
|
|
+ WKUP_PULL_DOWN,
|
|
+ WKUP_PULL_RESERVED
|
|
+};
|
|
+
|
|
+#define SMC(class, op, offset, val) do { \
|
|
+ struct arm_smccc_res res; \
|
|
+ arm_smccc_smc(class, op, PWR_WKUP_OFFSET + (offset), val, \
|
|
+ 0, 0, 0, 0, &res); \
|
|
+} while (0) \
|
|
+
|
|
+struct stm32_pwr_data {
|
|
+ struct device *dev;
|
|
+ void __iomem *base; /* IO Memory base address */
|
|
+ struct irq_domain *domain; /* Domain for this controller */
|
|
+ int irq; /* Parent interrupt */
|
|
+ u32 masked; /* IRQ is masked */
|
|
+ u32 wake; /* IRQ is wake on */
|
|
+ u32 pending; /* IRQ has been received while wake on*/
|
|
+ int gpio[NB_WAKEUPPINS];
|
|
+};
|
|
+
|
|
+static void stm32_pwr_irq_ack(struct irq_data *d)
|
|
+{
|
|
+ struct stm32_pwr_data *priv = d->domain->host_data;
|
|
+
|
|
+ dev_dbg(priv->dev, "irq:%lu\n", d->hwirq);
|
|
+ SMC(STM32_SVC_PWR, STM32_SET_BITS, WKUPCR, BIT(d->hwirq));
|
|
+}
|
|
+
|
|
+static void stm32_pwr_irq_set_state(struct irq_data *d)
|
|
+{
|
|
+ struct stm32_pwr_data *priv = d->domain->host_data;
|
|
+
|
|
+ dev_dbg(priv->dev, "irq:%lu\n", d->hwirq);
|
|
+
|
|
+ /* enable is not masker or wake enabled */
|
|
+ if (!(priv->masked & BIT(d->hwirq)) || (priv->wake & BIT(d->hwirq)))
|
|
+ SMC(STM32_SVC_PWR, STM32_SET_BITS, MPUWKUPENR, BIT(d->hwirq));
|
|
+ else
|
|
+ SMC(STM32_SVC_PWR, STM32_CLEAR_BITS, MPUWKUPENR, BIT(d->hwirq));
|
|
+}
|
|
+
|
|
+static void stm32_pwr_irq_mask(struct irq_data *d)
|
|
+{
|
|
+ struct stm32_pwr_data *priv = d->domain->host_data;
|
|
+
|
|
+ dev_dbg(priv->dev, "irq:%lu\n", d->hwirq);
|
|
+ priv->masked |= BIT(d->hwirq);
|
|
+ stm32_pwr_irq_set_state(d);
|
|
+}
|
|
+
|
|
+static void stm32_pwr_irq_unmask(struct irq_data *d)
|
|
+{
|
|
+ struct stm32_pwr_data *priv = d->domain->host_data;
|
|
+
|
|
+ dev_dbg(priv->dev, "irq:%lu\n", d->hwirq);
|
|
+ priv->masked &= ~BIT(d->hwirq);
|
|
+ stm32_pwr_irq_set_state(d);
|
|
+}
|
|
+
|
|
+static int stm32_pwr_irq_set_wake(struct irq_data *d, unsigned int on)
|
|
+{
|
|
+ struct stm32_pwr_data *priv = d->domain->host_data;
|
|
+ struct irq_data *parent = irq_get_irq_data(priv->irq);
|
|
+
|
|
+ dev_dbg(priv->dev, "irq:%lu on:%d\n", d->hwirq, on);
|
|
+ if (on) {
|
|
+ priv->wake |= BIT(d->hwirq);
|
|
+ } else {
|
|
+ priv->wake &= ~BIT(d->hwirq);
|
|
+ priv->pending &= ~BIT(d->hwirq);
|
|
+ }
|
|
+ stm32_pwr_irq_set_state(d);
|
|
+
|
|
+ if (parent->chip && parent->chip->irq_set_wake)
|
|
+ return parent->chip->irq_set_wake(parent, on);
|
|
+
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+static int stm32_pwr_irq_set_type(struct irq_data *d, unsigned int flow_type)
|
|
+{
|
|
+ struct stm32_pwr_data *priv = d->domain->host_data;
|
|
+ int pin_id = d->hwirq;
|
|
+ u32 wkupcr;
|
|
+ int en;
|
|
+
|
|
+ dev_dbg(priv->dev, "irq:%lu\n", d->hwirq);
|
|
+
|
|
+ en = readl_relaxed(priv->base + MPUWKUPENR) & BIT(pin_id);
|
|
+ /* reference manual request to disable the wakeup pin while
|
|
+ * changing the edge detection setting
|
|
+ */
|
|
+ if (en)
|
|
+ stm32_pwr_irq_mask(d);
|
|
+
|
|
+ wkupcr = readl_relaxed(priv->base + WKUPCR);
|
|
+ switch (flow_type & IRQ_TYPE_SENSE_MASK) {
|
|
+ case IRQF_TRIGGER_FALLING:
|
|
+ wkupcr |= (1 << (WKUP_EDGE_SHIFT + pin_id));
|
|
+ break;
|
|
+ case IRQF_TRIGGER_RISING:
|
|
+ wkupcr &= ~(1 << (WKUP_EDGE_SHIFT + pin_id));
|
|
+ break;
|
|
+ default:
|
|
+ return -EINVAL;
|
|
+ }
|
|
+
|
|
+ SMC(STM32_SVC_PWR, STM32_WRITE, WKUPCR, wkupcr);
|
|
+
|
|
+ if (en)
|
|
+ stm32_pwr_irq_unmask(d);
|
|
+
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+#ifdef CONFIG_SMP
|
|
+static int stm32_pwr_set_affinity_parent(struct irq_data *data,
|
|
+ const struct cpumask *dest, bool force)
|
|
+{
|
|
+ struct stm32_pwr_data *priv = data->domain->host_data;
|
|
+ struct irq_data *parent = irq_get_irq_data(priv->irq);
|
|
+
|
|
+ irq_data_update_effective_affinity(data, dest);
|
|
+
|
|
+ if (parent->chip && parent->chip->irq_set_affinity)
|
|
+ return parent->chip->irq_set_affinity(parent, dest, force);
|
|
+
|
|
+ return IRQ_SET_MASK_OK_DONE;
|
|
+}
|
|
+#endif
|
|
+
|
|
+static int stm32_pwr_irq_request_resources(struct irq_data *d)
|
|
+{
|
|
+ struct stm32_pwr_data *priv = d->domain->host_data;
|
|
+ struct device_node *dn = priv->dev->of_node;
|
|
+ int gpio;
|
|
+ int ret;
|
|
+
|
|
+ if (!dn) {
|
|
+ dev_err(priv->dev, "No platform data\n");
|
|
+ return -ENODEV;
|
|
+ }
|
|
+
|
|
+ /* Get GPIO from device tree */
|
|
+ dev_dbg(priv->dev, "irq:%lu\n", d->hwirq);
|
|
+ gpio = of_get_named_gpio(dn, "st,wakeup-pins", d->hwirq);
|
|
+
|
|
+ if (gpio < 0) {
|
|
+ dev_err(priv->dev, "Failed to get wakeup gpio: %d", gpio);
|
|
+ return gpio;
|
|
+ }
|
|
+
|
|
+ /* GPIO request and configuration */
|
|
+ ret = devm_gpio_request_one(priv->dev, gpio, GPIOF_DIR_IN,
|
|
+ "wake-up pin");
|
|
+ if (ret) {
|
|
+ dev_err(priv->dev, "Failed to request wake-up pin\n");
|
|
+ return -ENODEV;
|
|
+ }
|
|
+
|
|
+ priv->gpio[d->hwirq] = gpio;
|
|
+
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+static void stm32_pwr_irq_release_resources(struct irq_data *d)
|
|
+{
|
|
+ struct stm32_pwr_data *priv = d->domain->host_data;
|
|
+
|
|
+ dev_dbg(priv->dev, "irq:%lu\n", d->hwirq);
|
|
+ devm_gpio_free(priv->dev, priv->gpio[d->hwirq]);
|
|
+}
|
|
+
|
|
+static struct irq_chip stm32_pwr_irq_chip = {
|
|
+ .name = "stm32-pwr-irq",
|
|
+ .irq_ack = stm32_pwr_irq_ack,
|
|
+ .irq_mask = stm32_pwr_irq_mask,
|
|
+ .irq_unmask = stm32_pwr_irq_unmask,
|
|
+ .irq_set_type = stm32_pwr_irq_set_type,
|
|
+ .irq_set_wake = stm32_pwr_irq_set_wake,
|
|
+ .irq_request_resources = stm32_pwr_irq_request_resources,
|
|
+ .irq_release_resources = stm32_pwr_irq_release_resources,
|
|
+#ifdef CONFIG_SMP
|
|
+ .irq_set_affinity = stm32_pwr_set_affinity_parent,
|
|
+#endif
|
|
+};
|
|
+
|
|
+static int stm32_pwr_irq_set_pull_config(struct irq_domain *d, int pin_id,
|
|
+ enum wkup_pull_setting config)
|
|
+{
|
|
+ struct stm32_pwr_data *priv = d->host_data;
|
|
+ u32 wkupcr;
|
|
+
|
|
+ dev_dbg(priv->dev, "irq:%d pull config:0x%x\n", pin_id, config);
|
|
+
|
|
+ if (config >= WKUP_PULL_RESERVED) {
|
|
+ pr_err("%s: bad irq pull config\n", __func__);
|
|
+ return -EINVAL;
|
|
+ }
|
|
+
|
|
+ wkupcr = readl_relaxed(priv->base + WKUPCR);
|
|
+ wkupcr &= ~((WKUP_PULL_MASK) << (WKUP_PULL_SHIFT + pin_id * 2));
|
|
+ wkupcr |= (config & WKUP_PULL_MASK) << (WKUP_PULL_SHIFT + pin_id * 2);
|
|
+
|
|
+ SMC(STM32_SVC_PWR, STM32_WRITE, WKUPCR, wkupcr);
|
|
+
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+static int stm32_pwr_xlate(struct irq_domain *d, struct device_node *ctrlr,
|
|
+ const u32 *intspec, unsigned int intsize,
|
|
+ irq_hw_number_t *out_hwirq, unsigned int *out_type)
|
|
+{
|
|
+ if (WARN_ON(intsize < 3)) {
|
|
+ pr_err("%s: bad irq config parameters\n", __func__);
|
|
+ return -EINVAL;
|
|
+ }
|
|
+
|
|
+ *out_hwirq = intspec[0];
|
|
+ *out_type = intspec[1] & (IRQ_TYPE_SENSE_MASK);
|
|
+
|
|
+ return stm32_pwr_irq_set_pull_config(d, intspec[0], intspec[2]);
|
|
+}
|
|
+
|
|
+static int stm32_pwr_alloc(struct irq_domain *d, unsigned int virq,
|
|
+ unsigned int nr_irqs, void *data)
|
|
+{
|
|
+ struct irq_fwspec *fwspec = data;
|
|
+ irq_hw_number_t hwirq;
|
|
+
|
|
+ hwirq = fwspec->param[0];
|
|
+ irq_domain_set_info(d, virq, hwirq, &stm32_pwr_irq_chip, d->host_data,
|
|
+ handle_edge_irq, NULL, NULL);
|
|
+
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+static const struct irq_domain_ops stm32_pwr_irq_domain_ops = {
|
|
+ .alloc = stm32_pwr_alloc,
|
|
+ .xlate = stm32_pwr_xlate,
|
|
+ .free = irq_domain_free_irqs_common,
|
|
+};
|
|
+
|
|
+/*
|
|
+ * Handler for the cascaded IRQ.
|
|
+ */
|
|
+static void stm32_pwr_handle_irq(struct irq_desc *desc)
|
|
+{
|
|
+ struct stm32_pwr_data *priv = irq_desc_get_handler_data(desc);
|
|
+ struct irq_chip *chip = irq_desc_get_chip(desc);
|
|
+ u32 wkupfr, wkupenr, i;
|
|
+
|
|
+ chained_irq_enter(chip, desc);
|
|
+
|
|
+ wkupfr = readl_relaxed(priv->base + WKUPFR);
|
|
+ wkupenr = readl_relaxed(priv->base + MPUWKUPENR);
|
|
+
|
|
+ for (i = 0; i < NB_WAKEUPPINS; i++) {
|
|
+ if ((wkupfr & BIT(i)) && (wkupenr & BIT(i))) {
|
|
+ struct irq_desc *d;
|
|
+
|
|
+ d = irq_to_desc(irq_find_mapping(priv->domain, i));
|
|
+
|
|
+ if (priv->wake & BIT(i)) {
|
|
+ dev_dbg(priv->dev,
|
|
+ "irq %d while wake enabled\n", i);
|
|
+ priv->pending |= BIT(i);
|
|
+ }
|
|
+
|
|
+ dev_dbg(priv->dev, "handle wkup irq:%d\n", i);
|
|
+ handle_edge_irq(d);
|
|
+ }
|
|
+ }
|
|
+ chained_irq_exit(chip, desc);
|
|
+}
|
|
+
|
|
+static int __maybe_unused stm32_pwr_suspend(struct device *dev)
|
|
+{
|
|
+ struct stm32_pwr_data *priv = dev_get_drvdata(dev);
|
|
+
|
|
+ pr_debug("suspend");
|
|
+ if (priv->pending != 0)
|
|
+ return -EBUSY;
|
|
+
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+static const struct dev_pm_ops stm32_pwr_pm = {
|
|
+ SET_NOIRQ_SYSTEM_SLEEP_PM_OPS(stm32_pwr_suspend, NULL)
|
|
+};
|
|
+
|
|
+static int stm32_pwr_probe(struct platform_device *pdev)
|
|
+{
|
|
+ struct device *dev = &pdev->dev;
|
|
+ struct stm32_pwr_data *priv;
|
|
+ struct device_node *np = dev->of_node;
|
|
+ struct resource *res;
|
|
+ int ret;
|
|
+
|
|
+ priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
|
|
+ if (!priv)
|
|
+ return -ENOMEM;
|
|
+ priv->dev = dev;
|
|
+ dev_set_drvdata(dev, priv);
|
|
+
|
|
+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
|
|
+ priv->base = devm_ioremap_resource(dev, res);
|
|
+ if (IS_ERR(priv->base)) {
|
|
+ dev_err(dev, "Unable to map registers\n");
|
|
+ return PTR_ERR(priv->base);
|
|
+ }
|
|
+
|
|
+ /* Disable all wake-up pins */
|
|
+ SMC(STM32_SVC_PWR, STM32_WRITE, MPUWKUPENR, 0);
|
|
+ /* Clear all interrupts flags */
|
|
+ SMC(STM32_SVC_PWR, STM32_SET_BITS, WKUPCR, WKUP_FLAGS_MASK);
|
|
+
|
|
+ priv->domain = irq_domain_add_linear(np, NB_WAKEUPPINS,
|
|
+ &stm32_pwr_irq_domain_ops, priv);
|
|
+ if (!priv->domain) {
|
|
+ dev_err(dev, "%s: Unable to add irq domain!\n", __func__);
|
|
+ ret = -ENOMEM;
|
|
+ goto out;
|
|
+ }
|
|
+
|
|
+ ret = irq_of_parse_and_map(np, 0);
|
|
+ if (ret < 0) {
|
|
+ dev_err(dev, "failed to get PWR IRQ\n");
|
|
+ ret = priv->irq;
|
|
+ goto out_domain;
|
|
+ }
|
|
+
|
|
+ priv->irq = ret;
|
|
+ irq_set_chained_handler_and_data(priv->irq, stm32_pwr_handle_irq, priv);
|
|
+
|
|
+ of_node_clear_flag(np, OF_POPULATED);
|
|
+
|
|
+ return 0;
|
|
+
|
|
+out_domain:
|
|
+ irq_domain_remove(priv->domain);
|
|
+out:
|
|
+ return ret;
|
|
+}
|
|
+
|
|
+static int stm32_pwr_remove(struct platform_device *pdev)
|
|
+{
|
|
+ struct stm32_pwr_data *priv = dev_get_drvdata(&pdev->dev);
|
|
+
|
|
+ irq_domain_remove(priv->domain);
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+static const struct of_device_id stm32_pwr_ids[] = {
|
|
+ { .compatible = "st,stm32mp1-pwr", },
|
|
+ {},
|
|
+};
|
|
+MODULE_DEVICE_TABLE(of, stm32_pwr_ids);
|
|
+
|
|
+static struct platform_driver stm32_pwr_driver = {
|
|
+ .probe = stm32_pwr_probe,
|
|
+ .remove = stm32_pwr_remove,
|
|
+ .driver = {
|
|
+ .name = "stm32_pwr",
|
|
+ .of_match_table = stm32_pwr_ids,
|
|
+ .pm = &stm32_pwr_pm,
|
|
+ },
|
|
+};
|
|
+
|
|
+static int __init stm32_pwr_init(void)
|
|
+{
|
|
+ return platform_driver_register(&stm32_pwr_driver);
|
|
+}
|
|
+
|
|
+static void __exit stm32_pwr_exit(void)
|
|
+{
|
|
+ return platform_driver_unregister(&stm32_pwr_driver);
|
|
+}
|
|
+
|
|
+arch_initcall(stm32_pwr_init);
|
|
+module_exit(stm32_pwr_exit);
|
|
diff --git a/drivers/mfd/stmfx.c b/drivers/mfd/stmfx.c
|
|
index e095a3930142..b411d2958c18 100644
|
|
--- a/drivers/mfd/stmfx.c
|
|
+++ b/drivers/mfd/stmfx.c
|
|
@@ -81,13 +81,11 @@ static struct mfd_cell stmfx_cells[] = {
|
|
.num_resources = ARRAY_SIZE(stmfx_pinctrl_resources),
|
|
},
|
|
{
|
|
- .of_compatible = "st,stmfx-0300-idd",
|
|
.name = "stmfx-idd",
|
|
.resources = stmfx_idd_resources,
|
|
.num_resources = ARRAY_SIZE(stmfx_idd_resources),
|
|
},
|
|
{
|
|
- .of_compatible = "st,stmfx-0300-ts",
|
|
.name = "stmfx-ts",
|
|
.resources = stmfx_ts_resources,
|
|
.num_resources = ARRAY_SIZE(stmfx_ts_resources),
|
|
diff --git a/drivers/mfd/stpmic1.c b/drivers/mfd/stpmic1.c
|
|
index eb3da558c3fb..40eef5d18b90 100644
|
|
--- a/drivers/mfd/stpmic1.c
|
|
+++ b/drivers/mfd/stpmic1.c
|
|
@@ -170,6 +170,9 @@ static int stpmic1_suspend(struct device *dev)
|
|
|
|
disable_irq(pmic_dev->irq);
|
|
|
|
+ if (device_may_wakeup(dev))
|
|
+ enable_irq_wake(pmic_dev->irq);
|
|
+
|
|
return 0;
|
|
}
|
|
|
|
@@ -183,6 +186,9 @@ static int stpmic1_resume(struct device *dev)
|
|
if (ret)
|
|
return ret;
|
|
|
|
+ if (device_may_wakeup(dev))
|
|
+ disable_irq_wake(pmic_dev->irq);
|
|
+
|
|
enable_irq(pmic_dev->irq);
|
|
|
|
return 0;
|
|
diff --git a/drivers/mfd/wm8994-core.c b/drivers/mfd/wm8994-core.c
|
|
index 7b1d270722ba..e2c98c66bf9f 100644
|
|
--- a/drivers/mfd/wm8994-core.c
|
|
+++ b/drivers/mfd/wm8994-core.c
|
|
@@ -185,6 +185,12 @@ static int wm8994_resume(struct device *dev)
|
|
if (!wm8994->suspended)
|
|
return 0;
|
|
|
|
+ /*
|
|
+ * LDO1/2 minimum cycle time is 36ms according to codec specification
|
|
+ * Wait before enabling regulator to make sure we fit this requirement
|
|
+ */
|
|
+ msleep(40);
|
|
+
|
|
ret = regulator_bulk_enable(wm8994->num_supplies,
|
|
wm8994->supplies);
|
|
if (ret != 0) {
|
|
diff --git a/include/linux/mfd/stm32-timers.h b/include/linux/mfd/stm32-timers.h
|
|
index f8db83aedb2b..f48f04dc4187 100644
|
|
--- a/include/linux/mfd/stm32-timers.h
|
|
+++ b/include/linux/mfd/stm32-timers.h
|
|
@@ -31,6 +31,7 @@
|
|
#define TIM_BDTR 0x44 /* Break and Dead-Time Reg */
|
|
#define TIM_DCR 0x48 /* DMA control register */
|
|
#define TIM_DMAR 0x4C /* DMA register for transfer */
|
|
+#define TIM_TISEL 0x68 /* Input Selection */
|
|
|
|
#define TIM_CR1_CEN BIT(0) /* Counter Enable */
|
|
#define TIM_CR1_DIR BIT(4) /* Counter Direction */
|
|
--
|
|
2.17.1
|
|
|