core/arch/arm/plat-ti/sm_platform_handler.c

   1 /*
   2  * Copyright (c) 2017, Texas Instruments
   3  * All rights reserved.
   4  *
   5  * Redistribution and use in source and binary forms, with or without
   6  * modification, are permitted provided that the following conditions are met:
   7  *
   8  * 1. Redistributions of source code must retain the above copyright notice,
   9  * this list of conditions and the following disclaimer.
  10  *
  11  * 2. Redistributions in binary form must reproduce the above copyright notice,
  12  * this list of conditions and the following disclaimer in the documentation
  13  * and/or other materials provided with the distribution.
  14  *
  15  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
  16  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  17  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  18  * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE
  19  * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
  20  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
  21  * SUBSTITUTE GOODS OR SERVICES// LOSS OF USE, DATA, OR PROFITS// OR BUSINESS
  22  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
  23  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
  24  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
  25  * POSSIBILITY OF SUCH DAMAGE.
  26  */
  27
  28 #include <arm32.h>
  29 #include <sm/sm.h>
  30 #include "api_monitor_index.h"
  31
  32 #define API_HAL_RET_VALUE_OK 0x00000000
  33 #define API_HAL_RET_VALUE_SERVICE_UNKNWON 0xFFFFFFFF
  34
  35 bool sm_platform_handler(struct sm_ctx *ctx)
  36 {
  37         if (ctx->nsec.r12 == 0x200)
  38                 return true;
  39
  40         switch (ctx->nsec.r12) {
  41         case API_MONITOR_ACTLR_SETREGISTER_INDEX:
  42                 write_actlr(ctx->nsec.r0);
  43                 isb();
  44                 ctx->nsec.r0 = API_HAL_RET_VALUE_OK;
  45                 break;
  46         case API_MONITOR_TIMER_SETCNTFRQ_INDEX:
  47                 write_cntfrq(ctx->nsec.r0);
  48                 isb();
  49                 ctx->nsec.r0 = API_HAL_RET_VALUE_OK;
  50                 break;
  51         default:
  52                 ctx->nsec.r0 = API_HAL_RET_VALUE_SERVICE_UNKNWON;
  53                 break;
  54         }
  55
  56         return false;
  57 }