1 // SPDX-License-Identifier: BSD-2-Clause 2 /* 3 * Copyright (C) 2016 Freescale Semiconductor, Inc. 4 * All rights reserved. 5 * 6 * Peng Fan <peng.fan@nxp.com> 7 * 8 * Redistribution and use in source and binary forms, with or without 9 * modification, are permitted provided that the following conditions are met: 10 * 11 * 1. Redistributions of source code must retain the above copyright notice, 12 * this list of conditions and the following disclaimer. 13 * 14 * 2. Redistributions in binary form must reproduce the above copyright notice, 15 * this list of conditions and the following disclaimer in the documentation 16 * and/or other materials provided with the distribution. 17 * 18 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" 19 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 20 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 21 * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE 22 * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 23 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 24 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 25 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 26 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 27 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 28 * POSSIBILITY OF SUCH DAMAGE. 29 */ 30 31 #include <stdint.h> 32 #include <sm/optee_smc.h> 33 #include <sm/psci.h> 34 #include <sm/sm.h> 35 #include <sm/std_smc.h> 36 #include <tee/uuid.h> 37 #include <trace.h> 38 39 static const TEE_UUID uuid = { 40 0x5f8b97df, 0x2d0d, 0x4ad2, 41 {0x98, 0xd2, 0x74, 0xf4, 0x38, 0x27, 0x98, 0xbb}, 42 }; 43 44 void smc_std_handler(struct thread_smc_args *args, struct sm_nsec_ctx *nsec) 45 { 46 uint32_t smc_fid = args->a0; 47 48 if (is_psci_fid(smc_fid)) { 49 tee_psci_handler(args, nsec); 50 return; 51 } 52 53 switch (smc_fid) { 54 case ARM_STD_SVC_CALL_COUNT: 55 /* PSCI is the only STD service implemented */ 56 args->a0 = PSCI_NUM_CALLS; 57 break; 58 case ARM_STD_SVC_UID: 59 args->a0 = uuid.timeLow; 60 args->a1 = (uuid.timeHiAndVersion << 16) | uuid.timeMid; 61 args->a2 = (uuid.clockSeqAndNode[3] << 24) | 62 (uuid.clockSeqAndNode[2] << 16) | 63 (uuid.clockSeqAndNode[1] << 8) | 64 uuid.clockSeqAndNode[0]; 65 args->a3 = (uuid.clockSeqAndNode[7] << 24) | 66 (uuid.clockSeqAndNode[6] << 16) | 67 (uuid.clockSeqAndNode[5] << 8) | 68 uuid.clockSeqAndNode[4]; 69 break; 70 case ARM_STD_SVC_VERSION: 71 args->a0 = STD_SVC_VERSION_MAJOR; 72 args->a1 = STD_SVC_VERSION_MINOR; 73 break; 74 default: 75 args->a0 = OPTEE_SMC_RETURN_UNKNOWN_FUNCTION; 76 break; 77 } 78 } 79