Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 12149a20 authored by Thomas Petazzoni's avatar Thomas Petazzoni Committed by Linus Walleij
Browse files

pinctrl: mvebu: add suspend/resume support to Armada XP pinctrl driver 



This commit adds suspend/resume support to the Armada XP pinctrl
driver, by simply saving and restoring the MPP registers.

Signed-off-by: default avatarThomas Petazzoni <thomas.petazzoni@free-electrons.com>
Signed-off-by: default avatarLinus Walleij <linus.walleij@linaro.org>
parent a8381fac

drivers/pinctrl/mvebu/pinctrl-armada-xp.c

+40 −0
Original line number Diff line number Diff line
@@ -34,6 +34,7 @@ 
#include "pinctrl-mvebu.h"



static void __iomem *mpp_base;

static u32 *mpp_saved_regs;



static int armada_xp_mpp_ctrl_get(unsigned pid, unsigned long *config)

{
@@ -406,12 +407,42 @@ static struct pinctrl_gpio_range mv78460_mpp_gpio_ranges[] = { 
	MPP_GPIO_RANGE(2,  64, 64,  3),

};



static int armada_xp_pinctrl_suspend(struct platform_device *pdev,

				     pm_message_t state)

{

	struct mvebu_pinctrl_soc_info *soc =

		platform_get_drvdata(pdev);

	int i, nregs;



	nregs = DIV_ROUND_UP(soc->nmodes, MVEBU_MPPS_PER_REG);



	for (i = 0; i < nregs; i++)

		mpp_saved_regs[i] = readl(mpp_base + i * 4);



	return 0;

}



static int armada_xp_pinctrl_resume(struct platform_device *pdev)

{

	struct mvebu_pinctrl_soc_info *soc =

		platform_get_drvdata(pdev);

	int i, nregs;



	nregs = DIV_ROUND_UP(soc->nmodes, MVEBU_MPPS_PER_REG);



	for (i = 0; i < nregs; i++)

		writel(mpp_saved_regs[i], mpp_base + i * 4);



	return 0;

}



static int armada_xp_pinctrl_probe(struct platform_device *pdev)

{

	struct mvebu_pinctrl_soc_info *soc = &armada_xp_pinctrl_info;

	const struct of_device_id *match =

		of_match_device(armada_xp_pinctrl_of_match, &pdev->dev);

	struct resource *res;

	int nregs;



	if (!match)

		return -ENODEV;
@@ -459,6 +490,13 @@ static int armada_xp_pinctrl_probe(struct platform_device *pdev) 
		break;

	}



	nregs = DIV_ROUND_UP(soc->nmodes, MVEBU_MPPS_PER_REG);



	mpp_saved_regs = devm_kmalloc(&pdev->dev, nregs * sizeof(u32),

				      GFP_KERNEL);

	if (!mpp_saved_regs)

		return -ENOMEM;



	pdev->dev.platform_data = soc;



	return mvebu_pinctrl_probe(pdev);
@@ -476,6 +514,8 @@ static struct platform_driver armada_xp_pinctrl_driver = { 
	},

	.probe = armada_xp_pinctrl_probe,

	.remove = armada_xp_pinctrl_remove,

	.suspend = armada_xp_pinctrl_suspend,

	.resume = armada_xp_pinctrl_resume,

};



module_platform_driver(armada_xp_pinctrl_driver);