Kevin Peng | c86dec0 | 2019-07-23 16:15:57 +0800 | [diff] [blame] | 1 | /* |
| 2 | * Copyright (c) 2017-2019, Arm Limited. All rights reserved. |
| 3 | * |
| 4 | * SPDX-License-Identifier: BSD-3-Clause |
| 5 | * |
| 6 | */ |
| 7 | #include <stdint.h> |
| 8 | #include <stdbool.h> |
| 9 | |
Kevin Peng | 477fa94 | 2019-07-29 10:55:17 +0800 | [diff] [blame] | 10 | #include "os_wrapper/mutex.h" |
Kevin Peng | c86dec0 | 2019-07-23 16:15:57 +0800 | [diff] [blame] | 11 | |
| 12 | #include "tfm_api.h" |
| 13 | #include "tfm_ns_interface.h" |
| 14 | |
| 15 | /** |
| 16 | * \brief the ns_lock ID |
| 17 | */ |
Kevin Peng | 383e840 | 2019-08-05 16:35:44 +0800 | [diff] [blame] | 18 | static void *ns_lock_handle = NULL; |
Kevin Peng | c86dec0 | 2019-07-23 16:15:57 +0800 | [diff] [blame] | 19 | |
| 20 | __attribute__((weak)) |
| 21 | int32_t tfm_ns_interface_dispatch(veneer_fn fn, |
| 22 | uint32_t arg0, uint32_t arg1, |
| 23 | uint32_t arg2, uint32_t arg3) |
| 24 | { |
| 25 | int32_t result; |
| 26 | |
| 27 | /* TFM request protected by NS lock */ |
Kevin Peng | 383e840 | 2019-08-05 16:35:44 +0800 | [diff] [blame] | 28 | if (os_wrapper_mutex_acquire(ns_lock_handle, OS_WRAPPER_WAIT_FOREVER) |
Kevin Peng | c86dec0 | 2019-07-23 16:15:57 +0800 | [diff] [blame] | 29 | != OS_WRAPPER_SUCCESS) { |
| 30 | return (int32_t)TFM_ERROR_GENERIC; |
| 31 | } |
| 32 | |
| 33 | result = fn(arg0, arg1, arg2, arg3); |
| 34 | |
Kevin Peng | 383e840 | 2019-08-05 16:35:44 +0800 | [diff] [blame] | 35 | if (os_wrapper_mutex_release(ns_lock_handle) != OS_WRAPPER_SUCCESS) { |
Kevin Peng | c86dec0 | 2019-07-23 16:15:57 +0800 | [diff] [blame] | 36 | return (int32_t)TFM_ERROR_GENERIC; |
| 37 | } |
| 38 | |
| 39 | return result; |
| 40 | } |
| 41 | |
| 42 | __attribute__((weak)) |
| 43 | enum tfm_status_e tfm_ns_interface_init(void) |
| 44 | { |
Kevin Peng | 383e840 | 2019-08-05 16:35:44 +0800 | [diff] [blame] | 45 | void *handle; |
Kevin Peng | c86dec0 | 2019-07-23 16:15:57 +0800 | [diff] [blame] | 46 | |
Kevin Peng | 383e840 | 2019-08-05 16:35:44 +0800 | [diff] [blame] | 47 | handle = os_wrapper_mutex_create(); |
| 48 | if (!handle) { |
Kevin Peng | c86dec0 | 2019-07-23 16:15:57 +0800 | [diff] [blame] | 49 | return TFM_ERROR_GENERIC; |
| 50 | } |
| 51 | |
Kevin Peng | 383e840 | 2019-08-05 16:35:44 +0800 | [diff] [blame] | 52 | ns_lock_handle = handle; |
Kevin Peng | c86dec0 | 2019-07-23 16:15:57 +0800 | [diff] [blame] | 53 | return TFM_SUCCESS; |
| 54 | } |