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 */
scmi_sys_pwr_state_set(void * p,uint32_t flags,uint32_t system_state)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 */
scmi_sys_pwr_state_get(void * p,uint32_t * system_state)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