lib/pmf/pmf_smc.c

   1 /*
   2  * Copyright (c) 2016-2018, ARM Limited and Contributors. All rights reserved.
   3  *
   4  * SPDX-License-Identifier: BSD-3-Clause
   5  */
   6 #include <assert.h>
   7 #include <debug.h>
   8 #include <platform.h>
   9 #include <pmf.h>
  10 #include <smccc_helpers.h>
  11
  12 /*
  13  * This function is responsible for handling all PMF SMC calls.
  14  */
  15 uintptr_t pmf_smc_handler(unsigned int smc_fid,
  16                         u_register_t x1,
  17                         u_register_t x2,
  18                         u_register_t x3,
  19                         u_register_t x4,
  20                         void *cookie,
  21                         void *handle,
  22                         u_register_t flags)
  23 {
  24         int rc;
  25         unsigned long long ts_value;
  26
  27         if (((smc_fid >> FUNCID_CC_SHIFT) & FUNCID_CC_MASK) == SMC_32) {
  28
  29                 x1 = (uint32_t)x1;
  30                 x2 = (uint32_t)x2;
  31                 x3 = (uint32_t)x3;
  32
  33                 if (smc_fid == PMF_SMC_GET_TIMESTAMP_32) {
  34                         /*
  35                          * Return error code and the captured
  36                          * time-stamp to the caller.
  37                          * x0 --> error code.
  38                          * x1 - x2 --> time-stamp value.
  39                          */
  40                         rc = pmf_get_timestamp_smc((unsigned int)x1, x2,
  41                                         (unsigned int)x3, &ts_value);
  42                         SMC_RET3(handle, rc, (uint32_t)ts_value,
  43                                         (uint32_t)(ts_value >> 32));
  44                 }
  45         } else {
  46                 if (smc_fid == PMF_SMC_GET_TIMESTAMP_64) {
  47                         /*
  48                          * Return error code and the captured
  49                          * time-stamp to the caller.
  50                          * x0 --> error code.
  51                          * x1 --> time-stamp value.
  52                          */
  53                         rc = pmf_get_timestamp_smc((unsigned int)x1, x2,
  54                                         (unsigned int)x3, &ts_value);
  55                         SMC_RET2(handle, rc, ts_value);
  56                 }
  57         }
  58
  59         WARN("Unimplemented PMF Call: 0x%x \n", smc_fid);
  60         SMC_RET1(handle, SMC_UNK);
  61 }