123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117 |
- #include <errno.h>
- #include <inttypes.h>
- #include <common/debug.h>
- #include <common/runtime_svc.h>
- #include <drivers/scmi-msg.h>
- #include <scmi.h>
- #include <tools_share/uuid.h>
- #include "ipi_mailbox_svc.h"
- #include "plat_private.h"
- #include "pm_svc_main.h"
- #define SIP_SVC_UID (0x8200ff01U)
- #define SIP_SVC_VERSION (0x8200ff03U)
- #define SIP_SVC_VERSION_MAJOR (0U)
- #define SIP_SVC_VERSION_MINOR (1U)
- #define SIP_FID_MASK GENMASK(23, 16)
- #define XLNX_FID_MASK GENMASK(23, 12)
- #define PM_FID_VALUE 0u
- #define IPI_FID_VALUE 0x1000u
- #define is_pm_fid(_fid) (((_fid) & XLNX_FID_MASK) == PM_FID_VALUE)
- #define is_ipi_fid(_fid) (((_fid) & XLNX_FID_MASK) == IPI_FID_VALUE)
- DEFINE_SVC_UUID2(_sip_uuid,
- 0x0499eb70, 0x5ed0, 0x11ee, 0xb3, 0x0a,
- 0x87, 0xd1, 0x1d, 0x4f, 0x8a, 0x9b);
- static int32_t sip_svc_setup(void)
- {
- return sip_svc_setup_init();
- }
- static uintptr_t sip_svc_smc_handler(uint32_t smc_fid,
- u_register_t x1,
- u_register_t x2,
- u_register_t x3,
- u_register_t x4,
- void *cookie,
- void *handle,
- u_register_t flags)
- {
- VERBOSE("SMCID: 0x%08x, x1: 0x%016" PRIx64 ", x2: 0x%016" PRIx64 ", x3: 0x%016" PRIx64 ", x4: 0x%016" PRIx64 "\n",
- smc_fid, x1, x2, x3, x4);
- if ((smc_fid & SIP_FID_MASK) != 0) {
- WARN("SMC out of SiP assinged range: 0x%x\n", smc_fid);
- SMC_RET1(handle, SMC_UNK);
- }
-
- if (is_pm_fid(smc_fid)) {
- return smc_handler(smc_fid, x1, x2, x3, x4, cookie, handle, flags);
- }
-
- if (is_ipi_fid(smc_fid)) {
- return ipi_smc_handler(smc_fid, x1, x2, x3, x4, cookie, handle, flags);
- }
-
- switch (smc_fid) {
- case SIP_SVC_UID:
- SMC_UUID_RET(handle, _sip_uuid);
- case SIP_SVC_VERSION:
- SMC_RET2(handle, SIP_SVC_VERSION_MAJOR, SIP_SVC_VERSION_MINOR);
- case SIP_SCMI:
- if (platform_id != EMU) {
- scmi_smt_fastcall_smc_entry(0);
- SMC_RET1(handle, 0);
- }
- WARN("SCMI is not working on EMU\n");
- SMC_RET1(handle, SMC_UNK);
- default:
- WARN("Unimplemented SiP Service Call: 0x%x\n", smc_fid);
- SMC_RET1(handle, SMC_UNK);
- }
- }
- DECLARE_RT_SVC(
- sip_svc,
- OEN_SIP_START,
- OEN_SIP_END,
- SMC_TYPE_FAST,
- sip_svc_setup,
- sip_svc_smc_handler);
|