109 lines
2 KiB
C
109 lines
2 KiB
C
|
// SPDX-License-Identifier: GPL-2.0
|
||
|
|
/*
|
||
|
|
* Copyright (c) 2019 MediaTek Inc.
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <linux/kernel.h>
|
||
|
|
#include <linux/errno.h>
|
||
|
|
#include <linux/spinlock.h>
|
||
|
|
|
||
|
|
#include <mtk_lpm_call.h>
|
||
|
|
|
||
|
|
static DEFINE_SPINLOCK(mtk_lp_plat_call_locker);
|
||
|
|
static LIST_HEAD(mtk_lpm_callees);
|
||
|
|
|
||
|
|
int mtk_lpm_callee_registry(struct mtk_lpm_callee *callee)
|
||
|
|
{
|
||
|
|
struct mtk_lpm_callee *pos;
|
||
|
|
|
||
|
|
if (!callee)
|
||
|
|
return -EINVAL;
|
||
|
|
|
||
|
|
spin_lock(&mtk_lp_plat_call_locker);
|
||
|
|
list_for_each_entry(pos, &mtk_lpm_callees, list) {
|
||
|
|
if (pos && (pos != callee) &&
|
||
|
|
(pos->uid == callee->uid)) {
|
||
|
|
pos = NULL;
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
if (pos) {
|
||
|
|
callee->ref = 0;
|
||
|
|
list_add(&callee->list, &mtk_lpm_callees);
|
||
|
|
}
|
||
|
|
spin_unlock(&mtk_lp_plat_call_locker);
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
EXPORT_SYMBOL(mtk_lpm_callee_registry);
|
||
|
|
|
||
|
|
int mtk_lpm_callee_unregistry(struct mtk_lpm_callee *callee)
|
||
|
|
{
|
||
|
|
int bRet = 0;
|
||
|
|
struct mtk_lpm_callee *pos;
|
||
|
|
|
||
|
|
if (!callee)
|
||
|
|
return -EINVAL;
|
||
|
|
|
||
|
|
spin_lock(&mtk_lp_plat_call_locker);
|
||
|
|
list_for_each_entry(pos, &mtk_lpm_callees, list) {
|
||
|
|
if (pos && (pos->uid == callee->uid)) {
|
||
|
|
if (!pos->ref)
|
||
|
|
list_del(&pos->list);
|
||
|
|
else
|
||
|
|
bRet = -EPERM;
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
spin_unlock(&mtk_lp_plat_call_locker);
|
||
|
|
|
||
|
|
return bRet;
|
||
|
|
}
|
||
|
|
EXPORT_SYMBOL(mtk_lpm_callee_unregistry);
|
||
|
|
|
||
|
|
int mtk_lpm_callee_get_impl(int uid, const struct mtk_lpm_callee **callee)
|
||
|
|
{
|
||
|
|
struct mtk_lpm_callee *pos;
|
||
|
|
|
||
|
|
if (!callee)
|
||
|
|
return -EINVAL;
|
||
|
|
|
||
|
|
*callee = NULL;
|
||
|
|
spin_lock(&mtk_lp_plat_call_locker);
|
||
|
|
list_for_each_entry(pos, &mtk_lpm_callees, list) {
|
||
|
|
if (pos && pos->uid == uid) {
|
||
|
|
pos->ref++;
|
||
|
|
*callee = pos;
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
spin_unlock(&mtk_lp_plat_call_locker);
|
||
|
|
|
||
|
|
return *callee ? 0 : -EINVAL;
|
||
|
|
}
|
||
|
|
EXPORT_SYMBOL(mtk_lpm_callee_get_impl);
|
||
|
|
|
||
|
|
int mtk_lpm_callee_put_impl(struct mtk_lpm_callee const *callee)
|
||
|
|
{
|
||
|
|
struct mtk_lpm_callee *pos;
|
||
|
|
int ret = -EPERM;
|
||
|
|
|
||
|
|
if (!callee)
|
||
|
|
return -EINVAL;
|
||
|
|
|
||
|
|
spin_lock(&mtk_lp_plat_call_locker);
|
||
|
|
list_for_each_entry(pos, &mtk_lpm_callees, list) {
|
||
|
|
if (pos && (pos->uid == callee->uid)) {
|
||
|
|
pos->ref--;
|
||
|
|
ret = 0;
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
spin_unlock(&mtk_lp_plat_call_locker);
|
||
|
|
|
||
|
|
return ret;
|
||
|
|
}
|
||
|
|
EXPORT_SYMBOL(mtk_lpm_callee_put_impl);
|
||
|
|
|