Commit 410119ee authored by Fabien Dessenne's avatar Fabien Dessenne Committed by Bjorn Andersson
Browse files

remoteproc: stm32: wakeup the system by wdg irq 



If the device node defines the 'wakeup-source' property, use the WDG
exti IRQ as a wakeup source of the system.

Signed-off-by: default avatarFabien Dessenne <fabien.dessenne@st.com>
Link: https://lore.kernel.org/r/1566833923-16718-3-git-send-email-fabien.dessenne@st.com


[bjorn: Replace ifdef with __maybe_unused for suspend/resume functions]
Signed-off-by: default avatarBjorn Andersson <bjorn.andersson@linaro.org>
parent 14ea1d04

drivers/remoteproc/stm32_rproc.c

+45 −0
Original line number Diff line number Diff line
@@ -15,6 +15,7 @@ 
#include <linux/of_address.h>

#include <linux/of_device.h>

#include <linux/of_reserved_mem.h>

#include <linux/pm_wakeirq.h>

#include <linux/regmap.h>

#include <linux/remoteproc.h>

#include <linux/reset.h>
@@ -69,6 +70,7 @@ struct stm32_rproc { 
	struct reset_control *rst;

	struct stm32_syscon hold_boot;

	struct stm32_syscon pdds;

	int wdg_irq;

	u32 nb_rmems;

	struct stm32_rproc_mem *rmems;

	struct stm32_mbox mb[MBOX_NB_MBX];
@@ -546,6 +548,13 @@ static int stm32_rproc_parse_dt(struct platform_device *pdev) 
			return err;

		}



		ddata->wdg_irq = irq;



		if (of_property_read_bool(np, "wakeup-source")) {

			device_init_wakeup(dev, true);

			dev_pm_set_wake_irq(dev, irq);

		}



		dev_info(dev, "wdg irq registered\n");

	}
@@ -633,6 +642,10 @@ free_mb: 
free_wkq:

	destroy_workqueue(ddata->workqueue);

free_rproc:

	if (device_may_wakeup(dev)) {

		dev_pm_clear_wake_irq(dev);

		device_init_wakeup(dev, false);

	}

	rproc_free(rproc);

	return ret;

}
@@ -641,6 +654,7 @@ static int stm32_rproc_remove(struct platform_device *pdev) 
{

	struct rproc *rproc = platform_get_drvdata(pdev);

	struct stm32_rproc *ddata = rproc->priv;

	struct device *dev = &pdev->dev;



	if (atomic_read(&rproc->power) > 0)

		rproc_shutdown(rproc);
@@ -648,16 +662,47 @@ static int stm32_rproc_remove(struct platform_device *pdev) 
	rproc_del(rproc);

	stm32_rproc_free_mbox(rproc);

	destroy_workqueue(ddata->workqueue);



	if (device_may_wakeup(dev)) {

		dev_pm_clear_wake_irq(dev);

		device_init_wakeup(dev, false);

	}

	rproc_free(rproc);



	return 0;

}



static int __maybe_unused stm32_rproc_suspend(struct device *dev)

{

	struct rproc *rproc = dev_get_drvdata(dev);

	struct stm32_rproc *ddata = rproc->priv;



	if (device_may_wakeup(dev))

		return enable_irq_wake(ddata->wdg_irq);



	return 0;

}



static int __maybe_unused stm32_rproc_resume(struct device *dev)

{

	struct rproc *rproc = dev_get_drvdata(dev);

	struct stm32_rproc *ddata = rproc->priv;



	if (device_may_wakeup(dev))

		return disable_irq_wake(ddata->wdg_irq);



	return 0;

}



static SIMPLE_DEV_PM_OPS(stm32_rproc_pm_ops,

			 stm32_rproc_suspend, stm32_rproc_resume);



static struct platform_driver stm32_rproc_driver = {

	.probe = stm32_rproc_probe,

	.remove = stm32_rproc_remove,

	.driver = {

		.name = "stm32-rproc",

		.pm = &stm32_rproc_pm_ops,

		.of_match_table = of_match_ptr(stm32_rproc_match),

	},

};

CRA Git | Maintained and supported by SUSTech CRA and CCSE