tsp_main.c revision a20a81e5b4a19969673f672523b946647f5d545d
17c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta/* 27c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * Copyright (c) 2013-2014, ARM Limited and Contributors. All rights reserved. 37c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * 47c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * Redistribution and use in source and binary forms, with or without 57c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * modification, are permitted provided that the following conditions are met: 67c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * 77c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * Redistributions of source code must retain the above copyright notice, this 87c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * list of conditions and the following disclaimer. 97c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * 107c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * Redistributions in binary form must reproduce the above copyright notice, 117c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * this list of conditions and the following disclaimer in the documentation 127c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * and/or other materials provided with the distribution. 137c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * 147c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * Neither the name of ARM nor the names of its contributors may be used 157c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * to endorse or promote products derived from this software without specific 167c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * prior written permission. 177c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * 187c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" 197c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 207c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 217c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE 227c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 237c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 247c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 257c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 267c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 277c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 287c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * POSSIBILITY OF SUCH DAMAGE. 297c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta */ 307c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta 317c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta#include <arch_helpers.h> 3297043ac98e13a726dbf8b3b41654dca759e3da2cDan Handley#include <bl_common.h> 3397043ac98e13a726dbf8b3b41654dca759e3da2cDan Handley#include <bl32.h> 347c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta#include <debug.h> 3597043ac98e13a726dbf8b3b41654dca759e3da2cDan Handley#include <platform.h> 367c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta#include <spinlock.h> 3797043ac98e13a726dbf8b3b41654dca759e3da2cDan Handley#include <stdio.h> 3897043ac98e13a726dbf8b3b41654dca759e3da2cDan Handley#include <tsp.h> 397c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta 407c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta/******************************************************************************* 416871c5d3a227cb95008a25e90e358ec0ac615222Vikram Kanigiri * Declarations of linker defined symbols which will help us find the layout 426871c5d3a227cb95008a25e90e358ec0ac615222Vikram Kanigiri * of trusted SRAM 436871c5d3a227cb95008a25e90e358ec0ac615222Vikram Kanigiri ******************************************************************************/ 446871c5d3a227cb95008a25e90e358ec0ac615222Vikram Kanigiriextern unsigned long __RO_START__; 456871c5d3a227cb95008a25e90e358ec0ac615222Vikram Kanigiriextern unsigned long __COHERENT_RAM_END__; 466871c5d3a227cb95008a25e90e358ec0ac615222Vikram Kanigiri 476871c5d3a227cb95008a25e90e358ec0ac615222Vikram Kanigiri/******************************************************************************* 487c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * Lock to control access to the console 497c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta ******************************************************************************/ 507c88f3f633288856dd691dfda222e60092e4dab9Achin Guptaspinlock_t console_lock; 517c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta 527c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta/******************************************************************************* 537c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * Per cpu data structure to populate parameters for an SMC in C code and use 547c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * a pointer to this structure in assembler code to populate x0-x7 557c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta ******************************************************************************/ 56fb037bfb7cbf7b404c069b4ebac5a10059d948b1Dan Handleystatic tsp_args_t tsp_smc_args[PLATFORM_CORE_COUNT]; 577c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta 587c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta/******************************************************************************* 597c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * Per cpu data structure to keep track of TSP activity 607c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta ******************************************************************************/ 616cf89021312a33395f804d80377a6ffdaadbbe21Achin Guptawork_statistics_t tsp_stats[PLATFORM_CORE_COUNT]; 627c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta 637c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta/******************************************************************************* 647c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * Single reference to the various entry points exported by the test secure 657c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * payload. A single copy should suffice for all cpus as they are not expected 667c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * to change. 677c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta ******************************************************************************/ 68fb037bfb7cbf7b404c069b4ebac5a10059d948b1Dan Handleystatic const entry_info_t tsp_entry_info = { 697c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta tsp_fast_smc_entry, 707c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta tsp_cpu_on_entry, 717c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta tsp_cpu_off_entry, 727c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta tsp_cpu_resume_entry, 737c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta tsp_cpu_suspend_entry, 746cf89021312a33395f804d80377a6ffdaadbbe21Achin Gupta tsp_fiq_entry, 757c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta}; 767c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta 776871c5d3a227cb95008a25e90e358ec0ac615222Vikram Kanigiri 786871c5d3a227cb95008a25e90e358ec0ac615222Vikram Kanigiri/******************************************************************************* 796871c5d3a227cb95008a25e90e358ec0ac615222Vikram Kanigiri * The BL32 memory footprint starts with an RO sections and ends 806871c5d3a227cb95008a25e90e358ec0ac615222Vikram Kanigiri * with a section for coherent RAM. Use it to find the memory size 816871c5d3a227cb95008a25e90e358ec0ac615222Vikram Kanigiri ******************************************************************************/ 826871c5d3a227cb95008a25e90e358ec0ac615222Vikram Kanigiri#define BL32_TOTAL_BASE (unsigned long)(&__RO_START__) 836871c5d3a227cb95008a25e90e358ec0ac615222Vikram Kanigiri 846871c5d3a227cb95008a25e90e358ec0ac615222Vikram Kanigiri#define BL32_TOTAL_LIMIT (unsigned long)(&__COHERENT_RAM_END__) 856871c5d3a227cb95008a25e90e358ec0ac615222Vikram Kanigiri 86fb037bfb7cbf7b404c069b4ebac5a10059d948b1Dan Handleystatic tsp_args_t *set_smc_args(uint64_t arg0, 877c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta uint64_t arg1, 887c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta uint64_t arg2, 897c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta uint64_t arg3, 907c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta uint64_t arg4, 917c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta uint64_t arg5, 927c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta uint64_t arg6, 937c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta uint64_t arg7) 947c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta{ 957c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta uint64_t mpidr = read_mpidr(); 967c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta uint32_t linear_id; 97fb037bfb7cbf7b404c069b4ebac5a10059d948b1Dan Handley tsp_args_t *pcpu_smc_args; 987c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta 997c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta /* 1007c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * Return to Secure Monitor by raising an SMC. The results of the 1017c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * service are passed as an arguments to the SMC 1027c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta */ 1037c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta linear_id = platform_get_core_pos(mpidr); 1047c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta pcpu_smc_args = &tsp_smc_args[linear_id]; 1057c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta write_sp_arg(pcpu_smc_args, TSP_ARG0, arg0); 1067c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta write_sp_arg(pcpu_smc_args, TSP_ARG1, arg1); 1077c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta write_sp_arg(pcpu_smc_args, TSP_ARG2, arg2); 1087c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta write_sp_arg(pcpu_smc_args, TSP_ARG3, arg3); 1097c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta write_sp_arg(pcpu_smc_args, TSP_ARG4, arg4); 1107c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta write_sp_arg(pcpu_smc_args, TSP_ARG5, arg5); 1117c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta write_sp_arg(pcpu_smc_args, TSP_ARG6, arg6); 1127c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta write_sp_arg(pcpu_smc_args, TSP_ARG7, arg7); 1137c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta 1147c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta return pcpu_smc_args; 1157c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta} 1167c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta 1177c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta/******************************************************************************* 1187c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * TSP main entry point where it gets the opportunity to initialize its secure 1197c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * state/applications. Once the state is initialized, it must return to the 1207c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * SPD with a pointer to the 'tsp_entry_info' structure. 1217c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta ******************************************************************************/ 1227c88f3f633288856dd691dfda222e60092e4dab9Achin Guptauint64_t tsp_main(void) 1237c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta{ 1247c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta uint64_t mpidr = read_mpidr(); 1257c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta uint32_t linear_id = platform_get_core_pos(mpidr); 1267c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta 1277c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta /* Initialize the platform */ 1287c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta bl32_platform_setup(); 1297c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta 1307c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta /* Initialize secure/applications state here */ 131a20a81e5b4a19969673f672523b946647f5d545dAchin Gupta tsp_generic_timer_start(); 1327c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta 1337c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta /* Update this cpu's statistics */ 1347c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta tsp_stats[linear_id].smc_count++; 1357c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta tsp_stats[linear_id].eret_count++; 1367c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta tsp_stats[linear_id].cpu_on_count++; 1377c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta 1387c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta spin_lock(&console_lock); 139fb05246201a2d708fb4f3d5febf47e1fc931fa7eJon Medhurst printf("TSP %s\n\r", build_message); 1406871c5d3a227cb95008a25e90e358ec0ac615222Vikram Kanigiri INFO("Total memory base : 0x%x\n", (unsigned long)BL32_TOTAL_BASE); 1416871c5d3a227cb95008a25e90e358ec0ac615222Vikram Kanigiri INFO("Total memory size : 0x%x bytes\n", 1426871c5d3a227cb95008a25e90e358ec0ac615222Vikram Kanigiri (unsigned long)(BL32_TOTAL_LIMIT - BL32_TOTAL_BASE)); 1437c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta INFO("cpu 0x%x: %d smcs, %d erets %d cpu on requests\n", mpidr, 1447c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta tsp_stats[linear_id].smc_count, 1457c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta tsp_stats[linear_id].eret_count, 1467c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta tsp_stats[linear_id].cpu_on_count); 1477c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta spin_unlock(&console_lock); 1487c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta 1497c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta /* 1507c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * TODO: There is a massive assumption that the SPD and SP can see each 1517c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * other's memory without issues so it is safe to pass pointers to 1527c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * internal memory. Replace this with a shared communication buffer. 1537c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta */ 1547c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta return (uint64_t) &tsp_entry_info; 1557c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta} 1567c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta 1577c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta/******************************************************************************* 1587c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * This function performs any remaining book keeping in the test secure payload 1597c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * after this cpu's architectural state has been setup in response to an earlier 1607c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * psci cpu_on request. 1617c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta ******************************************************************************/ 162fb037bfb7cbf7b404c069b4ebac5a10059d948b1Dan Handleytsp_args_t *tsp_cpu_on_main(void) 1637c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta{ 1647c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta uint64_t mpidr = read_mpidr(); 1657c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta uint32_t linear_id = platform_get_core_pos(mpidr); 1667c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta 167a20a81e5b4a19969673f672523b946647f5d545dAchin Gupta /* Initialize secure/applications state here */ 168a20a81e5b4a19969673f672523b946647f5d545dAchin Gupta tsp_generic_timer_start(); 169a20a81e5b4a19969673f672523b946647f5d545dAchin Gupta 1707c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta /* Update this cpu's statistics */ 1717c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta tsp_stats[linear_id].smc_count++; 1727c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta tsp_stats[linear_id].eret_count++; 1737c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta tsp_stats[linear_id].cpu_on_count++; 1747c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta 1757c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta spin_lock(&console_lock); 1767c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta printf("SP: cpu 0x%x turned on\n\r", mpidr); 1777c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta INFO("cpu 0x%x: %d smcs, %d erets %d cpu on requests\n", mpidr, 1787c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta tsp_stats[linear_id].smc_count, 1797c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta tsp_stats[linear_id].eret_count, 1807c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta tsp_stats[linear_id].cpu_on_count); 1817c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta spin_unlock(&console_lock); 1827c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta 1837c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta /* Indicate to the SPD that we have completed turned ourselves on */ 1847c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta return set_smc_args(TSP_ON_DONE, 0, 0, 0, 0, 0, 0, 0); 1857c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta} 1867c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta 1877c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta/******************************************************************************* 1887c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * This function performs any remaining book keeping in the test secure payload 1897c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * before this cpu is turned off in response to a psci cpu_off request. 1907c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta ******************************************************************************/ 191fb037bfb7cbf7b404c069b4ebac5a10059d948b1Dan Handleytsp_args_t *tsp_cpu_off_main(uint64_t arg0, 1927c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta uint64_t arg1, 1937c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta uint64_t arg2, 1947c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta uint64_t arg3, 1957c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta uint64_t arg4, 1967c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta uint64_t arg5, 1977c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta uint64_t arg6, 1987c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta uint64_t arg7) 1997c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta{ 2007c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta uint64_t mpidr = read_mpidr(); 2017c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta uint32_t linear_id = platform_get_core_pos(mpidr); 2027c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta 203a20a81e5b4a19969673f672523b946647f5d545dAchin Gupta /* 204a20a81e5b4a19969673f672523b946647f5d545dAchin Gupta * This cpu is being turned off, so disable the timer to prevent the 205a20a81e5b4a19969673f672523b946647f5d545dAchin Gupta * secure timer interrupt from interfering with power down. A pending 206a20a81e5b4a19969673f672523b946647f5d545dAchin Gupta * interrupt will be lost but we do not care as we are turning off. 207a20a81e5b4a19969673f672523b946647f5d545dAchin Gupta */ 208a20a81e5b4a19969673f672523b946647f5d545dAchin Gupta tsp_generic_timer_stop(); 209a20a81e5b4a19969673f672523b946647f5d545dAchin Gupta 2107c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta /* Update this cpu's statistics */ 2117c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta tsp_stats[linear_id].smc_count++; 2127c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta tsp_stats[linear_id].eret_count++; 2137c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta tsp_stats[linear_id].cpu_off_count++; 2147c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta 2157c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta spin_lock(&console_lock); 2167c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta printf("SP: cpu 0x%x off request\n\r", mpidr); 2177c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta INFO("cpu 0x%x: %d smcs, %d erets %d cpu off requests\n", mpidr, 2187c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta tsp_stats[linear_id].smc_count, 2197c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta tsp_stats[linear_id].eret_count, 2207c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta tsp_stats[linear_id].cpu_off_count); 2217c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta spin_unlock(&console_lock); 2227c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta 2237c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta 224607084ee4c2a7c20832beb8cd1d5cebf02b2cb26Achin Gupta /* Indicate to the SPD that we have completed this request */ 2257c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta return set_smc_args(TSP_OFF_DONE, 0, 0, 0, 0, 0, 0, 0); 2267c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta} 2277c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta 2287c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta/******************************************************************************* 2297c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * This function performs any book keeping in the test secure payload before 2307c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * this cpu's architectural state is saved in response to an earlier psci 2317c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * cpu_suspend request. 2327c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta ******************************************************************************/ 233fb037bfb7cbf7b404c069b4ebac5a10059d948b1Dan Handleytsp_args_t *tsp_cpu_suspend_main(uint64_t power_state, 2347c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta uint64_t arg1, 2357c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta uint64_t arg2, 2367c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta uint64_t arg3, 2377c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta uint64_t arg4, 2387c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta uint64_t arg5, 2397c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta uint64_t arg6, 2407c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta uint64_t arg7) 2417c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta{ 2427c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta uint64_t mpidr = read_mpidr(); 2437c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta uint32_t linear_id = platform_get_core_pos(mpidr); 2447c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta 245a20a81e5b4a19969673f672523b946647f5d545dAchin Gupta /* 246a20a81e5b4a19969673f672523b946647f5d545dAchin Gupta * Save the time context and disable it to prevent the secure timer 247a20a81e5b4a19969673f672523b946647f5d545dAchin Gupta * interrupt from interfering with wakeup from the suspend state. 248a20a81e5b4a19969673f672523b946647f5d545dAchin Gupta */ 249a20a81e5b4a19969673f672523b946647f5d545dAchin Gupta tsp_generic_timer_save(); 250a20a81e5b4a19969673f672523b946647f5d545dAchin Gupta tsp_generic_timer_stop(); 251a20a81e5b4a19969673f672523b946647f5d545dAchin Gupta 2527c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta /* Update this cpu's statistics */ 2537c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta tsp_stats[linear_id].smc_count++; 2547c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta tsp_stats[linear_id].eret_count++; 2557c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta tsp_stats[linear_id].cpu_suspend_count++; 2567c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta 2577c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta spin_lock(&console_lock); 2587c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta printf("SP: cpu 0x%x suspend request. power state: 0x%x\n\r", 2597c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta mpidr, power_state); 2607c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta INFO("cpu 0x%x: %d smcs, %d erets %d cpu suspend requests\n", mpidr, 2617c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta tsp_stats[linear_id].smc_count, 2627c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta tsp_stats[linear_id].eret_count, 2637c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta tsp_stats[linear_id].cpu_suspend_count); 2647c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta spin_unlock(&console_lock); 2657c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta 266607084ee4c2a7c20832beb8cd1d5cebf02b2cb26Achin Gupta /* Indicate to the SPD that we have completed this request */ 2677c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta return set_smc_args(TSP_SUSPEND_DONE, 0, 0, 0, 0, 0, 0, 0); 2687c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta} 2697c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta 2707c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta/******************************************************************************* 2717c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * This function performs any book keeping in the test secure payload after this 2727c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * cpu's architectural state has been restored after wakeup from an earlier psci 2737c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * cpu_suspend request. 2747c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta ******************************************************************************/ 275fb037bfb7cbf7b404c069b4ebac5a10059d948b1Dan Handleytsp_args_t *tsp_cpu_resume_main(uint64_t suspend_level, 2767c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta uint64_t arg1, 2777c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta uint64_t arg2, 2787c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta uint64_t arg3, 2797c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta uint64_t arg4, 2807c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta uint64_t arg5, 2817c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta uint64_t arg6, 2827c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta uint64_t arg7) 2837c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta{ 2847c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta uint64_t mpidr = read_mpidr(); 2857c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta uint32_t linear_id = platform_get_core_pos(mpidr); 2867c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta 287a20a81e5b4a19969673f672523b946647f5d545dAchin Gupta /* Restore the generic timer context */ 288a20a81e5b4a19969673f672523b946647f5d545dAchin Gupta tsp_generic_timer_restore(); 289a20a81e5b4a19969673f672523b946647f5d545dAchin Gupta 2907c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta /* Update this cpu's statistics */ 2917c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta tsp_stats[linear_id].smc_count++; 2927c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta tsp_stats[linear_id].eret_count++; 2937c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta tsp_stats[linear_id].cpu_resume_count++; 2947c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta 2957c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta spin_lock(&console_lock); 2967c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta printf("SP: cpu 0x%x resumed. suspend level %d \n\r", 2977c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta mpidr, suspend_level); 2987c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta INFO("cpu 0x%x: %d smcs, %d erets %d cpu suspend requests\n", mpidr, 2997c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta tsp_stats[linear_id].smc_count, 3007c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta tsp_stats[linear_id].eret_count, 3017c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta tsp_stats[linear_id].cpu_suspend_count); 3027c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta spin_unlock(&console_lock); 3037c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta 304607084ee4c2a7c20832beb8cd1d5cebf02b2cb26Achin Gupta /* Indicate to the SPD that we have completed this request */ 3057c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta return set_smc_args(TSP_RESUME_DONE, 0, 0, 0, 0, 0, 0, 0); 3067c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta} 3077c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta 3087c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta/******************************************************************************* 3097c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * TSP fast smc handler. The secure monitor jumps to this function by 3107c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * doing the ERET after populating X0-X7 registers. The arguments are received 3117c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * in the function arguments in order. Once the service is rendered, this 3127c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * function returns to Secure Monitor by raising SMC 3137c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta ******************************************************************************/ 314fb037bfb7cbf7b404c069b4ebac5a10059d948b1Dan Handleytsp_args_t *tsp_fast_smc_handler(uint64_t func, 3157c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta uint64_t arg1, 3167c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta uint64_t arg2, 3177c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta uint64_t arg3, 3187c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta uint64_t arg4, 3197c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta uint64_t arg5, 3207c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta uint64_t arg6, 3217c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta uint64_t arg7) 3227c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta{ 323916a2c1ec16eed4199f27a24b8e2985275cda423Achin Gupta uint64_t results[2]; 324916a2c1ec16eed4199f27a24b8e2985275cda423Achin Gupta uint64_t service_args[2]; 325916a2c1ec16eed4199f27a24b8e2985275cda423Achin Gupta uint64_t mpidr = read_mpidr(); 326916a2c1ec16eed4199f27a24b8e2985275cda423Achin Gupta uint32_t linear_id = platform_get_core_pos(mpidr); 3277c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta 328916a2c1ec16eed4199f27a24b8e2985275cda423Achin Gupta /* Update this cpu's statistics */ 329916a2c1ec16eed4199f27a24b8e2985275cda423Achin Gupta tsp_stats[linear_id].smc_count++; 330916a2c1ec16eed4199f27a24b8e2985275cda423Achin Gupta tsp_stats[linear_id].eret_count++; 331916a2c1ec16eed4199f27a24b8e2985275cda423Achin Gupta 332916a2c1ec16eed4199f27a24b8e2985275cda423Achin Gupta printf("SP: cpu 0x%x received fast smc 0x%x\n", read_mpidr(), func); 333916a2c1ec16eed4199f27a24b8e2985275cda423Achin Gupta INFO("cpu 0x%x: %d smcs, %d erets\n", mpidr, 334916a2c1ec16eed4199f27a24b8e2985275cda423Achin Gupta tsp_stats[linear_id].smc_count, 335916a2c1ec16eed4199f27a24b8e2985275cda423Achin Gupta tsp_stats[linear_id].eret_count); 3367c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta 337916a2c1ec16eed4199f27a24b8e2985275cda423Achin Gupta /* Render secure services and obtain results here */ 3387c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta 3397c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta results[0] = arg1; 3407c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta results[1] = arg2; 3417c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta 3427c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta /* 3437c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * Request a service back from dispatcher/secure monitor. This call 3447c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta * return and thereafter resume exectuion 3457c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta */ 3467c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta tsp_get_magic(service_args); 3477c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta 3487c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta /* Determine the function to perform based on the function ID */ 3497c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta switch (func) { 3507c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta case TSP_FID_ADD: 3517c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta results[0] += service_args[0]; 3527c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta results[1] += service_args[1]; 3537c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta break; 3547c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta case TSP_FID_SUB: 3557c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta results[0] -= service_args[0]; 3567c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta results[1] -= service_args[1]; 3577c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta break; 3587c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta case TSP_FID_MUL: 3597c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta results[0] *= service_args[0]; 3607c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta results[1] *= service_args[1]; 3617c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta break; 3627c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta case TSP_FID_DIV: 3637c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta results[0] /= service_args[0] ? service_args[0] : 1; 3647c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta results[1] /= service_args[1] ? service_args[1] : 1; 3657c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta break; 3667c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta default: 3677c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta break; 3687c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta } 3697c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta 370916a2c1ec16eed4199f27a24b8e2985275cda423Achin Gupta return set_smc_args(func, 3717c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta results[0], 3727c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta results[1], 373916a2c1ec16eed4199f27a24b8e2985275cda423Achin Gupta 0, 0, 0, 0, 0); 3747c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta} 3757c88f3f633288856dd691dfda222e60092e4dab9Achin Gupta 376