333 lines
6.9 KiB
C
333 lines
6.9 KiB
C
|
// SPDX-License-Identifier: GPL-2.0
|
||
|
|
/*
|
||
|
|
* Copyright (C) 2011-2015 MediaTek Inc.
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <linux/module.h> /* needed by all modules */
|
||
|
|
#include <linux/init.h> /* needed by module macros */
|
||
|
|
#include <linux/fs.h> /* needed by file_operations* */
|
||
|
|
#include <linux/miscdevice.h> /* needed by miscdevice* */
|
||
|
|
#include <linux/platform_device.h>
|
||
|
|
#include <linux/device.h> /* needed by device_* */
|
||
|
|
#include <linux/vmalloc.h> /* needed by kmalloc */
|
||
|
|
#include <linux/uaccess.h> /* needed by copy_to_user */
|
||
|
|
#include <linux/fs.h> /* needed by file_operations* */
|
||
|
|
#include <linux/slab.h> /* needed by kmalloc */
|
||
|
|
#include <linux/poll.h> /* needed by poll */
|
||
|
|
#include <linux/mutex.h>
|
||
|
|
#include <linux/kthread.h>
|
||
|
|
#include <linux/sched.h>
|
||
|
|
#include <linux/interrupt.h>
|
||
|
|
#include <linux/suspend.h>
|
||
|
|
#include <linux/timer.h>
|
||
|
|
#include <linux/notifier.h>
|
||
|
|
#include <linux/of.h>
|
||
|
|
#include <linux/of_address.h>
|
||
|
|
#include <linux/of_irq.h>
|
||
|
|
#include <linux/of_fdt.h>
|
||
|
|
#include <linux/ioport.h>
|
||
|
|
#include <linux/io.h>
|
||
|
|
#include <linux/atomic.h>
|
||
|
|
#include <mt-plat/sync_write.h>
|
||
|
|
#include "sspm_define.h"
|
||
|
|
#include "sspm_helper.h"
|
||
|
|
#include "sspm_ipi_table.h"
|
||
|
|
#include "sspm_sysfs.h"
|
||
|
|
#include "sspm_reservedmem.h"
|
||
|
|
#include "sspm_timesync.h"
|
||
|
|
|
||
|
|
#define SEM_TIMEOUT 5000
|
||
|
|
#define SSPM_INIT_FLAG 0x1
|
||
|
|
|
||
|
|
static int __init sspm_init(void);
|
||
|
|
|
||
|
|
struct sspm_regs sspmreg;
|
||
|
|
struct platform_device *sspm_pdev;
|
||
|
|
#if SSPM_PLT_SERV_SUPPORT
|
||
|
|
int sspm_plt_ackdata;
|
||
|
|
#endif
|
||
|
|
static struct workqueue_struct *sspm_workqueue;
|
||
|
|
static atomic_t sspm_inited = ATOMIC_INIT(0);
|
||
|
|
static atomic_t sspm_dev_inited = ATOMIC_INIT(0);
|
||
|
|
static unsigned int sspm_ready;
|
||
|
|
|
||
|
|
/*
|
||
|
|
* acquire a hardware semaphore
|
||
|
|
* @param flag: semaphore id
|
||
|
|
*/
|
||
|
|
int get_sspm_semaphore(int flag)
|
||
|
|
{
|
||
|
|
void __iomem *sema = sspmreg.cfg + SSPM_CFG_OFS_SEMA;
|
||
|
|
int read_back;
|
||
|
|
int count = 0;
|
||
|
|
int ret = -1;
|
||
|
|
|
||
|
|
flag = (flag * 2) + 1;
|
||
|
|
|
||
|
|
read_back = (readl(sema) >> flag) & 0x1;
|
||
|
|
|
||
|
|
if (read_back == 0) {
|
||
|
|
writel((1 << flag), sema);
|
||
|
|
|
||
|
|
while (count != SEM_TIMEOUT) {
|
||
|
|
/* repeat test if we get semaphore */
|
||
|
|
read_back = (readl(sema) >> flag) & 0x1;
|
||
|
|
if (read_back == 1) {
|
||
|
|
ret = 1;
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
writel((1 << flag), sema);
|
||
|
|
count++;
|
||
|
|
}
|
||
|
|
|
||
|
|
if (ret < 0)
|
||
|
|
pr_debug("[SSPM] get semaphore %d TIMEOUT...!\n", flag);
|
||
|
|
} else {
|
||
|
|
pr_debug("[SSPM] already hold semaphore %d\n", flag);
|
||
|
|
}
|
||
|
|
|
||
|
|
return ret;
|
||
|
|
}
|
||
|
|
EXPORT_SYMBOL_GPL(get_sspm_semaphore);
|
||
|
|
|
||
|
|
/*
|
||
|
|
* release a hardware semaphore
|
||
|
|
* @param flag: semaphore id
|
||
|
|
*/
|
||
|
|
int release_sspm_semaphore(int flag)
|
||
|
|
{
|
||
|
|
void __iomem *sema = sspmreg.cfg + SSPM_CFG_OFS_SEMA;
|
||
|
|
int read_back;
|
||
|
|
int ret = -1;
|
||
|
|
|
||
|
|
flag = (flag * 2) + 1;
|
||
|
|
|
||
|
|
read_back = (readl(sema) >> flag) & 0x1;
|
||
|
|
|
||
|
|
if (read_back == 1) {
|
||
|
|
/* Write 1 clear */
|
||
|
|
writel((1 << flag), sema);
|
||
|
|
read_back = (readl(sema) >> flag) & 0x1;
|
||
|
|
if (read_back == 0)
|
||
|
|
ret = 1;
|
||
|
|
else
|
||
|
|
pr_debug("[SSPM] release semaphore %d failed!\n", flag);
|
||
|
|
} else {
|
||
|
|
pr_debug("[SSPM] try to release semaphore %d not own by me\n",
|
||
|
|
flag);
|
||
|
|
}
|
||
|
|
|
||
|
|
return ret;
|
||
|
|
}
|
||
|
|
EXPORT_SYMBOL_GPL(release_sspm_semaphore);
|
||
|
|
|
||
|
|
/*
|
||
|
|
* schedule a work on sspm's work queue
|
||
|
|
* @param sspm_ws: work_struct to schedule
|
||
|
|
*/
|
||
|
|
void sspm_schedule_work(struct sspm_work_struct *sspm_ws)
|
||
|
|
{
|
||
|
|
queue_work(sspm_workqueue, &sspm_ws->work);
|
||
|
|
}
|
||
|
|
EXPORT_SYMBOL_GPL(sspm_schedule_work);
|
||
|
|
|
||
|
|
/*
|
||
|
|
* @return: 1 if sspm is ready for running tasks
|
||
|
|
*/
|
||
|
|
unsigned int is_sspm_ready(void)
|
||
|
|
{
|
||
|
|
if (sspm_ready)
|
||
|
|
return 1;
|
||
|
|
else
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
EXPORT_SYMBOL_GPL(is_sspm_ready);
|
||
|
|
|
||
|
|
static int sspm_device_probe(struct platform_device *pdev)
|
||
|
|
{
|
||
|
|
struct resource *res;
|
||
|
|
struct device *dev = &pdev->dev;
|
||
|
|
int i, ret;
|
||
|
|
|
||
|
|
if (atomic_inc_return(&sspm_dev_inited) != 1)
|
||
|
|
return -1;
|
||
|
|
|
||
|
|
res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "cfgreg");
|
||
|
|
sspmreg.cfg = devm_ioremap_resource(dev, res);
|
||
|
|
|
||
|
|
if (IS_ERR((void const *) sspmreg.cfg)) {
|
||
|
|
pr_err("[SSPM] Unable to ioremap registers\n");
|
||
|
|
return -1;
|
||
|
|
}
|
||
|
|
|
||
|
|
sspmreg.cfgregsize = (unsigned int) resource_size(res);
|
||
|
|
|
||
|
|
sspmreg.irq = platform_get_irq_byname(pdev, "ipc");
|
||
|
|
if (sspmreg.irq < 0) {
|
||
|
|
pr_err("[SSPM] Unable to get IRQ\n");
|
||
|
|
return -1;
|
||
|
|
}
|
||
|
|
|
||
|
|
pr_debug("[SSPM] sspm irq=%d, cfgreg=0x%p\n", sspmreg.irq, sspmreg.cfg);
|
||
|
|
|
||
|
|
sspm_pdev = pdev;
|
||
|
|
|
||
|
|
pr_debug("[SSPM] mbox probe\n");
|
||
|
|
for (i = 0; i < SSPM_MBOX_TOTAL; i++) {
|
||
|
|
sspm_mbox_table[i].mbdev = &sspm_mboxdev;
|
||
|
|
ret = mtk_mbox_probe(pdev, sspm_mbox_table[i].mbdev, i);
|
||
|
|
if (ret) {
|
||
|
|
pr_err("[SSPM] mbox probe fail on mbox-%d, ret %d\n",
|
||
|
|
i, ret);
|
||
|
|
return -1;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
pr_debug("[SSPM] ipi register\n");
|
||
|
|
ret = mtk_ipi_device_register(&sspm_ipidev, pdev, &sspm_mboxdev,
|
||
|
|
SSPM_IPI_COUNT);
|
||
|
|
if (ret) {
|
||
|
|
pr_err("[SSPM] ipi_dev_register fail, ret %d\n", ret);
|
||
|
|
return -1;
|
||
|
|
}
|
||
|
|
|
||
|
|
#if SSPM_PLT_SERV_SUPPORT
|
||
|
|
ret = mtk_ipi_register(&sspm_ipidev, IPIS_C_PLATFORM, NULL, NULL,
|
||
|
|
(void *) &sspm_plt_ackdata);
|
||
|
|
if (ret) {
|
||
|
|
pr_err("[SSPM] ipi_register fail, ret %d\n", ret);
|
||
|
|
return -1;
|
||
|
|
}
|
||
|
|
#endif
|
||
|
|
|
||
|
|
pr_info("SSPM is ready to service IPI\n");
|
||
|
|
|
||
|
|
#ifdef SSPM_SHARE_BUFFER_SUPPORT
|
||
|
|
if (sspm_sbuf_init()) {
|
||
|
|
pr_err("[SSPM] Shared Buffer Init Failed\n");
|
||
|
|
return -1;
|
||
|
|
}
|
||
|
|
#endif
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
EXPORT_SYMBOL_GPL(sspm_ipidev);
|
||
|
|
|
||
|
|
#ifdef CONFIG_PM
|
||
|
|
static int sspm_suspend(struct device *dev)
|
||
|
|
{
|
||
|
|
sspm_timesync_suspend();
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
static int sspm_resume(struct device *dev)
|
||
|
|
{
|
||
|
|
sspm_timesync_resume();
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
static const struct dev_pm_ops sspm_dev_pm_ops = {
|
||
|
|
.suspend = sspm_suspend,
|
||
|
|
.resume = sspm_resume,
|
||
|
|
};
|
||
|
|
#endif
|
||
|
|
|
||
|
|
static const struct of_device_id sspm_of_match[] = {
|
||
|
|
{ .compatible = "mediatek,sspm", },
|
||
|
|
{},
|
||
|
|
};
|
||
|
|
|
||
|
|
static const struct platform_device_id sspm_id_table[] = {
|
||
|
|
{ "sspm", 0},
|
||
|
|
{ },
|
||
|
|
};
|
||
|
|
|
||
|
|
static struct platform_driver mtk_sspm_driver = {
|
||
|
|
.remove = NULL,
|
||
|
|
.shutdown = NULL,
|
||
|
|
.suspend = NULL,
|
||
|
|
.resume = NULL,
|
||
|
|
.probe = sspm_device_probe,
|
||
|
|
.driver = {
|
||
|
|
.name = "sspm",
|
||
|
|
.owner = THIS_MODULE,
|
||
|
|
.of_match_table = sspm_of_match,
|
||
|
|
#ifdef CONFIG_PM
|
||
|
|
.pm = &sspm_dev_pm_ops,
|
||
|
|
#endif
|
||
|
|
},
|
||
|
|
.id_table = sspm_id_table,
|
||
|
|
};
|
||
|
|
|
||
|
|
/*
|
||
|
|
* driver initialization entry point
|
||
|
|
*/
|
||
|
|
static int __init sspm_init(void)
|
||
|
|
{
|
||
|
|
if (atomic_inc_return(&sspm_inited) != 1)
|
||
|
|
return 0;
|
||
|
|
|
||
|
|
/* static initialise */
|
||
|
|
sspm_ready = 0;
|
||
|
|
|
||
|
|
sspm_workqueue = create_workqueue("SSPM_WQ");
|
||
|
|
|
||
|
|
if (!sspm_workqueue) {
|
||
|
|
pr_err("[SSPM] Workqueue Create Failed\n");
|
||
|
|
goto error;
|
||
|
|
}
|
||
|
|
|
||
|
|
if (platform_driver_register(&mtk_sspm_driver)) {
|
||
|
|
pr_err("[SSPM] Device Init Failed\n");
|
||
|
|
goto error;
|
||
|
|
}
|
||
|
|
|
||
|
|
#ifdef CONFIG_OF_RESERVED_MEM
|
||
|
|
if (sspm_reserve_memory_init()) {
|
||
|
|
pr_err("[SSPM] Reserved Memory Failed\n");
|
||
|
|
goto error;
|
||
|
|
}
|
||
|
|
#endif
|
||
|
|
|
||
|
|
pr_debug("[SSPM] Helper Init\n");
|
||
|
|
|
||
|
|
sspm_ready = 1;
|
||
|
|
|
||
|
|
atomic_set(&sspm_inited, 1);
|
||
|
|
return 0;
|
||
|
|
|
||
|
|
error:
|
||
|
|
atomic_set(&sspm_inited, 1);
|
||
|
|
return -1;
|
||
|
|
}
|
||
|
|
|
||
|
|
static int __init sspm_module_init(void)
|
||
|
|
{
|
||
|
|
if (sspm_sysfs_init()) {
|
||
|
|
pr_err("[SSPM] Sysfs Init Failed\n");
|
||
|
|
return -1;
|
||
|
|
}
|
||
|
|
|
||
|
|
#if SSPM_PLT_SERV_SUPPORT
|
||
|
|
if (sspm_plt_init()) {
|
||
|
|
pr_err("[SSPM] Platform Init Failed\n");
|
||
|
|
return -1;
|
||
|
|
}
|
||
|
|
pr_info("SSPM platform service is ready\n");
|
||
|
|
#endif
|
||
|
|
|
||
|
|
#if SSPM_TIMESYNC_SUPPORT
|
||
|
|
if (sspm_timesync_init()) {
|
||
|
|
pr_err("[SSPM] Timesync Init Failed\n");
|
||
|
|
return -1;
|
||
|
|
}
|
||
|
|
#endif
|
||
|
|
|
||
|
|
sspm_lock_emi_mpu();
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
arch_initcall(sspm_init);
|
||
|
|
module_init(sspm_module_init);
|