securemsm-kernel : Add new functionality in HLOS for TZ to sleep for certain
amount of time.
This commit is contained in:
@@ -1,6 +1,6 @@
|
|||||||
// SPDX-License-Identifier: GPL-2.0-only
|
// SPDX-License-Identifier: GPL-2.0-only
|
||||||
/*
|
/*
|
||||||
* Copyright (c) 2016-2021, The Linux Foundation. All rights reserved.
|
* Copyright (c) 2016-2022, The Linux Foundation. All rights reserved.
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#define pr_fmt(fmt) "smcinvoke: %s: " fmt, __func__
|
#define pr_fmt(fmt) "smcinvoke: %s: " fmt, __func__
|
||||||
@@ -950,6 +950,23 @@ out:
|
|||||||
return ret;
|
return ret;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static int32_t smcinvoke_sleep(void *buf, size_t buf_len)
|
||||||
|
{
|
||||||
|
struct smcinvoke_tzcb_req *msg = buf;
|
||||||
|
uint32_t sleepTimeMs_val = 0;
|
||||||
|
|
||||||
|
if (msg->hdr.counts != OBJECT_COUNTS_PACK(1, 0, 0, 0) ||
|
||||||
|
(buf_len - msg->args[0].b.offset < msg->args[0].b.size)) {
|
||||||
|
pr_err("Invalid counts received for sleeping in hlos\n");
|
||||||
|
return OBJECT_ERROR_INVALID;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Time in miliseconds is expected from tz */
|
||||||
|
sleepTimeMs_val = *((uint32_t *)(buf + msg->args[0].b.offset));
|
||||||
|
msleep(sleepTimeMs_val);
|
||||||
|
return OBJECT_OK;
|
||||||
|
}
|
||||||
|
|
||||||
static void process_kernel_obj(void *buf, size_t buf_len)
|
static void process_kernel_obj(void *buf, size_t buf_len)
|
||||||
{
|
{
|
||||||
struct smcinvoke_tzcb_req *cb_req = buf;
|
struct smcinvoke_tzcb_req *cb_req = buf;
|
||||||
@@ -961,6 +978,9 @@ static void process_kernel_obj(void *buf, size_t buf_len)
|
|||||||
case OBJECT_OP_YIELD:
|
case OBJECT_OP_YIELD:
|
||||||
cb_req->result = OBJECT_OK;
|
cb_req->result = OBJECT_OK;
|
||||||
break;
|
break;
|
||||||
|
case OBJECT_OP_SLEEP:
|
||||||
|
cb_req->result = smcinvoke_sleep(buf, buf_len);
|
||||||
|
break;
|
||||||
default:
|
default:
|
||||||
pr_err(" invalid operation for tz kernel object\n");
|
pr_err(" invalid operation for tz kernel object\n");
|
||||||
cb_req->result = OBJECT_ERROR_INVALID;
|
cb_req->result = OBJECT_ERROR_INVALID;
|
||||||
|
@@ -1,6 +1,6 @@
|
|||||||
/* SPDX-License-Identifier: GPL-2.0-only */
|
/* SPDX-License-Identifier: GPL-2.0-only */
|
||||||
/*
|
/*
|
||||||
* Copyright (c) 2016-2021, The Linux Foundation. All rights reserved.
|
* Copyright (c) 2016-2022, The Linux Foundation. All rights reserved.
|
||||||
*/
|
*/
|
||||||
#ifndef __SMCINVOKE_OBJECT_H
|
#ifndef __SMCINVOKE_OBJECT_H
|
||||||
#define __SMCINVOKE_OBJECT_H
|
#define __SMCINVOKE_OBJECT_H
|
||||||
@@ -20,6 +20,7 @@
|
|||||||
#define OBJECT_OP_RETAIN (OBJECT_OP_METHOD_MASK - 1)
|
#define OBJECT_OP_RETAIN (OBJECT_OP_METHOD_MASK - 1)
|
||||||
#define OBJECT_OP_MAP_REGION 0
|
#define OBJECT_OP_MAP_REGION 0
|
||||||
#define OBJECT_OP_YIELD 1
|
#define OBJECT_OP_YIELD 1
|
||||||
|
#define OBJECT_OP_SLEEP 2
|
||||||
|
|
||||||
#define OBJECT_COUNTS_MAX_BI 0xF
|
#define OBJECT_COUNTS_MAX_BI 0xF
|
||||||
#define OBJECT_COUNTS_MAX_BO 0xF
|
#define OBJECT_COUNTS_MAX_BO 0xF
|
||||||
|
Reference in New Issue
Block a user