blob: c7996ce7ea7ceb6c523dbced910f098c9522209b [file] [log] [blame]
Soren Brinkmann76fcae32016-03-06 20:16:27 -08001/*
Wendy Liangf8fec362017-09-06 09:39:55 -07002 * Copyright (c) 2013-2017, ARM Limited and Contributors. All rights reserved.
Soren Brinkmann76fcae32016-03-06 20:16:27 -08003 *
dp-armfa3cf0b2017-05-03 09:38:09 +01004 * SPDX-License-Identifier: BSD-3-Clause
Soren Brinkmann76fcae32016-03-06 20:16:27 -08005 */
6
7/* Top level SMC handler for SiP calls. Dispatch PM calls to PM SMC handler. */
8
9#include <runtime_svc.h>
10#include <uuid.h>
Wendy Liangf8fec362017-09-06 09:39:55 -070011#include "ipi_mailbox_svc.h"
Soren Brinkmann76fcae32016-03-06 20:16:27 -080012#include "pm_svc_main.h"
Wendy Liangf8fec362017-09-06 09:39:55 -070013#include "zynqmp_ipi.h"
Soren Brinkmann76fcae32016-03-06 20:16:27 -080014
15/* SMC function IDs for SiP Service queries */
16#define ZYNQMP_SIP_SVC_CALL_COUNT 0x8200ff00
17#define ZYNQMP_SIP_SVC_UID 0x8200ff01
18#define ZYNQMP_SIP_SVC_VERSION 0x8200ff03
19
20/* SiP Service Calls version numbers */
21#define SIP_SVC_VERSION_MAJOR 0
22#define SIP_SVC_VERSION_MINOR 1
23
Wendy Liangf8fec362017-09-06 09:39:55 -070024/* These macros are used to identify PM, IPI calls from the SMC function ID */
Soren Brinkmann76fcae32016-03-06 20:16:27 -080025#define PM_FID_MASK 0xf000u
26#define PM_FID_VALUE 0u
Wendy Liangf8fec362017-09-06 09:39:55 -070027#define IPI_FID_VALUE 0x1000u
Soren Brinkmann76fcae32016-03-06 20:16:27 -080028#define is_pm_fid(_fid) (((_fid) & PM_FID_MASK) == PM_FID_VALUE)
Wendy Liangf8fec362017-09-06 09:39:55 -070029#define is_ipi_fid(_fid) (((_fid) & PM_FID_MASK) == IPI_FID_VALUE)
Soren Brinkmann76fcae32016-03-06 20:16:27 -080030
31/* SiP Service UUID */
32DEFINE_SVC_UUID(zynqmp_sip_uuid,
33 0x2a1d9b5c, 0x8605, 0x4023, 0xa6, 0x1b,
34 0xb9, 0x25, 0x82, 0x2d, 0xe3, 0xa5);
35
36/**
37 * sip_svc_setup() - Setup SiP Service
38 *
39 * Invokes PM setup
40 */
41static int32_t sip_svc_setup(void)
42{
43 /* PM implementation as SiP Service */
44 pm_setup();
45
46 return 0;
47}
48
49/**
50 * sip_svc_smc_handler() - Top-level SiP Service SMC handler
51 *
52 * Handler for all SiP SMC calls. Handles standard SIP requests
53 * and calls PM SMC handler if the call is for a PM-API function.
54 */
Masahiro Yamada5ac9d962018-04-19 01:18:48 +090055uintptr_t sip_svc_smc_handler(uint32_t smc_fid,
56 u_register_t x1,
57 u_register_t x2,
58 u_register_t x3,
59 u_register_t x4,
60 void *cookie,
61 void *handle,
62 u_register_t flags)
Soren Brinkmann76fcae32016-03-06 20:16:27 -080063{
64 /* Let PM SMC handler deal with PM-related requests */
65 if (is_pm_fid(smc_fid)) {
66 return pm_smc_handler(smc_fid, x1, x2, x3, x4, cookie, handle,
67 flags);
68 }
69
Wendy Liangf8fec362017-09-06 09:39:55 -070070 /* Let IPI SMC handler deal with IPI-related requests */
71 if (is_ipi_fid(smc_fid)) {
72 return ipi_smc_handler(smc_fid, x1, x2, x3, x4, cookie, handle,
73 flags);
74 }
75
Soren Brinkmann76fcae32016-03-06 20:16:27 -080076 switch (smc_fid) {
77 case ZYNQMP_SIP_SVC_CALL_COUNT:
78 /* PM functions + default functions */
79 SMC_RET1(handle, PM_API_MAX + 2);
80
81 case ZYNQMP_SIP_SVC_UID:
82 SMC_UUID_RET(handle, zynqmp_sip_uuid);
83
84 case ZYNQMP_SIP_SVC_VERSION:
85 SMC_RET2(handle, SIP_SVC_VERSION_MAJOR, SIP_SVC_VERSION_MINOR);
86
87 default:
88 WARN("Unimplemented SiP Service Call: 0x%x\n", smc_fid);
89 SMC_RET1(handle, SMC_UNK);
90 }
91}
92
93/* Register PM Service Calls as runtime service */
94DECLARE_RT_SVC(
95 sip_svc,
96 OEN_SIP_START,
97 OEN_SIP_END,
98 SMC_TYPE_FAST,
99 sip_svc_setup,
100 sip_svc_smc_handler);