Aquaris-M10-4G/drivers/misc/mediatek/base/power/mt6735/mt_psci.c

/*
 * Copyright (c) 2015 MediaTek Inc.
 *
 * 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.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 */
#include <linux/init.h>
#include <linux/smp.h>

#include <asm/cpu_ops.h>
#include <asm/psci.h>
#include <mach/mt_spm_mtcmos.h>
#include "mt_cpu_psci_ops.h"

#ifdef CONFIG_SMP

static int __init mt_psci_cpu_init(struct device_node *dn, unsigned int cpu)
{
	return 0;
}

static int __init mt_psci_cpu_prepare(unsigned int cpu)
{
	if (cpu == 1)
		spm_mtcmos_cpu_init();
	return cpu_psci_ops.cpu_prepare(cpu);
}

static int mt_psci_cpu_boot(unsigned int cpu)
{
	int ret;

	ret = cpu_psci_ops.cpu_boot(cpu);
	if (ret < 0)
		return ret;

	return spm_mtcmos_ctrl_cpu(cpu, STA_POWER_ON, 1);
}

#ifdef CONFIG_HOTPLUG_CPU
static int mt_psci_cpu_disable(unsigned int cpu)
{
	return cpu_psci_ops.cpu_disable(cpu);
}

static void mt_psci_cpu_die(unsigned int cpu)
{
	cpu_psci_ops.cpu_die(cpu);
}

static int mt_psci_cpu_kill(unsigned int cpu)
{
	int ret;

	ret = cpu_psci_ops.cpu_kill(cpu);
	if (!ret)
		pr_warn("CPU%d may not have shut down cleanly\n", cpu);

	return !spm_mtcmos_ctrl_cpu(cpu, STA_POWER_DOWN, 1);
}
#endif

#ifdef CONFIG_CPU_IDLE
static int mt_psci_cpu_init_idle(struct device_node *cpu_node,
				 unsigned int cpu)
{
	return cpu_psci_ops.cpu_init_idle(cpu_node, cpu);
}

static int mt_psci_cpu_suspend(unsigned long index)
{
	return cpu_psci_ops.cpu_suspend(index);
}
#endif

const struct cpu_operations mt_cpu_psci_ops = {
	.name = "mt-boot",
#ifdef CONFIG_CPU_IDLE
	.cpu_init_idle	= mt_psci_cpu_init_idle,
	.cpu_suspend	= mt_psci_cpu_suspend,
#endif
	.cpu_init = mt_psci_cpu_init,
	.cpu_prepare = mt_psci_cpu_prepare,
	.cpu_boot = mt_psci_cpu_boot,
#ifdef CONFIG_HOTPLUG_CPU
	.cpu_disable = mt_psci_cpu_disable,
	.cpu_die = mt_psci_cpu_die,
	.cpu_kill = mt_psci_cpu_kill,
#endif
};

#endif