1 /* 2 * Copyright (c) 2017, ARM Limited and Contributors. All rights reserved. 3 * 4 * SPDX-License-Identifier: BSD-3-Clause 5 */ 6 7 #include <arch_helpers.h> 8 #include <assert.h> 9 #include <debug.h> 10 #include "scmi.h" 11 #include "scmi_private.h" 12 13 /* 14 * API to set the SCMI system power state 15 */ 16 int scmi_sys_pwr_state_set(void *p, uint32_t flags, uint32_t system_state) 17 { 18 mailbox_mem_t *mbx_mem; 19 int token = 0, ret; 20 scmi_channel_t *ch = (scmi_channel_t *)p; 21 22 validate_scmi_channel(ch); 23 24 scmi_get_channel(ch); 25 26 mbx_mem = (mailbox_mem_t *)(ch->info->scmi_mbx_mem); 27 mbx_mem->msg_header = SCMI_MSG_CREATE(SCMI_SYS_PWR_PROTO_ID, 28 SCMI_SYS_PWR_STATE_SET_MSG, token); 29 mbx_mem->len = SCMI_SYS_PWR_STATE_SET_MSG_LEN; 30 mbx_mem->flags = SCMI_FLAG_RESP_POLL; 31 SCMI_PAYLOAD_ARG2(mbx_mem->payload, flags, system_state); 32 33 scmi_send_sync_command(ch); 34 35 /* Get the return values */ 36 SCMI_PAYLOAD_RET_VAL1(mbx_mem->payload, ret); 37 assert(mbx_mem->len == SCMI_SYS_PWR_STATE_SET_RESP_LEN); 38 assert(token == SCMI_MSG_GET_TOKEN(mbx_mem->msg_header)); 39 40 scmi_put_channel(ch); 41 42 return ret; 43 } 44 45 /* 46 * API to get the SCMI system power state 47 */ 48 int scmi_sys_pwr_state_get(void *p, uint32_t *system_state) 49 { 50 mailbox_mem_t *mbx_mem; 51 int token = 0, ret; 52 scmi_channel_t *ch = (scmi_channel_t *)p; 53 54 validate_scmi_channel(ch); 55 56 scmi_get_channel(ch); 57 58 mbx_mem = (mailbox_mem_t *)(ch->info->scmi_mbx_mem); 59 mbx_mem->msg_header = SCMI_MSG_CREATE(SCMI_SYS_PWR_PROTO_ID, 60 SCMI_SYS_PWR_STATE_GET_MSG, token); 61 mbx_mem->len = SCMI_SYS_PWR_STATE_GET_MSG_LEN; 62 mbx_mem->flags = SCMI_FLAG_RESP_POLL; 63 64 scmi_send_sync_command(ch); 65 66 /* Get the return values */ 67 SCMI_PAYLOAD_RET_VAL2(mbx_mem->payload, ret, *system_state); 68 assert(mbx_mem->len == SCMI_SYS_PWR_STATE_GET_RESP_LEN); 69 assert(token == SCMI_MSG_GET_TOKEN(mbx_mem->msg_header)); 70 71 scmi_put_channel(ch); 72 73 return ret; 74 } 75
