2014-05-09 11:42:56 +01:00
|
|
|
/*
|
2015-03-23 18:13:33 +00:00
|
|
|
* Copyright (c) 2014-2015, ARM Limited and Contributors. All rights reserved.
|
2014-05-09 11:42:56 +01:00
|
|
|
*
|
2017-05-03 09:38:09 +01:00
|
|
|
* SPDX-License-Identifier: BSD-3-Clause
|
2014-05-09 11:42:56 +01:00
|
|
|
*/
|
|
|
|
|
|
|
|
#include <assert.h>
|
2018-12-14 00:18:21 +00:00
|
|
|
|
2014-05-14 17:44:19 +01:00
|
|
|
#include <platform_def.h>
|
2018-12-14 00:18:21 +00:00
|
|
|
|
|
|
|
#include <arch_helpers.h>
|
|
|
|
#include <bl32/tsp/tsp.h>
|
|
|
|
#include <common/debug.h>
|
|
|
|
#include <plat/common/platform.h>
|
|
|
|
|
2014-08-01 17:58:27 +01:00
|
|
|
#include "tsp_private.h"
|
2014-05-09 11:42:56 +01:00
|
|
|
|
|
|
|
/*******************************************************************************
|
2015-09-03 18:29:38 +01:00
|
|
|
* This function updates the TSP statistics for S-EL1 interrupts handled
|
|
|
|
* synchronously i.e the ones that have been handed over by the TSPD. It also
|
|
|
|
* keeps count of the number of times control was passed back to the TSPD
|
|
|
|
* after handling the interrupt. In the future it will be possible that the
|
|
|
|
* TSPD hands over an S-EL1 interrupt to the TSP but does not expect it to
|
|
|
|
* return execution. This statistic will be useful to distinguish between these
|
|
|
|
* two models of synchronous S-EL1 interrupt handling. The 'elr_el3' parameter
|
|
|
|
* contains the address of the instruction in normal world where this S-EL1
|
|
|
|
* interrupt was generated.
|
2014-05-09 11:42:56 +01:00
|
|
|
******************************************************************************/
|
2015-09-03 18:29:38 +01:00
|
|
|
void tsp_update_sync_sel1_intr_stats(uint32_t type, uint64_t elr_el3)
|
2014-05-09 11:42:56 +01:00
|
|
|
{
|
2015-07-08 21:45:46 +01:00
|
|
|
uint32_t linear_id = plat_my_core_pos();
|
2014-05-09 11:42:56 +01:00
|
|
|
|
2015-09-03 18:29:38 +01:00
|
|
|
tsp_stats[linear_id].sync_sel1_intr_count++;
|
|
|
|
if (type == TSP_HANDLE_SEL1_INTR_AND_RETURN)
|
|
|
|
tsp_stats[linear_id].sync_sel1_intr_ret_count++;
|
2014-05-09 11:42:56 +01:00
|
|
|
|
2014-07-29 17:14:00 +01:00
|
|
|
#if LOG_LEVEL >= LOG_LEVEL_VERBOSE
|
2014-05-09 11:42:56 +01:00
|
|
|
spin_lock(&console_lock);
|
types: use int-ll64 for both aarch32 and aarch64
Since commit 031dbb122472 ("AArch32: Add essential Arch helpers"),
it is difficult to use consistent format strings for printf() family
between aarch32 and aarch64.
For example, uint64_t is defined as 'unsigned long long' for aarch32
and as 'unsigned long' for aarch64. Likewise, uintptr_t is defined
as 'unsigned int' for aarch32, and as 'unsigned long' for aarch64.
A problem typically arises when you use printf() in common code.
One solution could be, to cast the arguments to a type long enough
for both architectures. For example, if 'val' is uint64_t type,
like this:
printf("val = %llx\n", (unsigned long long)val);
Or, somebody may suggest to use a macro provided by <inttypes.h>,
like this:
printf("val = %" PRIx64 "\n", val);
But, both would make the code ugly.
The solution adopted in Linux kernel is to use the same typedefs for
all architectures. The fixed integer types in the kernel-space have
been unified into int-ll64, like follows:
typedef signed char int8_t;
typedef unsigned char uint8_t;
typedef signed short int16_t;
typedef unsigned short uint16_t;
typedef signed int int32_t;
typedef unsigned int uint32_t;
typedef signed long long int64_t;
typedef unsigned long long uint64_t;
[ Linux commit: 0c79a8e29b5fcbcbfd611daf9d500cfad8370fcf ]
This gets along with the codebase shared between 32 bit and 64 bit,
with the data model called ILP32, LP64, respectively.
The width for primitive types is defined as follows:
ILP32 LP64
int 32 32
long 32 64
long long 64 64
pointer 32 64
'long long' is 64 bit for both, so it is used for defining uint64_t.
'long' has the same width as pointer, so for uintptr_t.
We still need an ifdef conditional for (s)size_t.
All 64 bit architectures use "unsigned long" size_t, and most 32 bit
architectures use "unsigned int" size_t. H8/300, S/390 are known as
exceptions; they use "unsigned long" size_t despite their architecture
is 32 bit.
One idea for simplification might be to define size_t as 'unsigned long'
across architectures, then forbid the use of "%z" string format.
However, this would cause a distortion between size_t and sizeof()
operator. We have unknowledge about the native type of sizeof(), so
we need a guess of it anyway. I want the following formula to always
return 1:
__builtin_types_compatible_p(size_t, typeof(sizeof(int)))
Fortunately, ARM is probably a majority case. As far as I know, all
32 bit ARM compilers use "unsigned int" size_t.
Signed-off-by: Masahiro Yamada <yamada.masahiro@socionext.com>
2018-02-02 06:09:36 +00:00
|
|
|
VERBOSE("TSP: cpu 0x%lx sync s-el1 interrupt request from 0x%llx\n",
|
2015-07-08 21:45:46 +01:00
|
|
|
read_mpidr(), elr_el3);
|
2015-09-03 18:29:38 +01:00
|
|
|
VERBOSE("TSP: cpu 0x%lx: %d sync s-el1 interrupt requests,"
|
|
|
|
" %d sync s-el1 interrupt returns\n",
|
2015-07-08 21:45:46 +01:00
|
|
|
read_mpidr(),
|
2015-09-03 18:29:38 +01:00
|
|
|
tsp_stats[linear_id].sync_sel1_intr_count,
|
|
|
|
tsp_stats[linear_id].sync_sel1_intr_ret_count);
|
2014-05-09 11:42:56 +01:00
|
|
|
spin_unlock(&console_lock);
|
2014-07-29 17:14:00 +01:00
|
|
|
#endif
|
2014-05-09 11:42:56 +01:00
|
|
|
}
|
|
|
|
|
2015-09-22 12:01:18 +01:00
|
|
|
/******************************************************************************
|
|
|
|
* This function is invoked when a non S-EL1 interrupt is received and causes
|
|
|
|
* the preemption of TSP. This function returns TSP_PREEMPTED and results
|
|
|
|
* in the control being handed over to EL3 for handling the interrupt.
|
|
|
|
*****************************************************************************/
|
|
|
|
int32_t tsp_handle_preemption(void)
|
|
|
|
{
|
|
|
|
uint32_t linear_id = plat_my_core_pos();
|
|
|
|
|
|
|
|
tsp_stats[linear_id].preempt_intr_count++;
|
|
|
|
#if LOG_LEVEL >= LOG_LEVEL_VERBOSE
|
|
|
|
spin_lock(&console_lock);
|
|
|
|
VERBOSE("TSP: cpu 0x%lx: %d preempt interrupt requests\n",
|
|
|
|
read_mpidr(), tsp_stats[linear_id].preempt_intr_count);
|
|
|
|
spin_unlock(&console_lock);
|
|
|
|
#endif
|
|
|
|
return TSP_PREEMPTED;
|
|
|
|
}
|
|
|
|
|
2014-05-09 11:42:56 +01:00
|
|
|
/*******************************************************************************
|
2015-09-03 18:29:38 +01:00
|
|
|
* TSP interrupt handler is called as a part of both synchronous and
|
|
|
|
* asynchronous handling of TSP interrupts. Currently the physical timer
|
|
|
|
* interrupt is the only S-EL1 interrupt that this handler expects. It returns
|
|
|
|
* 0 upon successfully handling the expected interrupt and all other
|
|
|
|
* interrupts are treated as normal world or EL3 interrupts.
|
2014-05-09 11:42:56 +01:00
|
|
|
******************************************************************************/
|
2015-09-03 18:29:38 +01:00
|
|
|
int32_t tsp_common_int_handler(void)
|
2014-05-09 11:42:56 +01:00
|
|
|
{
|
2015-07-08 21:45:46 +01:00
|
|
|
uint32_t linear_id = plat_my_core_pos(), id;
|
2014-05-09 11:42:56 +01:00
|
|
|
|
|
|
|
/*
|
|
|
|
* Get the highest priority pending interrupt id and see if it is the
|
|
|
|
* secure physical generic timer interrupt in which case, handle it.
|
|
|
|
* Otherwise throw this interrupt at the EL3 firmware.
|
2015-09-22 12:01:18 +01:00
|
|
|
*
|
|
|
|
* There is a small time window between reading the highest priority
|
|
|
|
* pending interrupt and acknowledging it during which another
|
|
|
|
* interrupt of higher priority could become the highest pending
|
|
|
|
* interrupt. This is not expected to happen currently for TSP.
|
2014-05-09 11:42:56 +01:00
|
|
|
*/
|
2014-05-27 16:17:21 +01:00
|
|
|
id = plat_ic_get_pending_interrupt_id();
|
2014-05-09 11:42:56 +01:00
|
|
|
|
|
|
|
/* TSP can only handle the secure physical timer interrupt */
|
2014-08-04 11:41:20 +01:00
|
|
|
if (id != TSP_IRQ_SEC_PHY_TIMER)
|
2015-09-22 12:01:18 +01:00
|
|
|
return tsp_handle_preemption();
|
2014-05-09 11:42:56 +01:00
|
|
|
|
|
|
|
/*
|
2015-09-22 12:01:18 +01:00
|
|
|
* Acknowledge and handle the secure timer interrupt. Also sanity check
|
|
|
|
* if it has been preempted by another interrupt through an assertion.
|
2014-05-09 11:42:56 +01:00
|
|
|
*/
|
2014-05-27 16:17:21 +01:00
|
|
|
id = plat_ic_acknowledge_interrupt();
|
2014-08-04 11:41:20 +01:00
|
|
|
assert(id == TSP_IRQ_SEC_PHY_TIMER);
|
2014-05-09 11:42:56 +01:00
|
|
|
tsp_generic_timer_handler();
|
2014-05-27 16:17:21 +01:00
|
|
|
plat_ic_end_of_interrupt(id);
|
2014-05-09 11:42:56 +01:00
|
|
|
|
|
|
|
/* Update the statistics and print some messages */
|
2015-09-03 18:29:38 +01:00
|
|
|
tsp_stats[linear_id].sel1_intr_count++;
|
2014-07-29 17:14:00 +01:00
|
|
|
#if LOG_LEVEL >= LOG_LEVEL_VERBOSE
|
2014-05-09 11:42:56 +01:00
|
|
|
spin_lock(&console_lock);
|
2015-09-03 18:29:38 +01:00
|
|
|
VERBOSE("TSP: cpu 0x%lx handled S-EL1 interrupt %d\n",
|
2015-07-08 21:45:46 +01:00
|
|
|
read_mpidr(), id);
|
2015-09-03 18:29:38 +01:00
|
|
|
VERBOSE("TSP: cpu 0x%lx: %d S-EL1 requests\n",
|
|
|
|
read_mpidr(), tsp_stats[linear_id].sel1_intr_count);
|
2014-05-09 11:42:56 +01:00
|
|
|
spin_unlock(&console_lock);
|
2014-07-29 17:14:00 +01:00
|
|
|
#endif
|
2014-05-09 11:42:56 +01:00
|
|
|
return 0;
|
|
|
|
}
|