forked from Minki/linux
2874c5fd28
Based on 1 normalized pattern(s): this program is free software you can redistribute it and or modify it under the terms of the gnu general public license as published by the free software foundation either version 2 of the license or at your option any later version extracted by the scancode license scanner the SPDX license identifier GPL-2.0-or-later has been chosen to replace the boilerplate/reference in 3029 file(s). Signed-off-by: Thomas Gleixner <tglx@linutronix.de> Reviewed-by: Allison Randal <allison@lohutok.net> Cc: linux-spdx@vger.kernel.org Link: https://lkml.kernel.org/r/20190527070032.746973796@linutronix.de Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
85 lines
1.7 KiB
C
85 lines
1.7 KiB
C
// SPDX-License-Identifier: GPL-2.0-or-later
|
|
/*
|
|
* Suspend/resume support
|
|
*
|
|
* Copyright 2009 MontaVista Software, Inc.
|
|
*
|
|
* Author: Anton Vorontsov <avorontsov@ru.mvista.com>
|
|
*/
|
|
|
|
#include <linux/init.h>
|
|
#include <linux/types.h>
|
|
#include <linux/errno.h>
|
|
#include <linux/export.h>
|
|
#include <linux/suspend.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/device.h>
|
|
#include <linux/of_address.h>
|
|
#include <linux/of_platform.h>
|
|
|
|
struct pmc_regs {
|
|
__be32 devdisr;
|
|
__be32 devdisr2;
|
|
__be32 :32;
|
|
__be32 :32;
|
|
__be32 pmcsr;
|
|
#define PMCSR_SLP (1 << 17)
|
|
};
|
|
|
|
static struct device *pmc_dev;
|
|
static struct pmc_regs __iomem *pmc_regs;
|
|
|
|
static int pmc_suspend_enter(suspend_state_t state)
|
|
{
|
|
int ret;
|
|
|
|
setbits32(&pmc_regs->pmcsr, PMCSR_SLP);
|
|
/* At this point, the CPU is asleep. */
|
|
|
|
/* Upon resume, wait for SLP bit to be clear. */
|
|
ret = spin_event_timeout((in_be32(&pmc_regs->pmcsr) & PMCSR_SLP) == 0,
|
|
10000, 10) ? 0 : -ETIMEDOUT;
|
|
if (ret)
|
|
dev_err(pmc_dev, "tired waiting for SLP bit to clear\n");
|
|
return ret;
|
|
}
|
|
|
|
static int pmc_suspend_valid(suspend_state_t state)
|
|
{
|
|
if (state != PM_SUSPEND_STANDBY)
|
|
return 0;
|
|
return 1;
|
|
}
|
|
|
|
static const struct platform_suspend_ops pmc_suspend_ops = {
|
|
.valid = pmc_suspend_valid,
|
|
.enter = pmc_suspend_enter,
|
|
};
|
|
|
|
static int pmc_probe(struct platform_device *ofdev)
|
|
{
|
|
pmc_regs = of_iomap(ofdev->dev.of_node, 0);
|
|
if (!pmc_regs)
|
|
return -ENOMEM;
|
|
|
|
pmc_dev = &ofdev->dev;
|
|
suspend_set_ops(&pmc_suspend_ops);
|
|
return 0;
|
|
}
|
|
|
|
static const struct of_device_id pmc_ids[] = {
|
|
{ .compatible = "fsl,mpc8548-pmc", },
|
|
{ .compatible = "fsl,mpc8641d-pmc", },
|
|
{ },
|
|
};
|
|
|
|
static struct platform_driver pmc_driver = {
|
|
.driver = {
|
|
.name = "fsl-pmc",
|
|
.of_match_table = pmc_ids,
|
|
},
|
|
.probe = pmc_probe,
|
|
};
|
|
|
|
builtin_platform_driver(pmc_driver);
|