mirror of
https://mirrors.bfsu.edu.cn/git/linux.git
synced 2024-12-15 06:55:13 +08:00
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>
103 lines
1.9 KiB
C
103 lines
1.9 KiB
C
// SPDX-License-Identifier: GPL-2.0-or-later
|
|
/*
|
|
* MPC85xx PM operators
|
|
*
|
|
* Copyright 2015 Freescale Semiconductor Inc.
|
|
*/
|
|
|
|
#define pr_fmt(fmt) "%s: " fmt, __func__
|
|
|
|
#include <linux/kernel.h>
|
|
#include <linux/of.h>
|
|
#include <linux/of_address.h>
|
|
#include <linux/fsl/guts.h>
|
|
|
|
#include <asm/io.h>
|
|
#include <asm/fsl_pm.h>
|
|
|
|
static struct ccsr_guts __iomem *guts;
|
|
|
|
static void mpc85xx_irq_mask(int cpu)
|
|
{
|
|
|
|
}
|
|
|
|
static void mpc85xx_irq_unmask(int cpu)
|
|
{
|
|
|
|
}
|
|
|
|
static void mpc85xx_cpu_die(int cpu)
|
|
{
|
|
u32 tmp;
|
|
|
|
tmp = (mfspr(SPRN_HID0) & ~(HID0_DOZE|HID0_SLEEP)) | HID0_NAP;
|
|
mtspr(SPRN_HID0, tmp);
|
|
|
|
/* Enter NAP mode. */
|
|
tmp = mfmsr();
|
|
tmp |= MSR_WE;
|
|
asm volatile(
|
|
"msync\n"
|
|
"mtmsr %0\n"
|
|
"isync\n"
|
|
:
|
|
: "r" (tmp));
|
|
}
|
|
|
|
static void mpc85xx_cpu_up_prepare(int cpu)
|
|
{
|
|
|
|
}
|
|
|
|
static void mpc85xx_freeze_time_base(bool freeze)
|
|
{
|
|
uint32_t mask;
|
|
|
|
mask = CCSR_GUTS_DEVDISR_TB0 | CCSR_GUTS_DEVDISR_TB1;
|
|
if (freeze)
|
|
setbits32(&guts->devdisr, mask);
|
|
else
|
|
clrbits32(&guts->devdisr, mask);
|
|
|
|
in_be32(&guts->devdisr);
|
|
}
|
|
|
|
static const struct of_device_id mpc85xx_smp_guts_ids[] = {
|
|
{ .compatible = "fsl,mpc8572-guts", },
|
|
{ .compatible = "fsl,p1020-guts", },
|
|
{ .compatible = "fsl,p1021-guts", },
|
|
{ .compatible = "fsl,p1022-guts", },
|
|
{ .compatible = "fsl,p1023-guts", },
|
|
{ .compatible = "fsl,p2020-guts", },
|
|
{ .compatible = "fsl,bsc9132-guts", },
|
|
{},
|
|
};
|
|
|
|
static const struct fsl_pm_ops mpc85xx_pm_ops = {
|
|
.freeze_time_base = mpc85xx_freeze_time_base,
|
|
.irq_mask = mpc85xx_irq_mask,
|
|
.irq_unmask = mpc85xx_irq_unmask,
|
|
.cpu_die = mpc85xx_cpu_die,
|
|
.cpu_up_prepare = mpc85xx_cpu_up_prepare,
|
|
};
|
|
|
|
int __init mpc85xx_setup_pmc(void)
|
|
{
|
|
struct device_node *np;
|
|
|
|
np = of_find_matching_node(NULL, mpc85xx_smp_guts_ids);
|
|
if (np) {
|
|
guts = of_iomap(np, 0);
|
|
of_node_put(np);
|
|
if (!guts) {
|
|
pr_err("Could not map guts node address\n");
|
|
return -ENOMEM;
|
|
}
|
|
}
|
|
|
|
qoriq_pm_ops = &mpc85xx_pm_ops;
|
|
|
|
return 0;
|
|
}
|